Removed marker specific code in sensor_control

Code temporarily moved to marker code.txt. The only function of
sensor_control should be fetching sensor data and preparing/filtering
this data!