Coded a PID class. Sorry, Christian. Also, still working on implementing arm/belt code