added PID testing

added a simple autonomous PD adjusting thingy for Cyclops