Updating the search wave, solving a bug
Updating wave_detection_sm for less time consuming
Updating with give_desired_object_sm
Added some information error printing
Updating Emergency
Merge pull request #253 from reem-utils/chang_branch

Chang branch