Update lqr.cpp, planar_quadrotor_visualizer.h, lqr.h, simulate.h, planar_quadrotor.h, planar_quadrotor.cpp, planar_quadrotor_visualizer.cpp, simulate.cpp files