diff --git a/Source/LuckyWorldV2/Private/Robot/PilotComponent/RobotPilotSO100Component.cpp b/Source/LuckyWorldV2/Private/Robot/PilotComponent/RobotPilotSO100Component.cpp index dc1357ca..23aebe42 100644 --- a/Source/LuckyWorldV2/Private/Robot/PilotComponent/RobotPilotSO100Component.cpp +++ b/Source/LuckyWorldV2/Private/Robot/PilotComponent/RobotPilotSO100Component.cpp @@ -59,21 +59,6 @@ void URobotPilotSO100Component::DisableAnim() AnimationStartTime = 0; } -void URobotPilotSO100Component::DebugUpdatePos() -{ - const int JointId = RobotOwner->PhysicsSceneProxy->GetJointId("MujocoBody_6"); - auto MjData = RobotOwner->PhysicsSceneProxy->GetMujocoData(); - auto MjModel = RobotOwner->PhysicsSceneProxy->GetMujocoModel(); - // mj_name2id(MjModel, mjOBJ_JOINT, ""); - - if (JointId) - { - auto adx = MjModel.jnt_qposadr[JointId]; - mjtNum* body_pos = MjData.xpos + 3 * JointId; - UE_LOG(LogTemp, Log, TEXT("JointId %i - pos.x %f - pos.y %f - pos.z %f"), JointId, body_pos[0], body_pos[1], body_pos[2]); - } -} - FSo100Actuators URobotPilotSO100Component::GetCurrentControlsFromPhysicScene() const { return FSo100Actuators diff --git a/Source/LuckyWorldV2/Public/Robot/PilotComponent/RobotPilotSO100Component.h b/Source/LuckyWorldV2/Public/Robot/PilotComponent/RobotPilotSO100Component.h index 6e325e23..c63095bc 100644 --- a/Source/LuckyWorldV2/Public/Robot/PilotComponent/RobotPilotSO100Component.h +++ b/Source/LuckyWorldV2/Public/Robot/PilotComponent/RobotPilotSO100Component.h @@ -53,9 +53,6 @@ public: UFUNCTION(BlueprintCallable) void DisableAnim(); - UFUNCTION(BlueprintCallable) - void DebugUpdatePos(); - private: // SO100 Controls by name FString Actuator_Rotation = FString("Rotation");