[Feature Request]: Decouple interactions between SimpleFOC and MicroROS

[Legohead259]

Is your feature request related to a problem? Please describe.
The MicroROS implementation has a strong dependency on the SimpleFOC implementation right now, requiring the use of the motor and sensorFOC objects.

Describe the solution you'd like
This dependency should be removed by passing SimpleFOC functions like motor.disable(), motor.enable(), and sensorFOC.getAngle() as callbacks to the SimpleFOC functions. Micro-ROS does not need to interact directly with these sensors, rather just know to make these callbacks when necessary. The callbacks can be set in the main script initialization function.

This may also reduce the risk of circular dependencies.