fs.c 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. * (C) Copyright 2002
  3. * Stäubli Faverges - <www.staubli.com>
  4. * Pierre AUBERT p.aubert@staubli.com
  5. *
  6. * See file CREDITS for list of people who contributed to this
  7. * project.
  8. *
  9. * This program is free software; you can redistribute it and/or
  10. * modify it under the terms of the GNU General Public License as
  11. * published by the Free Software Foundation; either version 2 of
  12. * the License, or (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  22. * MA 02111-1307 USA
  23. */
  24. #include <common.h>
  25. #include <config.h>
  26. #include <malloc.h>
  27. #include "dos.h"
  28. #include "fdos.h"
  29. /*-----------------------------------------------------------------------------
  30. * fill_fs -- Read info on file system
  31. *-----------------------------------------------------------------------------
  32. */
  33. static int fill_fs (BootSector_t *boot, Fs_t *fs)
  34. {
  35. fs -> fat_start = __le16_to_cpu (boot -> nrsvsect);
  36. fs -> fat_len = __le16_to_cpu (boot -> fatlen);
  37. fs -> nb_fat = boot -> nfat;
  38. fs -> dir_start = fs -> fat_start + fs -> nb_fat * fs -> fat_len;
  39. fs -> dir_len = __le16_to_cpu (boot -> dirents) * MDIR_SIZE / SZ_STD_SECTOR;
  40. fs -> cluster_size = boot -> clsiz;
  41. fs -> num_clus = (fs -> tot_sectors - fs -> dir_start - fs -> dir_len) / fs -> cluster_size;
  42. return (0);
  43. }
  44. /*-----------------------------------------------------------------------------
  45. * fs_init --
  46. *-----------------------------------------------------------------------------
  47. */
  48. int fs_init (Fs_t *fs)
  49. {
  50. BootSector_t *boot;
  51. /* Initialize physical device */
  52. if (dev_open () < 0) {
  53. PRINTF ("Unable to initialize the fdc\n");
  54. return (-1);
  55. }
  56. init_subdir ();
  57. /* Allocate space for read the boot sector */
  58. if ((boot = (BootSector_t *)malloc (sizeof (BootSector_t))) == NULL) {
  59. PRINTF ("Unable to allocate space for boot sector\n");
  60. return (-1);
  61. }
  62. /* read boot sector */
  63. if (dev_read (boot, 0, 1)){
  64. PRINTF ("Error during boot sector read\n");
  65. free (boot);
  66. return (-1);
  67. }
  68. /* we verify it'a a DOS diskette */
  69. if (boot -> jump [0] != JUMP_0_1 && boot -> jump [0] != JUMP_0_2) {
  70. PRINTF ("Not a DOS diskette\n");
  71. free (boot);
  72. return (-1);
  73. }
  74. if (boot -> descr < MEDIA_STD) {
  75. /* We handle only recent medias (type F0) */
  76. PRINTF ("unrecognized diskette type\n");
  77. free (boot);
  78. return (-1);
  79. }
  80. if (check_dev (boot, fs) < 0) {
  81. PRINTF ("Bad diskette\n");
  82. free (boot);
  83. return (-1);
  84. }
  85. if (fill_fs (boot, fs) < 0) {
  86. free (boot);
  87. return (-1);
  88. }
  89. /* Read FAT */
  90. if (read_fat (boot, fs) < 0) {
  91. free (boot);
  92. return (-1);
  93. }
  94. free (boot);
  95. return (0);
  96. }