Cleaned-up ardunio code
Python code operational, needs adjustment + refactoring