call get_robot_pos function 5 times until it return true
rename argument and modify give function
Merge pull request #261 from irvs/issue260

Issue260