BBIO SPI fix

Properly deinit old SPI if switching to a different device.
hydrabus · Jun 20, 2024 · f42daef · f42daef
1 parent 116882b
commit f42daef
Showing 1 changed file with 7 additions and 1 deletion.
diff --git a/src/hydrabus/hydrabus_bbio_spi.c b/src/hydrabus/hydrabus_bbio_spi.c
@@ -283,7 +283,13 @@ void bbio_mode_spi(t_hydra_console *con)
 				} else if ((bbio_subcommand & BBIO_SPI_CONFIG) == BBIO_SPI_CONFIG) {
 					proto->config.spi.dev_polarity = (bbio_subcommand & 0b100)?1:0;
 					proto->config.spi.dev_phase = (bbio_subcommand & 0b10)?1:0;
-					proto->dev_num = (bbio_subcommand & 0b1)?BSP_DEV_SPI1:BSP_DEV_SPI2;
+
+					data = (bbio_subcommand & 0b1)?BSP_DEV_SPI1:BSP_DEV_SPI2;
+					if (proto->dev_num != data) {
+						bsp_spi_deinit(proto->dev_num);
+						proto->dev_num = data;
+					}
+
 					status = bsp_spi_init(proto->dev_num, proto);
 					if(status == BSP_OK) {
 						cprint(con, "\x01", 1);