3 * Holger Brunck, Keymile GmbH Hannover, holger.brunck@keymile.com
5 * SPDX-License-Identifier: GPL-2.0+
13 static int ivm_calc_crc(unsigned char *buf
, int len
)
15 const unsigned short crc_tab
[16] = {
16 0x0000, 0xCC01, 0xD801, 0x1400,
17 0xF001, 0x3C00, 0x2800, 0xE401,
18 0xA001, 0x6C00, 0x7800, 0xB401,
19 0x5000, 0x9C01, 0x8801, 0x4400};
21 unsigned short crc
= 0; /* final result */
22 unsigned short r1
= 0; /* temp */
23 unsigned char byte
= 0; /* input buffer */
26 /* calculate CRC from array data */
27 for (i
= 0; i
< len
; i
++) {
31 r1
= crc_tab
[crc
& 0xF];
32 crc
= ((crc
) >> 4) & 0x0FFF;
33 crc
= crc
^ r1
^ crc_tab
[byte
& 0xF];
36 r1
= crc_tab
[crc
& 0xF];
37 crc
= (crc
>> 4) & 0x0FFF;
38 crc
= crc
^ r1
^ crc_tab
[(byte
>> 4) & 0xF];
43 static int ivm_set_value(char *name
, char *value
)
48 sprintf(tempbuf
, "%s=%s", name
, value
);
49 return set_local_var(tempbuf
, 0);
51 unset_local_var(name
);
56 static int ivm_get_value(unsigned char *buf
, int len
, char *name
, int off
,
60 unsigned char valbuf
[30];
62 if ((buf
[off
+ 0] != buf
[off
+ 2]) &&
63 (buf
[off
+ 2] != buf
[off
+ 4])) {
64 printf("%s Error corrupted %s\n", __func__
, name
);
67 val
= buf
[off
+ 0] + (buf
[off
+ 1] << 8);
68 if ((val
== 0) && (check
== 1))
71 sprintf((char *)valbuf
, "%x", val
);
72 ivm_set_value(name
, (char *)valbuf
);
76 #define INV_BLOCKSIZE 0x100
77 #define INV_DATAADDRESS 0x21
78 #define INVENTORYDATASIZE (INV_BLOCKSIZE - INV_DATAADDRESS - 3)
80 #define IVM_POS_SHORT_TEXT 0
81 #define IVM_POS_MANU_ID 1
82 #define IVM_POS_MANU_SERIAL 2
83 #define IVM_POS_PART_NUMBER 3
84 #define IVM_POS_BUILD_STATE 4
85 #define IVM_POS_SUPPLIER_PART_NUMBER 5
86 #define IVM_POS_DELIVERY_DATE 6
87 #define IVM_POS_SUPPLIER_BUILD_STATE 7
88 #define IVM_POS_CUSTOMER_ID 8
89 #define IVM_POS_CUSTOMER_PROD_ID 9
90 #define IVM_POS_HISTORY 10
91 #define IVM_POS_SYMBOL_ONLY 11
93 static char convert_char(char c
)
95 return (c
< ' ' || c
> '~') ? '.' : c
;
98 static int ivm_findinventorystring(int type
,
99 unsigned char *const string
,
100 unsigned long maxlen
,
104 unsigned long cr
= 0;
105 unsigned long addr
= INV_DATAADDRESS
;
106 unsigned long size
= 0;
107 unsigned long nr
= type
;
108 int stop
= 0; /* stop on semicolon */
110 memset(string
, '\0', maxlen
);
112 case IVM_POS_SYMBOL_ONLY
:
121 /* Look for the requested number of CR. */
122 while ((cr
!= nr
) && (addr
< INVENTORYDATASIZE
)) {
123 if (buf
[addr
] == '\r')
129 * the expected number of CR was found until the end of the IVM
130 * content --> fill string
132 if (addr
< INVENTORYDATASIZE
) {
133 /* Copy the IVM string in the corresponding string */
134 for (; (buf
[addr
] != '\r') &&
135 ((buf
[addr
] != ';') || (!stop
)) &&
136 (size
< (maxlen
- 1) &&
137 (addr
< INVENTORYDATASIZE
)); addr
++) {
138 size
+= sprintf((char *)string
+ size
, "%c",
139 convert_char (buf
[addr
]));
143 * copy phase is done: check if everything is ok. If not,
144 * the inventory data is most probably corrupted: tell
145 * the world there is a problem!
147 if (addr
== INVENTORYDATASIZE
) {
149 printf("Error end of string not found\n");
150 } else if ((size
> (maxlen
- 1)) &&
151 (buf
[addr
] != '\r')) {
153 printf("string too long till next CR\n");
157 * some CR are missing...
158 * the inventory data is most probably corrupted
161 printf("not enough cr found\n");
166 #define GET_STRING(name, which, len) \
167 if (ivm_findinventorystring(which, valbuf, len, buf) == 0) { \
168 ivm_set_value(name, (char *)valbuf); \
171 static int ivm_check_crc(unsigned char *buf
, int block
)
174 unsigned long crceeprom
;
176 crc
= ivm_calc_crc(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 2);
177 crceeprom
= (buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 1] + \
178 buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 2] * 256);
179 if (crc
!= crceeprom
) {
181 printf("Error CRC Block: %d EEprom: calculated: \
182 %lx EEprom: %lx\n", block
, crc
, crceeprom
);
188 static int calculate_mac_offset(unsigned char *valbuf
, unsigned char *buf
,
191 unsigned long val
= (buf
[4] << 16) + (buf
[5] << 8) + buf
[6];
197 buf
[4] = (val
>> 16) & 0xff;
198 buf
[5] = (val
>> 8) & 0xff;
200 sprintf((char *)valbuf
, "%pM", buf
+ 1);
204 static int ivm_analyze_block2(unsigned char *buf
, int len
)
206 unsigned char valbuf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
];
209 /* IVM_MAC Adress begins at offset 1 */
210 sprintf((char *)valbuf
, "%pM", buf
+ 1);
211 ivm_set_value("IVM_MacAddress", (char *)valbuf
);
212 /* if an offset is defined, add it */
213 calculate_mac_offset(buf
, valbuf
, CONFIG_PIGGY_MAC_ADRESS_OFFSET
);
214 #ifdef MACH_TYPE_KM_KIRKWOOD
215 setenv((char *)"ethaddr", (char *)valbuf
);
217 if (getenv("ethaddr") == NULL
)
218 setenv((char *)"ethaddr", (char *)valbuf
);
220 #ifdef CONFIG_KMVECT1
221 /* KMVECT1 has two ethernet interfaces */
222 if (getenv("eth1addr") == NULL
) {
223 calculate_mac_offset(buf
, valbuf
, 1);
224 setenv((char *)"eth1addr", (char *)valbuf
);
228 count
= (buf
[10] << 24) +
232 if (count
== 0xffffffff)
234 sprintf((char *)valbuf
, "%lx", count
);
235 ivm_set_value("IVM_MacCount", (char *)valbuf
);
239 static int ivm_analyze_eeprom(unsigned char *buf
, int len
)
242 unsigned char valbuf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
];
245 if (ivm_check_crc(buf
, 0) != 0)
248 ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
249 "IVM_BoardId", 0, 1);
250 val
= ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
253 sprintf((char *)valbuf
, "%x", ((val
/ 100) % 10));
254 ivm_set_value("IVM_HWVariant", (char *)valbuf
);
255 sprintf((char *)valbuf
, "%x", (val
% 100));
256 ivm_set_value("IVM_HWVersion", (char *)valbuf
);
258 ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
259 "IVM_Functions", 12, 0);
261 GET_STRING("IVM_Symbol", IVM_POS_SYMBOL_ONLY
, 8)
262 GET_STRING("IVM_DeviceName", IVM_POS_SHORT_TEXT
, 64)
263 tmp
= (unsigned char *) getenv("IVM_DeviceName");
265 int len
= strlen((char *)tmp
);
270 ivm_set_value("IVM_ShortText",
271 (char *)&tmp
[i
+ 1]);
277 ivm_set_value("IVM_ShortText", NULL
);
279 ivm_set_value("IVM_ShortText", NULL
);
281 GET_STRING("IVM_ManufacturerID", IVM_POS_MANU_ID
, 32)
282 GET_STRING("IVM_ManufacturerSerialNumber", IVM_POS_MANU_SERIAL
, 20)
283 GET_STRING("IVM_ManufacturerPartNumber", IVM_POS_PART_NUMBER
, 32)
284 GET_STRING("IVM_ManufacturerBuildState", IVM_POS_BUILD_STATE
, 32)
285 GET_STRING("IVM_SupplierPartNumber", IVM_POS_SUPPLIER_PART_NUMBER
, 32)
286 GET_STRING("IVM_DelieveryDate", IVM_POS_DELIVERY_DATE
, 32)
287 GET_STRING("IVM_SupplierBuildState", IVM_POS_SUPPLIER_BUILD_STATE
, 32)
288 GET_STRING("IVM_CustomerID", IVM_POS_CUSTOMER_ID
, 32)
289 GET_STRING("IVM_CustomerProductID", IVM_POS_CUSTOMER_PROD_ID
, 32)
291 if (ivm_check_crc(&buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
* 2], 2) != 0)
293 ivm_analyze_block2(&buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
* 2],
294 CONFIG_SYS_IVM_EEPROM_PAGE_LEN
);
299 int ivm_read_eeprom(void)
301 uchar i2c_buffer
[CONFIG_SYS_IVM_EEPROM_MAX_LEN
];
304 i2c_set_bus_num(CONFIG_KM_IVM_BUS
);
305 /* add deblocking here */
308 ret
= i2c_read(CONFIG_SYS_IVM_EEPROM_ADR
, 0, 1, i2c_buffer
,
309 CONFIG_SYS_IVM_EEPROM_MAX_LEN
);
311 printf("Error reading EEprom\n");
315 return ivm_analyze_eeprom(i2c_buffer
, CONFIG_SYS_IVM_EEPROM_MAX_LEN
);