Added scaling of the obstacles

Scaling is still incomplete. It needs fine tuning and more proper
scaling.