implemented code reading
Merge branch 'master' of github.com:mg2/LegoMindstorms
Merge branch 'master' of github.com:mg2/LegoMindstorms
reads codes at full speed