Check our papers Robust Task Planning for Assembly Lines with Human-Robot Collaboration. Safe Interactive Industrial Robots using Jerk-based Safe Set Algorithm.