Updated to PID velocity control. Simulation framework down and working.