added PID controller, Live Grapher, kalman filter, fixed encoder