mirror of
https://github.com/Fennix-Project/Kernel.git
synced 2025-07-10 23:09:18 +00:00
Update filesystem structure
This commit is contained in:
311
Modules/AHCI/AdvancedHostControllerInterface.cpp
Normal file
311
Modules/AHCI/AdvancedHostControllerInterface.cpp
Normal file
@ -0,0 +1,311 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "ahci.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
using namespace PCI;
|
||||
|
||||
namespace AdvancedHostControllerInterface
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
HBAMemory *ABAR;
|
||||
Port *Ports[32];
|
||||
uint8_t PortCount = 0;
|
||||
|
||||
PCIDeviceHeader *PCIBaseAddress;
|
||||
|
||||
const char *PortTypeName[] = {"None",
|
||||
"SATA",
|
||||
"SEMB",
|
||||
"PM",
|
||||
"SATAPI"};
|
||||
|
||||
PortType CheckPortType(HBAPort *Port)
|
||||
{
|
||||
uint32_t SataStatus = Port->SataStatus;
|
||||
uint8_t InterfacePowerManagement = (SataStatus >> 8) & 0b111;
|
||||
uint8_t DeviceDetection = SataStatus & 0b111;
|
||||
|
||||
if (DeviceDetection != HBA_PORT_DEV_PRESENT)
|
||||
return PortType::None;
|
||||
if (InterfacePowerManagement != HBA_PORT_IPM_ACTIVE)
|
||||
return PortType::None;
|
||||
|
||||
switch (Port->Signature)
|
||||
{
|
||||
case SATA_SIG_ATAPI:
|
||||
return PortType::SATAPI;
|
||||
case SATA_SIG_ATA:
|
||||
return PortType::SATA;
|
||||
case SATA_SIG_PM:
|
||||
return PortType::PM;
|
||||
case SATA_SIG_SEMB:
|
||||
return PortType::SEMB;
|
||||
default:
|
||||
return PortType::None;
|
||||
}
|
||||
}
|
||||
|
||||
Port::Port(PortType Type, HBAPort *PortPtr, uint8_t PortNumber)
|
||||
{
|
||||
this->AHCIPortType = Type;
|
||||
this->HBAPortPtr = PortPtr;
|
||||
this->Buffer = static_cast<uint8_t *>(KAPI.Memory.RequestPage(1));
|
||||
memset(this->Buffer, 0, KAPI.Memory.PageSize);
|
||||
this->PortNumber = PortNumber;
|
||||
}
|
||||
|
||||
Port::~Port()
|
||||
{
|
||||
KAPI.Memory.FreePage(this->Buffer, 1);
|
||||
}
|
||||
|
||||
void Port::StartCMD()
|
||||
{
|
||||
while (HBAPortPtr->CommandStatus & HBA_PxCMD_CR)
|
||||
;
|
||||
HBAPortPtr->CommandStatus |= HBA_PxCMD_FRE;
|
||||
HBAPortPtr->CommandStatus |= HBA_PxCMD_ST;
|
||||
}
|
||||
|
||||
void Port::StopCMD()
|
||||
{
|
||||
HBAPortPtr->CommandStatus &= ~HBA_PxCMD_ST;
|
||||
HBAPortPtr->CommandStatus &= ~HBA_PxCMD_FRE;
|
||||
while (true)
|
||||
{
|
||||
if (HBAPortPtr->CommandStatus & HBA_PxCMD_FR)
|
||||
continue;
|
||||
if (HBAPortPtr->CommandStatus & HBA_PxCMD_CR)
|
||||
continue;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
void Port::Configure()
|
||||
{
|
||||
StopCMD();
|
||||
void *NewBase = KAPI.Memory.RequestPage(1);
|
||||
HBAPortPtr->CommandListBase = (uint32_t)(uint64_t)NewBase;
|
||||
HBAPortPtr->CommandListBaseUpper = (uint32_t)((uint64_t)NewBase >> 32);
|
||||
memset(reinterpret_cast<void *>(HBAPortPtr->CommandListBase), 0, 1024);
|
||||
|
||||
void *FISBase = KAPI.Memory.RequestPage(1);
|
||||
HBAPortPtr->FISBaseAddress = (uint32_t)(uint64_t)FISBase;
|
||||
HBAPortPtr->FISBaseAddressUpper = (uint32_t)((uint64_t)FISBase >> 32);
|
||||
memset(FISBase, 0, 256);
|
||||
|
||||
HBACommandHeader *CommandHeader = (HBACommandHeader *)((uint64_t)HBAPortPtr->CommandListBase + ((uint64_t)HBAPortPtr->CommandListBaseUpper << 32));
|
||||
for (int i = 0; i < 32; i++)
|
||||
{
|
||||
CommandHeader[i].PRDTLength = 8;
|
||||
void *CommandTableAddress = KAPI.Memory.RequestPage(1);
|
||||
uint64_t Address = (uint64_t)CommandTableAddress + (i << 8);
|
||||
CommandHeader[i].CommandTableBaseAddress = (uint32_t)(uint64_t)Address;
|
||||
CommandHeader[i].CommandTableBaseAddressUpper = (uint32_t)((uint64_t)Address >> 32);
|
||||
memset(CommandTableAddress, 0, 256);
|
||||
}
|
||||
StartCMD();
|
||||
}
|
||||
|
||||
bool Port::ReadWrite(uint64_t Sector, uint32_t SectorCount, uint8_t *Buffer, bool Write)
|
||||
{
|
||||
if (this->PortNumber == PortType::SATAPI && Write)
|
||||
{
|
||||
error("SATAPI port does not support write.");
|
||||
return false;
|
||||
}
|
||||
|
||||
uint32_t SectorL = (uint32_t)Sector;
|
||||
uint32_t SectorH = (uint32_t)(Sector >> 32);
|
||||
|
||||
HBAPortPtr->InterruptStatus = (uint32_t)-1; // Clear pending interrupt bits
|
||||
|
||||
HBACommandHeader *CommandHeader = reinterpret_cast<HBACommandHeader *>(HBAPortPtr->CommandListBase);
|
||||
CommandHeader->CommandFISLength = sizeof(FIS_REG_H2D) / sizeof(uint32_t);
|
||||
if (Write)
|
||||
CommandHeader->Write = 1;
|
||||
else
|
||||
CommandHeader->Write = 0;
|
||||
CommandHeader->PRDTLength = 1;
|
||||
|
||||
HBACommandTable *CommandTable = reinterpret_cast<HBACommandTable *>(CommandHeader->CommandTableBaseAddress);
|
||||
memset(CommandTable, 0, sizeof(HBACommandTable) + (CommandHeader->PRDTLength - 1) * sizeof(HBAPRDTEntry));
|
||||
|
||||
CommandTable->PRDTEntry[0].DataBaseAddress = (uint32_t)(uint64_t)Buffer;
|
||||
CommandTable->PRDTEntry[0].DataBaseAddressUpper = (uint32_t)((uint64_t)Buffer >> 32);
|
||||
|
||||
#pragma GCC diagnostic push
|
||||
/* conversion from ‘uint32_t’ {aka ‘unsigned int’} to ‘unsigned int:22’ may change value */
|
||||
#pragma GCC diagnostic ignored "-Wconversion"
|
||||
CommandTable->PRDTEntry[0].ByteCount = (SectorCount << 9) - 1; /* 512 bytes per sector */
|
||||
#pragma GCC diagnostic pop
|
||||
|
||||
CommandTable->PRDTEntry[0].InterruptOnCompletion = 1;
|
||||
|
||||
FIS_REG_H2D *CommandFIS = (FIS_REG_H2D *)(&CommandTable->CommandFIS);
|
||||
|
||||
CommandFIS->FISType = FIS_TYPE_REG_H2D;
|
||||
CommandFIS->CommandControl = 1;
|
||||
if (Write)
|
||||
CommandFIS->Command = ATA_CMD_WRITE_DMA_EX;
|
||||
else
|
||||
CommandFIS->Command = ATA_CMD_READ_DMA_EX;
|
||||
|
||||
CommandFIS->LBA0 = (uint8_t)SectorL;
|
||||
CommandFIS->LBA1 = (uint8_t)(SectorL >> 8);
|
||||
CommandFIS->LBA2 = (uint8_t)(SectorL >> 16);
|
||||
CommandFIS->LBA3 = (uint8_t)SectorH;
|
||||
CommandFIS->LBA4 = (uint8_t)(SectorH >> 8);
|
||||
CommandFIS->LBA5 = (uint8_t)(SectorH >> 16);
|
||||
|
||||
CommandFIS->DeviceRegister = 1 << 6; // LBA mode
|
||||
CommandFIS->CountLow = SectorCount & 0xFF;
|
||||
CommandFIS->CountHigh = (SectorCount >> 8) & 0xFF;
|
||||
|
||||
uint64_t Spin = 0;
|
||||
|
||||
while ((HBAPortPtr->TaskFileData & (ATA_DEV_BUSY | ATA_DEV_DRQ)) && Spin < 1000000)
|
||||
Spin++;
|
||||
if (Spin == 1000000)
|
||||
{
|
||||
error("Port not responding.");
|
||||
return false;
|
||||
}
|
||||
|
||||
HBAPortPtr->CommandIssue = 1;
|
||||
|
||||
Spin = 0;
|
||||
int TryCount = 0;
|
||||
|
||||
while (true)
|
||||
{
|
||||
if (Spin > 100000000)
|
||||
{
|
||||
error("Port %d not responding. (%d)", this->PortNumber, TryCount);
|
||||
Spin = 0;
|
||||
TryCount++;
|
||||
if (TryCount > 10)
|
||||
return false;
|
||||
}
|
||||
if (HBAPortPtr->CommandIssue == 0)
|
||||
break;
|
||||
Spin++;
|
||||
if (HBAPortPtr->InterruptStatus & HBA_PxIS_TFES)
|
||||
{
|
||||
error("Error reading/writing (%d).", Write);
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
PCIBaseAddress = reinterpret_cast<PCIDeviceHeader *>(Data->RawPtr);
|
||||
ABAR = reinterpret_cast<HBAMemory *>(((PCIHeader0 *)PCIBaseAddress)->BAR5);
|
||||
KAPI.Memory.Map((void *)ABAR, (void *)ABAR, (1 << 1));
|
||||
|
||||
uint32_t PortsImplemented = ABAR->PortsImplemented;
|
||||
for (int i = 0; i < 32; i++)
|
||||
{
|
||||
if (PortsImplemented & (1 << i))
|
||||
{
|
||||
PortType portType = CheckPortType(&ABAR->Ports[i]);
|
||||
if (portType == PortType::SATA || portType == PortType::SATAPI)
|
||||
{
|
||||
trace("%s drive found at port %d", PortTypeName[portType], i);
|
||||
Ports[PortCount] = new Port(portType, &ABAR->Ports[i], PortCount);
|
||||
PortCount++;
|
||||
}
|
||||
else
|
||||
{
|
||||
if (portType != PortType::None)
|
||||
warn("Unsupported drive type %s found at port %d", PortTypeName[portType], i);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
for (int i = 0; i < PortCount; i++)
|
||||
Ports[i]->Configure();
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
Data->DiskCallback.Fetch.Ports = PortCount;
|
||||
Data->DiskCallback.Fetch.BytesPerSector = 512;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
// TODO: Stop the driver.
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
case ReceiveReason:
|
||||
{
|
||||
Ports[Data->DiskCallback.RW.Port]->ReadWrite(Data->DiskCallback.RW.Sector,
|
||||
(uint32_t)Data->DiskCallback.RW.SectorCount,
|
||||
Data->DiskCallback.RW.Buffer,
|
||||
Data->DiskCallback.RW.Write);
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
/* There's no need to do anything here. */
|
||||
return OK;
|
||||
}
|
||||
}
|
193
Modules/AHCI/ahci.hpp
Normal file
193
Modules/AHCI/ahci.hpp
Normal file
@ -0,0 +1,193 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_AHCI_H__
|
||||
#define __FENNIX_KERNEL_AHCI_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace AdvancedHostControllerInterface
|
||||
{
|
||||
#define ATA_DEV_BUSY 0x80
|
||||
#define ATA_DEV_DRQ 0x08
|
||||
#define ATA_CMD_WRITE_DMA_EX 0x35
|
||||
#define ATA_CMD_READ_DMA_EX 0x25
|
||||
#define HBA_PxIS_TFES (1 << 30)
|
||||
|
||||
#define HBA_PORT_DEV_PRESENT 0x3
|
||||
#define HBA_PORT_IPM_ACTIVE 0x1
|
||||
#define SATA_SIG_ATAPI 0xEB140101
|
||||
#define SATA_SIG_ATA 0x00000101
|
||||
#define SATA_SIG_SEMB 0xC33C0101
|
||||
#define SATA_SIG_PM 0x96690101
|
||||
|
||||
#define HBA_PxCMD_CR 0x8000
|
||||
#define HBA_PxCMD_FRE 0x0010
|
||||
#define HBA_PxCMD_ST 0x0001
|
||||
#define HBA_PxCMD_FR 0x4000
|
||||
|
||||
enum PortType
|
||||
{
|
||||
None = 0,
|
||||
SATA = 1,
|
||||
SEMB = 2,
|
||||
PM = 3,
|
||||
SATAPI = 4,
|
||||
};
|
||||
|
||||
enum FIS_TYPE
|
||||
{
|
||||
FIS_TYPE_REG_H2D = 0x27,
|
||||
FIS_TYPE_REG_D2H = 0x34,
|
||||
FIS_TYPE_DMA_ACT = 0x39,
|
||||
FIS_TYPE_DMA_SETUP = 0x41,
|
||||
FIS_TYPE_DATA = 0x46,
|
||||
FIS_TYPE_BIST = 0x58,
|
||||
FIS_TYPE_PIO_SETUP = 0x5F,
|
||||
FIS_TYPE_DEV_BITS = 0xA1,
|
||||
};
|
||||
|
||||
struct HBAPort
|
||||
{
|
||||
uint32_t CommandListBase;
|
||||
uint32_t CommandListBaseUpper;
|
||||
uint32_t FISBaseAddress;
|
||||
uint32_t FISBaseAddressUpper;
|
||||
uint32_t InterruptStatus;
|
||||
uint32_t InterruptEnable;
|
||||
uint32_t CommandStatus;
|
||||
uint32_t Reserved0;
|
||||
uint32_t TaskFileData;
|
||||
uint32_t Signature;
|
||||
uint32_t SataStatus;
|
||||
uint32_t SataControl;
|
||||
uint32_t SataError;
|
||||
uint32_t SataActive;
|
||||
uint32_t CommandIssue;
|
||||
uint32_t SataNotification;
|
||||
uint32_t FISSwitchControl;
|
||||
uint32_t Reserved1[11];
|
||||
uint32_t Vendor[4];
|
||||
};
|
||||
|
||||
struct HBAMemory
|
||||
{
|
||||
uint32_t HostCapability;
|
||||
uint32_t GlobalHostControl;
|
||||
uint32_t InterruptStatus;
|
||||
uint32_t PortsImplemented;
|
||||
uint32_t Version;
|
||||
uint32_t CCCControl;
|
||||
uint32_t CCCPorts;
|
||||
uint32_t EnclosureManagementLocation;
|
||||
uint32_t EnclosureManagementControl;
|
||||
uint32_t HostCapabilitiesExtended;
|
||||
uint32_t BIOSHandoffControlStatus;
|
||||
uint8_t Reserved0[0x74];
|
||||
uint8_t Vendor[0x60];
|
||||
HBAPort Ports[1];
|
||||
};
|
||||
|
||||
struct HBACommandHeader
|
||||
{
|
||||
uint8_t CommandFISLength : 5;
|
||||
uint8_t ATAPI : 1;
|
||||
uint8_t Write : 1;
|
||||
uint8_t Preferable : 1;
|
||||
uint8_t Reset : 1;
|
||||
uint8_t BIST : 1;
|
||||
uint8_t ClearBusy : 1;
|
||||
uint8_t Reserved0 : 1;
|
||||
uint8_t PortMultiplier : 4;
|
||||
uint16_t PRDTLength;
|
||||
uint32_t PRDBCount;
|
||||
uint32_t CommandTableBaseAddress;
|
||||
uint32_t CommandTableBaseAddressUpper;
|
||||
uint32_t Reserved1[4];
|
||||
};
|
||||
|
||||
struct HBAPRDTEntry
|
||||
{
|
||||
uint32_t DataBaseAddress;
|
||||
uint32_t DataBaseAddressUpper;
|
||||
uint32_t Reserved0;
|
||||
uint32_t ByteCount : 22;
|
||||
uint32_t Reserved1 : 9;
|
||||
uint32_t InterruptOnCompletion : 1;
|
||||
};
|
||||
|
||||
struct HBACommandTable
|
||||
{
|
||||
uint8_t CommandFIS[64];
|
||||
uint8_t ATAPICommand[16];
|
||||
uint8_t Reserved[48];
|
||||
HBAPRDTEntry PRDTEntry[];
|
||||
};
|
||||
|
||||
struct FIS_REG_H2D
|
||||
{
|
||||
uint8_t FISType;
|
||||
uint8_t PortMultiplier : 4;
|
||||
uint8_t Reserved0 : 3;
|
||||
uint8_t CommandControl : 1;
|
||||
uint8_t Command;
|
||||
uint8_t FeatureLow;
|
||||
uint8_t LBA0;
|
||||
uint8_t LBA1;
|
||||
uint8_t LBA2;
|
||||
uint8_t DeviceRegister;
|
||||
uint8_t LBA3;
|
||||
uint8_t LBA4;
|
||||
uint8_t LBA5;
|
||||
uint8_t FeatureHigh;
|
||||
uint8_t CountLow;
|
||||
uint8_t CountHigh;
|
||||
uint8_t ISOCommandCompletion;
|
||||
uint8_t Control;
|
||||
uint8_t Reserved1[4];
|
||||
};
|
||||
|
||||
struct BARData
|
||||
{
|
||||
uint8_t Type;
|
||||
uint16_t IOBase;
|
||||
uint64_t MemoryBase;
|
||||
};
|
||||
|
||||
class Port
|
||||
{
|
||||
public:
|
||||
PortType AHCIPortType;
|
||||
HBAPort *HBAPortPtr;
|
||||
uint8_t *Buffer;
|
||||
uint8_t PortNumber;
|
||||
|
||||
Port(PortType Type, HBAPort *PortPtr, uint8_t PortNumber);
|
||||
~Port();
|
||||
void StartCMD();
|
||||
void StopCMD();
|
||||
void Configure();
|
||||
bool ReadWrite(uint64_t Sector, uint32_t SectorCount, uint8_t *Buffer, bool Write);
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_AHCI_H__
|
91
Modules/ATA/AdvancedTechnologyAttachment.cpp
Normal file
91
Modules/ATA/AdvancedTechnologyAttachment.cpp
Normal file
@ -0,0 +1,91 @@
|
||||
#include "ata.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
namespace AdvancedTechnologyAttachment
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
bool IsATAPresent()
|
||||
{
|
||||
outb(0x1F0 + 2, 0);
|
||||
outb(0x1F0 + 3, 0);
|
||||
outb(0x1F0 + 4, 0);
|
||||
outb(0x1F0 + 5, 0);
|
||||
outb(0x1F0 + 7, 0xEC);
|
||||
if (inb(0x1F0 + 7) == 0 || inb(0x1F0 + 1) != 0)
|
||||
return false;
|
||||
return true;
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
if (!IsATAPresent())
|
||||
return NOT_AVAILABLE;
|
||||
trace("ATA device found.");
|
||||
|
||||
return NOT_IMPLEMENTED;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
case ReceiveReason:
|
||||
{
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
// TODO: Stop the driver.
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *Registers)
|
||||
{
|
||||
if (Registers->InterruptNumber == 0xE)
|
||||
{
|
||||
fixme("IRQ14");
|
||||
}
|
||||
else if (Registers->InterruptNumber == 0xF)
|
||||
{
|
||||
fixme("IRQ15");
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
}
|
31
Modules/ATA/ata.hpp
Normal file
31
Modules/ATA/ata.hpp
Normal file
@ -0,0 +1,31 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_ATA_H__
|
||||
#define __FENNIX_KERNEL_ATA_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace AdvancedTechnologyAttachment
|
||||
{
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_ATA_H__
|
114
Modules/AdvancedMicroDevices/PCNET.cpp
Normal file
114
Modules/AdvancedMicroDevices/PCNET.cpp
Normal file
@ -0,0 +1,114 @@
|
||||
#include "pcnet.hpp"
|
||||
|
||||
#include <net/net.hpp>
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
using namespace PCI;
|
||||
|
||||
namespace PCNET
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
PCIDeviceHeader *PCIBaseAddress;
|
||||
BARData BAR;
|
||||
|
||||
MediaAccessControl MAC;
|
||||
InternetProtocol::Version4 IP;
|
||||
|
||||
void WriteRAP32(uint32_t Value) { outportl(BAR.IOBase + 0x14, Value); }
|
||||
void WriteRAP16(uint16_t Value) { outportw(BAR.IOBase + 0x12, Value); }
|
||||
|
||||
uint32_t ReadCSR32(uint32_t CSR)
|
||||
{
|
||||
WriteRAP32(CSR);
|
||||
return inportl(BAR.IOBase + 0x10);
|
||||
}
|
||||
|
||||
uint16_t ReadCSR16(uint16_t CSR)
|
||||
{
|
||||
WriteRAP32(CSR);
|
||||
return inportw(BAR.IOBase + 0x10);
|
||||
}
|
||||
|
||||
void WriteCSR32(uint32_t CSR, uint32_t Value)
|
||||
{
|
||||
WriteRAP32(CSR);
|
||||
outportl(BAR.IOBase + 0x10, Value);
|
||||
}
|
||||
|
||||
void WriteCSR16(uint16_t CSR, uint16_t Value)
|
||||
{
|
||||
WriteRAP16(CSR);
|
||||
outportw(BAR.IOBase + 0x10, Value);
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
PCIBaseAddress = reinterpret_cast<PCIDeviceHeader *>(Data->RawPtr);
|
||||
if (PCIBaseAddress->VendorID == 0x1022 && PCIBaseAddress->DeviceID == 0x2000)
|
||||
{
|
||||
trace("Found AMD PCNET.");
|
||||
uint32_t PCIBAR = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
BAR.Type = PCIBAR & 1;
|
||||
BAR.IOBase = (uint16_t)(PCIBAR & (~3));
|
||||
BAR.MemoryBase = PCIBAR & (~15);
|
||||
}
|
||||
else
|
||||
return DEVICE_NOT_SUPPORTED;
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
memcpy(Data->NetworkCallback.Fetch.Name, (void *)"AMD PCNET", 10);
|
||||
Data->NetworkCallback.Fetch.MAC = MAC.ToHex();
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
{
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
// TODO: Stop the driver.
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
return OK;
|
||||
}
|
||||
}
|
38
Modules/AdvancedMicroDevices/pcnet.hpp
Normal file
38
Modules/AdvancedMicroDevices/pcnet.hpp
Normal file
@ -0,0 +1,38 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_AMD_PCNET_H__
|
||||
#define __FENNIX_KERNEL_AMD_PCNET_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace PCNET
|
||||
{
|
||||
struct BARData
|
||||
{
|
||||
uint8_t Type;
|
||||
uint16_t IOBase;
|
||||
uint64_t MemoryBase;
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_AMD_PCNET_H__
|
370
Modules/AudioCodec97/AudioCodec97.cpp
Normal file
370
Modules/AudioCodec97/AudioCodec97.cpp
Normal file
@ -0,0 +1,370 @@
|
||||
#include "ac97.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
using namespace PCI;
|
||||
|
||||
namespace AudioCodec97
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
/* https://wiki.osdev.org/AC97 */
|
||||
|
||||
PCIDeviceHeader *PCIBaseAddress;
|
||||
BARData BAR;
|
||||
BufferDescriptorList *DescriptorList = nullptr;
|
||||
|
||||
AudioEncodingValues Encoding = AE_PCMs16le;
|
||||
char Channels = 2;
|
||||
uint8_t Volume = AV_Maximum;
|
||||
bool Mute = false;
|
||||
int SampleRate = 48000;
|
||||
char SampleSize = 2;
|
||||
|
||||
uint16_t MixerVolume(uint8_t Left, uint8_t Right, bool Mute)
|
||||
{
|
||||
return ((uint16_t)((Right & 0x3F) |
|
||||
((Left & 0x3F) << 0x8) |
|
||||
(Mute & 1 << 0xF)));
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
PCIBaseAddress = reinterpret_cast<PCIDeviceHeader *>(Data->RawPtr);
|
||||
PCIBaseAddress->Command |= PCI_COMMAND_MASTER | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
||||
|
||||
/* Native Audio Mixer Base Address */
|
||||
uint32_t PCIBAR0 = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
|
||||
/* Native Audio Bus Master Base Address */
|
||||
uint32_t PCIBAR1 = ((PCIHeader0 *)PCIBaseAddress)->BAR1;
|
||||
|
||||
BAR.Type = PCIBAR0 & 1;
|
||||
BAR.MixerAddress = (uint16_t)(PCIBAR0 & (~3));
|
||||
BAR.BusMasterAddress = PCIBAR1 & (~15);
|
||||
|
||||
if (BAR.Type != 1)
|
||||
{
|
||||
error("BAR0 is not I/O.");
|
||||
return INVALID_PCI_BAR;
|
||||
}
|
||||
uint16_t OutputPCMTransferControl = (uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl);
|
||||
|
||||
/* DescriptorList address MUST be physical. */
|
||||
DescriptorList = (BufferDescriptorList *)KAPI.Memory.RequestPage((sizeof(BufferDescriptorList) * DescriptorListLength) / KAPI.Memory.PageSize + 1);
|
||||
memset(DescriptorList, 0, sizeof(BufferDescriptorList) * DescriptorListLength);
|
||||
|
||||
uint16_t DLSampleCount = (uint16_t)(KAPI.Memory.PageSize / SampleSize);
|
||||
for (int i = 0; i < DescriptorListLength; i++)
|
||||
{
|
||||
int DescriptorPages = (int)(sizeof(uint16_t *) / KAPI.Memory.PageSize + 1);
|
||||
DescriptorList[i].Address = (uint32_t)(uint64_t)KAPI.Memory.RequestPage(DescriptorPages);
|
||||
DescriptorList[i].SampleCount = DLSampleCount;
|
||||
DescriptorList[i].Flags = 0;
|
||||
debug("DescriptorList[%d] = { Address: 0x%x (%d %s), SampleCount: %d, Flags: 0x%x }",
|
||||
i,
|
||||
DescriptorList[i].Address, DescriptorPages, DescriptorPages == 1 ? "page" : "pages",
|
||||
DescriptorList[i].SampleCount,
|
||||
DescriptorList[i].Flags);
|
||||
}
|
||||
|
||||
outw(BAR.MixerAddress + NAM_MasterVolume, MixerVolume(Volume, Volume, Mute));
|
||||
outw(BAR.MixerAddress + NAM_PCMOutVolume, MixerVolume(Volume, Volume, Mute));
|
||||
|
||||
outb(OutputPCMTransferControl, inb(OutputPCMTransferControl) | TC_TransferReset);
|
||||
while (inb(OutputPCMTransferControl) & TC_TransferReset)
|
||||
;
|
||||
|
||||
uint32_t GlobalControl = inl((uint16_t)(BAR.BusMasterAddress + NABM_GlobalControl));
|
||||
GlobalControl = (GlobalControl & ~((0x3U) << 22)); /* PCM 16-bit mode */
|
||||
GlobalControl = (GlobalControl & ~((0x3U) << 20)); /* 2 channels */
|
||||
GlobalControl |= GC_GlobalInterruptEnable;
|
||||
GlobalControl &= ~GC_ShutDown;
|
||||
|
||||
outl((uint16_t)(BAR.BusMasterAddress + PCMOUT_BufferDescriptorList), (uint32_t)(uint64_t)DescriptorList);
|
||||
outl((uint16_t)(BAR.BusMasterAddress + NABM_GlobalControl), GlobalControl);
|
||||
|
||||
uint8_t TransferControl = inb(OutputPCMTransferControl);
|
||||
TransferControl |= TC_LastBufferEntryInterruptEnable | TC_IOCInterruptEnable | TC_FifoERRORInterruptEnable;
|
||||
outb(OutputPCMTransferControl, TransferControl);
|
||||
|
||||
// Stop DMA
|
||||
outb(OutputPCMTransferControl, inb(OutputPCMTransferControl) & ~TC_DMAControllerControl);
|
||||
debug("AC'97 configured.");
|
||||
break;
|
||||
}
|
||||
case AdjustReason:
|
||||
{
|
||||
if (Data->AudioCallback.Adjust._Volume)
|
||||
{
|
||||
Volume = (uint8_t)(0x3F - (0x3F * Data->AudioCallback.Adjust.Volume / 100));
|
||||
outw(BAR.MixerAddress + NAM_MasterVolume, MixerVolume(Volume, Volume, Mute));
|
||||
// outw(BAR.MixerAddress + NAM_PCMOutVolume, MixerVolume(Volume, Volume, Mute));
|
||||
}
|
||||
else if (Data->AudioCallback.Adjust._Encoding)
|
||||
{
|
||||
fixme("Encoding changing not supported yet.");
|
||||
}
|
||||
else if (Data->AudioCallback.Adjust._SampleRate)
|
||||
{
|
||||
switch (Data->AudioCallback.Adjust.SampleRate)
|
||||
{
|
||||
case 0:
|
||||
{
|
||||
SampleRate = 8000;
|
||||
break;
|
||||
}
|
||||
case 1:
|
||||
{
|
||||
SampleRate = 11025;
|
||||
break;
|
||||
}
|
||||
case 2:
|
||||
{
|
||||
SampleRate = 16000;
|
||||
break;
|
||||
}
|
||||
case 3:
|
||||
{
|
||||
SampleRate = 22050;
|
||||
break;
|
||||
}
|
||||
case 4:
|
||||
{
|
||||
SampleRate = 32000;
|
||||
break;
|
||||
}
|
||||
case 5:
|
||||
{
|
||||
SampleRate = 44100;
|
||||
break;
|
||||
}
|
||||
case 6:
|
||||
{
|
||||
SampleRate = 48000;
|
||||
break;
|
||||
}
|
||||
case 7:
|
||||
{
|
||||
SampleRate = 88200;
|
||||
break;
|
||||
}
|
||||
case 8:
|
||||
{
|
||||
SampleRate = 96000;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
SampleRate = 16000;
|
||||
error("Invalid sample rate. Defaulting to 16000.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (Data->AudioCallback.Adjust._Channels)
|
||||
{
|
||||
switch (Data->AudioCallback.Adjust.Channels)
|
||||
{
|
||||
case 0:
|
||||
{
|
||||
Channels = 1; // Mono
|
||||
break;
|
||||
}
|
||||
case 1:
|
||||
{
|
||||
Channels = 2; // Stereo
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
Channels = 2;
|
||||
error("Invalid channel count. Defaulting to 2.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
Data->AudioCallback.Fetch.Volume = (unsigned char)((inw(BAR.MixerAddress + NAM_MasterVolume) & 0x3F) * 100 / 0x3F);
|
||||
Data->AudioCallback.Fetch.Encoding = Encoding; /* FIXME */
|
||||
// Data->AudioCallback.Fetch.SampleRate = SampleRate; /* FIXME */
|
||||
Data->AudioCallback.Fetch.Channels = Channels;
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
{
|
||||
unsigned char *Buffer = (unsigned char *)Data->AudioCallback.Send.Data;
|
||||
unsigned int Length = (unsigned int)Data->AudioCallback.Send.Length;
|
||||
|
||||
if (Buffer == nullptr)
|
||||
{
|
||||
error("Invalid buffer.");
|
||||
return INVALID_DATA;
|
||||
}
|
||||
|
||||
if ((Length == 0) || (Length % (SampleSize * Channels)))
|
||||
{
|
||||
error("Invalid buffer length.");
|
||||
return INVALID_DATA;
|
||||
}
|
||||
|
||||
int TotalBDLToFill = (int)((Length + KAPI.Memory.PageSize - 1) >> 12);
|
||||
|
||||
while (Length > 0)
|
||||
{
|
||||
bool ActiveDMA = !(inw((uint16_t)(BAR.BusMasterAddress + PCMOUT_Status)) & TC_DMAControllerControl);
|
||||
|
||||
if (ActiveDMA)
|
||||
{
|
||||
int RemainingBDL = 0;
|
||||
|
||||
do
|
||||
{
|
||||
int CurrentBDL = inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_BufferDescriptorEntry));
|
||||
int LastBDL = inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_DescriptorEntries));
|
||||
|
||||
RemainingBDL = LastBDL - CurrentBDL;
|
||||
if (RemainingBDL < 0)
|
||||
RemainingBDL += DescriptorListLength;
|
||||
|
||||
RemainingBDL += 1;
|
||||
|
||||
if (RemainingBDL >= DescriptorListLength - 1)
|
||||
{
|
||||
long SampleCount = DescriptorList[(CurrentBDL + 1) % DescriptorListLength].SampleCount / Channels;
|
||||
if (SampleCount > 0)
|
||||
KAPI.Util.Sleep(SampleCount * 1000 / SampleRate); // milliseconds
|
||||
}
|
||||
|
||||
} while (RemainingBDL >= DescriptorListLength - 1 && !(inw((uint16_t)(BAR.BusMasterAddress + PCMOUT_Status)) & TC_DMAControllerControl));
|
||||
}
|
||||
|
||||
{
|
||||
uint8_t CurrentBDL = inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_BufferDescriptorEntry));
|
||||
uint8_t LastBDL = inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_DescriptorEntries));
|
||||
uint8_t NextBDL = LastBDL % DescriptorListLength;
|
||||
|
||||
ActiveDMA = !(inw((uint16_t)(BAR.BusMasterAddress + PCMOUT_Status)) & TC_DMAControllerControl);
|
||||
if (ActiveDMA)
|
||||
{
|
||||
NextBDL = (uint8_t)((LastBDL + 1) % DescriptorListLength);
|
||||
if (NextBDL == CurrentBDL)
|
||||
continue;
|
||||
}
|
||||
|
||||
do
|
||||
{
|
||||
size_t Wrote = (KAPI.Memory.PageSize > Length) ? Length : KAPI.Memory.PageSize;
|
||||
|
||||
if (Wrote == 0)
|
||||
break;
|
||||
memcpy((void *)((uint64_t)DescriptorList[NextBDL].Address), Buffer, Wrote);
|
||||
DescriptorList[NextBDL].Flags = 0;
|
||||
|
||||
Buffer += Wrote;
|
||||
Length -= (unsigned int)Wrote;
|
||||
|
||||
DescriptorList[NextBDL].SampleCount = (uint16_t)(Wrote / SampleSize);
|
||||
TotalBDLToFill--;
|
||||
NextBDL = (uint8_t)((NextBDL + 1) % DescriptorListLength);
|
||||
} while (TotalBDLToFill-- && NextBDL != CurrentBDL);
|
||||
|
||||
outb((uint16_t)(BAR.BusMasterAddress + PCMOUT_DescriptorEntries), NextBDL - 1);
|
||||
|
||||
ActiveDMA = !(inw((uint16_t)(BAR.BusMasterAddress + PCMOUT_Status)) & TC_DMAControllerControl);
|
||||
if (!ActiveDMA)
|
||||
{
|
||||
// Start DMA
|
||||
outb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl), inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl) | TC_DMAControllerControl));
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
outw(BAR.MixerAddress + NAM_MasterVolume, MixerVolume(AV_Maximum, AV_Maximum, true));
|
||||
outw(BAR.MixerAddress + NAM_PCMOutVolume, MixerVolume(AV_Maximum, AV_Maximum, true));
|
||||
|
||||
// Stop DMA
|
||||
outb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl), inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl)) & ~TC_DMAControllerControl);
|
||||
|
||||
// Disable interrupts
|
||||
uint8_t TransferControl = inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl));
|
||||
TransferControl &= ~(TC_LastBufferEntryInterruptEnable | TC_IOCInterruptEnable | TC_FifoERRORInterruptEnable);
|
||||
outb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl), TransferControl);
|
||||
|
||||
// Disable global control
|
||||
uint32_t GlobalControl = inl((uint16_t)(BAR.BusMasterAddress + NABM_GlobalControl));
|
||||
GlobalControl &= ~GC_GlobalInterruptEnable;
|
||||
GlobalControl |= GC_ShutDown;
|
||||
outl((uint16_t)(BAR.BusMasterAddress + NABM_GlobalControl), GlobalControl);
|
||||
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
uint16_t Status = inw(BAR.MixerAddress + PCMOUT_Status);
|
||||
|
||||
if (Status & TC_IOCInterruptEnable)
|
||||
{
|
||||
debug("Interrupt on completion.");
|
||||
}
|
||||
else if (Status & TC_LastBufferEntryInterruptEnable)
|
||||
{
|
||||
debug("Last buffer entry.");
|
||||
// Stop DMA
|
||||
outb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl), inb((uint16_t)(BAR.BusMasterAddress + PCMOUT_TransferControl)) & ~TC_DMAControllerControl);
|
||||
}
|
||||
else if (Status & TC_FifoERRORInterruptEnable)
|
||||
{
|
||||
debug("FIFO error.");
|
||||
}
|
||||
else if (Status != 0x0)
|
||||
{
|
||||
error("Unknown status: %#lx", Status);
|
||||
}
|
||||
|
||||
outw(BAR.MixerAddress + PCMOUT_Status, 0xFFFF);
|
||||
return OK;
|
||||
}
|
||||
}
|
348
Modules/AudioCodec97/ac97.hpp
Normal file
348
Modules/AudioCodec97/ac97.hpp
Normal file
@ -0,0 +1,348 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_AC97_H__
|
||||
#define __FENNIX_KERNEL_AC97_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace AudioCodec97
|
||||
{
|
||||
#define DescriptorListLength 0x20
|
||||
|
||||
enum AudioVolumeValues
|
||||
{
|
||||
AV_Maximum = 0x0,
|
||||
AV_Minimum = 0x3F,
|
||||
};
|
||||
|
||||
enum AudioEncodingValues
|
||||
{
|
||||
AE_PCMs8,
|
||||
AE_PCMu8,
|
||||
|
||||
AE_PCMs16le,
|
||||
AE_PCMs20le,
|
||||
AE_PCMs24le,
|
||||
AE_PCMs32le,
|
||||
|
||||
AE_PCMu16le,
|
||||
AE_PCMu20le,
|
||||
AE_PCMu24le,
|
||||
AE_PCMu32le,
|
||||
|
||||
AE_PCMs16be,
|
||||
AE_PCMs20be,
|
||||
AE_PCMs24be,
|
||||
AE_PCMs32be,
|
||||
|
||||
AE_PCMu16be,
|
||||
AE_PCMu20be,
|
||||
AE_PCMu24be,
|
||||
AE_PCMu32be,
|
||||
};
|
||||
|
||||
enum NativeAudioMixerRegisters
|
||||
{
|
||||
/**
|
||||
* @brief Reset Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_Reset = 0x00,
|
||||
|
||||
/**
|
||||
* @brief Master Volume Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_MasterVolume = 0x02,
|
||||
|
||||
/**
|
||||
* @brief Microphone Volume Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_MicrophoneVolume = 0x0E,
|
||||
|
||||
/**
|
||||
* @brief PCM Out Volume Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_PCMOutVolume = 0x18,
|
||||
|
||||
/**
|
||||
* @brief Select Record Input Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_SelectRecordInput = 0x1A,
|
||||
|
||||
/**
|
||||
* @brief Record Gain Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_RecordGain = 0x1C,
|
||||
|
||||
/**
|
||||
* @brief Record Gain Microphone Register
|
||||
* @note Length: word
|
||||
*/
|
||||
NAM_RecordGainMicrophone = 0x1E,
|
||||
};
|
||||
|
||||
enum NativeAudioBusMasterRegisters
|
||||
{
|
||||
/**
|
||||
* @brief Register box for PCM IN
|
||||
* @note Length: below
|
||||
*/
|
||||
NABM_PCMInBox = 0x00,
|
||||
|
||||
/**
|
||||
* @brief Register box for PCM OUT
|
||||
* @note Length: below
|
||||
*/
|
||||
NABM_PCMOutBox = 0x10,
|
||||
|
||||
/**
|
||||
* @brief Register box for Microphone
|
||||
* @note Length: below
|
||||
*/
|
||||
NABM_MicrophoneBox = 0x20,
|
||||
|
||||
/**
|
||||
* @brief Global Control Register
|
||||
* @note Length: dword
|
||||
*/
|
||||
NABM_GlobalControl = 0x2C, /* 0x30 */
|
||||
|
||||
/**
|
||||
* @brief Global Status Register
|
||||
* @note Length: dword
|
||||
*/
|
||||
NABM_GlobalStatus = 0x30, /* 0x34 */
|
||||
};
|
||||
|
||||
enum NativeAudioBusMasterBoxOffsets
|
||||
{
|
||||
/**
|
||||
* @brief Physical Address of Buffer Descriptor List
|
||||
* @note Length: dword
|
||||
*/
|
||||
NABMBOFF_BufferDescriptorList = 0x00,
|
||||
|
||||
/**
|
||||
* @brief Number of Actual Processed Buffer Descriptor Entry
|
||||
* @note Length: byte
|
||||
*/
|
||||
NABMBOFF_BufferDescriptorEntry = 0x04,
|
||||
|
||||
/**
|
||||
* @brief Number of all Descriptor Entries
|
||||
* @note Length: byte
|
||||
*/
|
||||
NABMBOFF_DescriptorEntries = 0x05,
|
||||
|
||||
/**
|
||||
* @brief Status of transferring Data
|
||||
* @note Length: word
|
||||
*/
|
||||
NABMBOFF_Status = 0x06,
|
||||
|
||||
/**
|
||||
* @brief Number of transferred Samples in Actual Processed Entry
|
||||
* @note Length: word
|
||||
*/
|
||||
NABMBOFF_TransferredSamples = 0x08,
|
||||
|
||||
/**
|
||||
* @brief Number of next processed Buffer Entry
|
||||
* @note Length: byte
|
||||
*/
|
||||
NABMBOFF_NextProcessedBufferEntry = 0x0A,
|
||||
|
||||
/**
|
||||
* @brief Transfer Control
|
||||
* @note Length: byte
|
||||
*/
|
||||
NABMBOFF_TransferControl = 0x0B,
|
||||
};
|
||||
|
||||
enum OutputPulseCodeModulationRegisters
|
||||
{
|
||||
/**
|
||||
* @brief Physical Address of Buffer Descriptor List
|
||||
* @note Length: dword
|
||||
*/
|
||||
PCMOUT_BufferDescriptorList = (int)NABM_PCMOutBox + (int)NABMBOFF_BufferDescriptorList,
|
||||
|
||||
/**
|
||||
* @brief Number of Actual Processed Buffer Descriptor Entry
|
||||
* @note Length: byte
|
||||
*/
|
||||
PCMOUT_BufferDescriptorEntry = (int)NABM_PCMOutBox + (int)NABMBOFF_BufferDescriptorEntry,
|
||||
|
||||
/**
|
||||
* @brief Number of all Descriptor Entries
|
||||
* @note Length: byte
|
||||
*/
|
||||
PCMOUT_DescriptorEntries = (int)NABM_PCMOutBox + (int)NABMBOFF_DescriptorEntries,
|
||||
|
||||
/**
|
||||
* @brief Status of transferring Data
|
||||
* @note Length: word
|
||||
*/
|
||||
PCMOUT_Status = (int)NABM_PCMOutBox + (int)NABMBOFF_Status,
|
||||
|
||||
/**
|
||||
* @brief Number of transferred Samples in Actual Processed Entry
|
||||
* @note Length: word
|
||||
*/
|
||||
PCMOUT_TransferredSamples = (int)NABM_PCMOutBox + (int)NABMBOFF_TransferredSamples,
|
||||
|
||||
/**
|
||||
* @brief Number of next processed Buffer Entry
|
||||
* @note Length: byte
|
||||
*/
|
||||
PCMOUT_NextProcessedBufferEntry = (int)NABM_PCMOutBox + (int)NABMBOFF_NextProcessedBufferEntry,
|
||||
|
||||
/**
|
||||
* @brief Transfer Control
|
||||
* @note Length: byte
|
||||
*/
|
||||
PCMOUT_TransferControl = (int)NABM_PCMOutBox + (int)NABMBOFF_TransferControl,
|
||||
};
|
||||
|
||||
enum TransferControlRegisters
|
||||
{
|
||||
/**
|
||||
* @brief DMA controller control
|
||||
* 0 = Pause transfer
|
||||
* 1 = Transfer sound data
|
||||
*/
|
||||
TC_DMAControllerControl = 0x01,
|
||||
|
||||
/**
|
||||
* @brief Reset
|
||||
* 0 = Remove reset condition
|
||||
* 1 = Reset this NABM register box, this bit is cleared by card when is reset complete
|
||||
*/
|
||||
TC_TransferReset = 0x02,
|
||||
|
||||
/**
|
||||
* @brief Last Buffer Entry Interrupt enable
|
||||
* 0 = Disable interrupt
|
||||
* 1 = Enable interrupt
|
||||
*/
|
||||
TC_LastBufferEntryInterruptEnable = 0x04,
|
||||
|
||||
/**
|
||||
* @brief IOC Interrupt enable
|
||||
* 0 = Disable interrupt
|
||||
* 1 = Enable interrupt
|
||||
*/
|
||||
TC_IOCInterruptEnable = 0x08,
|
||||
|
||||
/**
|
||||
* @brief Fifo ERROR Interrupt enable
|
||||
* 0 = Disable interrupt
|
||||
* 1 = Enable interrupt
|
||||
*/
|
||||
TC_FifoERRORInterruptEnable = 0x10,
|
||||
};
|
||||
|
||||
enum GlobalControlRegisters
|
||||
{
|
||||
/**
|
||||
* @brief Global Interrupt Enable
|
||||
* 0 = Disable Interrupts
|
||||
* 1 = Enable Interrupts
|
||||
*/
|
||||
GC_GlobalInterruptEnable = 0x01,
|
||||
|
||||
/**
|
||||
* @brief Cold reset
|
||||
* 0 = Device is in reset and can not be used
|
||||
* 1 = Resume to operational state
|
||||
*/
|
||||
GC_ColdReset = 0x02,
|
||||
|
||||
/**
|
||||
* @brief Warm reset
|
||||
*/
|
||||
GC_WarmReset = 0x04,
|
||||
|
||||
/**
|
||||
* @brief Shut down
|
||||
* 0 = Device is powered
|
||||
* 1 = Shut down
|
||||
*/
|
||||
GC_ShutDown = 0x08,
|
||||
|
||||
/**
|
||||
* @brief Channels for PCM Output
|
||||
* 00 = 2 channels
|
||||
* 01 = 4 channels
|
||||
* 10 = 6 channels
|
||||
* 11 = Reserved
|
||||
*/
|
||||
GC_ChannelsForPCMOutput = 0x30,
|
||||
|
||||
/**
|
||||
* @brief PCM Output mode
|
||||
* 00 = 16 bit samples
|
||||
* 01 = 20 bit samples
|
||||
*/
|
||||
GC_PCMOutputMode = 0xC0,
|
||||
};
|
||||
|
||||
struct BufferDescriptorList
|
||||
{
|
||||
/**
|
||||
* @brief Physical Address to sound data in memory
|
||||
* @note Length: dword
|
||||
*/
|
||||
uint32_t Address;
|
||||
|
||||
/**
|
||||
* @brief Number of samples in this buffer
|
||||
* @note Length: word
|
||||
*/
|
||||
uint16_t SampleCount;
|
||||
|
||||
/**
|
||||
* @brief Flags
|
||||
* @note Length: word
|
||||
*
|
||||
* Bit 15 = Interrupt fired when data from this entry is transferred
|
||||
* Bit 14 = Last entry of buffer, stop playing
|
||||
* Other bits = Reserved
|
||||
*/
|
||||
uint16_t Flags;
|
||||
} __attribute__((packed));
|
||||
|
||||
struct BARData
|
||||
{
|
||||
uint8_t Type;
|
||||
uint16_t MixerAddress;
|
||||
uint64_t BusMasterAddress;
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_AC97_H__
|
278
Modules/BuiltinDriverLoader.cpp
Normal file
278
Modules/BuiltinDriverLoader.cpp
Normal file
@ -0,0 +1,278 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "drv.hpp"
|
||||
|
||||
#include "AHCI/ahci.hpp"
|
||||
#include "VMware/mouse.hpp"
|
||||
#include "PersonalSystem2/mouse.hpp"
|
||||
#include "ATA/ata.hpp"
|
||||
#include "AudioCodec97/ac97.hpp"
|
||||
#include "Realtek/rtl8139.hpp"
|
||||
#include "AdvancedMicroDevices/pcnet.hpp"
|
||||
#include "Intel/gigabit.hpp"
|
||||
|
||||
#include <pci.hpp>
|
||||
#include <vector>
|
||||
|
||||
#include "../Core/Driver/api.hpp"
|
||||
#include "../kernel.h"
|
||||
#include "../DAPI.hpp"
|
||||
#include "../Fex.hpp"
|
||||
|
||||
#pragma GCC diagnostic push
|
||||
#pragma GCC diagnostic ignored "-Wmissing-field-initializers"
|
||||
|
||||
FexExtended AHCIExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Advanced Host Controller Interface",
|
||||
.Type = FexDriverType_Storage,
|
||||
.Callback = AdvancedHostControllerInterface::CallbackHandler,
|
||||
.InterruptCallback = AdvancedHostControllerInterface::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_PCI,
|
||||
.PCI = {
|
||||
.VendorID = {0x8086, 0x15AD},
|
||||
.DeviceID = {0x2922, 0x2829, 0x07E0},
|
||||
.Class = 0x1,
|
||||
.SubClass = 0x6,
|
||||
.ProgIF = 0x1,
|
||||
}}}};
|
||||
|
||||
FexExtended VMwareVirtualMouseExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "VMware Virtual Mouse",
|
||||
.Type = FexDriverType_Input,
|
||||
.TypeFlags = FexDriverInputTypes_Mouse,
|
||||
.OverrideOnConflict = true,
|
||||
.Callback = VMwareMouse::CallbackHandler,
|
||||
.InterruptCallback = VMwareMouse::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_INTERRUPT,
|
||||
.Interrupt = {
|
||||
.Vector = {12}, // IRQ12
|
||||
}}}};
|
||||
|
||||
FexExtended PS2MouseExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "PS/2 Mouse",
|
||||
.Type = FexDriverType_Input,
|
||||
.TypeFlags = FexDriverInputTypes_Mouse,
|
||||
.Callback = PS2Mouse::CallbackHandler,
|
||||
.InterruptCallback = PS2Mouse::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_INTERRUPT,
|
||||
.Interrupt = {
|
||||
.Vector = {12}, // IRQ12
|
||||
}}}};
|
||||
|
||||
FexExtended ATAExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Advanced Technology Attachment",
|
||||
.Type = FexDriverType_Storage,
|
||||
.Callback = AdvancedTechnologyAttachment::CallbackHandler,
|
||||
.InterruptCallback = AdvancedTechnologyAttachment::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_INTERRUPT,
|
||||
.Interrupt = {
|
||||
.Vector = {14, 15}, // IRQ14, IRQ15
|
||||
}}}};
|
||||
|
||||
FexExtended AC97ExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Audio Codec '97 Driver",
|
||||
.Type = FexDriverType_Audio,
|
||||
.TypeFlags = FexDriverInputTypes_None,
|
||||
.OverrideOnConflict = false,
|
||||
.Callback = AudioCodec97::CallbackHandler,
|
||||
.InterruptCallback = AudioCodec97::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_PCI,
|
||||
.PCI = {
|
||||
.VendorID = {0x8086},
|
||||
.DeviceID = {0x2415},
|
||||
.Class = 0x4,
|
||||
.SubClass = 0x3,
|
||||
.ProgIF = 0x0,
|
||||
}}}};
|
||||
|
||||
FexExtended RTL8139ExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Realtek RTL8139",
|
||||
.Type = FexDriverType_Network,
|
||||
.Callback = RTL8139::CallbackHandler,
|
||||
.InterruptCallback = RTL8139::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_PCI,
|
||||
.PCI = {
|
||||
.VendorID = {0x10EC},
|
||||
.DeviceID = {0x8139},
|
||||
.Class = 0x2,
|
||||
.SubClass = 0x0,
|
||||
.ProgIF = 0x0,
|
||||
}}}};
|
||||
|
||||
FexExtended AMDPCNETExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Advanced Micro Devices PCNET",
|
||||
.Type = FexDriverType_Network,
|
||||
.Callback = PCNET::CallbackHandler,
|
||||
.InterruptCallback = PCNET::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_PCI,
|
||||
.PCI = {
|
||||
.VendorID = {0x1022},
|
||||
.DeviceID = {0x2000},
|
||||
.Class = 0x2,
|
||||
.SubClass = 0x0,
|
||||
.ProgIF = 0x0,
|
||||
}}}};
|
||||
|
||||
FexExtended IntelGigabitExtendedHeader = {
|
||||
.Driver = {
|
||||
.Name = "Intel Gigabit Ethernet Controller",
|
||||
.Type = FexDriverType_Network,
|
||||
.Callback = Gigabit::CallbackHandler,
|
||||
.InterruptCallback = Gigabit::InterruptCallback,
|
||||
.Bind = {
|
||||
.Type = BIND_PCI,
|
||||
.PCI = {
|
||||
.VendorID = {0x8086},
|
||||
.DeviceID = {0x100E, 0x100F, 0x10D3, 0x10EA, 0x153A},
|
||||
.Class = 0x2,
|
||||
.SubClass = 0x0,
|
||||
.ProgIF = 0x0,
|
||||
}}}};
|
||||
|
||||
#pragma GCC diagnostic pop
|
||||
|
||||
std::vector<PCI::PCIDeviceHeader *> FindPCI(uint16_t VendorID[16], uint16_t DeviceID[16])
|
||||
{
|
||||
for (uint16_t Vidx = 0; Vidx < 16; Vidx++)
|
||||
{
|
||||
for (uint16_t Didx = 0; Didx < 16; Didx++)
|
||||
{
|
||||
if (VendorID[Vidx] == 0 || DeviceID[Didx] == 0)
|
||||
break;
|
||||
|
||||
std::vector<PCI::PCIDeviceHeader *> devices = PCIManager->FindPCIDevice(VendorID[Vidx], DeviceID[Didx]);
|
||||
if (devices.size() == 0)
|
||||
continue;
|
||||
|
||||
return devices;
|
||||
}
|
||||
}
|
||||
|
||||
warn("No PCI device found");
|
||||
return std::vector<PCI::PCIDeviceHeader *>();
|
||||
}
|
||||
|
||||
bool StartAHCI()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = AdvancedHostControllerInterface::DriverEntry,
|
||||
.ExtendedHeader = &AHCIExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindPCI((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartVMwareMouse()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = VMwareMouse::DriverEntry,
|
||||
.ExtendedHeader = &VMwareVirtualMouseExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindInterrupt((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartPS2Mouse()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = PS2Mouse::DriverEntry,
|
||||
.ExtendedHeader = &PS2MouseExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindInterrupt((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartATA()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = AdvancedTechnologyAttachment::DriverEntry,
|
||||
.ExtendedHeader = &ATAExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindInterrupt((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartAC97()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = AudioCodec97::DriverEntry,
|
||||
.ExtendedHeader = &AC97ExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindPCI((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartRTL8139()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = RTL8139::DriverEntry,
|
||||
.ExtendedHeader = &RTL8139ExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindPCI((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartPCNET()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = PCNET::DriverEntry,
|
||||
.ExtendedHeader = &AMDPCNETExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindPCI((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
bool StartGigabit()
|
||||
{
|
||||
Driver::BuiltInDriverInfo BIDI = {
|
||||
.EntryPoint = Gigabit::DriverEntry,
|
||||
.ExtendedHeader = &IntelGigabitExtendedHeader};
|
||||
|
||||
if (DriverManager->DriverLoadBindPCI((uintptr_t)&BIDI, 0, true) == Driver::DriverCode::OK)
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
369
Modules/Intel/Gigabit.cpp
Normal file
369
Modules/Intel/Gigabit.cpp
Normal file
@ -0,0 +1,369 @@
|
||||
#include "gigabit.hpp"
|
||||
|
||||
#include <net/net.hpp>
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
using namespace PCI;
|
||||
|
||||
namespace Gigabit
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
PCIDeviceHeader *PCIBaseAddress;
|
||||
uint32_t CurrentPacket;
|
||||
BARData BAR;
|
||||
bool EEPROMAvailable;
|
||||
|
||||
uint16_t RXCurrent;
|
||||
uint16_t TXCurrent;
|
||||
RXDescriptor *RX[E1000_NUM_RX_DESC];
|
||||
TXDescriptor *TX[E1000_NUM_TX_DESC];
|
||||
|
||||
MediaAccessControl MAC;
|
||||
InternetProtocol::Version4 IP;
|
||||
|
||||
void WriteCMD(uint16_t Address, uint32_t Value)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
mmioout32(BAR.MemoryBase + Address, Value);
|
||||
else
|
||||
{
|
||||
outportl(BAR.IOBase, Address);
|
||||
outportl(BAR.IOBase + 4, Value);
|
||||
}
|
||||
}
|
||||
|
||||
uint32_t ReadCMD(uint16_t Address)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
return mmioin32(BAR.MemoryBase + Address);
|
||||
else
|
||||
{
|
||||
outportl(BAR.IOBase, Address);
|
||||
return inportl(BAR.IOBase + 0x4);
|
||||
}
|
||||
}
|
||||
|
||||
uint32_t ReadEEPROM(uint8_t Address)
|
||||
{
|
||||
uint16_t Data = 0;
|
||||
uint32_t temp = 0;
|
||||
if (EEPROMAvailable)
|
||||
{
|
||||
WriteCMD(REG::EEPROM, (1) | ((uint32_t)(Address) << 8));
|
||||
while (!((temp = ReadCMD(REG::EEPROM)) & (1 << 4)))
|
||||
;
|
||||
}
|
||||
else
|
||||
{
|
||||
WriteCMD(REG::EEPROM, (1) | ((uint32_t)(Address) << 2));
|
||||
while (!((temp = ReadCMD(REG::EEPROM)) & (1 << 1)))
|
||||
;
|
||||
}
|
||||
Data = (uint16_t)((temp >> 16) & 0xFFFF);
|
||||
return Data;
|
||||
}
|
||||
|
||||
MediaAccessControl GetMAC()
|
||||
{
|
||||
MediaAccessControl mac;
|
||||
if (EEPROMAvailable)
|
||||
{
|
||||
uint32_t temp;
|
||||
temp = ReadEEPROM(0);
|
||||
mac.Address[0] = temp & 0xff;
|
||||
mac.Address[1] = (uint8_t)(temp >> 8);
|
||||
temp = ReadEEPROM(1);
|
||||
mac.Address[2] = temp & 0xff;
|
||||
mac.Address[3] = (uint8_t)(temp >> 8);
|
||||
temp = ReadEEPROM(2);
|
||||
mac.Address[4] = temp & 0xff;
|
||||
mac.Address[5] = (uint8_t)(temp >> 8);
|
||||
}
|
||||
else
|
||||
{
|
||||
uint8_t *BaseMac8 = (uint8_t *)(BAR.MemoryBase + 0x5400);
|
||||
uint32_t *BaseMac32 = (uint32_t *)(BAR.MemoryBase + 0x5400);
|
||||
if (BaseMac32[0] != 0)
|
||||
for (int i = 0; i < 6; i++)
|
||||
mac.Address[i] = BaseMac8[i];
|
||||
else
|
||||
{
|
||||
error("No MAC address found.");
|
||||
return MediaAccessControl();
|
||||
}
|
||||
}
|
||||
return mac;
|
||||
}
|
||||
|
||||
void InitializeRX()
|
||||
{
|
||||
debug("Initializing RX...");
|
||||
uintptr_t Ptr = (uintptr_t)KAPI.Memory.RequestPage((((sizeof(RXDescriptor) * E1000_NUM_RX_DESC + 16)) / KAPI.Memory.PageSize) + 1);
|
||||
|
||||
for (int i = 0; i < E1000_NUM_RX_DESC; i++)
|
||||
{
|
||||
RX[i] = (RXDescriptor *)(Ptr + i * 16);
|
||||
RX[i]->Address = (uint64_t)(uintptr_t)KAPI.Memory.RequestPage(((8192 + 16) / KAPI.Memory.PageSize) + 1);
|
||||
RX[i]->Status = 0;
|
||||
}
|
||||
|
||||
WriteCMD(REG::TXDESCLO, (uint32_t)(Ptr >> 32));
|
||||
WriteCMD(REG::TXDESCHI, (uint32_t)(Ptr & 0xFFFFFFFF));
|
||||
|
||||
WriteCMD(REG::RXDESCLO, (uint32_t)Ptr);
|
||||
WriteCMD(REG::RXDESCHI, 0);
|
||||
|
||||
WriteCMD(REG::RXDESCLEN, E1000_NUM_RX_DESC * 16);
|
||||
|
||||
WriteCMD(REG::RXDESCHEAD, 0);
|
||||
WriteCMD(REG::RXDESCTAIL, E1000_NUM_RX_DESC - 1);
|
||||
RXCurrent = 0;
|
||||
WriteCMD(REG::RCTRL, RCTL::EN | RCTL::SBP | RCTL::UPE | RCTL::MPE | RCTL::LBM_NONE | RTCL::RDMTS_HALF | RCTL::BAM | RCTL::SECRC | RCTL::BSIZE_8192);
|
||||
}
|
||||
|
||||
void InitializeTX()
|
||||
{
|
||||
debug("Initializing TX...");
|
||||
uintptr_t Ptr = (uintptr_t)KAPI.Memory.RequestPage(((sizeof(TXDescriptor) * E1000_NUM_RX_DESC + 16) / KAPI.Memory.PageSize) + 1);
|
||||
|
||||
for (short i = 0; i < E1000_NUM_TX_DESC; i++)
|
||||
{
|
||||
TX[i] = (TXDescriptor *)((uintptr_t)Ptr + i * 16);
|
||||
TX[i]->Address = 0;
|
||||
TX[i]->Command = 0;
|
||||
TX[i]->Status = TSTA::DD;
|
||||
}
|
||||
|
||||
WriteCMD(REG::TXDESCHI, (uint32_t)((uint64_t)Ptr >> 32));
|
||||
WriteCMD(REG::TXDESCLO, (uint32_t)((uint64_t)Ptr & 0xFFFFFFFF));
|
||||
|
||||
WriteCMD(REG::TXDESCLEN, E1000_NUM_TX_DESC * 16);
|
||||
|
||||
WriteCMD(REG::TXDESCHEAD, 0);
|
||||
WriteCMD(REG::TXDESCTAIL, 0);
|
||||
TXCurrent = 0;
|
||||
WriteCMD(REG::TCTRL, TCTL::EN_ | TCTL::PSP | (15 << TCTL::CT_SHIFT) | (64 << TCTL::COLD_SHIFT) | TCTL::RTLC);
|
||||
|
||||
WriteCMD(REG::TCTRL, 0b0110000000000111111000011111010);
|
||||
WriteCMD(REG::TIPG, 0x0060200A);
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
PCIBaseAddress = reinterpret_cast<PCIDeviceHeader *>(Data->RawPtr);
|
||||
switch (PCIBaseAddress->DeviceID)
|
||||
{
|
||||
case 0x100E:
|
||||
{
|
||||
trace("Found Intel 82540EM Gigabit Ethernet Controller.");
|
||||
|
||||
PCIBaseAddress->Command |= PCI_COMMAND_MASTER | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
||||
uint32_t PCIBAR0 = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
uint32_t PCIBAR1 = ((PCIHeader0 *)PCIBaseAddress)->BAR1;
|
||||
|
||||
BAR.Type = PCIBAR0 & 1;
|
||||
BAR.IOBase = (uint16_t)(PCIBAR1 & (~3));
|
||||
BAR.MemoryBase = PCIBAR0 & (~15);
|
||||
|
||||
// Detect EEPROM
|
||||
WriteCMD(REG::EEPROM, 0x1);
|
||||
for (int i = 0; i < 1000 && !EEPROMAvailable; i++)
|
||||
if (ReadCMD(REG::EEPROM) & 0x10)
|
||||
EEPROMAvailable = true;
|
||||
else
|
||||
EEPROMAvailable = false;
|
||||
|
||||
// Get MAC address
|
||||
if (!GetMAC().Valid())
|
||||
return NOT_AVAILABLE;
|
||||
else
|
||||
debug("MAC address found.");
|
||||
MAC = GetMAC();
|
||||
|
||||
// Start link
|
||||
uint32_t cmdret = ReadCMD(REG::CTRL);
|
||||
WriteCMD(REG::CTRL, cmdret | ECTRL::SLU);
|
||||
|
||||
for (int i = 0; i < 0x80; i++)
|
||||
WriteCMD((uint16_t)(0x5200 + i * 4), 0);
|
||||
|
||||
WriteCMD(REG::IMASK, 0x1F6DC);
|
||||
WriteCMD(REG::IMASK, 0xFF & ~4);
|
||||
ReadCMD(0xC0);
|
||||
|
||||
InitializeRX();
|
||||
InitializeTX();
|
||||
return OK;
|
||||
}
|
||||
case 0x100F:
|
||||
{
|
||||
trace("Found Intel 82545EM Gigabit Ethernet Controller.");
|
||||
PCIBaseAddress->Command |= PCI_COMMAND_MASTER | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
||||
uint32_t PCIBAR0 = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
uint32_t PCIBAR1 = ((PCIHeader0 *)PCIBaseAddress)->BAR1;
|
||||
|
||||
BAR.Type = PCIBAR0 & 1;
|
||||
BAR.IOBase = (uint16_t)(PCIBAR1 & (~3));
|
||||
BAR.MemoryBase = PCIBAR0 & (~15);
|
||||
|
||||
// Detect EEPROM
|
||||
WriteCMD(REG::EEPROM, 0x1);
|
||||
for (int i = 0; i < 1000 && !EEPROMAvailable; i++)
|
||||
if (ReadCMD(REG::EEPROM) & 0x10)
|
||||
EEPROMAvailable = true;
|
||||
else
|
||||
EEPROMAvailable = false;
|
||||
|
||||
// Get MAC address
|
||||
if (!GetMAC().Valid())
|
||||
return NOT_AVAILABLE;
|
||||
else
|
||||
debug("MAC address found.");
|
||||
MAC = GetMAC();
|
||||
|
||||
return NOT_IMPLEMENTED;
|
||||
}
|
||||
case 0x10D3:
|
||||
{
|
||||
trace("Found Intel 82574L Gigabit Ethernet Controller.");
|
||||
|
||||
PCIBaseAddress->Command |= PCI_COMMAND_MASTER | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
||||
uint32_t PCIBAR0 = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
uint32_t PCIBAR1 = ((PCIHeader0 *)PCIBaseAddress)->BAR1;
|
||||
|
||||
BAR.Type = PCIBAR0 & 1;
|
||||
BAR.IOBase = (uint16_t)(PCIBAR1 & (~3));
|
||||
BAR.MemoryBase = PCIBAR0 & (~15);
|
||||
|
||||
// Detect EEPROM
|
||||
WriteCMD(REG::EEPROM, 0x1);
|
||||
for (int i = 0; i < 1000 && !EEPROMAvailable; i++)
|
||||
if (ReadCMD(REG::EEPROM) & 0x10)
|
||||
EEPROMAvailable = true;
|
||||
else
|
||||
EEPROMAvailable = false;
|
||||
|
||||
// Get MAC address
|
||||
if (!GetMAC().Valid())
|
||||
return NOT_AVAILABLE;
|
||||
else
|
||||
debug("MAC address found.");
|
||||
MAC = GetMAC();
|
||||
|
||||
return NOT_IMPLEMENTED;
|
||||
}
|
||||
case 0x10EA:
|
||||
{
|
||||
fixme("Found Intel I217-LM Gigabit Ethernet Controller.");
|
||||
return NOT_IMPLEMENTED;
|
||||
}
|
||||
case 0x153A:
|
||||
{
|
||||
fixme("Found Intel 82577LM Gigabit Ethernet Controller.");
|
||||
return NOT_IMPLEMENTED;
|
||||
}
|
||||
default:
|
||||
{
|
||||
error("Unsupported Intel Ethernet Controller.");
|
||||
return DEVICE_NOT_SUPPORTED;
|
||||
}
|
||||
}
|
||||
return ERROR;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
memcpy(Data->NetworkCallback.Fetch.Name, (void *)"Intel Gigabit Ethernet Controller", 34);
|
||||
Data->NetworkCallback.Fetch.MAC = MAC.ToHex();
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
{
|
||||
TX[TXCurrent]->Address = (uint64_t)Data->NetworkCallback.Send.Data;
|
||||
TX[TXCurrent]->Length = (uint16_t)Data->NetworkCallback.Send.Length;
|
||||
TX[TXCurrent]->Command = CMD::EOP | CMD::IFCS | CMD::RS;
|
||||
TX[TXCurrent]->Status = 0;
|
||||
uint16_t OldTXCurrent = TXCurrent;
|
||||
TXCurrent = (uint16_t)((TXCurrent + 1) % E1000_NUM_TX_DESC);
|
||||
WriteCMD(REG::TXDESCTAIL, TXCurrent);
|
||||
while (!(TX[OldTXCurrent]->Status & 0xFF))
|
||||
;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
// Clearing Enable bit in Receive Control Register
|
||||
uint32_t cmdret = ReadCMD(REG::RCTRL);
|
||||
WriteCMD(REG::RCTRL, cmdret & ~RCTL::EN);
|
||||
|
||||
// Masking Interrupt Mask, Interrupt Throttling Rate & Interrupt Auto-Mask
|
||||
WriteCMD(REG::IMASK, 0x00000000);
|
||||
WriteCMD(REG::ITR, 0x00000000);
|
||||
WriteCMD(REG::IAM, 0x00000000);
|
||||
|
||||
// Clearing SLU bit in Device Control Register
|
||||
cmdret = ReadCMD(REG::CTRL);
|
||||
WriteCMD(REG::CTRL, cmdret & ~ECTRL::SLU);
|
||||
|
||||
// Clear the Interrupt Cause Read register by reading it
|
||||
ReadCMD(REG::ICR);
|
||||
|
||||
// Powering down the device (?)
|
||||
WriteCMD(REG::CTRL, PCTRL::POWER_DOWN);
|
||||
/* TODO: Stop link; further testing required */
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
WriteCMD(REG::IMASK, 0x1);
|
||||
uint32_t status = ReadCMD(0xC0);
|
||||
UNUSED(status);
|
||||
|
||||
while ((RX[RXCurrent]->Status & 0x1))
|
||||
{
|
||||
uint8_t *Data = (uint8_t *)RX[RXCurrent]->Address;
|
||||
uint16_t DataLength = RX[RXCurrent]->Length;
|
||||
KAPI.Command.Network.ReceivePacket(KAPI.Info.DriverUID, Data, DataLength);
|
||||
RX[RXCurrent]->Status = 0;
|
||||
uint16_t OldRXCurrent = RXCurrent;
|
||||
RXCurrent = (uint16_t)((RXCurrent + 1) % E1000_NUM_RX_DESC);
|
||||
WriteCMD(REG::RXDESCTAIL, OldRXCurrent);
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
}
|
177
Modules/Intel/gigabit.hpp
Normal file
177
Modules/Intel/gigabit.hpp
Normal file
@ -0,0 +1,177 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_INTEL_GIGABIT_H__
|
||||
#define __FENNIX_KERNEL_INTEL_GIGABIT_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace Gigabit
|
||||
{
|
||||
#define E1000_NUM_RX_DESC 32
|
||||
#define E1000_NUM_TX_DESC 8
|
||||
|
||||
enum REG
|
||||
{
|
||||
CTRL = 0x0000,
|
||||
STATUS = 0x0008,
|
||||
ICR = 0x000C,
|
||||
EEPROM = 0x0014,
|
||||
CTRL_EXT = 0x0018,
|
||||
ITR = 0x00C4,
|
||||
IMASK = 0x00D0,
|
||||
IAM = 0x00D8,
|
||||
RCTRL = 0x0100,
|
||||
RXDESCLO = 0x2800,
|
||||
RXDESCHI = 0x2804,
|
||||
RXDESCLEN = 0x2808,
|
||||
RXDESCHEAD = 0x2810,
|
||||
RXDESCTAIL = 0x2818,
|
||||
TCTRL = 0x0400,
|
||||
TXDESCLO = 0x3800,
|
||||
TXDESCHI = 0x3804,
|
||||
TXDESCLEN = 0x3808,
|
||||
TXDESCHEAD = 0x3810,
|
||||
TXDESCTAIL = 0x3818,
|
||||
RDTR = 0x2820,
|
||||
RXDCTL = 0x3828,
|
||||
RADV = 0x282C,
|
||||
RSRPD = 0x2C00,
|
||||
TIPG = 0x0410
|
||||
};
|
||||
|
||||
enum PCTRL
|
||||
{
|
||||
RESERVED = 0b000000, // bits 5:0
|
||||
SPEED_SELECTION_MSB = 0b010000, // bit 6
|
||||
UPDATE_COLLISION_TEST = 0b001000, // bit 7
|
||||
DUPLEX_MODE = 0b000100, // bit 8
|
||||
RESTART_AUTO_NEGOTIATION = 0b000010, // bit 9
|
||||
ISOLATE = 0b000001, // bit 10
|
||||
POWER_DOWN = 0b100000, // bit 11
|
||||
SPEED_SELECTION_LSB = 0b100000, // bit 13
|
||||
};
|
||||
|
||||
enum ECTRL
|
||||
{
|
||||
SLU = 0x40
|
||||
};
|
||||
|
||||
enum RTCL
|
||||
{
|
||||
RDMTS_HALF = (0 << 8),
|
||||
RDMTS_QUARTER = (1 << 8),
|
||||
RDMTS_EIGHTH = (2 << 8)
|
||||
};
|
||||
|
||||
enum RCTL
|
||||
{
|
||||
EN = (1 << 1),
|
||||
SBP = (1 << 2),
|
||||
UPE = (1 << 3),
|
||||
MPE = (1 << 4),
|
||||
LPE = (1 << 5),
|
||||
LBM_NONE = (0 << 6),
|
||||
LBM_PHY = (3 << 6),
|
||||
MO_36 = (0 << 12),
|
||||
MO_35 = (1 << 12),
|
||||
MO_34 = (2 << 12),
|
||||
MO_32 = (3 << 12),
|
||||
BAM = (1 << 15),
|
||||
VFE = (1 << 18),
|
||||
CFIEN = (1 << 19),
|
||||
CFI = (1 << 20),
|
||||
DPF = (1 << 22),
|
||||
PMCF = (1 << 23),
|
||||
SECRC = (1 << 26),
|
||||
BSIZE_256 = (3 << 16),
|
||||
BSIZE_512 = (2 << 16),
|
||||
BSIZE_1024 = (1 << 16),
|
||||
BSIZE_2048 = (0 << 16),
|
||||
BSIZE_4096 = ((3 << 16) | (1 << 25)),
|
||||
BSIZE_8192 = ((2 << 16) | (1 << 25)),
|
||||
BSIZE_16384 = ((1 << 16) | (1 << 25))
|
||||
};
|
||||
|
||||
enum CMD
|
||||
{
|
||||
EOP = (1 << 0),
|
||||
IFCS = (1 << 1),
|
||||
IC = (1 << 2),
|
||||
RS = (1 << 3),
|
||||
RPS = (1 << 4),
|
||||
VLE = (1 << 6),
|
||||
IDE = (1 << 7)
|
||||
};
|
||||
|
||||
enum TCTL
|
||||
{
|
||||
EN_ = (1 << 1),
|
||||
PSP = (1 << 3),
|
||||
CT_SHIFT = 4,
|
||||
COLD_SHIFT = 12,
|
||||
SWXOFF = (1 << 22),
|
||||
RTLC = (1 << 24)
|
||||
};
|
||||
|
||||
enum TSTA
|
||||
{
|
||||
DD = (1 << 0),
|
||||
EC = (1 << 1),
|
||||
LC = (1 << 2)
|
||||
};
|
||||
|
||||
enum LSTA
|
||||
{
|
||||
LSTA_TU = (1 << 3)
|
||||
};
|
||||
|
||||
struct RXDescriptor
|
||||
{
|
||||
volatile uint64_t Address;
|
||||
volatile uint16_t Length;
|
||||
volatile uint16_t Checksum;
|
||||
volatile uint8_t Status;
|
||||
volatile uint8_t Errors;
|
||||
volatile uint16_t Special;
|
||||
} __attribute__((packed));
|
||||
|
||||
struct TXDescriptor
|
||||
{
|
||||
volatile uint64_t Address;
|
||||
volatile uint16_t Length;
|
||||
volatile uint8_t cso;
|
||||
volatile uint8_t Command;
|
||||
volatile uint8_t Status;
|
||||
volatile uint8_t css;
|
||||
volatile uint16_t Special;
|
||||
} __attribute__((packed));
|
||||
|
||||
struct BARData
|
||||
{
|
||||
uint8_t Type;
|
||||
uint16_t IOBase;
|
||||
uint64_t MemoryBase;
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_INTEL_GIGABIT_H__
|
234
Modules/PersonalSystem2/Mouse.cpp
Normal file
234
Modules/PersonalSystem2/Mouse.cpp
Normal file
@ -0,0 +1,234 @@
|
||||
#include "mouse.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
namespace PS2Mouse
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
int MouseX = 0, MouseY = 0, MouseZ = 0;
|
||||
int MouseLeft = 0, MouseMiddle = 0, MouseRight = 0;
|
||||
|
||||
uint8_t Packet[4];
|
||||
bool PacketReady = false;
|
||||
uint8_t Cycle = 0;
|
||||
|
||||
void WaitRead()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if (inb(Ports::STATUS) & State::OUTPUT_FULL)
|
||||
return;
|
||||
}
|
||||
|
||||
void WaitWrite()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if ((inb(Ports::STATUS) & State::INPUT_FULL) == 0)
|
||||
return;
|
||||
}
|
||||
|
||||
uint8_t Read()
|
||||
{
|
||||
WaitRead();
|
||||
return inb(Ports::DATA);
|
||||
}
|
||||
|
||||
void Write(uint16_t Port, uint8_t Value)
|
||||
{
|
||||
WaitWrite();
|
||||
outb(Port, Value);
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status |= 0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF6);
|
||||
Read();
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF4);
|
||||
Read();
|
||||
|
||||
trace("PS/2 mouse configured.");
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
Data->InputCallback.Mouse.X = MouseX;
|
||||
Data->InputCallback.Mouse.Y = MouseY;
|
||||
Data->InputCallback.Mouse.Z = MouseZ;
|
||||
Data->InputCallback.Mouse.Buttons.Left = MouseLeft;
|
||||
Data->InputCallback.Mouse.Buttons.Right = MouseRight;
|
||||
Data->InputCallback.Mouse.Buttons.Middle = MouseMiddle;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status &= ~0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF5);
|
||||
Read();
|
||||
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
uint8_t Data = inb(0x60);
|
||||
|
||||
if (__builtin_expect(!!(PacketReady), 0))
|
||||
{
|
||||
bool XNegative, YNegative, XOverflow, YOverflow;
|
||||
|
||||
if (Packet[0] & PS2XSign)
|
||||
XNegative = true;
|
||||
else
|
||||
XNegative = false;
|
||||
|
||||
if (Packet[0] & PS2YSign)
|
||||
YNegative = true;
|
||||
else
|
||||
YNegative = false;
|
||||
|
||||
if (Packet[0] & PS2XOverflow)
|
||||
XOverflow = true;
|
||||
else
|
||||
XOverflow = false;
|
||||
|
||||
if (Packet[0] & PS2YOverflow)
|
||||
YOverflow = true;
|
||||
else
|
||||
YOverflow = false;
|
||||
|
||||
if (!XNegative)
|
||||
{
|
||||
MouseX += Packet[1];
|
||||
if (XOverflow)
|
||||
MouseX += 255;
|
||||
}
|
||||
else
|
||||
{
|
||||
Packet[1] = (uint8_t)(256 - Packet[1]);
|
||||
MouseX -= Packet[1];
|
||||
if (XOverflow)
|
||||
MouseX -= 255;
|
||||
}
|
||||
|
||||
if (!YNegative)
|
||||
{
|
||||
MouseY -= Packet[2];
|
||||
if (YOverflow)
|
||||
MouseY -= 255;
|
||||
}
|
||||
else
|
||||
{
|
||||
Packet[2] = (uint8_t)(256 - Packet[2]);
|
||||
MouseY += Packet[2];
|
||||
if (YOverflow)
|
||||
MouseY += 255;
|
||||
}
|
||||
|
||||
uint32_t Width = KAPI.Display.GetWidth();
|
||||
uint32_t Height = KAPI.Display.GetHeight();
|
||||
|
||||
if (MouseX < 0)
|
||||
MouseX = 0;
|
||||
|
||||
if ((uint32_t)MouseX > Width - 1)
|
||||
MouseX = Width - 1;
|
||||
|
||||
if (MouseY < 0)
|
||||
MouseY = 0;
|
||||
if ((uint32_t)MouseY > Height - 1)
|
||||
MouseY = Height - 1;
|
||||
|
||||
MouseLeft = 0;
|
||||
MouseMiddle = 0;
|
||||
MouseRight = 0;
|
||||
|
||||
if (Packet[0] & PS2LeftButton)
|
||||
MouseLeft = 1;
|
||||
if (Packet[0] & PS2MiddleButton)
|
||||
MouseMiddle = 1;
|
||||
if (Packet[0] & PS2RightButton)
|
||||
MouseRight = 1;
|
||||
PacketReady = false;
|
||||
}
|
||||
|
||||
switch (Cycle)
|
||||
{
|
||||
case 0:
|
||||
{
|
||||
if ((Data & 0b00001000) == 0)
|
||||
break;
|
||||
Packet[0] = Data;
|
||||
Cycle++;
|
||||
break;
|
||||
}
|
||||
case 1:
|
||||
{
|
||||
Packet[1] = Data;
|
||||
Cycle++;
|
||||
break;
|
||||
}
|
||||
case 2:
|
||||
{
|
||||
Packet[2] = Data;
|
||||
PacketReady = true;
|
||||
Cycle = 0;
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown cycle %d", Cycle);
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
}
|
59
Modules/PersonalSystem2/mouse.hpp
Normal file
59
Modules/PersonalSystem2/mouse.hpp
Normal file
@ -0,0 +1,59 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_PS2_MOUSE_H__
|
||||
#define __FENNIX_KERNEL_PS2_MOUSE_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace PS2Mouse
|
||||
{
|
||||
#define PS2LeftButton 0b00000001
|
||||
#define PS2MiddleButton 0b00000100
|
||||
#define PS2RightButton 0b00000010
|
||||
#define PS2XSign 0b00010000
|
||||
#define PS2YSign 0b00100000
|
||||
#define PS2XOverflow 0b01000000
|
||||
#define PS2YOverflow 0b10000000
|
||||
|
||||
enum Config
|
||||
{
|
||||
READ_CONFIG = 0x20,
|
||||
WRITE_CONFIG = 0x60
|
||||
};
|
||||
|
||||
enum Ports
|
||||
{
|
||||
DATA = 0x60,
|
||||
STATUS = 0x64,
|
||||
COMMAND = 0x64,
|
||||
};
|
||||
|
||||
enum State
|
||||
{
|
||||
OUTPUT_FULL = (1 << 0),
|
||||
INPUT_FULL = (1 << 1),
|
||||
MOUSE_BYTE = (1 << 5)
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_PS2_MOUSE_H__
|
190
Modules/Realtek/RTL8139.cpp
Normal file
190
Modules/Realtek/RTL8139.cpp
Normal file
@ -0,0 +1,190 @@
|
||||
#include "rtl8139.hpp"
|
||||
|
||||
#include <net/net.hpp>
|
||||
#include <debug.h>
|
||||
#include <pci.hpp>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
using namespace PCI;
|
||||
|
||||
namespace RTL8139
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
PCIDeviceHeader *PCIBaseAddress;
|
||||
BARData BAR;
|
||||
|
||||
uint8_t *RXBuffer;
|
||||
int TXCurrent;
|
||||
uint16_t CurrentPacket;
|
||||
|
||||
MediaAccessControl MAC;
|
||||
InternetProtocol::Version4 IP;
|
||||
|
||||
uint8_t TSAD[4] = {0x20, 0x24, 0x28, 0x2C};
|
||||
uint8_t TSD[4] = {0x10, 0x14, 0x18, 0x1C};
|
||||
|
||||
void RTLOB(uint16_t Address, uint8_t Value)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
mmoutb(reinterpret_cast<void *>(BAR.MemoryBase + Address), Value);
|
||||
else
|
||||
outportb(BAR.IOBase + Address, Value);
|
||||
}
|
||||
|
||||
void RTLOW(uint16_t Address, uint16_t Value)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
mmoutw(reinterpret_cast<void *>(BAR.MemoryBase + Address), Value);
|
||||
else
|
||||
outportw(BAR.IOBase + Address, Value);
|
||||
}
|
||||
|
||||
void RTLOL(uint16_t Address, uint32_t Value)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
mmoutl(reinterpret_cast<void *>(BAR.MemoryBase + Address), Value);
|
||||
else
|
||||
outportl(BAR.IOBase + Address, Value);
|
||||
}
|
||||
|
||||
uint8_t RTLIB(uint16_t Address)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
return mminb(reinterpret_cast<void *>(BAR.MemoryBase + Address));
|
||||
else
|
||||
return inportb(BAR.IOBase + Address);
|
||||
}
|
||||
|
||||
uint16_t RTLIW(uint16_t Address)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
return mminw(reinterpret_cast<void *>(BAR.MemoryBase + Address));
|
||||
else
|
||||
return inportw(BAR.IOBase + Address);
|
||||
}
|
||||
|
||||
uint32_t RTLIL(uint16_t Address)
|
||||
{
|
||||
if (BAR.Type == 0)
|
||||
return mminl(reinterpret_cast<void *>(BAR.MemoryBase + Address));
|
||||
else
|
||||
return inportl(BAR.IOBase + Address);
|
||||
}
|
||||
|
||||
MediaAccessControl GetMAC()
|
||||
{
|
||||
uint32_t MAC1 = RTLIL(0x0);
|
||||
uint16_t MAC2 = RTLIW(0x4);
|
||||
MediaAccessControl mac = {
|
||||
mac.Address[0] = (uint8_t)MAC1,
|
||||
mac.Address[1] = (uint8_t)(MAC1 >> 8),
|
||||
mac.Address[2] = (uint8_t)(MAC1 >> 16),
|
||||
mac.Address[3] = (uint8_t)(MAC1 >> 24),
|
||||
mac.Address[4] = (uint8_t)MAC2,
|
||||
mac.Address[5] = (uint8_t)(MAC2 >> 8)};
|
||||
return mac;
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
return OK;
|
||||
}
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
debug("Driver received configuration data.");
|
||||
PCIBaseAddress = reinterpret_cast<PCIDeviceHeader *>(Data->RawPtr);
|
||||
if (PCIBaseAddress->VendorID == 0x10EC && PCIBaseAddress->DeviceID == 0x8139)
|
||||
{
|
||||
trace("Found RTL-8139.");
|
||||
|
||||
PCIBaseAddress->Command |= PCI_COMMAND_MASTER | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
|
||||
uint32_t PCIBAR0 = ((PCIHeader0 *)PCIBaseAddress)->BAR0;
|
||||
uint32_t PCIBAR1 = ((PCIHeader0 *)PCIBaseAddress)->BAR1;
|
||||
|
||||
BAR.Type = PCIBAR1 & 1;
|
||||
BAR.IOBase = (uint16_t)(PCIBAR0 & (~3));
|
||||
BAR.MemoryBase = PCIBAR1 & (~15);
|
||||
|
||||
RXBuffer = (uint8_t *)KAPI.Memory.RequestPage(2);
|
||||
RTLOB(0x52, 0x0);
|
||||
RTLOB(0x37, (1 << 4));
|
||||
while ((RTLIB(0x37) & (1 << 4)))
|
||||
;
|
||||
RTLOL(0x30, static_cast<uint32_t>(reinterpret_cast<uint64_t>(RXBuffer)));
|
||||
RTLOW(0x3C, ((1 << 0) | (1 << 1) | (1 << 2) | (1 << 3) |
|
||||
(1 << 4) | (1 << 5) | (1 << 6) | (1 << 13) |
|
||||
(1 << 14) | (1 << 15)));
|
||||
RTLOL(0x44, ((1 << 0) | (1 << 1) | (1 << 2) | (1 << 3) | (1 << 7)));
|
||||
RTLOB(0x37, 0x0C);
|
||||
MAC = GetMAC();
|
||||
}
|
||||
else
|
||||
return DEVICE_NOT_SUPPORTED;
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
memcpy(Data->NetworkCallback.Fetch.Name, (void *)"RTL-8139", 9);
|
||||
Data->NetworkCallback.Fetch.MAC = MAC.ToHex();
|
||||
break;
|
||||
}
|
||||
case SendReason:
|
||||
{
|
||||
RTLOL(TSAD[TXCurrent], static_cast<uint32_t>(reinterpret_cast<uint64_t>(Data->NetworkCallback.Send.Data)));
|
||||
RTLOL(TSD[TXCurrent++], (uint32_t)Data->NetworkCallback.Send.Length);
|
||||
if (TXCurrent > 3)
|
||||
TXCurrent = 0;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
// TODO: Stop the driver.
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
uint16_t Status = RTLIW(0x3E);
|
||||
UNUSED(Status);
|
||||
|
||||
uint16_t *Data = (uint16_t *)(RXBuffer + CurrentPacket);
|
||||
uint16_t DataLength = *(Data + 1);
|
||||
Data = Data + 2;
|
||||
KAPI.Command.Network.ReceivePacket(KAPI.Info.DriverUID, (uint8_t *)Data, DataLength);
|
||||
CurrentPacket = (uint16_t)((CurrentPacket + DataLength + 4 + 3) & (~3));
|
||||
if (CurrentPacket > 8192)
|
||||
CurrentPacket -= 8192;
|
||||
RTLOW(0x38, CurrentPacket - 0x10);
|
||||
|
||||
RTLOW(0x3E, (1 << 0) | (1 << 2));
|
||||
return OK;
|
||||
}
|
||||
}
|
38
Modules/Realtek/rtl8139.hpp
Normal file
38
Modules/Realtek/rtl8139.hpp
Normal file
@ -0,0 +1,38 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_RTL8139_H__
|
||||
#define __FENNIX_KERNEL_RTL8139_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace RTL8139
|
||||
{
|
||||
struct BARData
|
||||
{
|
||||
uint8_t Type;
|
||||
uint16_t IOBase;
|
||||
uint64_t MemoryBase;
|
||||
};
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_RTL8139_H__
|
225
Modules/VMware/Mouse.cpp
Normal file
225
Modules/VMware/Mouse.cpp
Normal file
@ -0,0 +1,225 @@
|
||||
#include "mouse.hpp"
|
||||
|
||||
#include <debug.h>
|
||||
#include <io.h>
|
||||
|
||||
#include "../../DAPI.hpp"
|
||||
#include "../drv.hpp"
|
||||
|
||||
/* https://wiki.osdev.org/VMware_tools */
|
||||
|
||||
namespace VMwareMouse
|
||||
{
|
||||
KernelAPI KAPI;
|
||||
|
||||
void CommandSend(VMwareCommand *cmd)
|
||||
{
|
||||
cmd->magic = VMWARE_MAGIC;
|
||||
cmd->port = VMWARE_PORT;
|
||||
asm volatile("in %%dx, %0"
|
||||
: "+a"(cmd->ax), "+b"(cmd->bx), "+c"(cmd->cx), "+d"(cmd->dx), "+S"(cmd->si), "+D"(cmd->di));
|
||||
}
|
||||
|
||||
bool IsVMwareBackdoorAvailable(void)
|
||||
{
|
||||
VMwareCommand cmd;
|
||||
cmd.bx = ~VMWARE_MAGIC;
|
||||
cmd.command = CMD_GETVERSION;
|
||||
CommandSend(&cmd);
|
||||
if (cmd.bx != VMWARE_MAGIC || cmd.ax == 0xFFFFFFFF)
|
||||
return false;
|
||||
return true;
|
||||
}
|
||||
|
||||
int DriverEntry(void *Data)
|
||||
{
|
||||
if (!Data)
|
||||
return INVALID_KERNEL_API;
|
||||
KAPI = *(KernelAPI *)Data;
|
||||
if (KAPI.Version.Major < 0 || KAPI.Version.Minor < 0 || KAPI.Version.Patch < 0)
|
||||
return KERNEL_API_VERSION_NOT_SUPPORTED;
|
||||
|
||||
if (!IsVMwareBackdoorAvailable())
|
||||
return SYSTEM_NOT_SUPPORTED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
void Absolute(void)
|
||||
{
|
||||
VMwareCommand cmd;
|
||||
|
||||
/* Enable */
|
||||
cmd.bx = ABSPOINTER_ENABLE;
|
||||
cmd.command = CMD_ABSPOINTER_COMMAND;
|
||||
CommandSend(&cmd);
|
||||
|
||||
/* Status */
|
||||
cmd.bx = 0;
|
||||
cmd.command = CMD_ABSPOINTER_STATUS;
|
||||
CommandSend(&cmd);
|
||||
|
||||
/* Read data (1) */
|
||||
cmd.bx = 1;
|
||||
cmd.command = CMD_ABSPOINTER_DATA;
|
||||
CommandSend(&cmd);
|
||||
|
||||
/* Enable absolute */
|
||||
cmd.bx = ABSPOINTER_ABSOLUTE;
|
||||
cmd.command = CMD_ABSPOINTER_COMMAND;
|
||||
CommandSend(&cmd);
|
||||
}
|
||||
|
||||
void Relative(void)
|
||||
{
|
||||
VMwareCommand cmd;
|
||||
cmd.bx = ABSPOINTER_RELATIVE;
|
||||
cmd.command = CMD_ABSPOINTER_COMMAND;
|
||||
CommandSend(&cmd);
|
||||
}
|
||||
|
||||
enum Config
|
||||
{
|
||||
READ_CONFIG = 0x20,
|
||||
WRITE_CONFIG = 0x60
|
||||
};
|
||||
|
||||
enum Ports
|
||||
{
|
||||
DATA = 0x60,
|
||||
STATUS = 0x64,
|
||||
COMMAND = 0x64,
|
||||
};
|
||||
|
||||
enum State
|
||||
{
|
||||
OUTPUT_FULL = (1 << 0),
|
||||
INPUT_FULL = (1 << 1),
|
||||
MOUSE_BYTE = (1 << 5)
|
||||
};
|
||||
|
||||
void WaitRead()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if (inb(Ports::STATUS) & State::OUTPUT_FULL)
|
||||
return;
|
||||
}
|
||||
|
||||
void WaitWrite()
|
||||
{
|
||||
uint64_t Timeout = 100000;
|
||||
while (Timeout--)
|
||||
if ((inb(Ports::STATUS) & State::INPUT_FULL) == 0)
|
||||
return;
|
||||
}
|
||||
|
||||
void Write(uint16_t Port, uint8_t Value)
|
||||
{
|
||||
WaitWrite();
|
||||
outb(Port, Value);
|
||||
}
|
||||
|
||||
uint8_t Read()
|
||||
{
|
||||
WaitRead();
|
||||
return inb(Ports::DATA);
|
||||
}
|
||||
|
||||
int MouseX = 0, MouseY = 0, MouseZ = 0;
|
||||
int MouseButton = 0;
|
||||
|
||||
int CallbackHandler(KernelCallback *Data)
|
||||
{
|
||||
switch (Data->Reason)
|
||||
{
|
||||
case AcknowledgeReason:
|
||||
{
|
||||
debug("Kernel acknowledged the driver.");
|
||||
break;
|
||||
}
|
||||
case ConfigurationReason:
|
||||
{
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status |= 0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF6);
|
||||
Read();
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF4);
|
||||
Read();
|
||||
Absolute();
|
||||
trace("VMware mouse configured.");
|
||||
break;
|
||||
}
|
||||
case FetchReason:
|
||||
{
|
||||
Data->InputCallback.Mouse.X = (MouseX * KAPI.Display.GetWidth()) / 0xFFFF;
|
||||
Data->InputCallback.Mouse.Y = (MouseY * KAPI.Display.GetHeight()) / 0xFFFF;
|
||||
Data->InputCallback.Mouse.Z = MouseZ;
|
||||
Data->InputCallback.Mouse.Buttons.Left = MouseButton & 0x20;
|
||||
Data->InputCallback.Mouse.Buttons.Right = MouseButton & 0x10;
|
||||
Data->InputCallback.Mouse.Buttons.Middle = MouseButton & 0x08;
|
||||
break;
|
||||
}
|
||||
case StopReason:
|
||||
{
|
||||
Relative();
|
||||
// TODO: UNTESTED!!!
|
||||
outb(COMMAND, 0xA8);
|
||||
Write(COMMAND, READ_CONFIG);
|
||||
uint8_t Status = Read();
|
||||
Status &= ~0b10;
|
||||
Write(COMMAND, WRITE_CONFIG);
|
||||
Write(DATA, Status);
|
||||
Write(COMMAND, 0xD4);
|
||||
Write(DATA, 0xF5);
|
||||
Read();
|
||||
debug("Driver stopped.");
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
warn("Unknown reason.");
|
||||
break;
|
||||
}
|
||||
}
|
||||
return OK;
|
||||
}
|
||||
|
||||
int InterruptCallback(CPURegisters *)
|
||||
{
|
||||
uint8_t Data = inb(0x60);
|
||||
(void)Data;
|
||||
VMwareCommand cmd;
|
||||
cmd.bx = 0;
|
||||
cmd.command = CMD_ABSPOINTER_STATUS;
|
||||
CommandSend(&cmd);
|
||||
|
||||
if (cmd.ax == 0xFFFF0000)
|
||||
{
|
||||
warn("VMware mouse is not connected?");
|
||||
Relative();
|
||||
Absolute();
|
||||
return ERROR;
|
||||
}
|
||||
if ((cmd.ax & 0xFFFF) < 4)
|
||||
return ERROR;
|
||||
|
||||
cmd.bx = 4;
|
||||
cmd.command = CMD_ABSPOINTER_DATA;
|
||||
CommandSend(&cmd);
|
||||
|
||||
int flags = (cmd.ax & 0xFFFF0000) >> 16; /* Not important */
|
||||
(void)flags;
|
||||
MouseButton = (cmd.ax & 0xFFFF); /* 0x10 = Right, 0x20 = Left, 0x08 = Middle */
|
||||
MouseX = cmd.bx; /* Both X and Y are scaled from 0 to 0xFFFF */
|
||||
MouseY = cmd.cx; /* You should map these somewhere to the actual resolution. */
|
||||
MouseZ = (int8_t)cmd.dx; /* Z is a single signed byte indicating scroll direction. */
|
||||
return OK;
|
||||
}
|
||||
}
|
69
Modules/VMware/mouse.hpp
Normal file
69
Modules/VMware/mouse.hpp
Normal file
@ -0,0 +1,69 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_VMWARE_MOUSE_H__
|
||||
#define __FENNIX_KERNEL_VMWARE_MOUSE_H__
|
||||
|
||||
#include <types.h>
|
||||
#include "../../DAPI.hpp"
|
||||
|
||||
namespace VMwareMouse
|
||||
{
|
||||
#define VMWARE_MAGIC 0x564D5868 /* hXMV */
|
||||
#define VMWARE_PORT 0x5658
|
||||
|
||||
#define CMD_GETVERSION 0xA
|
||||
#define CMD_ABSPOINTER_DATA 0x27
|
||||
#define CMD_ABSPOINTER_STATUS 0x28
|
||||
#define CMD_ABSPOINTER_COMMAND 0x29
|
||||
|
||||
#define ABSPOINTER_ENABLE 0x45414552 /* Q E A E */
|
||||
#define ABSPOINTER_RELATIVE 0xF5
|
||||
#define ABSPOINTER_ABSOLUTE 0x53424152 /* R A B S */
|
||||
|
||||
typedef struct
|
||||
{
|
||||
union
|
||||
{
|
||||
uint32_t ax;
|
||||
uint32_t magic;
|
||||
};
|
||||
union
|
||||
{
|
||||
uint32_t bx;
|
||||
size_t size;
|
||||
};
|
||||
union
|
||||
{
|
||||
uint32_t cx;
|
||||
uint16_t command;
|
||||
};
|
||||
union
|
||||
{
|
||||
uint32_t dx;
|
||||
uint16_t port;
|
||||
};
|
||||
uint32_t si;
|
||||
uint32_t di;
|
||||
} VMwareCommand;
|
||||
|
||||
int DriverEntry(void *);
|
||||
int CallbackHandler(KernelCallback *);
|
||||
int InterruptCallback(CPURegisters *);
|
||||
}
|
||||
|
||||
#endif // !__FENNIX_KERNEL_VMWARE_MOUSE_H__
|
32
Modules/drv.hpp
Normal file
32
Modules/drv.hpp
Normal file
@ -0,0 +1,32 @@
|
||||
/*
|
||||
This file is part of Fennix Kernel.
|
||||
|
||||
Fennix Kernel is free software: you can redistribute it and/or
|
||||
modify it under the terms of the GNU General Public License as
|
||||
published by the Free Software Foundation, either version 3 of
|
||||
the License, or (at your option) any later version.
|
||||
|
||||
Fennix Kernel is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
GNU General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with Fennix Kernel. If not, see <https://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#ifndef __FENNIX_KERNEL_DRV_H__
|
||||
#define __FENNIX_KERNEL_DRV_H__
|
||||
|
||||
#include <types.h>
|
||||
|
||||
bool StartAHCI();
|
||||
bool StartVMwareMouse();
|
||||
bool StartPS2Mouse();
|
||||
bool StartATA();
|
||||
bool StartAC97();
|
||||
bool StartRTL8139();
|
||||
bool StartPCNET();
|
||||
bool StartGigabit();
|
||||
|
||||
#endif // !__FENNIX_KERNEL_DRV_H__
|
Reference in New Issue
Block a user