]>
Commit | Line | Data |
---|---|---|
674c3412 | 1 | /* |
674c3412 ML |
2 | * Copyright (C) 2010 - Maxim Levitsky |
3 | * | |
4 | * mtd_probe is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License as published by | |
6 | * the Free Software Foundation; either version 2 of the License, or | |
7 | * (at your option) any later version. | |
8 | * | |
9 | * mtd_probe is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with mtd_probe; if not, write to the Free Software | |
ad29a9f1 | 16 | * Foundation, Inc., 51 Franklin St, Fifth Floor, |
674c3412 ML |
17 | * Boston, MA 02110-1301 USA |
18 | */ | |
19 | ||
20 | #include <stdio.h> | |
21 | #include <stdlib.h> | |
22 | #include <mtd/mtd-user.h> | |
5f307a98 | 23 | #include <string.h> |
674c3412 ML |
24 | #include <sys/types.h> |
25 | #include <sys/stat.h> | |
26 | #include <fcntl.h> | |
27 | #include <unistd.h> | |
28 | #include <stdint.h> | |
29 | #include <stdlib.h> | |
30 | #include "mtd_probe.h" | |
31 | ||
32 | static const uint8_t cis_signature[] = { | |
912541b0 | 33 | 0x01, 0x03, 0xD9, 0x01, 0xFF, 0x18, 0x02, 0xDF, 0x01, 0x20 |
674c3412 ML |
34 | }; |
35 | ||
36 | ||
5f307a98 KS |
37 | void probe_smart_media(int mtd_fd, mtd_info_t* info) |
38 | { | |
912541b0 | 39 | char* cis_buffer = malloc(SM_SECTOR_SIZE); |
5f307a98 | 40 | |
912541b0 KS |
41 | if (!cis_buffer) |
42 | return; | |
674c3412 | 43 | |
912541b0 KS |
44 | if (info->type != MTD_NANDFLASH) |
45 | goto exit; | |
674c3412 | 46 | |
912541b0 KS |
47 | int sector_size = info->writesize; |
48 | int block_size = info->erasesize; | |
49 | int size_in_megs = info->size / (1024 * 1024); | |
50 | int spare_count; | |
674c3412 ML |
51 | |
52 | ||
912541b0 KS |
53 | if (sector_size != SM_SECTOR_SIZE && sector_size != SM_SMALL_PAGE) |
54 | goto exit; | |
674c3412 | 55 | |
912541b0 KS |
56 | switch(size_in_megs) { |
57 | case 1: | |
58 | case 2: | |
59 | spare_count = 6; | |
60 | break; | |
61 | case 4: | |
62 | spare_count = 12; | |
63 | break; | |
64 | default: | |
65 | spare_count = 24; | |
66 | break; | |
67 | } | |
674c3412 ML |
68 | |
69 | ||
912541b0 KS |
70 | int offset; |
71 | int cis_found = 0; | |
674c3412 | 72 | |
912541b0 KS |
73 | for (offset = 0 ; offset < block_size * spare_count ; |
74 | offset += sector_size) { | |
674c3412 | 75 | |
912541b0 KS |
76 | lseek(mtd_fd, SEEK_SET, offset); |
77 | if (read(mtd_fd, cis_buffer, SM_SECTOR_SIZE) == SM_SECTOR_SIZE){ | |
78 | cis_found = 1; | |
79 | break; | |
80 | } | |
81 | } | |
674c3412 | 82 | |
912541b0 KS |
83 | if (!cis_found) |
84 | goto exit; | |
674c3412 | 85 | |
912541b0 KS |
86 | if (memcmp(cis_buffer, cis_signature, sizeof(cis_signature)) != 0 && |
87 | (memcmp(cis_buffer + SM_SMALL_PAGE, cis_signature, | |
88 | sizeof(cis_signature)) != 0)) | |
89 | goto exit; | |
674c3412 | 90 | |
912541b0 KS |
91 | printf("MTD_FTL=smartmedia\n"); |
92 | free(cis_buffer); | |
93 | exit(0); | |
674c3412 | 94 | exit: |
912541b0 KS |
95 | free(cis_buffer); |
96 | return; | |
674c3412 | 97 | } |