Fix issue of SATA TH mode not removing TH gear after initial tag.
Merge pull request #46 from Kinematics/dev

Fix issue of SATA TH mode not removing TH gear after initial tag.