feat(format sector programm added)

tpfs/Makefile

@@ -13,7 +13,7 @@ LIBS    = -L$(LIBDIR) -lhardware
 ###------------------------------
 ### Main targets 
 ###------------------------------------------------------------
-BINARIES= mkhd display_sector
+BINARIES= mkhd display_sector format_sector
 
 all: $(BINARIES) $(OBJECTS)
 
@@ -29,6 +29,7 @@ all: $(BINARIES) $(OBJECTS)
 
 mkhd: mkhd.o
 display_sector: display_sector.o drive.o
+format_sector: format_sector.o drive.o
 
 ###------------------------------
 ### Misc.

tpfs/display_sector.c

@@ -52,7 +52,7 @@ int main(int argc, char const *argv[])
     _mask(1);
 
     read_sector(buffer, atoi(argv[1]), atoi(argv[2]));
-    dump(buffer, HDA_SECTORSIZE, 1, 0);
+    dump(buffer, HDA_SECTORSIZE, 0, 1);
 
     /* and exit! */
     exit(EXIT_SUCCESS);

tpfs/drive.c

@@ -47,10 +47,10 @@ void dump(unsigned char *buffer,
 
 void seek(int cylinder, int sector)
 {
-    _out(HDA_DATAREGS, (cylinder >> 8) & 256);
-    _out(HDA_DATAREGS + 1, cylinder & 256);
-    _out(HDA_DATAREGS + 2, (sector >> 8) & 256);
-    _out(HDA_DATAREGS + 3, sector & 256);
+    _out(HDA_DATAREGS, (cylinder >> 8) & 255);
+    _out(HDA_DATAREGS + 1, cylinder & 255);
+    _out(HDA_DATAREGS + 2, (sector >> 8) & 255);
+    _out(HDA_DATAREGS + 3, sector & 255);
     _out(HDA_CMDREG, CMD_SEEK);
     _sleep(HDA_IRQ);
 }
\ No newline at end of file

tpfs/drive.h

@@ -6,9 +6,9 @@
 #define HDA_CMDREG 0x3F6   /* registre de commande du disque maitre */
 #define HDA_DATAREGS 0x110 /* base des registres de données (r,r+1...r+15) */
 #define HDA_IRQ 14         /* Interruption du disque */
-#define CMD_SEEK 0x02
-#define CMD_READ 0x04
 #define HDA_SECTORSIZE 256
+#define HDA_MAXCYLINDER 16 /*  Nombre de pistes du disque ma�tre */
+#define HDA_MAXSECTOR 16   /*  Nombre de secteurs du disque ma�tre */
 
 void dump(unsigned char *buffer,
           unsigned int buffer_size,

tpfs/format_sector.c

+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+
+#include "hardware.h"
+#include "drive.h"
+
+static void
+empty_it()
+{
+    return;
+}
+
+void format_sector(int cylinder, int sector)
+{
+    seek(cylinder, sector);
+    _out(HDA_DATAREGS, 0x0);
+    _out(HDA_DATAREGS + 1, 1);
+    _out(HDA_DATAREGS + 2, 0xFF);
+    _out(HDA_DATAREGS + 3, 0x00);
+    _out(HDA_DATAREGS + 4, 0xFF);
+    _out(HDA_DATAREGS + 5, 0x00);
+    _out(HDA_CMDREG, CMD_FORMAT);
+    _sleep(HDA_IRQ);
+}
+
+int main(int argc, char const *argv[])
+{
+    unsigned int i;
+    int cylinder, sector;
+
+    /* init hardware */
+    if (init_hardware("hwconfig.ini") == 0)
+    {
+        fprintf(stderr, "Error in hardware initialization\n");
+        exit(EXIT_FAILURE);
+    }
+
+    /* Interreupt handlers */
+    for (i = 0; i < 16; i++)
+        IRQVECTOR[i] = empty_it;
+
+    /* Allows all IT */
+    _mask(1);
+
+    if (argc == 1)
+    {
+        for (cylinder = 0; cylinder < HDA_MAXCYLINDER; cylinder++)
+        {
+            for (sector = 0; sector < HDA_MAXSECTOR; sector++)
+                format_sector(cylinder, sector);
+        }
+    }
+    else if (argc == 2 && (!strcmp(argv[1], "-r")))
+    {
+        for (cylinder = HDA_MAXCYLINDER - 1; cylinder > -1; cylinder--)
+        {
+            for (sector = HDA_MAXSECTOR - 1; sector > -1; sector--)
+                format_sector(cylinder, sector);
+        }
+    }
+    else if (argc == 3)
+    {
+        format_sector(atoi(argv[1]), atoi(argv[2]));
+    }
+    else
+    {
+        fprintf(stderr, "Usage: %s <cylinder> <sector>\n", argv[0]);
+        exit(EXIT_FAILURE);
+    }
+
+    /* and exit! */
+    exit(EXIT_SUCCESS);
+}