V1 : speed obtaining via  encoders

1. speed obtaining via  encoders
2. used in ir open 2014
3.  AtmeStudio