Updated rmt. Some fixes. Scaled gains in WB control.