Guest User

Untitled

a guest
May 8th, 2012
28
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  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. {
  25.     outb(0x0A, 0x06); // Channel 2 Mask
  26.     outb(0x0B, 0x56); // DMA-Read
  27.    
  28.     outb(0x0A, 0x02); // Channel 2 Unmask
  29. }
  30.  
  31. void WaitIRQ()
  32. {
  33.     Block(WAIT_FOR_MESSAGE);
  34. }
  35.  
  36. int SendCommand(uint8_t cmd)
  37. {
  38.     for(uint32_t timeout = 0; timeout < 100; timeout++)
  39.     {
  40.         if((inb(MSR) & (MSR_DATAREG | MSR_DIO_TO_CPU)) == MSR_DATAREG)
  41.         {
  42.             outb(FIFO, cmd);
  43.             return NO_ERROR;            
  44.         }
  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.             return inb(FIFO);            
  58.         }
  59.         Sleep(5);
  60.     }
  61.     errno = ERR_TIMEOUT;
  62.     return 0;
  63. }
  64.  
  65. /************************************************************/
  66. /* Implementation der Klasse FloppyDrive                    */
  67. /************************************************************/
  68.  
  69. FloppyDrive::FloppyDrive()
  70. {
  71.  
  72. }
  73.  
  74. /************************************************************/
  75. /* Andere Helper Funktionen                                        */
  76. /************************************************************/
  77.  
  78. int VersionCommand()
  79. {
  80.     uint8_t result;
  81.     SendCommand(CMD_VERSION);
  82.     result = ReadData();
  83.    
  84.     if(errno != NO_ERROR)
  85.     {
  86.         printf("[ FLOPPY ] Konnte keine Daten vom Diskettencontroller empfangen!\n");
  87.         return errno;
  88.     }
  89.     else if(result != 0x90)
  90.     {
  91.         return ERR_NOT_SUPPORTED;
  92.     }    
  93.    
  94.     return NO_ERROR;
  95. }
  96.  
  97. void InitFDC()
  98. {
  99.     int result = VersionCommand();
  100.    
  101.     if(result == ERR_NOT_SUPPORTED)
  102.     {
  103.         printf("[ FLOPPY ] Ihr Diskettenlaufwerk wird nicht unterstützt!\n");
  104.     }
  105. }
Advertisement
Add Comment
Please, Sign In to add comment