X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_ms5607.c;h=1b55b7fdeea61d4f99101425fb3f38aed1606a4c;hb=93db8febda03d9a02c5c1ccdc6ad44eaf00a433b;hp=e1d0507ee8826b955f1e2a2075d8b1522a52b682;hpb=08a4ed8fe794a2b2b52147bd5535fe0954822e95;p=fw%2Faltos

diff --git a/src/drivers/ao_ms5607.c b/src/drivers/ao_ms5607.c
index e1d0507e..1b55b7fd 100644
--- a/src/drivers/ao_ms5607.c
+++ b/src/drivers/ao_ms5607.c
@@ -118,6 +118,7 @@ static uint8_t	ao_ms5607_done;
 static void
 ao_ms5607_isr(void)
 {
+	ao_exti_disable(AO_MS5607_MISO_GPIO, AO_MS5607_MISO);
 	ao_ms5607_done = 1;
 	ao_wakeup(&ao_ms5607_done);
 }
@@ -133,12 +134,18 @@ ao_ms5607_get_sample(uint8_t cmd) {
 	ao_ms5607_start();
 	ao_spi_send(&cmd, 1, AO_MS5607_SPI_INDEX);
 	ao_exti_enable(AO_MS5607_MISO_GPIO, AO_MS5607_MISO);
+#if AO_MS5607_PRIVATE_PINS
+	ao_spi_put(AO_MS5607_SPI_INDEX);
+#endif
 	cli();
 	while (!ao_ms5607_done)
 		ao_sleep(&ao_ms5607_done);
 	sei();
-	ao_exti_disable(AO_MS5607_MISO_GPIO, AO_MS5607_MISO);
+#if AO_MS5607_PRIVATE_PINS
+	stm_gpio_set(AO_MS5607_CS_GPIO, AO_MS5607_CS, 1);
+#else
 	ao_ms5607_stop();
+#endif
 
 	ao_ms5607_start();
 	read = AO_MS5607_ADC_READ;