Hi all, I have a new drone in the family...
This tiny drone is able to do completely automatic flights, it can perform altitude hold (based on sonar sensor) and obstacle avoiding based on IR distance sensors (you could see the "black stange eyes" on the photo). It´s your personal droid...
Look at the video (the "tennis game" part it´s funny. Thanks to Ramon for the idea!!)
There are some new features in this thrid part... This is the list:
For outdoor configuration:
- GPS library support (actually UBLOX or NMEA)
- Position hold based on GPS
For indoor configuration:
- 4x IR distance sensors to detect obstacles (1.5m range)
- Obstacle avoiding (using distance sensors)
Common:
- Altitude hold based on Sonar (LV-EZ0)
- Automatic flight pattern (experimental).
--- Automatic takeoff
--- Position hold [outdoor] or obstacle avoiding [indoor] during a predefined time
--- Automatic descend
--- Automatic landing
- Added XBee for telemetry (and debug)
And some improvements in the code:
- New "radio test mode" to test radio equipment
- Revised control routines
Development
For the GPS position hold I had to implement the navigation algorithms for the quadcopter because it´s really different that the one used for planes...For this navigation it´s necesary to have the magnetometer to cancel the yaw drift in hover conditions. One thing I have observed is that you can only fly this tiny drone on very calm days because it´s too light for the wind... so it´s better suitted as an indoor drone. Then I started to think how to make a cheap way to navigate on indoor enviroments... I have one sharp IR disntace sensor so I start making some tests mounting the sensor in a servo to make a 180º scan. The idea was to mount 2 (or 4) of this sensors in the moving head.
On the tests I found that in this little machine the moving head caused some inestability, so I decided to mount 4 sensors in a fixed way. OK, this the cheap DIY version of an EXPENSIVE laser range finder, but it works...
there are many thing to improve and test, but it´s a promising start...
Details
Sonar module is an LV-EZ0. Because we don´t have any analog input available I use the PWM interface in a Port Change pin (PCINT20) to use an interrupt to read the sensor. (It´s recommended some solder skills to make this modification).
For the IR range finder (Sharp GP2Y0A02) I needed to use a separate Arduino Pro mini (again we don´t have any analog input free). This module connects to the ArduIMU via Serial port so we need to choose between GPS of range finder (outdoor-indoor decision).
On this III part, the hardware (ArduIMU) really show it´s limits... it´s not a problem of CPU power, it´s a problem of the limited I/O as I said before, so it´s time to move to the big brother, the new ArduPilot Mega Hardware... this new platform will be fantastic for this projects...
Behind the scenes
During the test of position hold I have some crashes (nothing important, only some broken propellers...) and there was a moment in that the quad performs not so good, so I start searching the reason. Again I suspect that it could be a vibrations problem so I decided to make a modified code to test the vibration on each motor.
As you can see I have problems on left motor, so I change this prop, also add a new layer of doubled sided foam tape to the ArduIMU and problem gone.
The code is here: Quad1_mini_test_motor_vibrations.zip (If you want to use it read the instrucctions)
Respect to the IR distance sensor, the first version was a moving head with a servo but this had some problems with vibrations that affect stability and also has a poor scanning rate, here is a photo of this prototype. Finally I decided to use 4 fixed sensors.
Codes
Some parts of this codes are still experimental but you can get it here:
Outdoor code (GPS): Quad_mini_1_27.zip . GPS libraries : GPS_libraries.zip
Indoor code (IR sensors): Quad_mini_1_29_rangefinder.zip External Arduino pro mini code: IR_distance1.zip
Old posts of this project: http://www.diydrones.com/profiles/blogs/arduimu-quadcopter-part-ii
Jose.
Comments
you did good job and amazing!!!
could you attach more detail pictures.
I fixed my board and is alive.
now try quadcopter part III
Furthermore, that was my first test. I need to do a lot of tests with large buffers, etc. If it really does the job as it promises, I will share it with the DIY Drones community. I'm totally newbie on those things but I'm working a lot to learn the most that I can. So, by sharing it, I'm sure that the improvements will go one thousand miles from my vision. I know the risk of being very ingenuous in a sort of times... but OK. Is the way that children go through for learn a lot in short time. :)
if outside perfrming is bad then is notvery usefull for GPS navigation, thats a bit bad, but anyway... looks very good and sexy
So, I'm using the SPI hardware to controlling the communication. I defined an delay of 1usec per byte on Master with a clock prescale of 4Mhz (16Mhz/4) on SPI Control Registers. This is the result:
bit per sec on spi: 4000000 (theoretical 4Mbps with SCK at 4Mhz)
sec per bit on spi: 0,00000025 (0,25usec)
delay per bit on master: 0,000000125 (0,125usec -> delay per byte / 8)
sec per bit + delay: 0,000000375 = 3,75Mbps (real speed)
Man, at this speed, We can transport the entire binary IMU buffer on an SPI session with less than 60usec... :)
So I ask you... Why not move the flying control to a generic board and use the ArduIMU only for attitude reading? By this way we would use the latest unmodified ArduIMU firmware (with an SPI transportation class included on newest versions, of course).
For the last two years I have been closely following up your virtually daily posts and video of your Quadrocopter.
So what you have been up there ?
Regards
Rana
Sandro, you are right! it would be more easy. The problem is that I implemented first the sonar (I didn`t know that I would need an Arduino Pro mini at this moment...) and then I started to play with the distance sensors...
Jose.
Congratulations!
- Amir
Actually implementing i2c escs should be rather easy it also gives full scale adjustment.
you still spinning all props to same direction or did you implement counter rotation already?
--jp
Jack, this sensors works nice for this application but also has some problems, for example it fails on windows and mirrors (there are light sensors). I think I need a minimun of 4 because this quad could move on all directions...
Dave, I agree with you, it could be possible...
Jani, I have not measured cpu usage but I know that my main loop executes at 70Hz wihout problems and probably more (100hz).
Loris, I´m only made 2 or 3 test of the GPS position hold. I could see that the algorithm works but I need to adjust better the control gains. I will make this tests with a bigger prototype. As I said, you need a very calm day to test things outside with this one.
Jeff, the Arduino Pro mini is connected to the four IR sensors to read the analog signals and send to the main board (via serial port) but all the processing stuff it´s inside the ArduIMU.
Jose.