Ensures Accel and Cal mode calculate the right angle.
Size optimisation and moved helper functions to car class.