fs/fdos/fs.c

   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
  25 #include <common.h>
  26 #include <config.h>
  27 #include <malloc.h>
  28
  29 #include "dos.h"
  30 #include "fdos.h"
  31
  32
  33 /*-----------------------------------------------------------------------------
  34  * fill_fs -- Read info on file system
  35  *-----------------------------------------------------------------------------
  36  */
  37 static int fill_fs (BootSector_t *boot, Fs_t *fs)
  38 {
  39
  40     fs -> fat_start = __le16_to_cpu (boot -> nrsvsect);
  41     fs -> fat_len = __le16_to_cpu (boot -> fatlen);
  42     fs -> nb_fat = boot -> nfat;
  43
  44     fs -> dir_start = fs -> fat_start + fs -> nb_fat * fs -> fat_len;
  45     fs -> dir_len = __le16_to_cpu (boot -> dirents) * MDIR_SIZE / SZ_STD_SECTOR;
  46     fs -> cluster_size = boot -> clsiz;
  47     fs -> num_clus = (fs -> tot_sectors - fs -> dir_start - fs -> dir_len) / fs -> cluster_size;
  48
  49     return (0);
  50 }
  51
  52 /*-----------------------------------------------------------------------------
  53  * fs_init --
  54  *-----------------------------------------------------------------------------
  55  */
  56 int fs_init (Fs_t *fs)
  57 {
  58     BootSector_t *boot;
  59
  60     /* Initialize physical device                                            */
  61     if (dev_open () < 0) {
  62         PRINTF ("Unable to initialize the fdc\n");
  63         return (-1);
  64     }
  65     init_subdir ();
  66
  67     /* Allocate space for read the boot sector                               */
  68     if ((boot = (BootSector_t *)malloc (sizeof (BootSector_t))) == NULL) {
  69         PRINTF ("Unable to allocate space for boot sector\n");
  70         return (-1);
  71     }
  72
  73     /* read boot sector                                                      */
  74     if (dev_read (boot, 0, 1)){
  75         PRINTF ("Error during boot sector read\n");
  76         free (boot);
  77         return (-1);
  78     }
  79
  80     /* we verify it'a a DOS diskette                                         */
  81     if (boot -> jump [0] !=  JUMP_0_1 && boot -> jump [0] !=  JUMP_0_2) {
  82         PRINTF ("Not a DOS diskette\n");
  83         free (boot);
  84         return (-1);
  85     }
  86
  87     if (boot -> descr < MEDIA_STD) {
  88         /* We handle only recent medias (type F0)                            */
  89         PRINTF ("unrecognized diskette type\n");
  90         free (boot);
  91         return (-1);
  92     }
  93
  94     if (check_dev (boot, fs) < 0) {
  95         PRINTF ("Bad diskette\n");
  96         free (boot);
  97         return (-1);
  98     }
  99
 100     if (fill_fs (boot, fs) < 0) {
 101         free (boot);
 102
 103         return (-1);
 104     }
 105
 106     /* Read FAT                                                              */
 107     if (read_fat (boot, fs) < 0) {
 108         free (boot);
 109         return (-1);
 110     }
 111
 112     free (boot);
 113     return (0);
 114 }