added algorithm complexity

MotorDriver class added, velocity limit implemented, state machine
implemented, strain gauge calibration implemented, gravity compensation
implemented, code cleaned up