View difference between Paste ID: LEvYrDZy and kRyUzj3X
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+