Small cleanup of terrain radar
This commit is contained in:
parent
c2040f30a2
commit
7800918499
3 changed files with 13 additions and 18 deletions
|
@ -179,7 +179,7 @@ agRadar::setAntennaPos() {
|
|||
}
|
||||
|
||||
void
|
||||
agRadar::setUserVec(int az, double el)
|
||||
agRadar::setUserVec(double az, double el)
|
||||
{
|
||||
float yaw = _user_hdg_deg_node->getDoubleValue();
|
||||
float pitch = _user_pitch_deg_node->getDoubleValue();
|
||||
|
@ -197,15 +197,11 @@ agRadar::setUserVec(int az, double el)
|
|||
|
||||
// and postrotate the orientation of the radar wrt the horizontal
|
||||
// local frame
|
||||
hlTrans *= SGQuatd::fromYawPitchRollDeg(yaw, pitch, roll);
|
||||
hlTrans *= SGQuatd::fromYawPitchRollDeg(yaw,
|
||||
pitch_stab ? 0 :pitch,
|
||||
roll_stab ? 0 : roll);
|
||||
hlTrans *= offset;
|
||||
|
||||
if (roll_stab)
|
||||
hlTrans *= SGQuatd::fromYawPitchRollDeg(0, 0, -roll);
|
||||
|
||||
if (pitch_stab)
|
||||
hlTrans *= SGQuatd::fromYawPitchRollDeg(0, -pitch, 0);
|
||||
|
||||
// now rotate the rotation vector back into the
|
||||
// earth centered frames coordinates
|
||||
SGVec3d angleaxis(1,0,0);
|
||||
|
@ -283,12 +279,11 @@ agRadar::update_terrain()
|
|||
_Instrument->setStringValue("status", status);
|
||||
_Instrument->setDoubleValue("limit-deg", az_limit);
|
||||
_Instrument->setBoolValue("heading-marker", hdg_mkr);
|
||||
|
||||
for(double brg = -az_limit; brg <= az_limit; brg += az_step){
|
||||
setUserPos();
|
||||
setAntennaPos();
|
||||
SGVec3d cartantennapos = getCartAntennaPos();
|
||||
|
||||
for(double brg = -az_limit; brg <= az_limit; brg += az_step){
|
||||
for(double elev = el_limit; elev >= - el_limit; elev -= el_step){
|
||||
setUserVec(brg, elev);
|
||||
SGVec3d nearestHit;
|
||||
|
|
|
@ -41,7 +41,7 @@ public:
|
|||
virtual void update (double dt);
|
||||
|
||||
void setUserPos();
|
||||
void setUserVec(int az, double el);
|
||||
void setUserVec(double az, double el);
|
||||
void update_terrain();
|
||||
void setAntennaPos();
|
||||
|
||||
|
|
|
@ -147,11 +147,11 @@ radAlt::update_altitude()
|
|||
|
||||
_min_radalt = max_range;
|
||||
|
||||
for(double brg = -az_limit; brg <= az_limit; brg += az_step){
|
||||
setUserPos();
|
||||
setAntennaPos();
|
||||
SGVec3d cartantennapos = getCartAntennaPos();
|
||||
|
||||
for(double brg = -az_limit; brg <= az_limit; brg += az_step){
|
||||
for(double elev = el_limit; elev >= - el_limit; elev -= el_step){
|
||||
setUserVec(brg, elev);
|
||||
|
||||
|
|
Loading…
Add table
Reference in a new issue