now able to climb up and down stairs. Some code reduction made
Merge branch 'master' of https://github.com/Eiiki/megaman
some confliction fixes