adding console.cpp. Modified how motor and sonar interact