robot is now moving, some new methods to move faster, LED controll and reading sensor