A lot of small fixes for the planning
bins realeased at end_effectors position, on the table; carrying height is higher; shoulder_lift constrained to [-pi/2,0]