Skip to content

Commit

Permalink
more observation inputs
Browse files Browse the repository at this point in the history
  • Loading branch information
JulioJerez committed Sep 24, 2024
1 parent a70b27b commit 134665e
Showing 1 changed file with 10 additions and 3 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -47,9 +47,12 @@ namespace ndAdvancedRobot

// distance to target error.
ndBrainFloat m_delta_x;
ndBrainFloat m_target_x;
ndBrainFloat m_delta_z;
ndBrainFloat m_deltaAzimuth;
//ndBrainFloat m_deltaRotation;
ndBrainFloat m_target_z;
ndBrainFloat m_delta_Azimuth;
ndBrainFloat m_target_Azimuth;

ndBrainFloat m_sourcePin[3];
ndBrainFloat m_targetPin[3];
};
Expand Down Expand Up @@ -609,7 +612,11 @@ namespace ndAdvancedRobot
const ndVector positError(CalculateDeltaTargetPosit(currentEffectorMatrix));
observation->m_delta_x = ndBrainFloat(positError.m_x);
observation->m_delta_z = ndBrainFloat(positError.m_z);
observation->m_deltaAzimuth = ndBrainFloat(positError.m_w);
observation->m_delta_Azimuth = ndBrainFloat(positError.m_w);

observation->m_target_x = ndBrainFloat(m_targetLocation.m_x);
observation->m_target_z = ndBrainFloat(m_targetLocation.m_z);
observation->m_target_Azimuth = ndBrainFloat(m_targetLocation.m_azimuth);

//ndFloat32 angleError(CalculateDeltaTargetRotation(currentEffectorMatrix));
//observation->m_deltaRotation = ndBrainFloat(angleError);
Expand Down

0 comments on commit 134665e

Please sign in to comment.