Safe And Efficient Human-Robot Collaboration