Started implementing arm stuff. Also, I need this PID class so I'm going to (start to) code it