Compare commits
3 Commits
ft-pilot-s
...
main
Author | SHA1 | Date | |
---|---|---|---|
dd26c58e6b | |||
|
3c413a1982 | ||
127c37ffd7 |
@ -59,20 +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
|
||||||
{
|
{
|
||||||
|
@ -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