diff --git a/master/master/lib/slavesensors.c b/master/master/lib/slavesensors.c --- a/master/master/lib/slavesensors.c +++ b/master/master/lib/slavesensors.c @@ -172,7 +172,7 @@ void slavesensors_network_scan() { void slavesensors_selectnode(uint8_t nodeIndex) { serial0_ioff(); - + uint32_t startTime = time_millis(); #ifdef DEBUG_SELECTNODE serial0_sendString("Switch to node "); serial0_sendChar(nodeIndex + 0x30); @@ -211,6 +211,10 @@ void slavesensors_selectnode(uint8_t nod serial0_sendString("\r\n"); #endif + uint32_t switchTime = time_millis() - startTime; + char tmpB[32]; + snprintf(tmpB, 32, "CTXSW: %lu ms\r\n", switchTime); + serial0_sendString(tmpB); serial0_ion(); return; }