system now uses angular velocity for PID input

messed with PID values, got some interesting results and video!