Pick working now
New moveit config with continuous joints
adapted to new controller
minor changes
Changed pole position
Added constraints, pick in loop with return value