Updated LQR node (stil lneed dynamics), and worked on both manual and auto controlelr nodes. Might split trajectory generator and joystick reader into a separate single node and have one just for flying to eliminate the time discrepency between control outputs and LQR outputs