Refactoring in Utilities and Robofoot.cpp
Refactoring in SerialInterface