Set joint positions of simulated robot

Parameters

q: joint positions

Example command: set_pos([0.0,1.57,-1.57,0,0,3.14])

• Example Parameters:
  • q = [0.0,1.57,-1.57,0,0,3.14] -> the position of the simulated robot with joint angles in radians representing rotations of base, shoulder, elbow, wrist1, wrist2 and wrist3