orked on the pid. Added ISR and reworked the pid class.
The pid ISR now sets the speed, because the can_receive is blocking.