make the old behaviour the default

Author: runger1101001

src/common/base_classes/FOCMotor.cpp

@@ -1,4 +1,5 @@
 #include "FOCMotor.h"
+#include "../../communication/SimpleFOCDebug.h"
 
 /**
  * Default constructor - setting all variabels to default values
@@ -77,7 +78,8 @@ float FOCMotor::electricalAngle(){
 // function implementing the monitor_port setter
 void FOCMotor::useMonitoring(Print &print){
   monitor_port = &print; //operate on the address of print
-  if(monitor_port ) monitor_port->println(F("MOT: Monitor enabled!"));
+  SimpleFOCDebug::enable(&print);
+  SIMPLEFOC_DEBUG("MOT: Monitor enabled!");
 }
 
 // utility function intended to be used with serial plotter to monitor motor variables