Closed mmmfarrell closed 5 years ago
I assume this is working. Do you mind if I steal it for rosflight_sim
?
@superjax Of course, go for it. I wouldn't say this is the best way to simulate GPS, but it works with roscopter
right now, so its a good first pass.
Some fixes I realized we need while I was working on the roscopter estimator
@BillThePlatypus, per our conversation about Gazebo
WORLD
vsRELATIVE
frame, I couldn't find anything that convinced me either way ifGetWorldLinearVel
andGetLinearVel
both would give me the same velocity or not. But I think thatWorld
is more intuitive thanRelative
when it comes to velocities in the Inertial Frame. And this seems to work correctly.Also, I did not fix how the velocity is calculated for the NavSatFix message because there has been a belief that ROSPlane should match what is in the "Small Unmanned Aircraft" book as closely as possible. The method that is currently used to compute the GPS Velocity for the NavSat message comes straight from the book. This was probably pretty accurate when the book was published, but modern GPS receivers use Doppler shift for velocity. See https://insidegnss.com/wp-content/uploads/2018/01/marapr15-SOLUTIONS.pdf