1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2000
3*4882a593Smuzhiyun * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <s_record.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun static int hex1_bin (char c);
12*4882a593Smuzhiyun static int hex2_bin (char *s);
13*4882a593Smuzhiyun
srec_decode(char * input,int * count,ulong * addr,char * data)14*4882a593Smuzhiyun int srec_decode (char *input, int *count, ulong *addr, char *data)
15*4882a593Smuzhiyun {
16*4882a593Smuzhiyun int i;
17*4882a593Smuzhiyun int v; /* conversion buffer */
18*4882a593Smuzhiyun int srec_type; /* S-Record type */
19*4882a593Smuzhiyun unsigned char chksum; /* buffer for checksum */
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun chksum = 0;
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /* skip anything before 'S', and the 'S' itself.
24*4882a593Smuzhiyun * Return error if not found
25*4882a593Smuzhiyun */
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun for (; *input; ++input) {
28*4882a593Smuzhiyun if (*input == 'S') { /* skip 'S' */
29*4882a593Smuzhiyun ++input;
30*4882a593Smuzhiyun break;
31*4882a593Smuzhiyun }
32*4882a593Smuzhiyun }
33*4882a593Smuzhiyun if (*input == '\0') { /* no more data? */
34*4882a593Smuzhiyun return (SREC_EMPTY);
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun v = *input++; /* record type */
38*4882a593Smuzhiyun
39*4882a593Smuzhiyun if ((*count = hex2_bin(input)) < 0) {
40*4882a593Smuzhiyun return (SREC_E_NOSREC);
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun chksum += *count;
44*4882a593Smuzhiyun input += 2;
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun switch (v) { /* record type */
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun case '0': /* start record */
49*4882a593Smuzhiyun srec_type = SREC_START; /* 2 byte addr field */
50*4882a593Smuzhiyun *count -= 3; /* - checksum and addr */
51*4882a593Smuzhiyun break;
52*4882a593Smuzhiyun case '1':
53*4882a593Smuzhiyun srec_type = SREC_DATA2; /* 2 byte addr field */
54*4882a593Smuzhiyun *count -= 3; /* - checksum and addr */
55*4882a593Smuzhiyun break;
56*4882a593Smuzhiyun case '2':
57*4882a593Smuzhiyun srec_type = SREC_DATA3; /* 3 byte addr field */
58*4882a593Smuzhiyun *count -= 4; /* - checksum and addr */
59*4882a593Smuzhiyun break;
60*4882a593Smuzhiyun case '3': /* data record with a */
61*4882a593Smuzhiyun srec_type = SREC_DATA4; /* 4 byte addr field */
62*4882a593Smuzhiyun *count -= 5; /* - checksum and addr */
63*4882a593Smuzhiyun break;
64*4882a593Smuzhiyun /*** case '4' ***/
65*4882a593Smuzhiyun case '5': /* count record, addr field contains */
66*4882a593Smuzhiyun srec_type = SREC_COUNT; /* a 2 byte record counter */
67*4882a593Smuzhiyun *count = 0; /* no data */
68*4882a593Smuzhiyun break;
69*4882a593Smuzhiyun /*** case '6' -- not used ***/
70*4882a593Smuzhiyun case '7': /* end record with a */
71*4882a593Smuzhiyun srec_type = SREC_END4; /* 4 byte addr field */
72*4882a593Smuzhiyun *count -= 5; /* - checksum and addr */
73*4882a593Smuzhiyun break;
74*4882a593Smuzhiyun case '8': /* end record with a */
75*4882a593Smuzhiyun srec_type = SREC_END3; /* 3 byte addr field */
76*4882a593Smuzhiyun *count -= 4; /* - checksum and addr */
77*4882a593Smuzhiyun break;
78*4882a593Smuzhiyun case '9': /* end record with a */
79*4882a593Smuzhiyun srec_type = SREC_END2; /* 2 byte addr field */
80*4882a593Smuzhiyun *count -= 3; /* - checksum and addr */
81*4882a593Smuzhiyun break;
82*4882a593Smuzhiyun default:
83*4882a593Smuzhiyun return (SREC_E_BADTYPE);
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun /* read address field */
87*4882a593Smuzhiyun *addr = 0;
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun switch (v) {
90*4882a593Smuzhiyun case '3': /* 4 byte addr field */
91*4882a593Smuzhiyun case '7':
92*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
93*4882a593Smuzhiyun return (SREC_E_NOSREC);
94*4882a593Smuzhiyun }
95*4882a593Smuzhiyun *addr += v;
96*4882a593Smuzhiyun chksum += v;
97*4882a593Smuzhiyun input += 2;
98*4882a593Smuzhiyun /* FALL THRU */
99*4882a593Smuzhiyun case '2': /* 3 byte addr field */
100*4882a593Smuzhiyun case '8':
101*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
102*4882a593Smuzhiyun return (SREC_E_NOSREC);
103*4882a593Smuzhiyun }
104*4882a593Smuzhiyun *addr <<= 8;
105*4882a593Smuzhiyun *addr += v;
106*4882a593Smuzhiyun chksum += v;
107*4882a593Smuzhiyun input += 2;
108*4882a593Smuzhiyun /* FALL THRU */
109*4882a593Smuzhiyun case '0': /* 2 byte addr field */
110*4882a593Smuzhiyun case '1':
111*4882a593Smuzhiyun case '5':
112*4882a593Smuzhiyun case '9':
113*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
114*4882a593Smuzhiyun return (SREC_E_NOSREC);
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun *addr <<= 8;
117*4882a593Smuzhiyun *addr += v;
118*4882a593Smuzhiyun chksum += v;
119*4882a593Smuzhiyun input += 2;
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
122*4882a593Smuzhiyun return (SREC_E_NOSREC);
123*4882a593Smuzhiyun }
124*4882a593Smuzhiyun *addr <<= 8;
125*4882a593Smuzhiyun *addr += v;
126*4882a593Smuzhiyun chksum += v;
127*4882a593Smuzhiyun input += 2;
128*4882a593Smuzhiyun
129*4882a593Smuzhiyun break;
130*4882a593Smuzhiyun default:
131*4882a593Smuzhiyun return (SREC_E_BADTYPE);
132*4882a593Smuzhiyun }
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun /* convert data and calculate checksum */
135*4882a593Smuzhiyun for (i=0; i < *count; ++i) {
136*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
137*4882a593Smuzhiyun return (SREC_E_NOSREC);
138*4882a593Smuzhiyun }
139*4882a593Smuzhiyun data[i] = v;
140*4882a593Smuzhiyun chksum += v;
141*4882a593Smuzhiyun input += 2;
142*4882a593Smuzhiyun }
143*4882a593Smuzhiyun
144*4882a593Smuzhiyun /* read anc check checksum */
145*4882a593Smuzhiyun if ((v = hex2_bin(input)) < 0) {
146*4882a593Smuzhiyun return (SREC_E_NOSREC);
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun if ((unsigned char)v != (unsigned char)~chksum) {
150*4882a593Smuzhiyun return (SREC_E_BADCHKS);
151*4882a593Smuzhiyun }
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun return (srec_type);
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun
hex1_bin(char c)156*4882a593Smuzhiyun static int hex1_bin (char c)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun if (c >= '0' && c <= '9')
159*4882a593Smuzhiyun return (c - '0');
160*4882a593Smuzhiyun if (c >= 'a' && c <= 'f')
161*4882a593Smuzhiyun return (c + 10 - 'a');
162*4882a593Smuzhiyun if (c >= 'A' && c <= 'F')
163*4882a593Smuzhiyun return (c + 10 - 'A');
164*4882a593Smuzhiyun return (-1);
165*4882a593Smuzhiyun }
166*4882a593Smuzhiyun
hex2_bin(char * s)167*4882a593Smuzhiyun static int hex2_bin (char *s)
168*4882a593Smuzhiyun {
169*4882a593Smuzhiyun int i, j;
170*4882a593Smuzhiyun
171*4882a593Smuzhiyun if ((i = hex1_bin(*s++)) < 0) {
172*4882a593Smuzhiyun return (-1);
173*4882a593Smuzhiyun }
174*4882a593Smuzhiyun if ((j = hex1_bin(*s)) < 0) {
175*4882a593Smuzhiyun return (-1);
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun return ((i<<4) + j);
179*4882a593Smuzhiyun }
180