1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <common.h>
16#include <command.h>
17#include <memalign.h>
18#include <ide.h>
19#include "part_mac.h"
20
21#ifdef CONFIG_HAVE_BLOCK_DEVICE
22
23
24#ifndef __ldiv_t_defined
25typedef struct {
26 long int quot;
27 long int rem;
28} ldiv_t;
29extern ldiv_t ldiv (long int __numer, long int __denom);
30# define __ldiv_t_defined 1
31#endif
32
33
34static int part_mac_read_ddb(struct blk_desc *dev_desc,
35 mac_driver_desc_t *ddb_p);
36static int part_mac_read_pdb(struct blk_desc *dev_desc, int part,
37 mac_partition_t *pdb_p);
38
39
40
41
42static int part_test_mac(struct blk_desc *dev_desc)
43{
44 ALLOC_CACHE_ALIGN_BUFFER(mac_driver_desc_t, ddesc, 1);
45 ALLOC_CACHE_ALIGN_BUFFER(mac_partition_t, mpart, 1);
46 ulong i, n;
47
48 if (part_mac_read_ddb (dev_desc, ddesc)) {
49
50
51
52
53 return (-1);
54 }
55
56 n = 1;
57 for (i=1; i<=n; ++i) {
58 if ((blk_dread(dev_desc, i, 1, (ulong *)mpart) != 1) ||
59 (mpart->signature != MAC_PARTITION_MAGIC) ) {
60 return (-1);
61 }
62
63 n = mpart->map_count;
64 }
65 return (0);
66}
67
68static void part_print_mac(struct blk_desc *dev_desc)
69{
70 ulong i, n;
71 ALLOC_CACHE_ALIGN_BUFFER(mac_driver_desc_t, ddesc, 1);
72 ALLOC_CACHE_ALIGN_BUFFER(mac_partition_t, mpart, 1);
73 ldiv_t mb, gb;
74
75 if (part_mac_read_ddb (dev_desc, ddesc)) {
76
77
78
79
80 return;
81 }
82
83 n = ddesc->blk_count;
84
85 mb = ldiv(n, ((1024 * 1024) / ddesc->blk_size));
86
87 mb.rem *= 10 * ddesc->blk_size;
88 mb.rem += 512 * 1024;
89 mb.rem /= 1024 * 1024;
90
91 gb = ldiv(10 * mb.quot + mb.rem, 10240);
92 gb.rem += 512;
93 gb.rem /= 1024;
94
95
96 printf ("Block Size=%d, Number of Blocks=%d, "
97 "Total Capacity: %ld.%ld MB = %ld.%ld GB\n"
98 "DeviceType=0x%x, DeviceId=0x%x\n\n"
99 " #: type name"
100 " length base (size)\n",
101 ddesc->blk_size,
102 ddesc->blk_count,
103 mb.quot, mb.rem, gb.quot, gb.rem,
104 ddesc->dev_type, ddesc->dev_id
105 );
106
107 n = 1;
108 for (i=1; i<=n; ++i) {
109 ulong bytes;
110 char c;
111
112 printf ("%4ld: ", i);
113 if (blk_dread(dev_desc, i, 1, (ulong *)mpart) != 1) {
114 printf ("** Can't read Partition Map on %d:%ld **\n",
115 dev_desc->devnum, i);
116 return;
117 }
118
119 if (mpart->signature != MAC_PARTITION_MAGIC) {
120 printf("** Bad Signature on %d:%ld - expected 0x%04x, got 0x%04x\n",
121 dev_desc->devnum, i, MAC_PARTITION_MAGIC,
122 mpart->signature);
123 return;
124 }
125
126
127 n = mpart->map_count;
128
129 c = 'k';
130 bytes = mpart->block_count;
131 bytes /= (1024 / ddesc->blk_size);
132 if (bytes >= 1024) {
133 bytes >>= 10;
134 c = 'M';
135 }
136 if (bytes >= 1024) {
137 bytes >>= 10;
138 c = 'G';
139 }
140
141 printf ("%20.32s %-18.32s %10u @ %-10u (%3ld%c)\n",
142 mpart->type,
143 mpart->name,
144 mpart->block_count,
145 mpart->start_block,
146 bytes, c
147 );
148 }
149
150 return;
151}
152
153
154
155
156
157static int part_mac_read_ddb(struct blk_desc *dev_desc,
158 mac_driver_desc_t *ddb_p)
159{
160 if (blk_dread(dev_desc, 0, 1, (ulong *)ddb_p) != 1) {
161 debug("** Can't read Driver Descriptor Block **\n");
162 return (-1);
163 }
164
165 if (ddb_p->signature != MAC_DRIVER_MAGIC) {
166 return (-1);
167 }
168 return (0);
169}
170
171
172
173
174static int part_mac_read_pdb(struct blk_desc *dev_desc, int part,
175 mac_partition_t *pdb_p)
176{
177 int n = 1;
178
179 for (;;) {
180
181
182
183
184
185 if (blk_dread(dev_desc, n, 1, (ulong *)pdb_p) != 1) {
186 printf ("** Can't read Partition Map on %d:%d **\n",
187 dev_desc->devnum, n);
188 return (-1);
189 }
190
191 if (pdb_p->signature != MAC_PARTITION_MAGIC) {
192 printf("** Bad Signature on %d:%d: expected 0x%04x, got 0x%04x\n",
193 dev_desc->devnum, n, MAC_PARTITION_MAGIC,
194 pdb_p->signature);
195 return (-1);
196 }
197
198 if (n == part)
199 return (0);
200
201 if ((part < 1) || (part > pdb_p->map_count)) {
202 printf ("** Invalid partition %d:%d [%d:1...%d:%d only]\n",
203 dev_desc->devnum, part,
204 dev_desc->devnum,
205 dev_desc->devnum, pdb_p->map_count);
206 return (-1);
207 }
208
209
210 n = part;
211 }
212
213
214}
215
216static int part_get_info_mac(struct blk_desc *dev_desc, int part,
217 disk_partition_t *info)
218{
219 ALLOC_CACHE_ALIGN_BUFFER(mac_driver_desc_t, ddesc, 1);
220 ALLOC_CACHE_ALIGN_BUFFER(mac_partition_t, mpart, 1);
221
222 if (part_mac_read_ddb (dev_desc, ddesc)) {
223 return (-1);
224 }
225
226 info->blksz = ddesc->blk_size;
227
228 if (part_mac_read_pdb (dev_desc, part, mpart)) {
229 return (-1);
230 }
231
232 info->start = mpart->start_block;
233 info->size = mpart->block_count;
234 memcpy (info->type, mpart->type, sizeof(info->type));
235 memcpy (info->name, mpart->name, sizeof(info->name));
236
237 return (0);
238}
239
240U_BOOT_PART_TYPE(mac) = {
241 .name = "MAC",
242 .part_type = PART_TYPE_MAC,
243 .max_entries = MAC_ENTRY_NUMBERS,
244 .get_info = part_get_info_mac,
245 .print = part_print_mac,
246 .test = part_test_mac,
247};
248#endif
249