wrote 2-pace code.

need to charge and test
semi working walk code