Online trajectory generation for industrial robot with 3D camera