Implemented new model for motion

Uses moment of each motor to calculate turning effect - simpler but more
effective model