Simulation in Gazebo

Optimization-based Inverse Kinematics and Impedance Control in Gazebo.

Optimization-based Trajectory Generation and Collision Avoidance in Gazebo.

Consider Orientation Soft Constraints

Collision Detection