xref: /aosp_15_r20/external/flashrom/stlinkv3_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) 2019 Miklós Márton [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; either version 2 of the License, or
9*0d6140beSAndroid Build Coastguard Worker  * (at your option) any later version.
10*0d6140beSAndroid Build Coastguard Worker  *
11*0d6140beSAndroid Build Coastguard Worker  * This program is distributed in the hope that it will be useful,
12*0d6140beSAndroid Build Coastguard Worker  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13*0d6140beSAndroid Build Coastguard Worker  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14*0d6140beSAndroid Build Coastguard Worker  * GNU General Public License for more details.
15*0d6140beSAndroid Build Coastguard Worker  *
16*0d6140beSAndroid Build Coastguard Worker  */
17*0d6140beSAndroid Build Coastguard Worker 
18*0d6140beSAndroid Build Coastguard Worker /*
19*0d6140beSAndroid Build Coastguard Worker  * Driver for programming SPI flash chips using the SPI port
20*0d6140beSAndroid Build Coastguard Worker  * of the STMicroelectronics's STLINK-V3 programmer/debugger.
21*0d6140beSAndroid Build Coastguard Worker  *
22*0d6140beSAndroid Build Coastguard Worker  * The implementation is inspired by the ST's STLINK-V3-BRIDGE C++ API:
23*0d6140beSAndroid Build Coastguard Worker  * https://www.st.com/en/development-tools/stlink-v3-bridge.html
24*0d6140beSAndroid Build Coastguard Worker  */
25*0d6140beSAndroid Build Coastguard Worker 
26*0d6140beSAndroid Build Coastguard Worker #include "flash.h"
27*0d6140beSAndroid Build Coastguard Worker #include "programmer.h"
28*0d6140beSAndroid Build Coastguard Worker #include "spi.h"
29*0d6140beSAndroid Build Coastguard Worker 
30*0d6140beSAndroid Build Coastguard Worker #include <libusb.h>
31*0d6140beSAndroid Build Coastguard Worker #include <limits.h>
32*0d6140beSAndroid Build Coastguard Worker #include <stdint.h>
33*0d6140beSAndroid Build Coastguard Worker #include <stdlib.h>
34*0d6140beSAndroid Build Coastguard Worker #include <string.h>
35*0d6140beSAndroid Build Coastguard Worker 
36*0d6140beSAndroid Build Coastguard Worker enum fw_version_check_result {
37*0d6140beSAndroid Build Coastguard Worker 	FW_VERSION_OK,
38*0d6140beSAndroid Build Coastguard Worker 	FW_VERSION_OLD,
39*0d6140beSAndroid Build Coastguard Worker };
40*0d6140beSAndroid Build Coastguard Worker 
41*0d6140beSAndroid Build Coastguard Worker enum spi_prescaler {
42*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_2 = 0,
43*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_4 = 1,
44*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_8 = 2,
45*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_16 = 3,
46*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_32 = 4,
47*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_64 = 5,
48*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_128 = 6,
49*0d6140beSAndroid Build Coastguard Worker 	SPI_BAUDRATEPRESCALER_256 = 7
50*0d6140beSAndroid Build Coastguard Worker };
51*0d6140beSAndroid Build Coastguard Worker 
52*0d6140beSAndroid Build Coastguard Worker enum spi_dir {
53*0d6140beSAndroid Build Coastguard Worker 	SPI_DIRECTION_2LINES_FULLDUPLEX = 0,
54*0d6140beSAndroid Build Coastguard Worker 	SPI_DIRECTION_2LINES_RXONLY = 1,
55*0d6140beSAndroid Build Coastguard Worker 	SPI_DIRECTION_1LINE_RX = 2,
56*0d6140beSAndroid Build Coastguard Worker 	SPI_DIRECTION_1LINE_TX = 3
57*0d6140beSAndroid Build Coastguard Worker };
58*0d6140beSAndroid Build Coastguard Worker 
59*0d6140beSAndroid Build Coastguard Worker enum spi_mode {
60*0d6140beSAndroid Build Coastguard Worker 	SPI_MODE_SLAVE = 0,
61*0d6140beSAndroid Build Coastguard Worker 	SPI_MODE_MASTER = 1
62*0d6140beSAndroid Build Coastguard Worker };
63*0d6140beSAndroid Build Coastguard Worker 
64*0d6140beSAndroid Build Coastguard Worker enum spi_datasize {
65*0d6140beSAndroid Build Coastguard Worker 	SPI_DATASIZE_16B = 0,
66*0d6140beSAndroid Build Coastguard Worker 	SPI_DATASIZE_8B = 1
67*0d6140beSAndroid Build Coastguard Worker };
68*0d6140beSAndroid Build Coastguard Worker 
69*0d6140beSAndroid Build Coastguard Worker enum spi_cpol {
70*0d6140beSAndroid Build Coastguard Worker 	SPI_CPOL_LOW = 0,
71*0d6140beSAndroid Build Coastguard Worker 	SPI_CPOL_HIGH = 1
72*0d6140beSAndroid Build Coastguard Worker };
73*0d6140beSAndroid Build Coastguard Worker 
74*0d6140beSAndroid Build Coastguard Worker enum spi_cpha {
75*0d6140beSAndroid Build Coastguard Worker 	SPI_CPHA_1EDGE = 0,
76*0d6140beSAndroid Build Coastguard Worker 	SPI_CPHA_2EDGE = 1
77*0d6140beSAndroid Build Coastguard Worker };
78*0d6140beSAndroid Build Coastguard Worker 
79*0d6140beSAndroid Build Coastguard Worker enum spi_firstbit {
80*0d6140beSAndroid Build Coastguard Worker 	SPI_FIRSTBIT_LSB = 0,
81*0d6140beSAndroid Build Coastguard Worker 	SPI_FIRSTBIT_MSB = 1
82*0d6140beSAndroid Build Coastguard Worker };
83*0d6140beSAndroid Build Coastguard Worker 
84*0d6140beSAndroid Build Coastguard Worker // ST calls the Chip select (CS) NSS == Negated Slave Select
85*0d6140beSAndroid Build Coastguard Worker enum spi_nss {
86*0d6140beSAndroid Build Coastguard Worker 	SPI_NSS_SOFT = 0,
87*0d6140beSAndroid Build Coastguard Worker 	SPI_NSS_HARD = 1
88*0d6140beSAndroid Build Coastguard Worker };
89*0d6140beSAndroid Build Coastguard Worker 
90*0d6140beSAndroid Build Coastguard Worker enum spi_nss_level {
91*0d6140beSAndroid Build Coastguard Worker 	SPI_NSS_LOW = 0,
92*0d6140beSAndroid Build Coastguard Worker 	SPI_NSS_HIGH = 1
93*0d6140beSAndroid Build Coastguard Worker };
94*0d6140beSAndroid Build Coastguard Worker 
95*0d6140beSAndroid Build Coastguard Worker #define ST_GETVERSION_EXT					0xFB
96*0d6140beSAndroid Build Coastguard Worker 
97*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_COMMAND					0xFC
98*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_CLOSE					0x01
99*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_GET_RWCMD_STATUS				0x02
100*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_GET_CLOCK					0x03
101*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_INIT_SPI					0x20
102*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_WRITE_SPI					0x21
103*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_READ_SPI					0x22
104*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_CS_SPI					0x23
105*0d6140beSAndroid Build Coastguard Worker 
106*0d6140beSAndroid Build Coastguard Worker #define STLINK_BRIDGE_SPI_ERROR					0x02
107*0d6140beSAndroid Build Coastguard Worker 
108*0d6140beSAndroid Build Coastguard Worker #define STLINK_SPI_COM						0x02
109*0d6140beSAndroid Build Coastguard Worker 
110*0d6140beSAndroid Build Coastguard Worker #define STLINK_EP_OUT						0x06
111*0d6140beSAndroid Build Coastguard Worker #define STLINK_EP_IN						0x86
112*0d6140beSAndroid Build Coastguard Worker 
113*0d6140beSAndroid Build Coastguard Worker #define FIRST_COMPATIBLE_BRIDGE_FW_VERSION			3
114*0d6140beSAndroid Build Coastguard Worker 
115*0d6140beSAndroid Build Coastguard Worker #define USB_TIMEOUT_IN_MS					5000
116*0d6140beSAndroid Build Coastguard Worker 
117*0d6140beSAndroid Build Coastguard Worker static const struct dev_entry devs_stlinkv3_spi[] = {
118*0d6140beSAndroid Build Coastguard Worker 	{0x0483, 0x374E, BAD, "STMicroelectronics", "STLINK-V3E"},
119*0d6140beSAndroid Build Coastguard Worker 	{0x0483, 0x374F, OK, "STMicroelectronics", "STLINK-V3S"},
120*0d6140beSAndroid Build Coastguard Worker 	{0x0483, 0x3753, OK, "STMicroelectronics", "STLINK-V3 dual VCP"},
121*0d6140beSAndroid Build Coastguard Worker 	{0x0483, 0x3754, NT, "STMicroelectronics", "STLINK-V3 no MSD"},
122*0d6140beSAndroid Build Coastguard Worker 	{0}
123*0d6140beSAndroid Build Coastguard Worker };
124*0d6140beSAndroid Build Coastguard Worker 
125*0d6140beSAndroid Build Coastguard Worker struct stlinkv3_spi_data {
126*0d6140beSAndroid Build Coastguard Worker 	struct libusb_context *usb_ctx;
127*0d6140beSAndroid Build Coastguard Worker 	libusb_device_handle *handle;
128*0d6140beSAndroid Build Coastguard Worker };
129*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_command(uint8_t * command,size_t command_length,uint8_t * answer,size_t answer_length,const char * command_name,libusb_device_handle * stlinkv3_handle)130*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_command(uint8_t *command, size_t command_length,
131*0d6140beSAndroid Build Coastguard Worker 		     uint8_t *answer, size_t answer_length, const char *command_name,
132*0d6140beSAndroid Build Coastguard Worker 		     libusb_device_handle *stlinkv3_handle)
133*0d6140beSAndroid Build Coastguard Worker {
134*0d6140beSAndroid Build Coastguard Worker 	int actual_length = 0;
135*0d6140beSAndroid Build Coastguard Worker 	int rc = libusb_bulk_transfer(stlinkv3_handle, STLINK_EP_OUT,
136*0d6140beSAndroid Build Coastguard Worker 				  command, command_length,
137*0d6140beSAndroid Build Coastguard Worker 				  &actual_length, USB_TIMEOUT_IN_MS);
138*0d6140beSAndroid Build Coastguard Worker 	if (rc != LIBUSB_TRANSFER_COMPLETED || (size_t)actual_length != command_length) {
139*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to issue the %s command: '%s'\n",
140*0d6140beSAndroid Build Coastguard Worker 			 command_name,
141*0d6140beSAndroid Build Coastguard Worker 			 libusb_error_name(rc));
142*0d6140beSAndroid Build Coastguard Worker 		return -1;
143*0d6140beSAndroid Build Coastguard Worker 	}
144*0d6140beSAndroid Build Coastguard Worker 
145*0d6140beSAndroid Build Coastguard Worker 	rc = libusb_bulk_transfer(stlinkv3_handle, STLINK_EP_IN,
146*0d6140beSAndroid Build Coastguard Worker 				  answer, answer_length,
147*0d6140beSAndroid Build Coastguard Worker 				  &actual_length, USB_TIMEOUT_IN_MS);
148*0d6140beSAndroid Build Coastguard Worker 	if (rc != LIBUSB_TRANSFER_COMPLETED || (size_t)actual_length != answer_length) {
149*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to get %s answer: '%s'\n",
150*0d6140beSAndroid Build Coastguard Worker 			 command_name,
151*0d6140beSAndroid Build Coastguard Worker 			 libusb_error_name(rc));
152*0d6140beSAndroid Build Coastguard Worker 		return -1;
153*0d6140beSAndroid Build Coastguard Worker 	}
154*0d6140beSAndroid Build Coastguard Worker 	return 0;
155*0d6140beSAndroid Build Coastguard Worker }
156*0d6140beSAndroid Build Coastguard Worker 
157*0d6140beSAndroid Build Coastguard Worker /**
158*0d6140beSAndroid Build Coastguard Worker  * @param[out] bridge_input_clk Current input frequency in kHz of the given com.
159*0d6140beSAndroid Build Coastguard Worker  */
stlinkv3_get_clk(uint32_t * bridge_input_clk,libusb_device_handle * stlinkv3_handle)160*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_get_clk(uint32_t *bridge_input_clk, libusb_device_handle *stlinkv3_handle)
161*0d6140beSAndroid Build Coastguard Worker {
162*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
163*0d6140beSAndroid Build Coastguard Worker 	uint8_t answer[12];
164*0d6140beSAndroid Build Coastguard Worker 
165*0d6140beSAndroid Build Coastguard Worker 	if (bridge_input_clk == NULL)
166*0d6140beSAndroid Build Coastguard Worker 		return -1;
167*0d6140beSAndroid Build Coastguard Worker 
168*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
169*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_GET_CLOCK;
170*0d6140beSAndroid Build Coastguard Worker 	command[2] = STLINK_SPI_COM;
171*0d6140beSAndroid Build Coastguard Worker 
172*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_command(command, sizeof(command),
173*0d6140beSAndroid Build Coastguard Worker 				answer, sizeof(answer),
174*0d6140beSAndroid Build Coastguard Worker 				"STLINK_BRIDGE_GET_CLOCK",
175*0d6140beSAndroid Build Coastguard Worker 				stlinkv3_handle) != 0)
176*0d6140beSAndroid Build Coastguard Worker 		return -1;
177*0d6140beSAndroid Build Coastguard Worker 
178*0d6140beSAndroid Build Coastguard Worker 	*bridge_input_clk = (uint32_t)answer[4]
179*0d6140beSAndroid Build Coastguard Worker 			  | (uint32_t)answer[5]<<8
180*0d6140beSAndroid Build Coastguard Worker 			  | (uint32_t)answer[6]<<16
181*0d6140beSAndroid Build Coastguard Worker 			  | (uint32_t)answer[7]<<24;
182*0d6140beSAndroid Build Coastguard Worker 	return 0;
183*0d6140beSAndroid Build Coastguard Worker 
184*0d6140beSAndroid Build Coastguard Worker }
185*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_calc_prescaler(uint16_t reqested_freq_in_kHz,enum spi_prescaler * prescaler,uint16_t * calculated_freq_in_kHz,libusb_device_handle * stlinkv3_handle)186*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_calc_prescaler(uint16_t reqested_freq_in_kHz,
187*0d6140beSAndroid Build Coastguard Worker 				       enum spi_prescaler *prescaler,
188*0d6140beSAndroid Build Coastguard Worker 				       uint16_t *calculated_freq_in_kHz,
189*0d6140beSAndroid Build Coastguard Worker 				       libusb_device_handle *stlinkv3_handle)
190*0d6140beSAndroid Build Coastguard Worker {
191*0d6140beSAndroid Build Coastguard Worker 	uint32_t bridge_clk_in_kHz;
192*0d6140beSAndroid Build Coastguard Worker 	uint32_t calculated_prescaler = 1;
193*0d6140beSAndroid Build Coastguard Worker 	uint16_t prescaler_value;
194*0d6140beSAndroid Build Coastguard Worker 
195*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_get_clk(&bridge_clk_in_kHz, stlinkv3_handle))
196*0d6140beSAndroid Build Coastguard Worker 		return -1;
197*0d6140beSAndroid Build Coastguard Worker 
198*0d6140beSAndroid Build Coastguard Worker 	calculated_prescaler  = bridge_clk_in_kHz/reqested_freq_in_kHz;
199*0d6140beSAndroid Build Coastguard Worker 	// Apply a smaller frequency if not exact
200*0d6140beSAndroid Build Coastguard Worker 	if (calculated_prescaler  <= 2) {
201*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_2;
202*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 2;
203*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 4) {
204*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_4;
205*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 4;
206*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 8) {
207*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_8;
208*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 8;
209*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 16) {
210*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_16;
211*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 16;
212*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 32) {
213*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_32;
214*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 32;
215*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 64) {
216*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_64;
217*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 64;
218*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 128) {
219*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_128;
220*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 128;
221*0d6140beSAndroid Build Coastguard Worker 	} else if (calculated_prescaler  <= 256) {
222*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_256;
223*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 256;
224*0d6140beSAndroid Build Coastguard Worker 	} else {
225*0d6140beSAndroid Build Coastguard Worker 		// smaller frequency not possible
226*0d6140beSAndroid Build Coastguard Worker 		*prescaler = SPI_BAUDRATEPRESCALER_256;
227*0d6140beSAndroid Build Coastguard Worker 		prescaler_value = 256;
228*0d6140beSAndroid Build Coastguard Worker 	}
229*0d6140beSAndroid Build Coastguard Worker 
230*0d6140beSAndroid Build Coastguard Worker 	*calculated_freq_in_kHz = bridge_clk_in_kHz / prescaler_value;
231*0d6140beSAndroid Build Coastguard Worker 
232*0d6140beSAndroid Build Coastguard Worker 	return 0;
233*0d6140beSAndroid Build Coastguard Worker }
234*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_check_version(enum fw_version_check_result * result,libusb_device_handle * stlinkv3_handle)235*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_check_version(enum fw_version_check_result *result, libusb_device_handle *stlinkv3_handle)
236*0d6140beSAndroid Build Coastguard Worker {
237*0d6140beSAndroid Build Coastguard Worker 	uint8_t answer[12];
238*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
239*0d6140beSAndroid Build Coastguard Worker 
240*0d6140beSAndroid Build Coastguard Worker 	command[0] = ST_GETVERSION_EXT;
241*0d6140beSAndroid Build Coastguard Worker 	command[1] = 0x80;
242*0d6140beSAndroid Build Coastguard Worker 
243*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_command(command, sizeof(command),
244*0d6140beSAndroid Build Coastguard Worker 				answer, sizeof(answer),
245*0d6140beSAndroid Build Coastguard Worker 				"ST_GETVERSION_EXT",
246*0d6140beSAndroid Build Coastguard Worker 				stlinkv3_handle) != 0)
247*0d6140beSAndroid Build Coastguard Worker 		return -1;
248*0d6140beSAndroid Build Coastguard Worker 
249*0d6140beSAndroid Build Coastguard Worker 	msg_pinfo("Connected to STLink V3 with bridge FW version: %d\n", answer[4]);
250*0d6140beSAndroid Build Coastguard Worker 	*result = answer[4] >= FIRST_COMPATIBLE_BRIDGE_FW_VERSION
251*0d6140beSAndroid Build Coastguard Worker 			? FW_VERSION_OK
252*0d6140beSAndroid Build Coastguard Worker 			: FW_VERSION_OLD;
253*0d6140beSAndroid Build Coastguard Worker 	return 0;
254*0d6140beSAndroid Build Coastguard Worker }
255*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_open(uint16_t reqested_freq_in_kHz,libusb_device_handle * stlinkv3_handle)256*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_open(uint16_t reqested_freq_in_kHz, libusb_device_handle *stlinkv3_handle)
257*0d6140beSAndroid Build Coastguard Worker {
258*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
259*0d6140beSAndroid Build Coastguard Worker 	uint8_t answer[2];
260*0d6140beSAndroid Build Coastguard Worker 	uint16_t SCK_freq_in_kHz;
261*0d6140beSAndroid Build Coastguard Worker 	enum spi_prescaler prescaler;
262*0d6140beSAndroid Build Coastguard Worker 	enum fw_version_check_result fw_check_result;
263*0d6140beSAndroid Build Coastguard Worker 
264*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_check_version(&fw_check_result, stlinkv3_handle)) {
265*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to query FW version\n");
266*0d6140beSAndroid Build Coastguard Worker 		return -1;
267*0d6140beSAndroid Build Coastguard Worker 	}
268*0d6140beSAndroid Build Coastguard Worker 
269*0d6140beSAndroid Build Coastguard Worker 	if (fw_check_result != FW_VERSION_OK) {
270*0d6140beSAndroid Build Coastguard Worker 		msg_pinfo("Your STLink V3 has a too old version of the bridge interface\n"
271*0d6140beSAndroid Build Coastguard Worker 			  "Please update the firmware to version 2.33.25 or newer of the STSW-LINK007\n"
272*0d6140beSAndroid Build Coastguard Worker 			  "which can be downloaded from here:\n"
273*0d6140beSAndroid Build Coastguard Worker 			  "https://www.st.com/en/development-tools/stsw-link007.html\n");
274*0d6140beSAndroid Build Coastguard Worker 		return -1;
275*0d6140beSAndroid Build Coastguard Worker 	}
276*0d6140beSAndroid Build Coastguard Worker 
277*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_spi_calc_prescaler(reqested_freq_in_kHz,
278*0d6140beSAndroid Build Coastguard Worker 					&prescaler,
279*0d6140beSAndroid Build Coastguard Worker 					&SCK_freq_in_kHz,
280*0d6140beSAndroid Build Coastguard Worker 					stlinkv3_handle)) {
281*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to calculate SPI clock prescaler\n");
282*0d6140beSAndroid Build Coastguard Worker 		return -1;
283*0d6140beSAndroid Build Coastguard Worker 	}
284*0d6140beSAndroid Build Coastguard Worker 	msg_pinfo("SCK frequency set to %d kHz\n", SCK_freq_in_kHz);
285*0d6140beSAndroid Build Coastguard Worker 
286*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
287*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_INIT_SPI;
288*0d6140beSAndroid Build Coastguard Worker 	command[2] = SPI_DIRECTION_2LINES_FULLDUPLEX;
289*0d6140beSAndroid Build Coastguard Worker 	command[3] = (SPI_MODE_MASTER
290*0d6140beSAndroid Build Coastguard Worker 		      | (SPI_CPHA_1EDGE << 1)
291*0d6140beSAndroid Build Coastguard Worker 		      | (SPI_CPOL_LOW << 2)
292*0d6140beSAndroid Build Coastguard Worker 		      | (SPI_FIRSTBIT_MSB << 3));
293*0d6140beSAndroid Build Coastguard Worker 	command[4] = SPI_DATASIZE_8B;
294*0d6140beSAndroid Build Coastguard Worker 	command[5] = SPI_NSS_SOFT;
295*0d6140beSAndroid Build Coastguard Worker 	command[6] = (uint8_t)prescaler;
296*0d6140beSAndroid Build Coastguard Worker 
297*0d6140beSAndroid Build Coastguard Worker 	return stlinkv3_command(command, sizeof(command),
298*0d6140beSAndroid Build Coastguard Worker 				answer, sizeof(answer),
299*0d6140beSAndroid Build Coastguard Worker 				"STLINK_BRIDGE_INIT_SPI",
300*0d6140beSAndroid Build Coastguard Worker 				stlinkv3_handle);
301*0d6140beSAndroid Build Coastguard Worker }
302*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_get_last_readwrite_status(uint32_t * status,libusb_device_handle * stlinkv3_handle)303*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_get_last_readwrite_status(uint32_t *status, libusb_device_handle *stlinkv3_handle)
304*0d6140beSAndroid Build Coastguard Worker {
305*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
306*0d6140beSAndroid Build Coastguard Worker 	uint16_t answer[4];
307*0d6140beSAndroid Build Coastguard Worker 
308*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
309*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_GET_RWCMD_STATUS;
310*0d6140beSAndroid Build Coastguard Worker 
311*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_command(command, sizeof(command),
312*0d6140beSAndroid Build Coastguard Worker 			     (uint8_t *)answer, sizeof(answer),
313*0d6140beSAndroid Build Coastguard Worker 			     "STLINK_BRIDGE_GET_RWCMD_STATUS",
314*0d6140beSAndroid Build Coastguard Worker 			     stlinkv3_handle) != 0)
315*0d6140beSAndroid Build Coastguard Worker 		return -1;
316*0d6140beSAndroid Build Coastguard Worker 
317*0d6140beSAndroid Build Coastguard Worker 	*status = (uint32_t)answer[2] | (uint32_t)answer[3]<<16;
318*0d6140beSAndroid Build Coastguard Worker 	return 0;
319*0d6140beSAndroid Build Coastguard Worker }
320*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_set_SPI_NSS(enum spi_nss_level nss_level,libusb_device_handle * stlinkv3_handle)321*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_set_SPI_NSS(enum spi_nss_level nss_level, libusb_device_handle *stlinkv3_handle)
322*0d6140beSAndroid Build Coastguard Worker {
323*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
324*0d6140beSAndroid Build Coastguard Worker 	uint8_t answer[2];
325*0d6140beSAndroid Build Coastguard Worker 
326*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
327*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_CS_SPI;
328*0d6140beSAndroid Build Coastguard Worker 	command[2] = (uint8_t) (nss_level);
329*0d6140beSAndroid Build Coastguard Worker 
330*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_command(command, sizeof(command),
331*0d6140beSAndroid Build Coastguard Worker 				answer, sizeof(answer),
332*0d6140beSAndroid Build Coastguard Worker 				"STLINK_BRIDGE_CS_SPI",
333*0d6140beSAndroid Build Coastguard Worker 				stlinkv3_handle) != 0)
334*0d6140beSAndroid Build Coastguard Worker 		return -1;
335*0d6140beSAndroid Build Coastguard Worker 	return 0;
336*0d6140beSAndroid Build Coastguard Worker }
337*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_transmit(const struct flashctx * flash,unsigned int write_cnt,unsigned int read_cnt,const unsigned char * write_arr,unsigned char * read_arr)338*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_transmit(const struct flashctx *flash,
339*0d6140beSAndroid Build Coastguard Worker 				 unsigned int write_cnt,
340*0d6140beSAndroid Build Coastguard Worker 				 unsigned int read_cnt,
341*0d6140beSAndroid Build Coastguard Worker 				 const unsigned char *write_arr,
342*0d6140beSAndroid Build Coastguard Worker 				 unsigned char *read_arr)
343*0d6140beSAndroid Build Coastguard Worker {
344*0d6140beSAndroid Build Coastguard Worker 	struct stlinkv3_spi_data *stlinkv3_data = flash->mst->spi.data;
345*0d6140beSAndroid Build Coastguard Worker 	libusb_device_handle *stlinkv3_handle = stlinkv3_data->handle;
346*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
347*0d6140beSAndroid Build Coastguard Worker 	int rc = 0;
348*0d6140beSAndroid Build Coastguard Worker 	int actual_length = 0;
349*0d6140beSAndroid Build Coastguard Worker 	uint32_t rw_status = 0;
350*0d6140beSAndroid Build Coastguard Worker 	unsigned int i;
351*0d6140beSAndroid Build Coastguard Worker 
352*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_spi_set_SPI_NSS(SPI_NSS_LOW, stlinkv3_handle)) {
353*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to set the NSS pin to low\n");
354*0d6140beSAndroid Build Coastguard Worker 		return -1;
355*0d6140beSAndroid Build Coastguard Worker 	}
356*0d6140beSAndroid Build Coastguard Worker 
357*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
358*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_WRITE_SPI;
359*0d6140beSAndroid Build Coastguard Worker 	command[2] = (uint8_t)write_cnt;
360*0d6140beSAndroid Build Coastguard Worker 	command[3] = (uint8_t)(write_cnt >> 8);
361*0d6140beSAndroid Build Coastguard Worker 
362*0d6140beSAndroid Build Coastguard Worker 	for (i = 0; (i < 8) && (i < write_cnt); i++)
363*0d6140beSAndroid Build Coastguard Worker 		command[4+i] = write_arr[i];
364*0d6140beSAndroid Build Coastguard Worker 
365*0d6140beSAndroid Build Coastguard Worker 	rc = libusb_bulk_transfer(stlinkv3_handle, STLINK_EP_OUT,
366*0d6140beSAndroid Build Coastguard Worker 				  command, sizeof(command),
367*0d6140beSAndroid Build Coastguard Worker 				  &actual_length, USB_TIMEOUT_IN_MS);
368*0d6140beSAndroid Build Coastguard Worker 	if (rc != LIBUSB_TRANSFER_COMPLETED || actual_length != sizeof(command)) {
369*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to issue the STLINK_BRIDGE_WRITE_SPI command: '%s'\n",
370*0d6140beSAndroid Build Coastguard Worker 			 libusb_error_name(rc));
371*0d6140beSAndroid Build Coastguard Worker 		goto transmit_err;
372*0d6140beSAndroid Build Coastguard Worker 	}
373*0d6140beSAndroid Build Coastguard Worker 
374*0d6140beSAndroid Build Coastguard Worker 	if (write_cnt > 8) {
375*0d6140beSAndroid Build Coastguard Worker 		rc = libusb_bulk_transfer(stlinkv3_handle,
376*0d6140beSAndroid Build Coastguard Worker 					  STLINK_EP_OUT,
377*0d6140beSAndroid Build Coastguard Worker 					  (unsigned char *)&write_arr[8],
378*0d6140beSAndroid Build Coastguard Worker 					  (unsigned int)(write_cnt - 8),
379*0d6140beSAndroid Build Coastguard Worker 					  &actual_length,
380*0d6140beSAndroid Build Coastguard Worker 					  USB_TIMEOUT_IN_MS);
381*0d6140beSAndroid Build Coastguard Worker 		if (rc != LIBUSB_TRANSFER_COMPLETED || (unsigned int)actual_length != (write_cnt - 8)) {
382*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Failed to send the  data after the  STLINK_BRIDGE_WRITE_SPI command: '%s'\n",
383*0d6140beSAndroid Build Coastguard Worker 				 libusb_error_name(rc));
384*0d6140beSAndroid Build Coastguard Worker 			goto transmit_err;
385*0d6140beSAndroid Build Coastguard Worker 		}
386*0d6140beSAndroid Build Coastguard Worker 	}
387*0d6140beSAndroid Build Coastguard Worker 
388*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_get_last_readwrite_status(&rw_status, stlinkv3_handle))
389*0d6140beSAndroid Build Coastguard Worker 		return -1;
390*0d6140beSAndroid Build Coastguard Worker 
391*0d6140beSAndroid Build Coastguard Worker 	if (rw_status != 0) {
392*0d6140beSAndroid Build Coastguard Worker 		msg_perr("SPI read/write failure: %d\n", rw_status);
393*0d6140beSAndroid Build Coastguard Worker 		goto transmit_err;
394*0d6140beSAndroid Build Coastguard Worker 	}
395*0d6140beSAndroid Build Coastguard Worker 
396*0d6140beSAndroid Build Coastguard Worker 	if (read_cnt) {
397*0d6140beSAndroid Build Coastguard Worker 		command[1] = STLINK_BRIDGE_READ_SPI;
398*0d6140beSAndroid Build Coastguard Worker 		command[2] = (uint8_t)read_cnt;
399*0d6140beSAndroid Build Coastguard Worker 		command[3] = (uint8_t)(read_cnt >> 8);
400*0d6140beSAndroid Build Coastguard Worker 
401*0d6140beSAndroid Build Coastguard Worker 		rc = libusb_bulk_transfer(stlinkv3_handle, STLINK_EP_OUT,
402*0d6140beSAndroid Build Coastguard Worker 					  command, sizeof(command),
403*0d6140beSAndroid Build Coastguard Worker 					  &actual_length, USB_TIMEOUT_IN_MS);
404*0d6140beSAndroid Build Coastguard Worker 		if (rc != LIBUSB_TRANSFER_COMPLETED || (unsigned int)actual_length != sizeof(command)) {
405*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Failed to issue the STLINK_BRIDGE_READ_SPI command: '%s'\n",
406*0d6140beSAndroid Build Coastguard Worker 				 libusb_error_name(rc));
407*0d6140beSAndroid Build Coastguard Worker 			goto transmit_err;
408*0d6140beSAndroid Build Coastguard Worker 		}
409*0d6140beSAndroid Build Coastguard Worker 
410*0d6140beSAndroid Build Coastguard Worker 		rc = libusb_bulk_transfer(stlinkv3_handle,
411*0d6140beSAndroid Build Coastguard Worker 					  STLINK_EP_IN,
412*0d6140beSAndroid Build Coastguard Worker 					  (unsigned char *)read_arr,
413*0d6140beSAndroid Build Coastguard Worker 					  (int)read_cnt,
414*0d6140beSAndroid Build Coastguard Worker 					  &actual_length,
415*0d6140beSAndroid Build Coastguard Worker 					  USB_TIMEOUT_IN_MS);
416*0d6140beSAndroid Build Coastguard Worker 		if (rc != LIBUSB_TRANSFER_COMPLETED || (unsigned int)actual_length != read_cnt) {
417*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Failed to retrieve the STLINK_BRIDGE_READ_SPI answer: '%s'\n",
418*0d6140beSAndroid Build Coastguard Worker 				 libusb_error_name(rc));
419*0d6140beSAndroid Build Coastguard Worker 			goto transmit_err;
420*0d6140beSAndroid Build Coastguard Worker 		}
421*0d6140beSAndroid Build Coastguard Worker 	}
422*0d6140beSAndroid Build Coastguard Worker 
423*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_get_last_readwrite_status(&rw_status, stlinkv3_handle))
424*0d6140beSAndroid Build Coastguard Worker 		goto transmit_err;
425*0d6140beSAndroid Build Coastguard Worker 
426*0d6140beSAndroid Build Coastguard Worker 	if (rw_status != 0) {
427*0d6140beSAndroid Build Coastguard Worker 		msg_perr("SPI read/write failure: %d\n", rw_status);
428*0d6140beSAndroid Build Coastguard Worker 		goto transmit_err;
429*0d6140beSAndroid Build Coastguard Worker 	}
430*0d6140beSAndroid Build Coastguard Worker 
431*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_spi_set_SPI_NSS(SPI_NSS_HIGH, stlinkv3_handle)) {
432*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to set the NSS pin to high\n");
433*0d6140beSAndroid Build Coastguard Worker 		return -1;
434*0d6140beSAndroid Build Coastguard Worker 	}
435*0d6140beSAndroid Build Coastguard Worker 	return 0;
436*0d6140beSAndroid Build Coastguard Worker 
437*0d6140beSAndroid Build Coastguard Worker transmit_err:
438*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_spi_set_SPI_NSS(SPI_NSS_HIGH, stlinkv3_handle))
439*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Failed to set the NSS pin to high\n");
440*0d6140beSAndroid Build Coastguard Worker 	return -1;
441*0d6140beSAndroid Build Coastguard Worker }
442*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_shutdown(void * data)443*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_shutdown(void *data)
444*0d6140beSAndroid Build Coastguard Worker {
445*0d6140beSAndroid Build Coastguard Worker 	struct stlinkv3_spi_data *stlinkv3_data = data;
446*0d6140beSAndroid Build Coastguard Worker 	uint8_t command[16] = { 0 };
447*0d6140beSAndroid Build Coastguard Worker 	uint8_t answer[2];
448*0d6140beSAndroid Build Coastguard Worker 
449*0d6140beSAndroid Build Coastguard Worker 	command[0] = STLINK_BRIDGE_COMMAND;
450*0d6140beSAndroid Build Coastguard Worker 	command[1] = STLINK_BRIDGE_CLOSE;
451*0d6140beSAndroid Build Coastguard Worker 	command[2] = STLINK_SPI_COM;
452*0d6140beSAndroid Build Coastguard Worker 
453*0d6140beSAndroid Build Coastguard Worker 	stlinkv3_command(command, sizeof(command),
454*0d6140beSAndroid Build Coastguard Worker 				answer, sizeof(answer),
455*0d6140beSAndroid Build Coastguard Worker 				"STLINK_BRIDGE_CLOSE",
456*0d6140beSAndroid Build Coastguard Worker 				stlinkv3_data->handle);
457*0d6140beSAndroid Build Coastguard Worker 
458*0d6140beSAndroid Build Coastguard Worker 	libusb_close(stlinkv3_data->handle);
459*0d6140beSAndroid Build Coastguard Worker 	libusb_exit(stlinkv3_data->usb_ctx);
460*0d6140beSAndroid Build Coastguard Worker 
461*0d6140beSAndroid Build Coastguard Worker 	free(data);
462*0d6140beSAndroid Build Coastguard Worker 	return 0;
463*0d6140beSAndroid Build Coastguard Worker }
464*0d6140beSAndroid Build Coastguard Worker 
465*0d6140beSAndroid Build Coastguard Worker static const struct spi_master spi_programmer_stlinkv3 = {
466*0d6140beSAndroid Build Coastguard Worker 	.max_data_read	= UINT16_MAX,
467*0d6140beSAndroid Build Coastguard Worker 	.max_data_write	= UINT16_MAX,
468*0d6140beSAndroid Build Coastguard Worker 	.command	= stlinkv3_spi_transmit,
469*0d6140beSAndroid Build Coastguard Worker 	.read		= default_spi_read,
470*0d6140beSAndroid Build Coastguard Worker 	.write_256	= default_spi_write_256,
471*0d6140beSAndroid Build Coastguard Worker 	.shutdown	= stlinkv3_spi_shutdown,
472*0d6140beSAndroid Build Coastguard Worker };
473*0d6140beSAndroid Build Coastguard Worker 
stlinkv3_spi_init(const struct programmer_cfg * cfg)474*0d6140beSAndroid Build Coastguard Worker static int stlinkv3_spi_init(const struct programmer_cfg *cfg)
475*0d6140beSAndroid Build Coastguard Worker {
476*0d6140beSAndroid Build Coastguard Worker 	uint16_t sck_freq_kHz = 1000;	// selecting 1 MHz SCK is a good bet
477*0d6140beSAndroid Build Coastguard Worker 	char *param_str;
478*0d6140beSAndroid Build Coastguard Worker 	char *endptr = NULL;
479*0d6140beSAndroid Build Coastguard Worker 	int ret = 1;
480*0d6140beSAndroid Build Coastguard Worker 	int devIndex = 0;
481*0d6140beSAndroid Build Coastguard Worker 	struct libusb_context *usb_ctx;
482*0d6140beSAndroid Build Coastguard Worker 	/* Initialize stlinkv3_handle to NULL for suppressing scan-build false positive core.uninitialized.Branch */
483*0d6140beSAndroid Build Coastguard Worker 	libusb_device_handle *stlinkv3_handle = NULL;
484*0d6140beSAndroid Build Coastguard Worker 	struct stlinkv3_spi_data *stlinkv3_data;
485*0d6140beSAndroid Build Coastguard Worker 
486*0d6140beSAndroid Build Coastguard Worker 	if (libusb_init(&usb_ctx)) {
487*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Could not initialize libusb!\n");
488*0d6140beSAndroid Build Coastguard Worker 		return 1;
489*0d6140beSAndroid Build Coastguard Worker 	}
490*0d6140beSAndroid Build Coastguard Worker 
491*0d6140beSAndroid Build Coastguard Worker 	param_str = extract_programmer_param_str(cfg, "serial");
492*0d6140beSAndroid Build Coastguard Worker 	if (param_str)
493*0d6140beSAndroid Build Coastguard Worker 		msg_pdbg("Opening STLINK-V3 with serial: %s\n", param_str);
494*0d6140beSAndroid Build Coastguard Worker 
495*0d6140beSAndroid Build Coastguard Worker 
496*0d6140beSAndroid Build Coastguard Worker 	while (devs_stlinkv3_spi[devIndex].vendor_id != 0) {
497*0d6140beSAndroid Build Coastguard Worker 		stlinkv3_handle = usb_dev_get_by_vid_pid_serial(usb_ctx,
498*0d6140beSAndroid Build Coastguard Worker 								devs_stlinkv3_spi[devIndex].vendor_id,
499*0d6140beSAndroid Build Coastguard Worker 								devs_stlinkv3_spi[devIndex].device_id,
500*0d6140beSAndroid Build Coastguard Worker 								param_str);
501*0d6140beSAndroid Build Coastguard Worker 		if (stlinkv3_handle) {
502*0d6140beSAndroid Build Coastguard Worker 			if (devs_stlinkv3_spi[devIndex].status == BAD) {
503*0d6140beSAndroid Build Coastguard Worker 				msg_perr("The STLINK-V3 Mini/MiniE does not support the bridge interface\n");
504*0d6140beSAndroid Build Coastguard Worker 				free(param_str);
505*0d6140beSAndroid Build Coastguard Worker 				goto init_err_exit;
506*0d6140beSAndroid Build Coastguard Worker 			}
507*0d6140beSAndroid Build Coastguard Worker 			break;
508*0d6140beSAndroid Build Coastguard Worker 		}
509*0d6140beSAndroid Build Coastguard Worker 		devIndex++;
510*0d6140beSAndroid Build Coastguard Worker 	}
511*0d6140beSAndroid Build Coastguard Worker 
512*0d6140beSAndroid Build Coastguard Worker 	if (!stlinkv3_handle) {
513*0d6140beSAndroid Build Coastguard Worker 		if (param_str)
514*0d6140beSAndroid Build Coastguard Worker 			msg_perr("No STLINK-V3 seems to be connected with serial %s\n", param_str);
515*0d6140beSAndroid Build Coastguard Worker 		else
516*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Could not find any connected STLINK-V3\n");
517*0d6140beSAndroid Build Coastguard Worker 		free(param_str);
518*0d6140beSAndroid Build Coastguard Worker 		goto init_err_exit;
519*0d6140beSAndroid Build Coastguard Worker 	}
520*0d6140beSAndroid Build Coastguard Worker 	free(param_str);
521*0d6140beSAndroid Build Coastguard Worker 
522*0d6140beSAndroid Build Coastguard Worker 	param_str = extract_programmer_param_str(cfg, "spispeed");
523*0d6140beSAndroid Build Coastguard Worker 	if (param_str) {
524*0d6140beSAndroid Build Coastguard Worker 		sck_freq_kHz = strtoul(param_str, &endptr, 0);
525*0d6140beSAndroid Build Coastguard Worker 		if (*endptr || sck_freq_kHz == 0) {
526*0d6140beSAndroid Build Coastguard Worker 			msg_perr("The spispeed parameter passed with invalid format: %s\n",
527*0d6140beSAndroid Build Coastguard Worker 				 param_str);
528*0d6140beSAndroid Build Coastguard Worker 			msg_perr("Please pass the parameter "
529*0d6140beSAndroid Build Coastguard Worker 				 "with a simple non-zero number in kHz\n");
530*0d6140beSAndroid Build Coastguard Worker 			free(param_str);
531*0d6140beSAndroid Build Coastguard Worker 			ret = -1;
532*0d6140beSAndroid Build Coastguard Worker 			goto init_err_exit;
533*0d6140beSAndroid Build Coastguard Worker 		}
534*0d6140beSAndroid Build Coastguard Worker 		free(param_str);
535*0d6140beSAndroid Build Coastguard Worker 	}
536*0d6140beSAndroid Build Coastguard Worker 
537*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_spi_open(sck_freq_kHz, stlinkv3_handle))
538*0d6140beSAndroid Build Coastguard Worker 		goto init_err_exit;
539*0d6140beSAndroid Build Coastguard Worker 
540*0d6140beSAndroid Build Coastguard Worker 	stlinkv3_data = calloc(1, sizeof(*stlinkv3_data));
541*0d6140beSAndroid Build Coastguard Worker 	if (!stlinkv3_data) {
542*0d6140beSAndroid Build Coastguard Worker 		msg_perr("Unable to allocate space for SPI master data\n");
543*0d6140beSAndroid Build Coastguard Worker 		goto init_err_exit;
544*0d6140beSAndroid Build Coastguard Worker 	}
545*0d6140beSAndroid Build Coastguard Worker 
546*0d6140beSAndroid Build Coastguard Worker 	stlinkv3_data->usb_ctx = usb_ctx;
547*0d6140beSAndroid Build Coastguard Worker 	stlinkv3_data->handle = stlinkv3_handle;
548*0d6140beSAndroid Build Coastguard Worker 
549*0d6140beSAndroid Build Coastguard Worker 	return register_spi_master(&spi_programmer_stlinkv3, stlinkv3_data);
550*0d6140beSAndroid Build Coastguard Worker 
551*0d6140beSAndroid Build Coastguard Worker init_err_exit:
552*0d6140beSAndroid Build Coastguard Worker 	if (stlinkv3_handle)
553*0d6140beSAndroid Build Coastguard Worker 		libusb_close(stlinkv3_handle);
554*0d6140beSAndroid Build Coastguard Worker 	libusb_exit(usb_ctx);
555*0d6140beSAndroid Build Coastguard Worker 	return ret;
556*0d6140beSAndroid Build Coastguard Worker }
557*0d6140beSAndroid Build Coastguard Worker 
558*0d6140beSAndroid Build Coastguard Worker const struct programmer_entry programmer_stlinkv3_spi = {
559*0d6140beSAndroid Build Coastguard Worker 	.name			= "stlinkv3_spi",
560*0d6140beSAndroid Build Coastguard Worker 	.type			= USB,
561*0d6140beSAndroid Build Coastguard Worker 	.devs.dev		= devs_stlinkv3_spi,
562*0d6140beSAndroid Build Coastguard Worker 	.init			= stlinkv3_spi_init,
563*0d6140beSAndroid Build Coastguard Worker };
564