Skip to content

HotFix error application on odom rot#54

Merged
prony5 merged 2 commits intomasterfrom
hotfix-error-on-rotation
Jan 13, 2025
Merged

HotFix error application on odom rot#54
prony5 merged 2 commits intomasterfrom
hotfix-error-on-rotation

Conversation

@Sh1co
Copy link
Contributor

@Sh1co Sh1co commented Dec 13, 2024

No description provided.

@Sh1co Sh1co requested a review from prony5 December 13, 2024 13:07
data.pose.pose.orientation.y += GaussianNoise.Generate(rotationNoiseStdDev);
data.pose.pose.orientation.z += GaussianNoise.Generate(rotationNoiseStdDev);
data.pose.pose.orientation.w += GaussianNoise.Generate(rotationNoiseStdDev);
var euler = data.pose.pose.orientation.FromRos().eulerAngles;
Copy link
Collaborator

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

var qNoise =Quaternion.Euler(
new Vector(GaussianNoise.Generate(rotationNoiseStdDev),
new Vector(GaussianNoise.Generate(rotationNoiseStdDev),
new Vector(GaussianNoise.Generate(rotationNoiseStdDev),
));

data.pose.pose.orientation *= qNoise;

@Sh1co Sh1co requested a review from prony5 January 9, 2025 09:58
@prony5 prony5 merged commit e6264fa into master Jan 13, 2025
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

2 participants