added u-shaped obstacle for proving the ability to handle it.
Merge branch 'u_shaped_obstacle' into dev
Merge branch 'dev'