Compare commits
3 Commits
ft-pilot-s
...
main
Author | SHA1 | Date | |
---|---|---|---|
dd26c58e6b | |||
|
3c413a1982 | ||
127c37ffd7 |
@ -59,20 +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
|
||||
{
|
||||
|
@ -53,9 +53,6 @@ public:
|
||||
UFUNCTION(BlueprintCallable)
|
||||
void DisableAnim();
|
||||
|
||||
UFUNCTION(BlueprintCallable)
|
||||
void DebugUpdatePos();
|
||||
|
||||
private:
|
||||
// SO100 Controls by name
|
||||
FString Actuator_Rotation = FString("Rotation");
|
||||
|
Loading…
x
Reference in New Issue
Block a user