Franka-Emika-Panda Original script by Amin Fakhari. Changes: URDF file has inertial parameters for each link Fix upper limit for joint 4