feedback gain too weak --- need to introduce weighting parameters to the lqg performance crit
need more checking
mrgd mods from master
fullstatefb stabi works
looks like suc
sths wrong
looks like working
mrgd red out branch