Alistair and John fixed dirty mistakes. Kinematics working, getRTC lagging behind because motors need time. PID next will fix this yeyeye

Signed-off-by: JHolland <jonathan.holland8@gmail.com>