Refactor sample functions to ServoModule #1
Description
Affects:
// TimeStats_Servo::takeTimeStamp, tsStart
DigitalIn::captureAllIns
SPI::readBus
Devices::sample
Controller::sample
Motor::sample, motor
Devices::update
SPI::writeBus, spibus
DigitalOut::activateAllOuts
// TimeStats_Servo::takeTimeStamp, tsTracing);
Traces_Servo::sampleAllTraces
// TimeStats_Servo::sampleCommand
// TimeStats_Servo::takeTimeStamp, tsCheckStop;
PeriodicTimer::checkStop
Cmd_UpdateFrequency::execute
// TimeStats_Servo::takeTimeStamp;
unlockDB;