General refinements

-Added print messages
-Refined LED function
-Added test message for test input