Switch back to parallel tof-sensor reading #221
Description
Currently we do sequential alternating tof sensor reading, we have more stable hardware now so we can switch back to parallel measurements.
- leading sensor (left) should give the pace for the readings, if the other tof-sensor is not ready just skip it
- for a better loop performance the sensor handling should not delay the loop but just return false if there are no new values available
- reduce size of recorded readings array (was increased to support the alternating readings)
- limiting the max distance from the theoretical maximum does not help to increase measurement frequency any more - increase max distance.
- make loop working with the hight frequency