开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > VxWorks > 查看源码
dosformt.c
资源名称：vxwork_src.rar　[点击查看]
上传用户：nvosite88
上传日期：2007-01-17
资源大小：4983k
文件大小：16k
源码类别：

VxWorks

开发平台：

C/C++

dosformt.c：源码内容
  1. /*
  2.  * $Log:   V:/dosformt.c_v  $
  3.  * 
  4.  *    Rev 1.16   05 May 1998 15:02:00   yogu
  5.  * renamed MIN_CLUSTER_SIZE to flMinClusterSize and made it
  6.  * a global int so it's customizable
  7.  *
  8.  *    Rev 1.16   25 Mar 1998 15:02:00   ANDRY, Hdei
  9.  * Added bootCode[] table.
  10.  *
  11.  *    Rev 1.16   11 Nov 1997 15:27:14   ANDRY
  12.  * () in complex expressions to get rid of compiler warnings
  13.  *
  14.  *    Rev 1.15   28 Aug 1997 16:40:32   danig
  15.  * Moved big-endian to flbase.c
  16.  *
  17.  *    Rev 1.14   21 Aug 1997 14:06:34   unknown
  18.  * Unaligned4
  19.  *
  20.  *    Rev 1.13   19 Aug 1997 20:08:58   danig
  21.  * Andray's changes
  22.  *
  23.  *    Rev 1.12   14 Aug 1997 16:06:34   danig
  24.  * Moved MIN_CLUSTER_SIZE to flcustom.h
  25.  *
  26.  *    Rev 1.11   24 Jul 1997 17:53:42   amirban
  27.  * FAR -> FAR0, UNALIGNED -> Unaligned
  28.  *
  29.  *    Rev 1.10   20 Jul 1997 17:16:20   amirban
  30.  * Get rid of warnings
  31.  *
  32.  *    Rev 1.9   07 Jul 1997 15:21:00   amirban
  33.  * Ver 2.0
  34.  *
  35.  *    Rev 1.8   03 Jun 1997 17:18:56   amirban
  36.  * Min cluster size
  37.  *
  38.  *    Rev 1.7   13 May 1997 14:04:40   amirban
  39.  * Big-endian bug fix (reverse order)
  40.  *
  41.  *    Rev 1.6   09 Apr 1997 17:35:36   amirban
  42.  * Partition table redefined
  43.  *
  44.  *    Rev 1.5   02 Apr 1997 16:55:34   amirban
  45.  * BBP redefined
  46.  *
  47.  *    Rev 1.4   16 Oct 1996 16:01:40   danig
  48.  * Big-Endian bug
  49.  *
  50.  *    Rev 1.3   03 Oct 1996 14:37:28   amirban
  51.  * New Big-Endian
  52.  *
  53.  *    Rev 1.3   03 Oct 1996 11:56:36   amirban
  54.  * New Big-Endian
  55.  *
  56.  *    Rev 1.2   18 Aug 1996 13:48:34   amirban
  57.  * Comments
  58.  *
  59.  *    Rev 1.1   14 Jul 1996 16:48:24   amirban
  60.  * format params
  61.  *
  62.  *    Rev 1.0   20 Mar 1996 13:33:06   amirban
  63.  * Initial revision.
  64.  */
  66. /************************************************************************/
  67. /*                                                                      */
  68. /* FAT-FTL Lite Software Development Kit */
  69. /* Copyright (C) M-Systems Ltd. 1995-1996 */
  70. /* */
  71. /************************************************************************/
  73. #include "fltl.h"
  75. #ifdef FORMAT_VOLUME
  77. #include "dosformt.h"
  79. #define FAT12bit  (LE4(bpb->totalSectorsInVolume) < 
  80.    4086LU * bpb->sectorsPerCluster)
  82. int flMinClusterSize = 4;
  84. /*----------------------------------------------------------------------*/
  85. /*             g e t D r i v e G e o m e t r y */
  86. /* */
  87. /* Calculates the geometry parameters for BIOS/DOS media */
  88. /* */
  89. /* Parameters:                                                          */
  90. /* vol : Pointer identifying drive */
  91. /*                                                                      */
  92. /* Returns:                                                             */
  93. /* bpb : volume BIOS parameter block */
  94. /* cylinders : Number of "cylinders" in volume */
  95. /* noOfFATs : Number of FAT copies */
  96. /*----------------------------------------------------------------------*/
  98. static void getDriveGeometry(TL vol,
  99.      BPB *bpb,
  100.      unsigned int *cylinders,
  101.      unsigned noOfFATs)
  102. {
  103.   unsigned long heads, sectors, temp;
  104.   long int sizeInSectors, noOfClusters;
  105.   int directorySectors;
  107.   SectorNo capacity = vol.sectorsInVolume(vol.rec); /* Volume size in sectors */
  108.   *cylinders = 1024;                 /* Set number of cylinders to max value */
  110.   heads = 16L;                      /* Max out number of heads */
  111.   temp = *cylinders * heads;        /* Compute divisor for heads */
  112.   sectors = capacity / temp;        /* Compute value for sectors per track */
  113.   if (capacity % temp) {      /* If no remainder, done! */
  114.     sectors++;                      /* Else, increment number of sectors */
  115.     temp = *cylinders * sectors;    /* Compute divisor for heads */
  116.     heads = capacity / temp;        /* Compute value for heads */
  117.     if (capacity % temp) {          /* If no remainder, done! */
  118.       heads++;                      /* Else, increment number of heads */
  119.       temp = heads * sectors;       /* Compute divisor for cylinders */
  120.       *cylinders = (unsigned) (capacity / temp);
  121.     }
  122.   }
  124.   toLE2(bpb->sectorsPerTrack,(unsigned short) sectors);
  125.   toLE2(bpb->noOfHeads,(unsigned short) heads);
  126.   toUNAL2(bpb->bytesPerSector,SECTOR_SIZE);
  127.   toLE2(bpb->reservedSectors,1);
  128.   bpb->noOfFATS = noOfFATs;
  129.   bpb->mediaDescriptor = 0xf8; /* hard disk */
  130.   toLE4(bpb->noOfHiddenSectors,sectors);
  132.   sizeInSectors = (long) (*cylinders) * heads * sectors - sectors;
  134.   toLE4(bpb->totalSectorsInVolume,sizeInSectors);
  135.   toUNAL2(bpb->totalSectorsInVolumeDOS3,sizeInSectors > 65535l ? 0 : (unsigned short) sizeInSectors);
  137.   noOfClusters = sizeInSectors / flMinClusterSize;
  138.   for (bpb->sectorsPerCluster = flMinClusterSize;
  139.        noOfClusters > (bpb->sectorsPerCluster < 8 ? 32766l : 65534l);
  140.        bpb->sectorsPerCluster <<= 1, noOfClusters >>= 1);
  142.   if (FAT12bit)
  143.     toLE2(bpb->sectorsPerFAT,
  144.   (unsigned short) ((((noOfClusters + 2L) * 3 + 1) / 2 - 1) / SECTOR_SIZE + 1));
  145.   else
  146.     toLE2(bpb->sectorsPerFAT,
  147.   (unsigned short) (((noOfClusters + 2L) * 2 - 1) / SECTOR_SIZE + 1));
  149.   directorySectors = capacity / 200;
  150.   if (directorySectors < 1) directorySectors = 1;
  151.   if (directorySectors > 15) directorySectors = 15;
  152.   toUNAL2(bpb->rootDirectoryEntries,
  153.  directorySectors * (SECTOR_SIZE / sizeof(DirectoryEntry)));
  154. }
  157. /*----------------------------------------------------------------------*/
  158. /*        c r e a t e M a s t e r B o o t R e c o r d */
  159. /* */
  160. /* Creates the Master Boot Record (Sector 0) */
  161. /* */
  162. /* Parameters:                                                          */
  163. /* vol : Pointer identifying drive */
  164. /* bpb : volume BIOS parameter block */
  165. /*                                                                      */
  166. /* Returns:                                                             */
  167. /* FLStatus : 0 on success, failed otherwise */
  168. /* cylinders : Number of "cylinders" in volume */
  169. /*----------------------------------------------------------------------*/
  171. static FLStatus createMasterBootRecord(TL vol,
  172.      BPB *bpb,
  173.      unsigned cylinders)
  174. {
  175.   /* create partition table */
  176.   PartitionTable partitionTable;
  177.   static unsigned char bootCode[] = {
  178.     0xFA, 0x33, 0xC0, 0x8E, 0xD0, 0xBC, 0x00, 0x7C,
  179.     0x8B, 0xF4, 0x50, 0x07, 0x50, 0x1F, 0xFB, 0xFC,
  180.     0xBF, 0x00, 0x06, 0xB9, 0x00, 0x01, 0xF2, 0xA5,
  181.     0xEA, 0x1D, 0x06, 0x00, 0x00, 0xBE, 0xBE, 0x07,
  182.     0xB3, 0x04, 0x80, 0x3C, 0x80, 0x74, 0x0E, 0x80,
  183.     0x3C, 0x00, 0x75, 0x1C, 0x83, 0xC6, 0x10, 0xFE,
  184.     0xCB, 0x75, 0xEF, 0xCD, 0x18, 0x8B, 0x14, 0x8B,
  185.     0x4C, 0x02, 0x8B, 0xEE, 0x83, 0xC6, 0x10, 0xFE,
  186.     0xCB, 0x74, 0x1A, 0x80, 0x3C, 0x00, 0x74, 0xF4,
  187.     0xBE, 0x8B, 0x06, 0xAC, 0x3C, 0x00, 0x74, 0x0B,
  188.     0x56, 0xBB, 0x07, 0x00, 0xB4, 0x0E, 0xCD, 0x10,
  189.     0x5E, 0xEB, 0xF0, 0xEB, 0xFE, 0xBF, 0x05, 0x00,
  190.     0xBB, 0x00, 0x7C, 0xB8, 0x01, 0x02, 0x57, 0xCD,
  191.     0x13, 0x5F, 0x73, 0x0C, 0x33, 0xC0, 0xCD, 0x13,
  192.     0x4F, 0x75, 0xED, 0xBE, 0xA3, 0x06, 0xEB, 0xD3,
  193.     0xBE, 0xC2, 0x06, 0xBF, 0xFE, 0x7D, 0x81, 0x3D,
  194.     0x55, 0xAA, 0x75, 0xC7, 0x8B, 0xF5, 0xEA, 0x00,
  195.     0x7C, 0x00, 0x00, 0x49, 0x6E, 0x76, 0x61, 0x6C,
  196.     0x69, 0x64, 0x20, 0x70, 0x61, 0x72, 0x74, 0x69,
  197.     0x74, 0x69, 0x6F, 0x6E, 0x20, 0x74, 0x61, 0x62,
  198.     0x6C, 0x65, 0x00, 0x45, 0x72, 0x72, 0x6F, 0x72,
  199.     0x20, 0x6C, 0x6F, 0x61, 0x64, 0x69, 0x6E, 0x67,
  200.     0x20, 0x6F, 0x70, 0x65, 0x72, 0x61, 0x74, 0x69,
  201.     0x6E, 0x67, 0x20, 0x73, 0x79, 0x73, 0x74, 0x65,
  202.     0x6D, 0x00, 0x4D, 0x69, 0x73, 0x73, 0x69, 0x6E,
  203.     0x67, 0x20, 0x6F, 0x70, 0x65, 0x72, 0x61, 0x74,
  204.     0x69, 0x6E, 0x67, 0x20, 0x73, 0x79, 0x73, 0x74,
  205.     0x65, 0x6D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  206.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  207.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  208.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  209.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  210.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  211.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  212.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  213.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  214.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  215.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  216.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  217.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  218.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  219.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  220.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  221.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  222.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  223.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  224.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  225.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  226.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  227.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  228.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  229.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  230.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  231.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  232.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  233.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x01,
  234.     0x01, 0x00, 0x06, 0x07, 0xE3, 0x66, 0x23, 0x00,
  235.     0x00, 0x00, 0x85, 0xB8, 0x03, 0x00, 0x00, 0x00,
  236.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  237.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  238.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  239.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  240.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
  241.     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x55, 0xAA};
  243.   tffscpy(&partitionTable,bootCode,sizeof partitionTable);
  245.   partitionTable.activeFlag = 0x80; /* bootable */
  246.   if (LE2(bpb->noOfHeads) > 1) {
  247.     partitionTable.startingHead = 1;
  248.     toLE2(partitionTable.startingCylinderSector,CYLINDER_SECTOR(0,1));
  249.   }
  250.   else {
  251.     partitionTable.startingHead = 0;
  252.     toLE2(partitionTable.startingCylinderSector,CYLINDER_SECTOR(1,1));
  253.   }
  254.   partitionTable.type = FAT12bit ? 1 : 4;
  255.   partitionTable.endingHead = LE2(bpb->noOfHeads) - 1;
  256.   toLE2(partitionTable.endingCylinderSector,
  257. CYLINDER_SECTOR((cylinders - 1),LE2(bpb->sectorsPerTrack)));
  258.   toUNAL4(partitionTable.startingSectorOfPartition,LE2(bpb->sectorsPerTrack));
  259.   toUNAL4(partitionTable.sectorsInPartition,LE4(bpb->totalSectorsInVolume));
  261.   toLE2(partitionTable.signature,PARTITION_SIGNATURE);
  263.   return vol.writeSector(vol.rec,0,&partitionTable);
  264. }
  266. /*----------------------------------------------------------------------*/
  267. /*            c r e a t e D O S B o o t S e c t o r */
  268. /* */
  269. /* Creates the DOS boot sector */
  270. /* */
  271. /* Parameters:                                                          */
  272. /* vol : Pointer identifying drive */
  273. /* bpb : volume BIOS parameter block */
  274. /* volumeId : 32-bit volume id */
  275. /* volumeLabel : volume label */
  276. /*                                                                      */
  277. /* Returns:                                                             */
  278. /* FLStatus : 0 on success, failed otherwise */
  279. /*----------------------------------------------------------------------*/
  281. static FLStatus createDOSbootSector(TL vol,
  282.   BPB *bpb,
  283.   const char FAR1 *volumeId,
  284.   const char FAR1 *volumeLabel)
  285. {
  286.   DOSBootSector bootSector;
  288.   tffsset(&bootSector,0,sizeof bootSector);
  289.   bootSector.physicalDriveNo = 0x80;
  290.   bootSector.extendedBootSignature = 0x29;
  291.   tffscpy(bootSector.volumeId,volumeId,sizeof bootSector.volumeId);
  292.   tffsset(bootSector.volumeLabel,' ',sizeof bootSector.volumeLabel);
  293.   if (volumeLabel)
  294.     tffscpy(bootSector.volumeLabel,volumeLabel,sizeof bootSector.volumeLabel);
  295.   tffscpy(bootSector.systemId,
  296.   FAT12bit ? "FAT12   " : "FAT16   ",
  297.   sizeof bootSector.systemId);
  299.   bootSector.bpb = *bpb;
  300. #if FALSE
  301.   tffscpy (&bootSector.bpb, bpb, sizeof(BPB));
  302. #endif /* FALSE */
  304.   bootSector.bpb.jumpInstruction[0] = 0xe9;
  305.   tffscpy(bootSector.bpb.OEMname,"MSystems",sizeof bootSector.bpb.OEMname);
  306.   toLE2(bootSector.signature,PARTITION_SIGNATURE);
  308.   return vol.writeSector(vol.rec,(SectorNo) LE4(bpb->noOfHiddenSectors),&bootSector);
  309. }
  312. /*----------------------------------------------------------------------*/
  313. /*                 c r e a t e F A T s */
  314. /* */
  315. /* Creates the FAT's */
  316. /* */
  317. /* Parameters:                                                          */
  318. /* vol : Pointer identifying drive */
  319. /* bpb : volume BIOS parameter block */
  320. /*                                                                      */
  321. /* Returns:                                                             */
  322. /* FLStatus : 0 on success, failed otherwise */
  323. /*----------------------------------------------------------------------*/
  325. static FLStatus createFATs(TL vol, BPB *bpb)
  326. {
  327.   int iFAT;
  329.   SectorNo sectorNo = (SectorNo) (LE4(bpb->noOfHiddenSectors) +
  330.   LE2(bpb->reservedSectors));
  332.   /* create the FATs */
  333.   for (iFAT = 0; iFAT < bpb->noOfFATS; iFAT++) {
  334.     int iSector;
  335.     unsigned char FATEntry[SECTOR_SIZE];
  337.     for (iSector = 0; iSector < LE2(bpb->sectorsPerFAT); iSector++) {
  338.       tffsset(FATEntry,0,SECTOR_SIZE);
  339.       if (iSector == 0) { /* write the reserved FAT entries */
  340. FATEntry[0] = bpb->mediaDescriptor;
  341. FATEntry[1] = 0xff;
  342. FATEntry[2] = 0xff;
  343. if (!FAT12bit)
  344.   FATEntry[3] = 0xff;
  345.       }
  346.       checkStatus(vol.writeSector(vol.rec,sectorNo++,FATEntry));
  347.     }
  348.   }
  350.   return flOK;
  351. }
  354. /*----------------------------------------------------------------------*/
  355. /*            c r e a t e R o o t D i r e c t o r y */
  356. /* */
  357. /* Creates the root directory */
  358. /* */
  359. /* Parameters:                                                          */
  360. /* vol : Pointer identifying drive */
  361. /* bpb : volume BIOS parameter block */
  362. /* volumeLabel : volume label */
  363. /*                                                                      */
  364. /* Returns:                                                             */
  365. /* FLStatus : 0 on success, failed otherwise */
  366. /*----------------------------------------------------------------------*/
  368. static FLStatus createRootDirectory(TL vol,
  369.   BPB *bpb,
  370.   const char FAR1 *volumeLabel)
  371. {
  372.   int iEntry;
  374.   SectorNo sectorNo = (SectorNo) (LE4(bpb->noOfHiddenSectors) +
  375.   LE2(bpb->reservedSectors) +
  376.   bpb->noOfFATS * LE2(bpb->sectorsPerFAT));
  378.   /* create the root directory */
  379.   for (iEntry = 0; iEntry < UNAL2(bpb->rootDirectoryEntries);
  380.        iEntry += (SECTOR_SIZE / sizeof(DirectoryEntry))) {
  381.     DirectoryEntry rootDirectorySector[SECTOR_SIZE / sizeof(DirectoryEntry)];
  383.     tffsset(rootDirectorySector,0,SECTOR_SIZE);
  384.     if (iEntry == 0 && volumeLabel) {
  385.       tffsset(rootDirectorySector[0].name,' ',sizeof rootDirectorySector[0].name);
  386.       tffscpy(rootDirectorySector[0].name,volumeLabel,sizeof rootDirectorySector[0].name);
  387.       rootDirectorySector[0].attributes = 0x28; /* VOL + ARC */
  388.       toLE2(rootDirectorySector[0].updateTime,0);
  389.       toLE2(rootDirectorySector[0].updateDate,0x21); /* 1/1/80 */
  390.     }
  391.     checkStatus(vol.writeSector(vol.rec,sectorNo++,rootDirectorySector));
  392.   }
  394.   return flOK;
  395. }
  398. /*----------------------------------------------------------------------*/
  399. /*                 f l D o s F o r m a t */
  400. /* */
  401. /* Writes a DOS-FAT file system on the Flash volume */
  402. /* */
  403. /* Parameters:                                                          */
  404. /* vol : Pointer identifying drive */
  405. /* formatParams : Address of FormatParams structure to use */
  406. /*                                                                      */
  407. /* Returns:                                                             */
  408. /* FLStatus : 0 on success, failed otherwise */
  409. /*----------------------------------------------------------------------*/
  411. FLStatus flDosFormat(TL vol, FormatParams FAR1 *formatParams)
  412. {
  413.   unsigned int cylinders;
  414.   BPB bpb;
  416.   getDriveGeometry(&vol,&bpb,&cylinders,formatParams->noOfFATcopies);
  418.   checkStatus(createMasterBootRecord(&vol,&bpb,cylinders));
  420.   checkStatus(createDOSbootSector(&vol,&bpb,formatParams->volumeId,formatParams->volumeLabel));
  422.   checkStatus(createFATs(&vol,&bpb));
  424.   checkStatus(createRootDirectory(&vol,&bpb,formatParams->volumeLabel));
  426.   return flOK;
  427. }
  429. #endif