Path planning for RSS challenge