fixes for multiple nonlinearities on fixed base robots #477

Closed jhwangbo closed 1 year ago