RFT: Sensor refactoring

# RFT
This is for disabling all sensors fifos as well as handling the data of sensors at different incoming rates properly within sensors.c module.
This is also intended to address #371 as well as #213.

PS: I harmonized sensor driver code formatting using astyle after going nuts because of inconsistency. This renders the diff barely readable so as this changes big parts of the sensor code anyway i suggest reviewing the whole files instead.