Communication with motor checked and OK

Still a big issue => No update of PID output...
Need to see if the instance of PID is working properly when declared
inside an object...
Nota, PID library is working well if running standalone.
if not, then do the PID algorithm myself.