Add a Vec3 PID controller class