DIY quadcopter : get the attitude

In my previous article about my quadcopter, I described my project. Now comes the first step where I explain how to get pitch, roll and yaw information from my inertial measurement unit (IMU) on my Arduino card.

For this part, I will be only using the accelerometer and the gyroscope of my MPU9150 (so it’s the same as a MPU6150).

Zoom on the MPU9150 which is the IMU used in my project

Zoom on the MPU9150, the IMU used on my quadcopter

We’ll first see why we need both an accelerometer and a gyroscope, then I’ll give you my wiring and finally I will talk quickly about the fusion algorithm.

Why do we need accelerometer AND gyroscope ?

To answer to this question, you need to understand what kind of information is given by the accelerometer and the gyroscope.

The accelerometer will measure acceleration, and in our case we are interested by the acceleration caused by gravity. If your sensor is not moving it will give you a 3D vector pointing at the ground, so you can know your attitude (pitch, roll and yaw). This is what is used in your smartphone to rotate what is displayed on your screen when you tilt your phone. Unfortunately, an accelerometer is sensible to movement and vibrations which are two elements that you have on a drone so you can’t use it alone.

The gyroscope will measure an angle velocity on every axis. By integrating this, you will be able to know what is your attitude. But you have to know your first attitude at the beginning (either by starting on a known position or by using data from another system like an accelerometer of course !). The gyroscope comes with another problem : it tends to drift over time so you need to reset its position from time to time.

This graph shows you calculated roll of my sensor if you only use an accelerometer or a gyroscope :

Gyroscope versus accelerometer

Gyroscope versus accelerometer

You can see that the accelerometer is noisy and that the gyroscope drift at the end. The point of a fusion algorithm is to get the advantages of both sensors in order to have a nice attitude indication.

Wiring to the Arduino

Like most of the IMU sensors, the MPU9150 is using the I2C port. This bus is quite useful because it is using only two wires for data (actually one for data and one for the clock). You can also connect multiple devices on the same port. For instance you can easily add a barometer to get your altitude.

The wiring is quite simple, VCC to 3.3V (check your sensor datasheet, it can change from one manufacturer to an other). GND to GND of course and SDL (data line) to A4 and SCL (clock line) to A5.

If like me you never remember if A5 is for data or clock, here is a stupid mnemonic trick : the clock is always ticking fast, so it  the greater number is for the clock (SCL -> A5).

I2C wiring (made with fritzing)

I2C wiring (made with fritzing)

You need one more thing to make it work correctly. As you can see there are some resistors on the schematic above : those are called pull-up resistors. Thanks to them the signal is less sensible to interferences.

The sensor can work without pull-up resistors, but as soon you as you have interferences your code can freeze. This is what happened with my drone. When the motors were disconnected everything was going fine. But when I did the same tests with the motor turning my program was freezing … which can be inconvenient when you’re building a flying drone ! This is because the brushless motors are creating electrical interferences on the I²C wires.

Fusion and code

Once your sensor is connected, you can start reading the values from it in order to have the information you are looking for. You have two solutions :

  • Implement your own fusion algorithm. It is hard to do it but it can be done using kalman filter. Unfortunately this is beyond my capacity (for now … 🙂 ). You can also implement easier but still good methods like the complementary filter. This is well explained on this website.
  • The other solution is easier, this is why I prefer it ! Nowadays some chips have bult-in calculation system which will take care of the fusion. Not only does this spares you some work but also the calculation is done by the IMU itself and not your Arduino. Here is the code that I use to get this information : link.

Conclusion

So far we’ve seen how to get the attitude of you drone which is a very important information to have when controlling a quadcopter. But there is still a lot of work to do.

I have already implement other features on my drone, it is almost ready to make its first flight ! In the future I will explain other important part of the development of my flight controller (reading RX signal, PID controll of the motors etc …)

Advertisements

2 thoughts on “DIY quadcopter : get the attitude

  1. Stephen says:

    Did you ever manage to get it up and flying? Im about to begin building my own arduino flight controller and would love to read your progress. Ive just completed the full construction of my quadcopter (frame, motors, ESC’s etc)

    Like

    • No only crashes for now … I have a stable attitude from the sensors when the motors are not turning, but when they are turning there is too much noise that I need to filter (physically and in the code). I’m also switching from one project to an other in order to have a better view of my project when I work on it (when you spend too much time in a row on a project you tend to not see stupid mistakes). I’ll try to write other articles about my drone.
      Good luck with your project 😉

      Like

Leave a comment

Fill in your details below or click an icon to log in:

WordPress.com Logo

You are commenting using your WordPress.com account. Log Out / Change )

Twitter picture

You are commenting using your Twitter account. Log Out / Change )

Facebook photo

You are commenting using your Facebook account. Log Out / Change )

Google+ photo

You are commenting using your Google+ account. Log Out / Change )

Connecting to %s