Started with new main loop
Button handling inserted
Main loop written
Merge branch 'master' of github.com:dfyx/lego-team7