|
|
@@ -107,6 +107,21 @@ void nbus_slave_unicastToSensorSet(nBus_TypeDef *nbus)
|
|
|
}
|
|
|
break;
|
|
|
|
|
|
+ case CMD_CALIBRATE: {
|
|
|
+ nbus->hw_platform->led_on();
|
|
|
+ if (1 == nbus->interface->calibrate(nbus->sensorInfo.address, 0, NULL))
|
|
|
+ {
|
|
|
+ nbus->tx_buffer[4] = 1;
|
|
|
+ nbus->tx_length += 1;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ setErrorResponse(nbus, ILLEGAL_DEVICE_ADDRESS);
|
|
|
+ }
|
|
|
+ nbus->hw_platform->led_off();
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
case CMD_DATA: {
|
|
|
nbus->tx_buffer[4] = nbus->interface->setData(&nbus->rx_buffer[3]);
|
|
|
if (nbus->tx_buffer[4] != OK_CODE)
|