SHOW:
|
|
- or go back to the newest paste.
| 1 | #include "floppy.h" | |
| 2 | #include <cstdio> | |
| 3 | #include <dayos.h> | |
| 4 | ||
| 5 | FloppyDrive drives[4]; | |
| 6 | FloppyDrive* currentDrive = (FloppyDrive*) 0; | |
| 7 | int errno = -1; // Wird Gesetzt, wenn der Wert nicht direkt per return zurueckgegeben werden kann | |
| 8 | ||
| 9 | /************************************************************/ | |
| 10 | /* Helper Funktionen */ | |
| 11 | /************************************************************/ | |
| 12 | ||
| 13 | /// DMA Funktionen TODO: Einheitliches DMA System | |
| 14 | ||
| 15 | void WriteTransfer() | |
| 16 | {
| |
| 17 | outb(0x0A, 0x06); // Channel 2 Mask | |
| 18 | outb(0x0B, 0x5A); // DMA-Write | |
| 19 | ||
| 20 | outb(0x0A, 0x02); // Channel 2 Unmask | |
| 21 | } | |
| 22 | ||
| 23 | void ReadTransfer() | |
| 24 | - | bool SendData(unsigned char data) |
| 24 | + | |
| 25 | outb(0x0A, 0x06); // Channel 2 Mask | |
| 26 | - | for(int i = 0; i < 2000; i++) |
| 26 | + | |
| 27 | ||
| 28 | - | if((inb(MSR) & 0xC0) == 0x80) |
| 28 | + | |
| 29 | } | |
| 30 | - | outb(FIFO, data); |
| 30 | + | |
| 31 | - | inb(MSR); |
| 31 | + | |
| 32 | - | return true; |
| 32 | + | |
| 33 | Block(WAIT_FOR_MESSAGE); | |
| 34 | } | |
| 35 | ||
| 36 | - | return false; |
| 36 | + | int SendCommand(uint8_t cmd) |
| 37 | {
| |
| 38 | for(uint32_t timeout = 0; timeout < 100; timeout++) | |
| 39 | - | unsigned char ReadData() |
| 39 | + | |
| 40 | if((inb(MSR) & (MSR_DATAREG | MSR_DIO_TO_CPU)) == MSR_DATAREG) | |
| 41 | - | for(int i = 0; i < 2000; i++) |
| 41 | + | |
| 42 | outb(FIFO, cmd); | |
| 43 | - | if((inb(MSR) & 0xD0) == 0xD0) |
| 43 | + | return NO_ERROR; |
| 44 | } | |
| 45 | - | return inb(FIFO); |
| 45 | + | Sleep(5); |
| 46 | } | |
| 47 | return ERR_TIMEOUT; | |
| 48 | } | |
| 49 | ||
| 50 | uint8_t ReadData() | |
| 51 | {
| |
| 52 | for(uint32_t timeout = 0; timeout < 100; timeout++) | |
| 53 | {
| |
| 54 | if((inb(MSR) & (MSR_DATAREG | MSR_DIO_TO_CPU)) == (MSR_DATAREG | MSR_DIO_TO_CPU)) | |
| 55 | {
| |
| 56 | errno = NO_ERROR; | |
| 57 | - | void Reset() |
| 57 | + | return inb(FIFO); |
| 58 | } | |
| 59 | - | outb(DRSR, 0 | 0x80); |
| 59 | + | Sleep(5); |
| 60 | } | |
| 61 | - | WaitIRQ(); |
| 61 | + | errno = ERR_TIMEOUT; |
| 62 | return 0; | |
| 63 | } | |
| 64 | - | void Sense(unsigned char* status, unsigned char* cylinder) |
| 64 | + | |
| 65 | /************************************************************/ | |
| 66 | - | SendData(CMD_SENSE); |
| 66 | + | /* Implementation der Klasse FloppyDrive */ |
| 67 | - | *status = ReadData(); |
| 67 | + | /************************************************************/ |
| 68 | - | *cylinder = ReadData(); |
| 68 | + | |
| 69 | FloppyDrive::FloppyDrive() | |
| 70 | {
| |
| 71 | - | void MotorOn() |
| 71 | + | |
| 72 | } | |
| 73 | - | uint8_t status = inb(0x3F2); |
| 73 | + | |
| 74 | - | outb(0x3F2, (status & 0x0F) | (0x10)); |
| 74 | + | /************************************************************/ |
| 75 | - | Sleep(500); |
| 75 | + | /* Andere Helper Funktionen */ |
| 76 | - | //printf("Motor on\n");
|
| 76 | + | /************************************************************/ |
| 77 | ||
| 78 | int VersionCommand() | |
| 79 | - | void MotorOff() |
| 79 | + | |
| 80 | uint8_t result; | |
| 81 | - | uint8_t status = inb(0x3F2); |
| 81 | + | SendCommand(CMD_VERSION); |
| 82 | - | outb(0x3F2, status & ~(0x10)); |
| 82 | + | result = ReadData(); |
| 83 | - | //printf("Motor off\n");
|
| 83 | + | |
| 84 | if(errno != NO_ERROR) | |
| 85 | {
| |
| 86 | - | bool Calibrate() |
| 86 | + | printf("[ FLOPPY ] Konnte keine Daten vom Diskettencontroller empfangen!\n");
|
| 87 | return errno; | |
| 88 | - | MotorOn(); |
| 88 | + | |
| 89 | else if(result != 0x90) | |
| 90 | - | for(int i = 0; i < 5; i++) |
| 90 | + | |
| 91 | return ERR_NOT_SUPPORTED; | |
| 92 | - | SendData(CMD_CALIBRATE); |
| 92 | + | } |
| 93 | - | SendData(0); |
| 93 | + | |
| 94 | - | WaitIRQ(); |
| 94 | + | return NO_ERROR; |
| 95 | } | |
| 96 | ||
| 97 | - | MotorOff(); |
| 97 | + | |
| 98 | {
| |
| 99 | int result = VersionCommand(); | |
| 100 | - | bool Seek(unsigned char cylinder, unsigned char head) |
| 100 | + | |
| 101 | if(result == ERR_NOT_SUPPORTED) | |
| 102 | - | unsigned char st0, cyl0; |
| 102 | + | |
| 103 | printf("[ FLOPPY ] Ihr Diskettenlaufwerk wird nicht unterstützt!\n");
| |
| 104 | - | int i = 0; |
| 104 | + | |
| 105 | - | for(i = 0; i < 5; i++) |
| 105 | + |