Code rewriting and cleaning
some fix
some fixes
change gpio
change gpio
Merge branch 'v1.1'