Unverified Commit 782703b1 authored by Florent Lamiraux's avatar Florent Lamiraux Committed by GitHub
Browse files

Merge pull request #32 from florent-lamiraux/devel

[Device] Copy robotState in state at initialization
parents 4097adb3 b3e99200
Pipeline #19795 passed with stage
in 3 minutes and 10 seconds
......@@ -265,7 +265,13 @@ void SoTTalosDevice::setSensors(map<string, dgsot::SensorValues>& SensorsIn) {
sotDEBUGOUT(25);
}
void SoTTalosDevice::setupSetSensors(map<string, dgsot::SensorValues>& SensorsIn) { setSensors(SensorsIn); }
void SoTTalosDevice::setupSetSensors(map<string, dgsot::SensorValues>& SensorsIn)
{
// The first time we read the sensors, we need to copy the state of the
// robot into the signal device.state.
setSensors(SensorsIn);
setState(robotState_(0));
}
void SoTTalosDevice::nominalSetSensors(map<string, dgsot::SensorValues>& SensorsIn) { setSensors(SensorsIn); }
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment