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