minor bug fix in the new robot NMPC example