Fixed serialisation bug
Added sensor data test function
Added msg parsing for sensor events
Cleanup