Create PID class

Replaces individual function for each PID axis