modeling and simulation for robots and mechanisms