LI mode works but arm moves in wrong direction
fixed matrix inverse