Merge pull request #18 from utexas-bwi/devel

pushing stable to 0.1.6
increasing inertia to keep robot vertical