Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / block / partitions / ibm.c
1 /*
2 * Author(s)......: Holger Smolinski <Holger.Smolinski@de.ibm.com>
3 * Volker Sameske <sameske@de.ibm.com>
4 * Bugreports.to..: <Linux390@de.ibm.com>
5 * Copyright IBM Corp. 1999, 2012
6 */
7
8 #include <linux/buffer_head.h>
9 #include <linux/hdreg.h>
10 #include <linux/slab.h>
11 #include <asm/dasd.h>
12 #include <asm/ebcdic.h>
13 #include <asm/uaccess.h>
14 #include <asm/vtoc.h>
15
16 #include "check.h"
17 #include "ibm.h"
18
19
20 union label_t {
21 struct vtoc_volume_label_cdl vol;
22 struct vtoc_volume_label_ldl lnx;
23 struct vtoc_cms_label cms;
24 };
25
26 /*
27 * compute the block number from a
28 * cyl-cyl-head-head structure
29 */
30 static sector_t cchh2blk(struct vtoc_cchh *ptr, struct hd_geometry *geo)
31 {
32 sector_t cyl;
33 __u16 head;
34
35 /* decode cylinder and heads for large volumes */
36 cyl = ptr->hh & 0xFFF0;
37 cyl <<= 12;
38 cyl |= ptr->cc;
39 head = ptr->hh & 0x000F;
40 return cyl * geo->heads * geo->sectors +
41 head * geo->sectors;
42 }
43
44 /*
45 * compute the block number from a
46 * cyl-cyl-head-head-block structure
47 */
48 static sector_t cchhb2blk(struct vtoc_cchhb *ptr, struct hd_geometry *geo)
49 {
50 sector_t cyl;
51 __u16 head;
52
53 /* decode cylinder and heads for large volumes */
54 cyl = ptr->hh & 0xFFF0;
55 cyl <<= 12;
56 cyl |= ptr->cc;
57 head = ptr->hh & 0x000F;
58 return cyl * geo->heads * geo->sectors +
59 head * geo->sectors +
60 ptr->b;
61 }
62
63 static int find_label(struct parsed_partitions *state,
64 dasd_information2_t *info,
65 struct hd_geometry *geo,
66 int blocksize,
67 sector_t *labelsect,
68 char name[],
69 char type[],
70 union label_t *label)
71 {
72 Sector sect;
73 unsigned char *data;
74 sector_t testsect[3];
75 unsigned char temp[5];
76 int found = 0;
77 int i, testcount;
78
79 /* There a three places where we may find a valid label:
80 * - on an ECKD disk it's block 2
81 * - on an FBA disk it's block 1
82 * - on an CMS formatted FBA disk it is sector 1, even if the block size
83 * is larger than 512 bytes (possible if the DIAG discipline is used)
84 * If we have a valid info structure, then we know exactly which case we
85 * have, otherwise we just search through all possebilities.
86 */
87 if (info) {
88 if ((info->cu_type == 0x6310 && info->dev_type == 0x9336) ||
89 (info->cu_type == 0x3880 && info->dev_type == 0x3370))
90 testsect[0] = info->label_block;
91 else
92 testsect[0] = info->label_block * (blocksize >> 9);
93 testcount = 1;
94 } else {
95 testsect[0] = 1;
96 testsect[1] = (blocksize >> 9);
97 testsect[2] = 2 * (blocksize >> 9);
98 testcount = 3;
99 }
100 for (i = 0; i < testcount; ++i) {
101 data = read_part_sector(state, testsect[i], &sect);
102 if (data == NULL)
103 continue;
104 memcpy(label, data, sizeof(*label));
105 memcpy(temp, data, 4);
106 temp[4] = 0;
107 EBCASC(temp, 4);
108 put_dev_sector(sect);
109 if (!strcmp(temp, "VOL1") ||
110 !strcmp(temp, "LNX1") ||
111 !strcmp(temp, "CMS1")) {
112 if (!strcmp(temp, "VOL1")) {
113 strncpy(type, label->vol.vollbl, 4);
114 strncpy(name, label->vol.volid, 6);
115 } else {
116 strncpy(type, label->lnx.vollbl, 4);
117 strncpy(name, label->lnx.volid, 6);
118 }
119 EBCASC(type, 4);
120 EBCASC(name, 6);
121 *labelsect = testsect[i];
122 found = 1;
123 break;
124 }
125 }
126 if (!found)
127 memset(label, 0, sizeof(*label));
128
129 return found;
130 }
131
132 static int find_vol1_partitions(struct parsed_partitions *state,
133 struct hd_geometry *geo,
134 int blocksize,
135 char name[],
136 union label_t *label)
137 {
138 sector_t blk;
139 int counter;
140 char tmp[64];
141 Sector sect;
142 unsigned char *data;
143 loff_t offset, size;
144 struct vtoc_format1_label f1;
145 int secperblk;
146
147 snprintf(tmp, sizeof(tmp), "VOL1/%8s:", name);
148 strlcat(state->pp_buf, tmp, PAGE_SIZE);
149 /*
150 * get start of VTOC from the disk label and then search for format1
151 * and format8 labels
152 */
153 secperblk = blocksize >> 9;
154 blk = cchhb2blk(&label->vol.vtoc, geo) + 1;
155 counter = 0;
156 data = read_part_sector(state, blk * secperblk, &sect);
157 while (data != NULL) {
158 memcpy(&f1, data, sizeof(struct vtoc_format1_label));
159 put_dev_sector(sect);
160 /* skip FMT4 / FMT5 / FMT7 labels */
161 if (f1.DS1FMTID == _ascebc['4']
162 || f1.DS1FMTID == _ascebc['5']
163 || f1.DS1FMTID == _ascebc['7']
164 || f1.DS1FMTID == _ascebc['9']) {
165 blk++;
166 data = read_part_sector(state, blk * secperblk, &sect);
167 continue;
168 }
169 /* only FMT1 and 8 labels valid at this point */
170 if (f1.DS1FMTID != _ascebc['1'] &&
171 f1.DS1FMTID != _ascebc['8'])
172 break;
173 /* OK, we got valid partition data */
174 offset = cchh2blk(&f1.DS1EXT1.llimit, geo);
175 size = cchh2blk(&f1.DS1EXT1.ulimit, geo) -
176 offset + geo->sectors;
177 offset *= secperblk;
178 size *= secperblk;
179 if (counter >= state->limit)
180 break;
181 put_partition(state, counter + 1, offset, size);
182 counter++;
183 blk++;
184 data = read_part_sector(state, blk * secperblk, &sect);
185 }
186 strlcat(state->pp_buf, "\n", PAGE_SIZE);
187
188 if (!data)
189 return -1;
190
191 return 1;
192 }
193
194 static int find_lnx1_partitions(struct parsed_partitions *state,
195 struct hd_geometry *geo,
196 int blocksize,
197 char name[],
198 union label_t *label,
199 sector_t labelsect,
200 loff_t i_size,
201 dasd_information2_t *info)
202 {
203 loff_t offset, geo_size, size;
204 char tmp[64];
205 int secperblk;
206
207 snprintf(tmp, sizeof(tmp), "LNX1/%8s:", name);
208 strlcat(state->pp_buf, tmp, PAGE_SIZE);
209 secperblk = blocksize >> 9;
210 if (label->lnx.ldl_version == 0xf2) {
211 size = label->lnx.formatted_blocks * secperblk;
212 } else {
213 /*
214 * Formated w/o large volume support. If the sanity check
215 * 'size based on geo == size based on i_size' is true, then
216 * we can safely assume that we know the formatted size of
217 * the disk, otherwise we need additional information
218 * that we can only get from a real DASD device.
219 */
220 geo_size = geo->cylinders * geo->heads
221 * geo->sectors * secperblk;
222 size = i_size >> 9;
223 if (size != geo_size) {
224 if (!info) {
225 strlcat(state->pp_buf, "\n", PAGE_SIZE);
226 return 1;
227 }
228 if (!strcmp(info->type, "ECKD"))
229 if (geo_size < size)
230 size = geo_size;
231 /* else keep size based on i_size */
232 }
233 }
234 /* first and only partition starts in the first block after the label */
235 offset = labelsect + secperblk;
236 put_partition(state, 1, offset, size - offset);
237 strlcat(state->pp_buf, "\n", PAGE_SIZE);
238 return 1;
239 }
240
241 static int find_cms1_partitions(struct parsed_partitions *state,
242 struct hd_geometry *geo,
243 int blocksize,
244 char name[],
245 union label_t *label,
246 sector_t labelsect)
247 {
248 loff_t offset, size;
249 char tmp[64];
250 int secperblk;
251
252 /*
253 * VM style CMS1 labeled disk
254 */
255 blocksize = label->cms.block_size;
256 secperblk = blocksize >> 9;
257 if (label->cms.disk_offset != 0) {
258 snprintf(tmp, sizeof(tmp), "CMS1/%8s(MDSK):", name);
259 strlcat(state->pp_buf, tmp, PAGE_SIZE);
260 /* disk is reserved minidisk */
261 offset = label->cms.disk_offset * secperblk;
262 size = (label->cms.block_count - 1) * secperblk;
263 } else {
264 snprintf(tmp, sizeof(tmp), "CMS1/%8s:", name);
265 strlcat(state->pp_buf, tmp, PAGE_SIZE);
266 /*
267 * Special case for FBA devices:
268 * If an FBA device is CMS formatted with blocksize > 512 byte
269 * and the DIAG discipline is used, then the CMS label is found
270 * in sector 1 instead of block 1. However, the partition is
271 * still supposed to start in block 2.
272 */
273 if (labelsect == 1)
274 offset = 2 * secperblk;
275 else
276 offset = labelsect + secperblk;
277 size = label->cms.block_count * secperblk;
278 }
279
280 put_partition(state, 1, offset, size-offset);
281 strlcat(state->pp_buf, "\n", PAGE_SIZE);
282 return 1;
283 }
284
285
286 /*
287 * This is the main function, called by check.c
288 */
289 int ibm_partition(struct parsed_partitions *state)
290 {
291 struct block_device *bdev = state->bdev;
292 int blocksize, res;
293 loff_t i_size, offset, size;
294 dasd_information2_t *info;
295 struct hd_geometry *geo;
296 char type[5] = {0,};
297 char name[7] = {0,};
298 sector_t labelsect;
299 union label_t *label;
300
301 res = 0;
302 blocksize = bdev_logical_block_size(bdev);
303 if (blocksize <= 0)
304 goto out_exit;
305 i_size = i_size_read(bdev->bd_inode);
306 if (i_size == 0)
307 goto out_exit;
308 info = kmalloc(sizeof(dasd_information2_t), GFP_KERNEL);
309 if (info == NULL)
310 goto out_exit;
311 geo = kmalloc(sizeof(struct hd_geometry), GFP_KERNEL);
312 if (geo == NULL)
313 goto out_nogeo;
314 label = kmalloc(sizeof(union label_t), GFP_KERNEL);
315 if (label == NULL)
316 goto out_nolab;
317 if (ioctl_by_bdev(bdev, HDIO_GETGEO, (unsigned long)geo) != 0)
318 goto out_freeall;
319 if (ioctl_by_bdev(bdev, BIODASDINFO2, (unsigned long)info) != 0) {
320 kfree(info);
321 info = NULL;
322 }
323
324 if (find_label(state, info, geo, blocksize, &labelsect, name, type,
325 label)) {
326 if (!strncmp(type, "VOL1", 4)) {
327 res = find_vol1_partitions(state, geo, blocksize, name,
328 label);
329 } else if (!strncmp(type, "LNX1", 4)) {
330 res = find_lnx1_partitions(state, geo, blocksize, name,
331 label, labelsect, i_size,
332 info);
333 } else if (!strncmp(type, "CMS1", 4)) {
334 res = find_cms1_partitions(state, geo, blocksize, name,
335 label, labelsect);
336 }
337 } else if (info) {
338 /*
339 * ugly but needed for backward compatibility:
340 * If the block device is a DASD (i.e. BIODASDINFO2 works),
341 * then we claim it in any case, even though it has no valid
342 * label. If it has the LDL format, then we simply define a
343 * partition as if it had an LNX1 label.
344 */
345 res = 1;
346 if (info->format == DASD_FORMAT_LDL) {
347 strlcat(state->pp_buf, "(nonl)", PAGE_SIZE);
348 size = i_size >> 9;
349 offset = (info->label_block + 1) * (blocksize >> 9);
350 put_partition(state, 1, offset, size-offset);
351 strlcat(state->pp_buf, "\n", PAGE_SIZE);
352 }
353 } else
354 res = 0;
355
356 out_freeall:
357 kfree(label);
358 out_nolab:
359 kfree(geo);
360 out_nogeo:
361 kfree(info);
362 out_exit:
363 return res;
364 }