Fixed reading offsets for Sensors. Added Advanced Settings property to MjGeomEditor

2022-05-13 13:32:40 +02:00
parent 87539dbd24
commit c62c68d744
2 changed files with 3 additions and 1 deletions
@@ -69,7 +69,8 @@ public class MjSiteVectorSensor : MjBaseSensor {
  }

  public override unsafe void OnSyncState(MujocoLib.mjData_* data) {
-    SensorReading = MjEngineTool.UnityVector3(data->sensordata, _sensorAddress);
+    Vector3 mjReading = new Vector3((float)data->sensordata[_sensorAddress], (float)data->sensordata[_sensorAddress + 1], (float)data->sensordata[_sensorAddress + 2]);
+    SensorReading = MjEngineTool.UnityVector3(mjReading);
  }
 }
 }