Building a PID formula for my encoded DC motor. Arduino.