This is a complete rework of the navigation for rotorcraft with the key features:
- all nav functions and interface in float
- nav function are registered (decoupling between nav API and implementation of standard pattern)
- submodes to specify if setpoint is a position (legacy), speed or accel (better integration of algorithms like GVF)
- guidance (H and V) is reorganized with default function to implement (run_pos, run_speed, run_accel)
- guidance control (the old default PID) is separated from the guidance logic
---------
Co-authored-by: Freek van Tienen <freek.v.tienen@gmail.com>
* [cleaning] removing some old stuff
- infrared sensors and related ahrs
- mkk and asctec actuators
- old carto modules
- fix bebop actuators for NPS
- clean airframe and conf
* [conf] add back asctec_v2 actuators that is still being used
* [abi] Add timestamp to AGL and BARO_ABS
* [make] Add support for c++0x for all architectures
* [math] Add air density calculation
* [gps] Add horizontal and vertical position accuracy
* [boards] PX4FMU change default baudrate and add SBUS
* [ins] Add EKF2
* [tests] Add Bebop2 with EKF2
* [nps] Fix jsbsim simulator initialisation and GPS accuracy
* [cleaning] remove PBN module
* [cleaning] remove ENOSE module
* [cleaning] update ENAC conf
* Cleaning on flight plans
* [cleaning] clean example and test conf
* add gazebo to the install step and compile example airframe
* Setup code for Gazebo
Currently only partially initializes the fdm struct, which produces
incorrect results in the GCS.
Compilation, however, already seems to work as expected!
Next step is to fetch data from Gazebo.
* Closed-loop flight in Gazebo
Finished the first implementation of the Gazebo FDM. It is now possible
to perform closed-loop flights using Paparazzi together with Gazebo.
Look at the example_ardrone2.xml airframe file for the required gazebo tags.
The following modifications are made:
- change fdm type to "gazebo"
- add definitions for ACTUATOR_THRUSTS and ACTUATOR_TORQUES. These were
obtained from the JSBsim ardrone model. The oredr is the same as the
ACTUATOR_NAMES.
The Gazebo world needs an aircraft model that is (by default) named
"paparazzi_uav". This model should include links with the names listed
in ACTUATOR_NAMES in the airframe file, as these are used to apply
forces on the quadrotor.
Known bugs:
- No fixed wing aircraft yet.
- Not all fields in the fdm struct are set. Most of the atmosphere
fields are not implemented yet.
- AHRS and INS need to be bypassed, these do not yet work correctly.
- No quadrotor models are supplied with paparazzi yet (although it is
included in the example world file).
* Added cameras, but sensor update causes crash
As in the quick standalone examples, gazebo regularly crashes when
cameras are used.
This is an intermediary commit where most of the camera infrastructure
is present, but not functional yet because of an unknown bug regarding
Gazebo.
* Simplified problem, located crash
Crash occurs when gazebo::sensors::run_once() is called during
the fdm update step. The exception (Ogre internal exception,
cannot create GL vertex buffer) only occurs after the main loop
has been performed a few times (10-20x typically).
Ignoring the error by catching the exception does not make it go
away.
* Add ogre to fdm_gazebo makefile
* Further changes for debugging, not fixed yet
* FIX bug
Turns out that fdm_init and fdm_run_step are not running in the same
thread, which apparently caused some problems with Gazebo.
The gazebo initialization code that starts the server is now moved
to the run_step function, and cameras work fine now.
Next step is to get the images from Gazebo to the video_thread_nps module.
* Transport images to Paparazzi
Added code that converts Gazebo's RGB888 images to Paparazzi's
YUV422 format, and calls the registered video callbacks.
* Finish video streaming
Finished video streaming. Video streaming in the paparazzi master
branch does not seem to work in simulation or even on a real ardrone.
Therefore, reverted to v5.10 viewvideo.c and rtp.c and now the streaming
works correctly.
* Separate UAV model from world.
Added a models/ directory to conf/simulator/gazebo, now the UAV model
can be included in the world file. The models/ dir is added to Gazebo's
search paths when the server is launched, so it does not require
any additional steps from the user.
* Move Gazebo modifications from examples/ardrone2.xml to examples/ardrone2_gazebo.xml
Reverted changes to the original airframe and moved these to a
separate example.
* Remove .sdp file
Remove .sdp file that should not have been included with commits.
* Move changes in conf_example.xml to separate entry
Moved the changes to conf_example.xml (selected flightplan, modules etc.)
to a separate etry named 'ardrone2 (Gazebo)'.
* Clean up changes to computer_vision module
- Removed unused viewvideo_nps.c.
- Add doc comments in video_thread_nps.c
* Fix bug in conf_example
Spaces in aircraft name caused compilation error, changed to
'ardrone2_gazebo'.
* Fix duplicate ac_id in conf_example
* Remove debug code from nps_fdm_gazebo.cpp and add comments
* Reduce weight of cameras
Cameras weighed 10 grams, which was quite much. Now reduced to 1 gram.
* Fix camera not active
During the cleanup of the ardrone gazebo model, the always_on tag
was removed. Now, the cameras are activated during gazebo_video_init
Also removed further debug code from nps_fdm_gazebo.cpp.
* Restore master branch video streamer and rtp encoder
The streamer of the master branh does not work correctly atm, but
this will be moved to a separate issue.
* Fix compilation warnings
Fixed all compilation warnings (tested with Gazebo 8).
Unused arguments are now marked as such.
The NPS makefile is modified to use CXXFLAGS in addition to CFLAGS,
which solves the std=c++11 related warnings.
fdm_gazebo.cpp now ignores deprecated warnings, as all of these
come from Gazebo. Not the cleanest solution, but it works for now.
* Add documentation to fdm module xml and add copyright notices where appropriate
* Fix code style
Fixed code style using the tool included with paparazzi.
* Fix missing model.config
.gitignore caused the model.config files for the Gazebo models to
be excluded from the commit. Added an exception to .gitignore and
added the missing file.
* Fix INS by adding placeholder atmospheric data values
Added placeholder values to the atmospheric section of the NPM
struct. These should be valid for low altitude, low speed flights.
Previously, these values were uninitialized which caused INS to fail
(incorrect altitude estimates). With these placeholder values,
the INS works ok and no longer needs to be bypassed.
* Fix makefile targets in video_rtp_stream and cv_colorfilter
(Re)added target="ap|nps" attribute to the module .xml files.
Use the main periodc freq timer for modules if the freqs are the same
This is e.g. useful to log the important values every time the control loop runs.
should fix#1923
* [imu] convert imu subsystems to modules
Also
- get rid of explicit imu init|event|periodic calls in main
- each imu implementation has their own imu_x_init/event/periodic
* [imu] fix some imu modules
* [imu] fix bad paths
* [imu] add imu_common module that every implementation autoloads
and put body_to_imu settings in imu_common module
* [imu] fix imu_ardrone2
* [conf] add imu_common settings module in conf_example and conf_tests
This pull request is for the guidance algorithms used to control hybrid drones like the Quadshot and MavShot. It supports autonomous waypoint navigation as well as "forward-flight". The code was flight tested in autonomous waypoint navigation mode, including autonomous landing (using sonar).
This pull request allows you to use both the front camera and the bottom camera on the bebop, and to run optical flow on the bottom camera while running something else on the front camera.
- modules can call cv_add_to_device(&camera, fun) to register the callback fun for the specified camera with the video thread
- use a linked list with listeners for the video
- saving jpeg encoded shots is now in a separate video_capture module
This will change the effect of the gains (depending on the type), but should be finally correct.
Especially the yaw commands have about half the effect now...
Jesús Bautista Villar
Angel-HF
Freek van Tienen
Gautier Hattenberger
Tom van Dijk
kirkscheper
knmcguire
tomvand
Michal Podhradsky
Felix Ruess
Christophe De Wagter
Deon Blaauw
Roland Meertens
Michal Podhradsky
Piotr Esden-Tempski