class done, need to write lqr control function
files for gui and control