3 * Holger Brunck, Keymile GmbH Hannover, holger.brunck@keymile.com
5 * SPDX-License-Identifier: GPL-2.0+
15 static int ivm_calc_crc(unsigned char *buf
, int len
)
17 const unsigned short crc_tab
[16] = {
18 0x0000, 0xCC01, 0xD801, 0x1400,
19 0xF001, 0x3C00, 0x2800, 0xE401,
20 0xA001, 0x6C00, 0x7800, 0xB401,
21 0x5000, 0x9C01, 0x8801, 0x4400};
23 unsigned short crc
= 0; /* final result */
24 unsigned short r1
= 0; /* temp */
25 unsigned char byte
= 0; /* input buffer */
28 /* calculate CRC from array data */
29 for (i
= 0; i
< len
; i
++) {
33 r1
= crc_tab
[crc
& 0xF];
34 crc
= ((crc
) >> 4) & 0x0FFF;
35 crc
= crc
^ r1
^ crc_tab
[byte
& 0xF];
38 r1
= crc_tab
[crc
& 0xF];
39 crc
= (crc
>> 4) & 0x0FFF;
40 crc
= crc
^ r1
^ crc_tab
[(byte
>> 4) & 0xF];
45 static int ivm_set_value(char *name
, char *value
)
50 sprintf(tempbuf
, "%s=%s", name
, value
);
51 return set_local_var(tempbuf
, 0);
53 unset_local_var(name
);
58 static int ivm_get_value(unsigned char *buf
, int len
, char *name
, int off
,
62 unsigned char valbuf
[30];
64 if ((buf
[off
+ 0] != buf
[off
+ 2]) &&
65 (buf
[off
+ 2] != buf
[off
+ 4])) {
66 printf("%s Error corrupted %s\n", __func__
, name
);
69 val
= buf
[off
+ 0] + (buf
[off
+ 1] << 8);
70 if ((val
== 0) && (check
== 1))
73 sprintf((char *)valbuf
, "%x", val
);
74 ivm_set_value(name
, (char *)valbuf
);
78 #define INV_BLOCKSIZE 0x100
79 #define INV_DATAADDRESS 0x21
80 #define INVENTORYDATASIZE (INV_BLOCKSIZE - INV_DATAADDRESS - 3)
82 #define IVM_POS_SHORT_TEXT 0
83 #define IVM_POS_MANU_ID 1
84 #define IVM_POS_MANU_SERIAL 2
85 #define IVM_POS_PART_NUMBER 3
86 #define IVM_POS_BUILD_STATE 4
87 #define IVM_POS_SUPPLIER_PART_NUMBER 5
88 #define IVM_POS_DELIVERY_DATE 6
89 #define IVM_POS_SUPPLIER_BUILD_STATE 7
90 #define IVM_POS_CUSTOMER_ID 8
91 #define IVM_POS_CUSTOMER_PROD_ID 9
92 #define IVM_POS_HISTORY 10
93 #define IVM_POS_SYMBOL_ONLY 11
95 static char convert_char(char c
)
97 return (c
< ' ' || c
> '~') ? '.' : c
;
100 static int ivm_findinventorystring(int type
,
101 unsigned char *const string
,
102 unsigned long maxlen
,
106 unsigned long cr
= 0;
107 unsigned long addr
= INV_DATAADDRESS
;
108 unsigned long size
= 0;
109 unsigned long nr
= type
;
110 int stop
= 0; /* stop on semicolon */
112 memset(string
, '\0', maxlen
);
114 case IVM_POS_SYMBOL_ONLY
:
123 /* Look for the requested number of CR. */
124 while ((cr
!= nr
) && (addr
< INVENTORYDATASIZE
)) {
125 if (buf
[addr
] == '\r')
131 * the expected number of CR was found until the end of the IVM
132 * content --> fill string
134 if (addr
< INVENTORYDATASIZE
) {
135 /* Copy the IVM string in the corresponding string */
136 for (; (buf
[addr
] != '\r') &&
137 ((buf
[addr
] != ';') || (!stop
)) &&
138 (size
< (maxlen
- 1) &&
139 (addr
< INVENTORYDATASIZE
)); addr
++) {
140 size
+= sprintf((char *)string
+ size
, "%c",
141 convert_char (buf
[addr
]));
145 * copy phase is done: check if everything is ok. If not,
146 * the inventory data is most probably corrupted: tell
147 * the world there is a problem!
149 if (addr
== INVENTORYDATASIZE
) {
151 printf("Error end of string not found\n");
152 } else if ((size
> (maxlen
- 1)) &&
153 (buf
[addr
] != '\r')) {
155 printf("string too long till next CR\n");
159 * some CR are missing...
160 * the inventory data is most probably corrupted
163 printf("not enough cr found\n");
168 #define GET_STRING(name, which, len) \
169 if (ivm_findinventorystring(which, valbuf, len, buf) == 0) { \
170 ivm_set_value(name, (char *)valbuf); \
173 static int ivm_check_crc(unsigned char *buf
, int block
)
176 unsigned long crceeprom
;
178 crc
= ivm_calc_crc(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 2);
179 crceeprom
= (buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 1] + \
180 buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
- 2] * 256);
181 if (crc
!= crceeprom
) {
183 printf("Error CRC Block: %d EEprom: calculated: \
184 %lx EEprom: %lx\n", block
, crc
, crceeprom
);
190 /* take care of the possible MAC address offset and the IVM content offset */
191 static int process_mac(unsigned char *valbuf
, unsigned char *buf
,
192 int offset
, bool unique
)
194 unsigned char mac
[6];
195 unsigned long val
= (buf
[4] << 16) + (buf
[5] << 8) + buf
[6];
197 /* use an intermediate buffer, to not change IVM content
198 * MAC address is at offset 1
200 memcpy(mac
, buf
+1, 6);
202 /* MAC adress can be set to locally administred, this is only allowed
203 * for interfaces which have now connection to the outside. For these
204 * addresses we need to set the second bit in the first byte.
211 mac
[3] = (val
>> 16) & 0xff;
212 mac
[4] = (val
>> 8) & 0xff;
216 sprintf((char *)valbuf
, "%pM", mac
);
220 static int ivm_analyze_block2(unsigned char *buf
, int len
)
222 unsigned char valbuf
[MAC_STR_SZ
];
225 /* IVM_MAC Adress begins at offset 1 */
226 sprintf((char *)valbuf
, "%pM", buf
+ 1);
227 ivm_set_value("IVM_MacAddress", (char *)valbuf
);
229 count
= (buf
[10] << 24) +
233 if (count
== 0xffffffff)
235 sprintf((char *)valbuf
, "%lx", count
);
236 ivm_set_value("IVM_MacCount", (char *)valbuf
);
240 int ivm_analyze_eeprom(unsigned char *buf
, int len
)
243 unsigned char valbuf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
];
246 if (ivm_check_crc(buf
, 0) != 0)
249 ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
250 "IVM_BoardId", 0, 1);
251 val
= ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
254 sprintf((char *)valbuf
, "%x", ((val
/ 100) % 10));
255 ivm_set_value("IVM_HWVariant", (char *)valbuf
);
256 sprintf((char *)valbuf
, "%x", (val
% 100));
257 ivm_set_value("IVM_HWVersion", (char *)valbuf
);
259 ivm_get_value(buf
, CONFIG_SYS_IVM_EEPROM_PAGE_LEN
,
260 "IVM_Functions", 12, 0);
262 GET_STRING("IVM_Symbol", IVM_POS_SYMBOL_ONLY
, 8)
263 GET_STRING("IVM_DeviceName", IVM_POS_SHORT_TEXT
, 64)
264 tmp
= (unsigned char *)env_get("IVM_DeviceName");
266 int len
= strlen((char *)tmp
);
271 ivm_set_value("IVM_ShortText",
272 (char *)&tmp
[i
+ 1]);
278 ivm_set_value("IVM_ShortText", NULL
);
280 ivm_set_value("IVM_ShortText", NULL
);
282 GET_STRING("IVM_ManufacturerID", IVM_POS_MANU_ID
, 32)
283 GET_STRING("IVM_ManufacturerSerialNumber", IVM_POS_MANU_SERIAL
, 20)
284 GET_STRING("IVM_ManufacturerPartNumber", IVM_POS_PART_NUMBER
, 32)
285 GET_STRING("IVM_ManufacturerBuildState", IVM_POS_BUILD_STATE
, 32)
286 GET_STRING("IVM_SupplierPartNumber", IVM_POS_SUPPLIER_PART_NUMBER
, 32)
287 GET_STRING("IVM_DelieveryDate", IVM_POS_DELIVERY_DATE
, 32)
288 GET_STRING("IVM_SupplierBuildState", IVM_POS_SUPPLIER_BUILD_STATE
, 32)
289 GET_STRING("IVM_CustomerID", IVM_POS_CUSTOMER_ID
, 32)
290 GET_STRING("IVM_CustomerProductID", IVM_POS_CUSTOMER_PROD_ID
, 32)
292 if (ivm_check_crc(&buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
* 2], 2) != 0)
294 ivm_analyze_block2(&buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
* 2],
295 CONFIG_SYS_IVM_EEPROM_PAGE_LEN
);
300 static int ivm_populate_env(unsigned char *buf
, int len
)
302 unsigned char *page2
;
303 unsigned char valbuf
[MAC_STR_SZ
];
305 /* do we have the page 2 filled ? if not return */
306 if (ivm_check_crc(buf
, 2))
308 page2
= &buf
[CONFIG_SYS_IVM_EEPROM_PAGE_LEN
*2];
310 #ifndef CONFIG_KMTEGR1
311 /* if an offset is defined, add it */
312 process_mac(valbuf
, page2
, CONFIG_PIGGY_MAC_ADRESS_OFFSET
, true);
313 env_set((char *)"ethaddr", (char *)valbuf
);
314 #ifdef CONFIG_KMVECT1
315 /* KMVECT1 has two ethernet interfaces */
316 process_mac(valbuf
, page2
, 1, true);
317 env_set((char *)"eth1addr", (char *)valbuf
);
320 /* KMTEGR1 has a special setup. eth0 has no connection to the outside and
321 * gets an locally administred MAC address, eth1 is the debug interface and
322 * gets the official MAC address from the IVM
324 process_mac(valbuf
, page2
, CONFIG_PIGGY_MAC_ADRESS_OFFSET
, false);
325 env_set((char *)"ethaddr", (char *)valbuf
);
326 process_mac(valbuf
, page2
, CONFIG_PIGGY_MAC_ADRESS_OFFSET
, true);
327 env_set((char *)"eth1addr", (char *)valbuf
);
333 int ivm_read_eeprom(unsigned char *buf
, int len
)
337 i2c_set_bus_num(CONFIG_KM_IVM_BUS
);
338 /* add deblocking here */
341 ret
= i2c_read(CONFIG_SYS_IVM_EEPROM_ADR
, 0, 1, buf
, len
);
343 printf("Error reading EEprom\n");
347 return ivm_populate_env(buf
, len
);