From 6b5736c991863789ee2b516d0aab238355f781fe Mon Sep 17 00:00:00 2001 From: Anastasia Klimchuk Date: Tue, 13 Apr 2021 10:15:26 +1000 Subject: linux_spi.c: Separate shutdown from failed init cleanup Shutdown function was covering two different jobs here: 1) the actual shutdown which is run at the end of the driver's lifecycle and 2) cleanup in cases when initialisation failed. Now, shutdown is only doing its main job (#1), and the driver itself is doing cleanup when init fails (#2). The good thing is that now resources are released/closed immediately in cases when init fails (vs shutdown function which was run at some point later), and the driver leaves clean space after itself if init fails. And very importantly this unlocks API change which plans to move register_shutdown inside register master API, see this https://review.coreboot.org/c/flashrom/+/51761 TEST=builds BUG=b:140394053 Change-Id: I1c8da2878cd0e85a1e43ba9b4b8e6f3d9f38ae5c Signed-off-by: Anastasia Klimchuk Reviewed-on: https://review.coreboot.org/c/flashrom/+/52284 Tested-by: build bot (Jenkins) Reviewed-by: Edward O'Callaghan --- linux_spi.c | 25 ++++++++++++++++++------- 1 file changed, 18 insertions(+), 7 deletions(-) (limited to 'linux_spi.c') diff --git a/linux_spi.c b/linux_spi.c index b3cbf976f..ae5c31864 100644 --- a/linux_spi.c +++ b/linux_spi.c @@ -167,6 +167,7 @@ int linux_spi_init(void) /* SPI mode 0 (beware this also includes: MSB first, CS active low and others */ const uint8_t mode = SPI_MODE_0; const uint8_t bits = 8; + int ret = 0; p = extract_programmer_param("spispeed"); if (p && strlen(p)) { @@ -200,34 +201,44 @@ int linux_spi_init(void) } free(dev); - if (register_shutdown(linux_spi_shutdown, NULL)) - return 1; - /* We rely on the shutdown function for cleanup from here on. */ - if (ioctl(fd, SPI_IOC_WR_MAX_SPEED_HZ, &speed_hz) == -1) { msg_perr("%s: failed to set speed to %"PRIu32"Hz: %s\n", __func__, speed_hz, strerror(errno)); - return 1; + ret = 1; + goto init_err; } msg_pdbg("Using %"PRIu32"kHz clock\n", speed_hz / 1000); if (ioctl(fd, SPI_IOC_WR_MODE, &mode) == -1) { msg_perr("%s: failed to set SPI mode to 0x%02x: %s\n", __func__, mode, strerror(errno)); - return 1; + ret = 1; + goto init_err; } if (ioctl(fd, SPI_IOC_WR_BITS_PER_WORD, &bits) == -1) { msg_perr("%s: failed to set the number of bits per SPI word to %u: %s\n", __func__, bits == 0 ? 8 : bits, strerror(errno)); - return 1; + ret = 1; + goto init_err; } max_kernel_buf_size = get_max_kernel_buf_size(); msg_pdbg("%s: max_kernel_buf_size: %zu\n", __func__, max_kernel_buf_size); + if (register_shutdown(linux_spi_shutdown, NULL)) { + ret = 1; + goto init_err; + } register_spi_master(&spi_master_linux); return 0; + +init_err: + if (fd != -1) { + close(fd); + fd = -1; + } + return ret; } #endif // CONFIG_LINUX_SPI == 1 -- cgit v1.2.3