fix 0003 bug of Simba...
Merge branch 'master' of github.com:gwu-robotics/simba