ishida: add new algorithms.
Merge branch 'master' of http://github.com/kouhara3/kobuki_asmd
ishida: marge Map.cpp, Block.cpp. And change CMakeLists.txt.