Fix counter type
Support different frequency for different servo
Merge branch 'master' of https://github.com/nkming2/libsmartcarcpp.git