Add environment with obstacles

[pockerman]

Create an environment with a diff drive robot equipped with an ultrasound sensor. The environment will have a number of obstacles. Use A* for creating a path in the environment