Implement LED and some minor bugfixes. fixed #2