sensor_prepare functions now using fix16_t scaling
added sensor data structure clearing
added more blocks to the main function
fixed sensor data conversion
implemented axis swapping
implemented fusion (invalid time constant as of now)