Improved State Estimation on PULP-based Nano-UAVs
Autonomous unmanned aerial vehicles (UAVs) are increasingly getting smaller and smarter. Their tiny form factor can be a game-changer in many practical applications such as aerial inspection or assistance in natural disaster areas, to name a few.
In this context, the parallel ultra-low-power (PULP) platform developed here at IIS, is the fundamental computational unit to bring state-of-the-art complex algorithms for autonomous navigation into the nano-scale class of vehicles. There are several embodiments of the PULP paradigm, one of them a system-on-chip (SoC) called Mr.Wolf. This SoC features 9 cores, divided into a fabric controller and a 8 core cluster with access to 2 floating-point units (FPUs).
To control any robot, there have to be three components implemented:
- State estimation current state A
- Intelligence next state B
- Actuation get from A to B
Previous work with the PULP-Shield, a tiny pluggable PCB, featuring a PULP-based SoC, focused on the intelligence, using a CNN to determine where to fly aboard a commercial Crazyflie 2.0 nano-drone. In this thesis, instead, we want to focus on the first component - the state estimation. To estimate where the drone is, we need to fuse the results of the on-board sensors to compute the position and attitude the drone is in. We want to use an extended Kalman filter (eKF), a non-linear estimator, for this task. This project will base the implementation of the eKF on the already used one on the Crazyflie.
The goal of this thesis is to port, optimize, and improve state estimation with a PULP SoC. Starting from the eKF used on the Crazyflie, we want to offload this compute-intensive task from the STM32 to a PULP SoC. This will allow us to incorporate even more sensor measurements into the eKF. The use case we want to implement is to improve the state estimation by also fusing ultra-wideband (UWB) range measurements. Figure 2 shows the resulting execution flow.
The resulting eKF can also be adopted on different PULP-based hardware designs.
- Semester Thesis by Marc Seger
- Supervisor: Hanna Mueller Vlad Niculescu Daniele Palossi
- Professor: Luca Benini
- Familiarity with C programming.
- Knowledge in control theory, especially recursive estimation, or willing to learn
- Basic knowledge of parallel programming and Host/Accelerator paradigm, or willing to learn
- Basic knowledge/experience in embedded programming favorable
- 20% Literature and theory study, familarization with existing code
- 60% C embedded programming (PULP programming/optimization)
- 20% Test and verification on the real prototype, report writing
Detailed Task Description
Meetings & Presentations
Weekly meetings will be held between the student and the assistants. The exact time and location of these meetings will be determined within the first week of the project in order to fit the students and the assistants schedule. These meetings will be used to evaluate the status and progress of the project. Beside these regular meetings, additional meetings can be organized to address urgent issues as well.
The main goal of this semester thesis is to accelerate the computation of the eKF on nano-drones at the example of a CrazyFlie equipped with a PULP-shield. The bonus goal is to improve the eKF, as we have a higher computational capability that enables the use of more sensors. The target application would be to allow UWB error correction, using Gaussian processes based models.
The approach we propose for this project is to extend a CrazyFlie with the computational capabilities offered by a PULP-based chip. Contrary to the previous work with the PULP-shield, we aim to use the academic Mr.Wolf PULP-SoC. This SoC features two FPUs on the 8-core cluster, and this enables accelerating the compute-intensive tasks of the flight controller in an ultra-low-power envelope.
On this platform, we can implement the matrix multiplications of the eKF to be executed in parallel, speeding up the execution.
The main tasks of this project are:
- T1: Designing and implementing a SPI bi-directional data transfer between Mr.Wolf and STM32, for exchanging sensor data and results
- T2: Porting the eKF used on the Crazyflie to Mr.Wolf (sequential execution on one core)
- T3: Verifying the eKF computation on PULP
- T4: Parallelization of the ekF
- T5: (optional) Fusing UWB range measurements into the eKF
- Communication protocol between PULP/STM32
- Sequential eKF implementation on PULP
- Parallel eKF implementation on PULP
- (optional) Parallel eKF with UWB on PULP
- Results: Power and performance measurements, accuracy evaluation
- Presentation and report including software documentation
To give some idea on how the time can be split up, we provide some possible partitioning:
- Familiarize with Crazyflie (CF) firmware (1 weeks)
- Implement data transfer between CF and PULP (1 week)
- Porting/Debugging/Verify the eKF to PULP (4 weeks)
- Parallelize PULP implementation (3 weeks)
- (optional) Fusing UWB range measurements into the eKF (2 weeks)
- Preparing thesis report and final presentation (2 weeks)
-  Crazyflie2.0 http://www.bitcraze.io/crazyflie-2/
-  D. Palossi et al., "A 64mW DNN-based Visual Navigation Engine for Au-tonomous Nano-Drones", in IEEE Internet of Things Journal, 2019. doi:10.1109/JIOT.2019.2917066
-  D. Palossi, F. Conti and L. Benini, "An Open Source and Open Hardware DeepLearning-Powered Visual Navigation Engine for Autonomous Nano-UAVs", 2019 15thInternational Conference on Distributed Computing in Sensor Systems (DCOSS),Santorini Island, Greece, 2019, pp. 604-611. doi: 10.1109/DCOSS.2019.00111
-  PULP Project http://iis-projects.ee.ethz.ch/index.php/PULP
-  A. Pullini, D. Rossi, I. Loi, A. Di Mauro and L. Benini, "Mr. Wolf: A 1 GFLOP/sEnergy-Proportional Parallel Ultra Low Power SoC for IOT Edge Processing", ES-SCIRC 2018 - IEEE 44th European Solid State Circuits Conference (ESSCIRC),Dresden, 2018, pp. 274-277. doi: 10.1109/ESSCIRC.2018.8494247
-  M. Mueller, M. Hamer, R. D’Andrea,"Fusing ultra-wideband range measurementswith accelerometers and rate gyroscopes for quadrocopter state estimation" 2015IEEE International Conference on Robotics and Automation (ICRA)
-  A. Ledergerber, R. D’Andrea, "Ultra-wideband range measurement model with Gaus-sian processes", 2017 IEEE Conference on Control Technology and Applications(CCTA),2017, pp. 1929-1934.