Work on mapping obstacles found by camera