Gitiles
Code Review Sign In
192.168.1.100 / T108 / c2023d5d03be91dbb983606f0ec5e9e4ea36c8c2 / . / marvell / uboot / fs / fdos / dev.c
blob: 4c48663e0910d3497380d4e19b87b00edc5c60f7 [file] [log] [blame]
b.liue9582032025-04-17 19:18:16 +0800[diff] [blame]1/*
2 * (C) Copyright 2002
3 * Stäubli Faverges - <www.staubli.com>
4 * Pierre AUBERT p.aubert@staubli.com
5 *
6 * SPDX-License-Identifier: GPL-2.0+
7 */
8
9#include <common.h>
10#include <config.h>
11
12#include "dos.h"
13#include "fdos.h"
14
15#define NB_HEADS 2
16#define NB_TRACKS 80
17#define NB_SECTORS 18
18
19
20static int lastwhere;
21
22/*-----------------------------------------------------------------------------
23 * dev_open --
24 *-----------------------------------------------------------------------------
25 */
26int dev_open (void)
27{
28 lastwhere = 0;
29 return (0);
30}
31
32/*-----------------------------------------------------------------------------
33 * dev_read -- len and where are sectors number
34 *-----------------------------------------------------------------------------
35 */
36int dev_read (void *buffer, int where, int len)
37{
38 PRINTF ("dev_read (len = %d, where = %d)\n", len, where);
39
40 /* Si on ne desire pas lire a la position courante, il faut un seek */
41 if (where != lastwhere) {
42 if (!fdc_fdos_seek (where)) {
43 PRINTF ("seek error in dev_read");
44 lastwhere = -1;
45 return (-1);
46 }
47 }
48
49 if (!fdc_fdos_read (buffer, len)) {
50 PRINTF ("read error\n");
51 lastwhere = -1;
52 return (-1);
53 }
54 lastwhere = where + len;
55 return (0);
56}
57/*-----------------------------------------------------------------------------
58 * check_dev -- verify the diskette format
59 *-----------------------------------------------------------------------------
60 */
61int check_dev (BootSector_t *boot, Fs_t *fs)
62{
63 unsigned int heads, sectors, tracks;
64 int BootP, Infp0, InfpX, InfTm;
65 int sect_per_track;
66
67 /* Display Boot header */
68 PRINTF ("Jump to boot code 0x%02x 0x%02x 0x%02x\n",
69 boot -> jump [0], boot -> jump [1], boot -> jump[2]);
70 PRINTF ("OEM name & version '%*.*s'\n",
71 BANNER_LG, BANNER_LG, boot -> banner );
72 PRINTF ("Bytes per sector hopefully 512 %d\n",
73 __le16_to_cpu (boot -> secsiz));
74 PRINTF ("Cluster size in sectors %d\n",
75 boot -> clsiz);
76 PRINTF ("Number of reserved (boot) sectors %d\n",
77 __le16_to_cpu (boot -> nrsvsect));
78 PRINTF ("Number of FAT tables hopefully 2 %d\n",
79 boot -> nfat);
80 PRINTF ("Number of directory slots %d\n",
81 __le16_to_cpu (boot -> dirents));
82 PRINTF ("Total sectors on disk %d\n",
83 __le16_to_cpu (boot -> psect));
84 PRINTF ("Media descriptor=first byte of FAT %d\n",
85 boot -> descr);
86 PRINTF ("Sectors in FAT %d\n",
87 __le16_to_cpu (boot -> fatlen));
88 PRINTF ("Sectors/track %d\n",
89 __le16_to_cpu (boot -> nsect));
90 PRINTF ("Heads %d\n",
91 __le16_to_cpu (boot -> nheads));
92 PRINTF ("number of hidden sectors %d\n",
93 __le32_to_cpu (boot -> nhs));
94 PRINTF ("big total sectors %d\n",
95 __le32_to_cpu (boot -> bigsect));
96 PRINTF ("physical drive ? %d\n",
97 boot -> physdrive);
98 PRINTF ("reserved %d\n",
99 boot -> reserved);
100 PRINTF ("dos > 4.0 diskette %d\n",
101 boot -> dos4);
102 PRINTF ("serial number %d\n",
103 __le32_to_cpu (boot -> serial));
104 PRINTF ("disk label %*.*s\n",
105 LABEL_LG, LABEL_LG, boot -> label);
106 PRINTF ("FAT type %8.8s\n",
107 boot -> fat_type);
108 PRINTF ("reserved by 2M %d\n",
109 boot -> res_2m);
110 PRINTF ("2M checksum (not used) %d\n",
111 boot -> CheckSum);
112 PRINTF ("2MF format version %d\n",
113 boot -> fmt_2mf);
114 PRINTF ("1 if write track after format %d\n",
115 boot -> wt);
116 PRINTF ("data transfer rate on track 0 %d\n",
117 boot -> rate_0);
118 PRINTF ("data transfer rate on track<>0 %d\n",
119 boot -> rate_any);
120 PRINTF ("offset to boot program %d\n",
121 __le16_to_cpu (boot -> BootP));
122 PRINTF ("T1: information for track 0 %d\n",
123 __le16_to_cpu (boot -> Infp0));
124 PRINTF ("T2: information for track<>0 %d\n",
125 __le16_to_cpu (boot -> InfpX));
126 PRINTF ("T3: track sectors size table %d\n",
127 __le16_to_cpu (boot -> InfTm));
128 PRINTF ("Format date 0x%04x\n",
129 __le16_to_cpu (boot -> DateF));
130 PRINTF ("Format time 0x%04x\n",
131 __le16_to_cpu (boot -> TimeF));
132
133
134 /* information is extracted from boot sector */
135 heads = __le16_to_cpu (boot -> nheads);
136 sectors = __le16_to_cpu (boot -> nsect);
137 fs -> tot_sectors = __le32_to_cpu (boot -> bigsect);
138 if (__le16_to_cpu (boot -> psect) != 0) {
139 fs -> tot_sectors = __le16_to_cpu (boot -> psect);
140 }
141
142 sect_per_track = heads * sectors;
143 tracks = (fs -> tot_sectors + sect_per_track - 1) / sect_per_track;
144
145 BootP = __le16_to_cpu (boot -> BootP);
146 Infp0 = __le16_to_cpu (boot -> Infp0);
147 InfpX = __le16_to_cpu (boot -> InfpX);
148 InfTm = __le16_to_cpu (boot -> InfTm);
149
150 if (boot -> dos4 == EXTENDED_BOOT &&
151 strncmp( boot->banner,"2M", 2 ) == 0 &&
152 BootP < SZ_STD_SECTOR &&
153 Infp0 < SZ_STD_SECTOR &&
154 InfpX < SZ_STD_SECTOR &&
155 InfTm < SZ_STD_SECTOR &&
156 BootP >= InfTm + 2 &&
157 InfTm >= InfpX &&
158 InfpX >= Infp0 &&
159 Infp0 >= 76 ) {
160
161 return (-1);
162 }
163
164 if (heads != NB_HEADS ||
165 tracks != NB_TRACKS ||
166 sectors != NB_SECTORS ||
167 __le16_to_cpu (boot -> secsiz) != SZ_STD_SECTOR ||
168 fs -> tot_sectors == 0 ||
169 (fs -> tot_sectors % sectors) != 0) {
170 return (-1);
171 }
172
173 return (0);
174}