|
|
@ -358,6 +358,12 @@ int SITL_State::sim_fd(const char *name, const char *arg) |
|
|
|
} |
|
|
|
} |
|
|
|
terarangertower = new SITL::PS_TeraRangerTower(); |
|
|
|
terarangertower = new SITL::PS_TeraRangerTower(); |
|
|
|
return terarangertower->fd(); |
|
|
|
return terarangertower->fd(); |
|
|
|
|
|
|
|
} else if (streq(name, "sf45b")) { |
|
|
|
|
|
|
|
if (sf45b != nullptr) { |
|
|
|
|
|
|
|
AP_HAL::panic("Only one sf45b at a time"); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
sf45b = new SITL::PS_LightWare_SF45B(); |
|
|
|
|
|
|
|
return sf45b->fd(); |
|
|
|
} else if (streq(name, "richenpower")) { |
|
|
|
} else if (streq(name, "richenpower")) { |
|
|
|
sitl_model->set_richenpower(&_sitl->richenpower_sim); |
|
|
|
sitl_model->set_richenpower(&_sitl->richenpower_sim); |
|
|
|
return _sitl->richenpower_sim.fd(); |
|
|
|
return _sitl->richenpower_sim.fd(); |
|
|
@ -471,6 +477,11 @@ int SITL_State::sim_fd_write(const char *name) |
|
|
|
AP_HAL::panic("No terarangertower created"); |
|
|
|
AP_HAL::panic("No terarangertower created"); |
|
|
|
} |
|
|
|
} |
|
|
|
return terarangertower->write_fd(); |
|
|
|
return terarangertower->write_fd(); |
|
|
|
|
|
|
|
} else if (streq(name, "sf45b")) { |
|
|
|
|
|
|
|
if (sf45b == nullptr) { |
|
|
|
|
|
|
|
AP_HAL::panic("No sf45b created"); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
return sf45b->write_fd(); |
|
|
|
} else if (streq(name, "richenpower")) { |
|
|
|
} else if (streq(name, "richenpower")) { |
|
|
|
return _sitl->richenpower_sim.write_fd(); |
|
|
|
return _sitl->richenpower_sim.write_fd(); |
|
|
|
} else if (streq(name, "ie24")) { |
|
|
|
} else if (streq(name, "ie24")) { |
|
|
@ -686,6 +697,10 @@ void SITL_State::_fdm_input_local(void) |
|
|
|
terarangertower->update(sitl_model->get_location()); |
|
|
|
terarangertower->update(sitl_model->get_location()); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (sf45b != nullptr) { |
|
|
|
|
|
|
|
sf45b->update(sitl_model->get_location()); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
if (_sitl) { |
|
|
|
if (_sitl) { |
|
|
|
_sitl->efi_ms.update(); |
|
|
|
_sitl->efi_ms.update(); |
|
|
|
} |
|
|
|
} |
|
|
|