Merge pull request #56 from twiniars/master

track force control
hi test_mode