fakeMotionControl and tests fix

robotology · Nov 22, 2023 · fa1ba18 · fa1ba18
1 parent 1ba2181
commit fa1ba18
Show file tree

Hide file tree

Showing 2 changed files with 5 additions and 4 deletions.
diff --git a/src/devices/fakeMotionControl/fakeMotionControl.cpp b/src/devices/fakeMotionControl/fakeMotionControl.cpp
@@ -3165,7 +3165,8 @@ bool FakeMotionControl::getNumberOfMotorsRaw(int* num)
 
 bool FakeMotionControl::getTemperatureRaw(int m, double* val)
 {
-    return NOT_YET_IMPLEMENTED("getTemperatureRaw");
+    *val = 37.5+double(m);
+    return true;
 }
 
 bool FakeMotionControl::getTemperaturesRaw(double *vals)

diff --git a/src/libYARP_dev/src/yarp/dev/tests/IMotorTest.h b/src/libYARP_dev/src/yarp/dev/tests/IMotorTest.h
@@ -21,11 +21,11 @@ namespace yarp::dev::tests
         int axis=0;
         bool b = false;
         double val=0;
-        double res=0;
-        double vals[2] = {0,0};
 
         b = imot->getNumberOfMotors(&axis);
         CHECK(b);
+        REQUIRE(axis > 0);
+        auto vals = std::vector<double>(axis);
 
         b = imot->getGearboxRatio(0, &val);
         CHECK(b);
@@ -48,7 +48,7 @@ namespace yarp::dev::tests
         b = imot->getTemperatureLimit(0, &val);
         CHECK(b);
 
-        b = imot->getTemperatures(vals);
+        b = imot->getTemperatures(vals.data());
         CHECK(b);
     }
 }