https://justarocketscientist.com/2020/11/optimal-lqr-control-notes-on-selection-of-q-r/