Calling Amtel PID library. TODO: configure timers so not destroy pwm functionality, remove serial debug logging