Push before testing

This commit is contained in:
Vyktori 2025-04-27 19:59:36 -04:00
parent cbb0bc5fc2
commit 42770f7234
5 changed files with 25 additions and 9 deletions

Binary file not shown.

View File

@ -11,6 +11,7 @@
#include "LuckyMujoco.h"
#include "fstream"
#include "filesystem"
#include "Kismet/KismetMathLibrary.h"
AMujocoVolumeActor::AMujocoVolumeActor()
{
@ -387,16 +388,26 @@ void AMujocoVolumeActor::PostRegisterAllComponents()
}
}
void AMujocoVolumeActor::Tick(float DeltaTime)
void AMujocoVolumeActor::Tick(float DeltaTime)
{
if (MujocoData)
{
mj_step(MujocoModel.Get(), MujocoData.Get());
for (int32 Frame = 0; Frame < FrameSkip; ++Frame)
{
mj_step(MujocoModel.Get(), MujocoData.Get());
}
// const int32 FixedSteps = UKismetMathLibrary::SafeDivide(DeltaTime, Options->Options.TimeStep);
//
// if (FixedSteps > 0)
// {
// for (int x = 0; x < FixedSteps; ++x)
// {
// mj_step(MujocoModel.Get(), MujocoData.Get());
// }
// }
//mj_step(MujocoModel.Get(), MujocoData.Get());
//mj_forward(MujocoModel.Get(), MujocoData.Get());
for (int32 Frame = 0; Frame <= FrameSkip; ++Frame)
{
mj_step(MujocoModel.Get(), MujocoData.Get());
}
for (int32 i = 1; i < BodyComponents.Num(); ++i)
{
@ -405,7 +416,7 @@ void AMujocoVolumeActor::Tick(float DeltaTime)
mjtNum* Pos = MujocoData->xpos + 3 * i;
mjtNum* Quat = MujocoData->xquat + 4 * i;
FVector Position = FVector(Pos[0], -Pos[1], Pos[2]) * 100.0f;
FVector Position = FVector(Pos[0], -Pos[1], Pos[2]) * 100.f;
FQuat Rotation = FQuat(Quat[1], -Quat[2], Quat[3], -Quat[0]);
BodyComponents[i]->SetWorldLocationAndRotation(Position, Rotation);

View File

@ -106,13 +106,18 @@ public:
UFUNCTION(BlueprintCallable, BlueprintPure, Category = "Mujoco")
double GetJointValueByIndex(int32 JointIndex) const;
///////// *********************************************
virtual void PostRegisterAllComponents() override;
virtual void Tick(float DeltaTime) override;
virtual void PostInitializeComponents() override;
//////&&&&&&&&&&&&&&&&&&&&
protected:
virtual void BeginPlay() override;