Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include "floppy.h"
- #include <cstdio>
- #include <dayos.h>
- FloppyDrive drives[4];
- FloppyDrive* currentDrive = (FloppyDrive*) 0;
- int errno = -1; // Wird Gesetzt, wenn der Wert nicht direkt per return zurueckgegeben werden kann
- /************************************************************/
- /* Helper Funktionen */
- /************************************************************/
- /// DMA Funktionen TODO: Einheitliches DMA System
- void WriteTransfer()
- {
- outb(0x0A, 0x06); // Channel 2 Mask
- outb(0x0B, 0x5A); // DMA-Write
- outb(0x0A, 0x02); // Channel 2 Unmask
- }
- void ReadTransfer()
- {
- outb(0x0A, 0x06); // Channel 2 Mask
- outb(0x0B, 0x56); // DMA-Read
- outb(0x0A, 0x02); // Channel 2 Unmask
- }
- void WaitIRQ()
- {
- Block(WAIT_FOR_MESSAGE);
- }
- int SendCommand(uint8_t cmd)
- {
- for(uint32_t timeout = 0; timeout < 100; timeout++)
- {
- if((inb(MSR) & (MSR_DATAREG | MSR_DIO_TO_CPU)) == MSR_DATAREG)
- {
- outb(FIFO, cmd);
- return NO_ERROR;
- }
- Sleep(5);
- }
- return ERR_TIMEOUT;
- }
- uint8_t ReadData()
- {
- for(uint32_t timeout = 0; timeout < 100; timeout++)
- {
- if((inb(MSR) & (MSR_DATAREG | MSR_DIO_TO_CPU)) == (MSR_DATAREG | MSR_DIO_TO_CPU))
- {
- errno = NO_ERROR;
- return inb(FIFO);
- }
- Sleep(5);
- }
- errno = ERR_TIMEOUT;
- return 0;
- }
- /************************************************************/
- /* Implementation der Klasse FloppyDrive */
- /************************************************************/
- FloppyDrive::FloppyDrive()
- {
- }
- /************************************************************/
- /* Andere Helper Funktionen */
- /************************************************************/
- int VersionCommand()
- {
- uint8_t result;
- SendCommand(CMD_VERSION);
- result = ReadData();
- if(errno != NO_ERROR)
- {
- printf("[ FLOPPY ] Konnte keine Daten vom Diskettencontroller empfangen!\n");
- return errno;
- }
- else if(result != 0x90)
- {
- return ERR_NOT_SUPPORTED;
- }
- return NO_ERROR;
- }
- void InitFDC()
- {
- int result = VersionCommand();
- if(result == ERR_NOT_SUPPORTED)
- {
- printf("[ FLOPPY ] Ihr Diskettenlaufwerk wird nicht unterstützt!\n");
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment