Added smach state machine to perform  autonomous patrolling of waypoints