How would you implement a PID controller in software to maintain a constant motor speed for Twin Disc equipment?