Many fixes

Added types.h to all libraries.
Fixed screen and keypad to new interface.
Minor fixes to comms.
Major fixed to core wheel balancing (complete overhaul).