S-RRT: Enhanced Path Planning for Collaborative Robots