protected override void useMarkerCoordinates() { floorPlane = MonitoringUtils.getPlaneFromCvCoordinates(_balls[(int)markerIds.Floor3], _balls[(int)markerIds.Floor2], _balls[(int)markerIds.Floor1]); calculateAngles(); if (firstMeasurement == true) { setInitialValues(); } for (int i = 0; i < _balls.Length; i++) { markers[i].transform.position = MonitoringUtils.getCoordinatesRelativeToPlane(_balls[i], floorPlane) + offset; } dummy.updateDummyPose( markers[(int)markerIds.Dummy1].transform.position, markers[(int)markerIds.Dummy2].transform.position, markers[(int)markerIds.Hands].transform.position, ref performTracking); subject.updateSubjectPose(markers[(int)markerIds.rightArm].transform.position, markers[(int)markerIds.leftArm].transform.position); checkCompressionDepth(); calculateCompressionRate(); updateMeasurementMessages(); updateGraphs(); if (saveCheckBox.isOn) { saveDataToTextFile(); } }
void setInitialValues() { offset = MonitoringUtils.setOffsetVector(desiredLocation.transform.position, floorPlane, _balls[(int)markerIds.Hands]); for (int i = 0; i < _balls.Length; i++) { markers[i].transform.position = MonitoringUtils.getCoordinatesRelativeToPlane(_balls[i], floorPlane) + offset; } dummy.setInitialPose(markers[(int)markerIds.Dummy1].transform.position, markers[(int)markerIds.Dummy2].transform.position, markers[(int)markerIds.Hands].transform.position); setInitialAngleValues(); subject.setSubjectInitialPose(offset, dummy.transform); }