Refactor sample functions to ServoModule

[wilbert-alberts]

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;

[wilbert-alberts]

Need to think about modules that have more then one periodic function.
SPI
Devices