diff --git a/SensorSPI.c b/SensorSPI.c index b9fa0fd..57bbdaa 100644 --- a/SensorSPI.c +++ b/SensorSPI.c @@ -74,14 +74,32 @@ bool setSpiSensor(tSensorSPI *env, tSensorType sensorType, tSensorAdr sensorAdr, setSensorTypeAdr(env, &env->conns->COON_A_B9_B10.Con, sensorAdr); } - SystemDelayMs(1); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); +// SystemDelayMs(1); + bool result = SpiPortTransmit(&env->spiPorts->Spi1_IO, &data, 1000); - SystemDelayMs(1); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); +// SystemDelayMs(1); GpioPinSet(&env->conns->COON_A_B9_B10.En1, true); GpioPinSet(&env->conns->COON_A_B9_B10.En2, true); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); + __asm__ volatile("nop"); +// SystemDelayMs(1); + return result; }