Create a proper sensor interface

[yamaan93]

Current sensor system is kinda bad, while the sensor objects work fine, I want to make a class to handle them and their CAN messages in a better fashion than the current implementation that is just an array of sensor pointers. This should make it easier to put everything on CAN as well as perhaps handle things like non-linear sensors a little better.