debugged low pass filter for pos integration
clean up of goto_pos and PID tweaking. not working, tho. (bitch doesn't ramp down.)