diff --git a/SensorSPI.c b/SensorSPI.c index 73586d9..562fe02 100644 --- a/SensorSPI.c +++ b/SensorSPI.c @@ -261,6 +261,22 @@ bool setSpiSensor(tSensorSPI *env, tSensorType sensorType, tSensorAdr sensorAdr, } + case SENSOR_TYPE_C: { + + GpioPinSet(&env->conns->COON_C.En1, false); // CS En1 + + setSensorTypeAdr(env, &env->conns->COON_C.Con, sensorAdr); + + Delay(DelayCn); + bool result = SpiPortTransmit(&env->spiPorts->Spi2_IO, &data, 1000); + Delay(DelayCn); + + GpioPinSet(&env->conns->COON_C.En1, true); + + Delay(DelayCn); + return result; + } + } return false;