yenon/ROS_Workspace
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Add way of keeping heading if no target Quaternion is given.

Browse Source
This commit is contained in:
Bastian Hofmann 2023-03-15 09:10:51 +00:00
parent b654b06945
commit 3be6dee6b8
1 changed files with 9 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/ign_actor_plugin/src/ActorSystem.cpp
View File

@ -173,6 +173,15 @@ void ActorSystem::PreUpdate(const UpdateInfo &_info, EntityComponentManager &_ec
movementDetails.moveDuration = 0.0; movementDetails.moveDuration = 0.0;
} }
if(
movementDetails.target.Rot().W() == 0 &&
movementDetails.target.Rot().X() == 0 &&
movementDetails.target.Rot().Y() == 0 &&
movementDetails.target.Rot().Z() == 0
){
movementDetails.target.Rot() = movementDetails.targetDiff.Rot();
}
movementDetails.rotateToEndDuration = Angle(movementDetails.targetDiff.Rot(),movementDetails.target.Rot()) / turnSpeed; movementDetails.rotateToEndDuration = Angle(movementDetails.targetDiff.Rot(),movementDetails.target.Rot()) / turnSpeed;
} }