Added PIDTestNoMotors library
PID with subract from full power method, benchtop
Working PD tuned. Energy shaving of strong motor.