xref: /aosp_15_r20/external/flashrom/mstarddc_spi.c (revision 0d6140be3aa665ecc836e8907834fcd3e3b018fc)
1*0d6140beSAndroid Build Coastguard Worker /*
2*0d6140beSAndroid Build Coastguard Worker  * This file is part of the flashrom project.
3*0d6140beSAndroid Build Coastguard Worker  *
4*0d6140beSAndroid Build Coastguard Worker  * Copyright (C) 2014 Alexandre Boeglin <[email protected]>
5*0d6140beSAndroid Build Coastguard Worker  *
6*0d6140beSAndroid Build Coastguard Worker  * This program is free software; you can redistribute it and/or modify
7*0d6140beSAndroid Build Coastguard Worker  * it under the terms of the GNU General Public License as published by
8*0d6140beSAndroid Build Coastguard Worker  * the Free Software Foundation; version 2 of the License.
9*0d6140beSAndroid Build Coastguard Worker  *
10*0d6140beSAndroid Build Coastguard Worker  * This program is distributed in the hope that it will be useful,
11*0d6140beSAndroid Build Coastguard Worker  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12*0d6140beSAndroid Build Coastguard Worker  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13*0d6140beSAndroid Build Coastguard Worker  * GNU General Public License for more details.
14*0d6140beSAndroid Build Coastguard Worker  */
15*0d6140beSAndroid Build Coastguard Worker 
16*0d6140beSAndroid Build Coastguard Worker #include <stdio.h>
17*0d6140beSAndroid Build Coastguard Worker #include <string.h>
18*0d6140beSAndroid Build Coastguard Worker #include <stdbool.h>
19*0d6140beSAndroid Build Coastguard Worker #include <stdlib.h>
20*0d6140beSAndroid Build Coastguard Worker #include <ctype.h>
21*0d6140beSAndroid Build Coastguard Worker #include <sys/types.h>
22*0d6140beSAndroid Build Coastguard Worker #include <sys/stat.h>
23*0d6140beSAndroid Build Coastguard Worker #include <fcntl.h>
24*0d6140beSAndroid Build Coastguard Worker #include <unistd.h>
25*0d6140beSAndroid Build Coastguard Worker #include <errno.h>
26*0d6140beSAndroid Build Coastguard Worker #include <sys/ioctl.h>
27*0d6140beSAndroid Build Coastguard Worker #include <linux/i2c-dev.h>
28*0d6140beSAndroid Build Coastguard Worker #include <linux/i2c.h>
29*0d6140beSAndroid Build Coastguard Worker #include "flash.h"
30*0d6140beSAndroid Build Coastguard Worker #include "programmer.h"
31*0d6140beSAndroid Build Coastguard Worker #include "spi.h"
32*0d6140beSAndroid Build Coastguard Worker 
33*0d6140beSAndroid Build Coastguard Worker struct mstarddc_spi_data {
34*0d6140beSAndroid Build Coastguard Worker 	int fd;
35*0d6140beSAndroid Build Coastguard Worker 	int addr;
36*0d6140beSAndroid Build Coastguard Worker 	bool doreset;
37*0d6140beSAndroid Build Coastguard Worker };
38*0d6140beSAndroid Build Coastguard Worker 
39*0d6140beSAndroid Build Coastguard Worker // MSTAR DDC Commands
40*0d6140beSAndroid Build Coastguard Worker #define MSTARDDC_SPI_WRITE	0x10
41*0d6140beSAndroid Build Coastguard Worker #define MSTARDDC_SPI_READ	0x11
42*0d6140beSAndroid Build Coastguard Worker #define MSTARDDC_SPI_END	0x12
43*0d6140beSAndroid Build Coastguard Worker #define MSTARDDC_SPI_RESET	0x24
44*0d6140beSAndroid Build Coastguard Worker 
45*0d6140beSAndroid Build Coastguard Worker /* Returns 0 upon success, a negative number upon errors. */
mstarddc_spi_shutdown(void * data)46*0d6140beSAndroid Build Coastguard Worker static int mstarddc_spi_shutdown(void *data)
47*0d6140beSAndroid Build Coastguard Worker {
48*0d6140beSAndroid Build Coastguard Worker 	struct mstarddc_spi_data *mstarddc_data = data;
49*0d6140beSAndroid Build Coastguard Worker 
50*0d6140beSAndroid Build Coastguard Worker 	// Reset, disables ISP mode
51*0d6140beSAndroid Build Coastguard Worker 	if (mstarddc_data->doreset) {
52*0d6140beSAndroid Build Coastguard Worker 		uint8_t cmd = MSTARDDC_SPI_RESET;
53*0d6140beSAndroid Build Coastguard Worker 		if (write(mstarddc_data->fd, &cmd, 1) < 0) {
54*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error sending reset command: errno %d.\n",
55*0d6140beSAndroid Build Coastguard Worker 				 errno);
56*0d6140beSAndroid Build Coastguard Worker 			return -1;
57*0d6140beSAndroid Build Coastguard Worker 		}
58*0d6140beSAndroid Build Coastguard Worker 	} else {
59*0d6140beSAndroid Build Coastguard Worker 		msg_pinfo("Info: Reset command was not sent. "
60*0d6140beSAndroid Build Coastguard Worker 			  "Either the noreset=1 option was used, "
61*0d6140beSAndroid Build Coastguard Worker 			  "or an error occurred.\n");
62*0d6140beSAndroid Build Coastguard Worker 	}
63*0d6140beSAndroid Build Coastguard Worker 
64*0d6140beSAndroid Build Coastguard Worker 	if (close(mstarddc_data->fd) < 0) {
65*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Error closing device: errno %d.\n", errno);
66*0d6140beSAndroid Build Coastguard Worker 		return -1;
67*0d6140beSAndroid Build Coastguard Worker 	}
68*0d6140beSAndroid Build Coastguard Worker 
69*0d6140beSAndroid Build Coastguard Worker 	free(data);
70*0d6140beSAndroid Build Coastguard Worker 	return 0;
71*0d6140beSAndroid Build Coastguard Worker }
72*0d6140beSAndroid Build Coastguard Worker 
73*0d6140beSAndroid Build Coastguard Worker /* Returns 0 upon success, a negative number upon errors. */
mstarddc_spi_send_command(const struct flashctx * flash,unsigned int writecnt,unsigned int readcnt,const unsigned char * writearr,unsigned char * readarr)74*0d6140beSAndroid Build Coastguard Worker static int mstarddc_spi_send_command(const struct flashctx *flash,
75*0d6140beSAndroid Build Coastguard Worker 				     unsigned int writecnt,
76*0d6140beSAndroid Build Coastguard Worker 				     unsigned int readcnt,
77*0d6140beSAndroid Build Coastguard Worker 				     const unsigned char *writearr,
78*0d6140beSAndroid Build Coastguard Worker 				     unsigned char *readarr)
79*0d6140beSAndroid Build Coastguard Worker {
80*0d6140beSAndroid Build Coastguard Worker 	struct mstarddc_spi_data *mstarddc_data = flash->mst->spi.data;
81*0d6140beSAndroid Build Coastguard Worker 	int ret = 0;
82*0d6140beSAndroid Build Coastguard Worker 	uint8_t *cmd = malloc((writecnt + 1) * sizeof(uint8_t));
83*0d6140beSAndroid Build Coastguard Worker 	if (cmd == NULL) {
84*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Error allocating memory: errno %d.\n", errno);
85*0d6140beSAndroid Build Coastguard Worker 		ret = -1;
86*0d6140beSAndroid Build Coastguard Worker 	}
87*0d6140beSAndroid Build Coastguard Worker 
88*0d6140beSAndroid Build Coastguard Worker 	if (!ret && writecnt) {
89*0d6140beSAndroid Build Coastguard Worker 		cmd[0] = MSTARDDC_SPI_WRITE;
90*0d6140beSAndroid Build Coastguard Worker 		memcpy(cmd + 1, writearr, writecnt);
91*0d6140beSAndroid Build Coastguard Worker 		if (write(mstarddc_data->fd, cmd, writecnt + 1) < 0) {
92*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error sending write command: errno %d.\n",
93*0d6140beSAndroid Build Coastguard Worker 				 errno);
94*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
95*0d6140beSAndroid Build Coastguard Worker 		}
96*0d6140beSAndroid Build Coastguard Worker 	}
97*0d6140beSAndroid Build Coastguard Worker 
98*0d6140beSAndroid Build Coastguard Worker 	if (!ret && readcnt) {
99*0d6140beSAndroid Build Coastguard Worker 		struct i2c_rdwr_ioctl_data i2c_data;
100*0d6140beSAndroid Build Coastguard Worker 		struct i2c_msg msg[2];
101*0d6140beSAndroid Build Coastguard Worker 
102*0d6140beSAndroid Build Coastguard Worker 		cmd[0] = MSTARDDC_SPI_READ;
103*0d6140beSAndroid Build Coastguard Worker 		i2c_data.nmsgs = 2;
104*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs = msg;
105*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[0].addr = mstarddc_data->addr;
106*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[0].len = 1;
107*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[0].flags = 0;
108*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[0].buf = cmd;
109*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[1].addr = mstarddc_data->addr;
110*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[1].len = readcnt;
111*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[1].flags = I2C_M_RD;
112*0d6140beSAndroid Build Coastguard Worker 		i2c_data.msgs[1].buf = readarr;
113*0d6140beSAndroid Build Coastguard Worker 
114*0d6140beSAndroid Build Coastguard Worker 		if (ioctl(mstarddc_data->fd, I2C_RDWR, &i2c_data) < 0) {
115*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error sending read command: errno %d.\n",
116*0d6140beSAndroid Build Coastguard Worker 				 errno);
117*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
118*0d6140beSAndroid Build Coastguard Worker 		}
119*0d6140beSAndroid Build Coastguard Worker 	}
120*0d6140beSAndroid Build Coastguard Worker 
121*0d6140beSAndroid Build Coastguard Worker 	if (!ret && (writecnt || readcnt)) {
122*0d6140beSAndroid Build Coastguard Worker 		cmd[0] = MSTARDDC_SPI_END;
123*0d6140beSAndroid Build Coastguard Worker 		if (write(mstarddc_data->fd, cmd, 1) < 0) {
124*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error sending end command: errno %d.\n",
125*0d6140beSAndroid Build Coastguard Worker 				 errno);
126*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
127*0d6140beSAndroid Build Coastguard Worker 		}
128*0d6140beSAndroid Build Coastguard Worker 	}
129*0d6140beSAndroid Build Coastguard Worker 
130*0d6140beSAndroid Build Coastguard Worker 	/* Do not reset if something went wrong, as it might prevent from
131*0d6140beSAndroid Build Coastguard Worker 	 * retrying flashing. */
132*0d6140beSAndroid Build Coastguard Worker 	if (ret != 0)
133*0d6140beSAndroid Build Coastguard Worker 		mstarddc_data->doreset = false;
134*0d6140beSAndroid Build Coastguard Worker 
135*0d6140beSAndroid Build Coastguard Worker 	if (cmd)
136*0d6140beSAndroid Build Coastguard Worker 		free(cmd);
137*0d6140beSAndroid Build Coastguard Worker 
138*0d6140beSAndroid Build Coastguard Worker 	return ret;
139*0d6140beSAndroid Build Coastguard Worker }
140*0d6140beSAndroid Build Coastguard Worker 
141*0d6140beSAndroid Build Coastguard Worker static const struct spi_master spi_master_mstarddc = {
142*0d6140beSAndroid Build Coastguard Worker 	.max_data_read	= 256,
143*0d6140beSAndroid Build Coastguard Worker 	.max_data_write	= 256,
144*0d6140beSAndroid Build Coastguard Worker 	.command	= mstarddc_spi_send_command,
145*0d6140beSAndroid Build Coastguard Worker 	.read		= default_spi_read,
146*0d6140beSAndroid Build Coastguard Worker 	.write_256	= default_spi_write_256,
147*0d6140beSAndroid Build Coastguard Worker 	.shutdown	= mstarddc_spi_shutdown,
148*0d6140beSAndroid Build Coastguard Worker };
149*0d6140beSAndroid Build Coastguard Worker 
150*0d6140beSAndroid Build Coastguard Worker /* Returns 0 upon success, a negative number upon errors. */
mstarddc_spi_init(const struct programmer_cfg * cfg)151*0d6140beSAndroid Build Coastguard Worker static int mstarddc_spi_init(const struct programmer_cfg *cfg)
152*0d6140beSAndroid Build Coastguard Worker {
153*0d6140beSAndroid Build Coastguard Worker 	int ret = 0;
154*0d6140beSAndroid Build Coastguard Worker 	int mstarddc_fd = -1;
155*0d6140beSAndroid Build Coastguard Worker 	int mstarddc_addr;
156*0d6140beSAndroid Build Coastguard Worker 	bool mstarddc_doreset = true;
157*0d6140beSAndroid Build Coastguard Worker 	struct mstarddc_spi_data *mstarddc_data;
158*0d6140beSAndroid Build Coastguard Worker 
159*0d6140beSAndroid Build Coastguard Worker 	// Get device, address from command-line
160*0d6140beSAndroid Build Coastguard Worker 	char *i2c_device = extract_programmer_param_str(cfg, "dev");
161*0d6140beSAndroid Build Coastguard Worker 	if (i2c_device != NULL && strlen(i2c_device) > 0) {
162*0d6140beSAndroid Build Coastguard Worker 		char *i2c_address = strchr(i2c_device, ':');
163*0d6140beSAndroid Build Coastguard Worker 		if (i2c_address != NULL) {
164*0d6140beSAndroid Build Coastguard Worker 			*i2c_address = '\0';
165*0d6140beSAndroid Build Coastguard Worker 			i2c_address++;
166*0d6140beSAndroid Build Coastguard Worker 		}
167*0d6140beSAndroid Build Coastguard Worker 		if (i2c_address == NULL || strlen(i2c_address) == 0) {
168*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error: no address specified.\n"
169*0d6140beSAndroid Build Coastguard Worker 				 "Use flashrom -p mstarddc_spi:dev=/dev/device:address.\n");
170*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
171*0d6140beSAndroid Build Coastguard Worker 			goto out;
172*0d6140beSAndroid Build Coastguard Worker 		}
173*0d6140beSAndroid Build Coastguard Worker 		mstarddc_addr = strtol(i2c_address, NULL, 16); // FIXME: error handling
174*0d6140beSAndroid Build Coastguard Worker 	} else {
175*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Error: no device specified.\n"
176*0d6140beSAndroid Build Coastguard Worker 			 "Use flashrom -p mstarddc_spi:dev=/dev/device:address.\n");
177*0d6140beSAndroid Build Coastguard Worker 		ret = -1;
178*0d6140beSAndroid Build Coastguard Worker 		goto out;
179*0d6140beSAndroid Build Coastguard Worker 	}
180*0d6140beSAndroid Build Coastguard Worker 	msg_pinfo("Info: Will try to use device %s and address 0x%02x.\n", i2c_device, mstarddc_addr);
181*0d6140beSAndroid Build Coastguard Worker 
182*0d6140beSAndroid Build Coastguard Worker 	// Get noreset=1 option from command-line
183*0d6140beSAndroid Build Coastguard Worker 	char *noreset = extract_programmer_param_str(cfg, "noreset");
184*0d6140beSAndroid Build Coastguard Worker 	if (noreset != NULL && noreset[0] == '1')
185*0d6140beSAndroid Build Coastguard Worker 		mstarddc_doreset = false;
186*0d6140beSAndroid Build Coastguard Worker 	free(noreset);
187*0d6140beSAndroid Build Coastguard Worker 	msg_pinfo("Info: Will %sreset the device at the end.\n", mstarddc_doreset ? "" : "NOT ");
188*0d6140beSAndroid Build Coastguard Worker 	// Open device
189*0d6140beSAndroid Build Coastguard Worker 	if ((mstarddc_fd = open(i2c_device, O_RDWR)) < 0) {
190*0d6140beSAndroid Build Coastguard Worker 		switch (errno) {
191*0d6140beSAndroid Build Coastguard Worker 		case EACCES:
192*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error opening %s: Permission denied.\n"
193*0d6140beSAndroid Build Coastguard Worker 				 "Please use sudo or run as root.\n",
194*0d6140beSAndroid Build Coastguard Worker 				 i2c_device);
195*0d6140beSAndroid Build Coastguard Worker 			break;
196*0d6140beSAndroid Build Coastguard Worker 		case ENOENT:
197*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error opening %s: No such file.\n"
198*0d6140beSAndroid Build Coastguard Worker 				 "Please check you specified the correct device.\n",
199*0d6140beSAndroid Build Coastguard Worker 				 i2c_device);
200*0d6140beSAndroid Build Coastguard Worker 			break;
201*0d6140beSAndroid Build Coastguard Worker 		default:
202*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error opening %s: %s.\n", i2c_device, strerror(errno));
203*0d6140beSAndroid Build Coastguard Worker 		}
204*0d6140beSAndroid Build Coastguard Worker 		ret = -1;
205*0d6140beSAndroid Build Coastguard Worker 		goto out;
206*0d6140beSAndroid Build Coastguard Worker 	}
207*0d6140beSAndroid Build Coastguard Worker 	// Set slave address
208*0d6140beSAndroid Build Coastguard Worker 	if (ioctl(mstarddc_fd, I2C_SLAVE, mstarddc_addr) < 0) {
209*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Error setting slave address 0x%02x: errno %d.\n",
210*0d6140beSAndroid Build Coastguard Worker 			 mstarddc_addr, errno);
211*0d6140beSAndroid Build Coastguard Worker 		ret = -1;
212*0d6140beSAndroid Build Coastguard Worker 		goto out;
213*0d6140beSAndroid Build Coastguard Worker 	}
214*0d6140beSAndroid Build Coastguard Worker 	// Enable ISP mode
215*0d6140beSAndroid Build Coastguard Worker 	uint8_t cmd[5] = { 'M', 'S', 'T', 'A', 'R' };
216*0d6140beSAndroid Build Coastguard Worker 	if (write(mstarddc_fd, cmd, 5) < 0) {
217*0d6140beSAndroid Build Coastguard Worker 		int enable_err = errno;
218*0d6140beSAndroid Build Coastguard Worker 		uint8_t end_cmd = MSTARDDC_SPI_END;
219*0d6140beSAndroid Build Coastguard Worker 
220*0d6140beSAndroid Build Coastguard Worker 		// Assume device is already in ISP mode, try to send END command
221*0d6140beSAndroid Build Coastguard Worker 		if (write(mstarddc_fd, &end_cmd, 1) < 0) {
222*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Error enabling ISP mode: errno %d & %d.\n"
223*0d6140beSAndroid Build Coastguard Worker 				 "Please check that device (%s) and address (0x%02x) are correct.\n",
224*0d6140beSAndroid Build Coastguard Worker 				 enable_err, errno, i2c_device, mstarddc_addr);
225*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
226*0d6140beSAndroid Build Coastguard Worker 			goto out;
227*0d6140beSAndroid Build Coastguard Worker 		}
228*0d6140beSAndroid Build Coastguard Worker 	}
229*0d6140beSAndroid Build Coastguard Worker 
230*0d6140beSAndroid Build Coastguard Worker 	mstarddc_data = calloc(1, sizeof(*mstarddc_data));
231*0d6140beSAndroid Build Coastguard Worker 	if (!mstarddc_data) {
232*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Unable to allocate space for SPI master data\n");
233*0d6140beSAndroid Build Coastguard Worker 		ret = -1;
234*0d6140beSAndroid Build Coastguard Worker 		goto out;
235*0d6140beSAndroid Build Coastguard Worker 	}
236*0d6140beSAndroid Build Coastguard Worker 
237*0d6140beSAndroid Build Coastguard Worker 	mstarddc_data->fd = mstarddc_fd;
238*0d6140beSAndroid Build Coastguard Worker 	mstarddc_data->addr = mstarddc_addr;
239*0d6140beSAndroid Build Coastguard Worker 	mstarddc_data->doreset = mstarddc_doreset;
240*0d6140beSAndroid Build Coastguard Worker 
241*0d6140beSAndroid Build Coastguard Worker 	// Register programmer
242*0d6140beSAndroid Build Coastguard Worker 	register_spi_master(&spi_master_mstarddc, mstarddc_data);
243*0d6140beSAndroid Build Coastguard Worker out:
244*0d6140beSAndroid Build Coastguard Worker 	free(i2c_device);
245*0d6140beSAndroid Build Coastguard Worker 	if (ret && (mstarddc_fd >= 0))
246*0d6140beSAndroid Build Coastguard Worker 		close(mstarddc_fd);
247*0d6140beSAndroid Build Coastguard Worker 	return ret;
248*0d6140beSAndroid Build Coastguard Worker }
249*0d6140beSAndroid Build Coastguard Worker 
250*0d6140beSAndroid Build Coastguard Worker const struct programmer_entry programmer_mstarddc_spi = {
251*0d6140beSAndroid Build Coastguard Worker 	.name			= "mstarddc_spi",
252*0d6140beSAndroid Build Coastguard Worker 	.type			= OTHER,
253*0d6140beSAndroid Build Coastguard Worker 	.devs.note		= "MSTAR DDC devices addressable via /dev/i2c-* on Linux.\n",
254*0d6140beSAndroid Build Coastguard Worker 	.init			= mstarddc_spi_init,
255*0d6140beSAndroid Build Coastguard Worker };
256