added rqt control panels, and fleshed out interface, should be close to working now, need to test