Replace vector of sensors by fixed size array of sensors

[amandel]

This still leaves the option to support more than 2 tof-sensors at a later point in time, but removes the complexity of dynamically allocated data structures.