FIX - This is next PR
This commit is contained in:
parent
3e69ebc730
commit
77e82a68cd
@ -59,21 +59,6 @@ void URobotPilotSO100Component::DisableAnim()
|
|||||||
AnimationStartTime = 0;
|
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
|
FSo100Actuators URobotPilotSO100Component::GetCurrentControlsFromPhysicScene() const
|
||||||
{
|
{
|
||||||
return FSo100Actuators
|
return FSo100Actuators
|
||||||
|
@ -53,9 +53,6 @@ public:
|
|||||||
UFUNCTION(BlueprintCallable)
|
UFUNCTION(BlueprintCallable)
|
||||||
void DisableAnim();
|
void DisableAnim();
|
||||||
|
|
||||||
UFUNCTION(BlueprintCallable)
|
|
||||||
void DebugUpdatePos();
|
|
||||||
|
|
||||||
private:
|
private:
|
||||||
// SO100 Controls by name
|
// SO100 Controls by name
|
||||||
FString Actuator_Rotation = FString("Rotation");
|
FString Actuator_Rotation = FString("Rotation");
|
||||||
|
Loading…
x
Reference in New Issue
Block a user