After having spent hours focusing on our PID into the Télécom ParisTech’s dancing room, we joined Télécom Robotic’s room in order to work on our implementation of Lucas and Kanade algorithm, because of a giant chessboard in green and red, perfect for image processing. We fixed Copterix in the air using some strings, and started test, with or without threshold, and it wasn’t really efficient…
We thought a moment about using ‘unfisheye’ opencv’s algorithm (see joined photo to understand why we wanted to use it), but it took 0.6 seconds per frame on our Gumstix…
Then we stopped and decided we should decide exactly how, even if it worked, Lucas and Kanade would help us to correct Copterix’s drift.
As we have 10 frames per second when processing the algorithm, it will be really difficult to determine in real time if we actually corrected the drift whenever we would want to correct it, and that is why we imagined the following algorithm:
- wait for Copterix to be horizontal (pitch and yaw < epsilon)
- take a reference picture and search the good features to track on it (quite heavy operation)
- while Copterix is horizontal (pitch and yaw < epsilon)
- ____take a picture, compare it with reference
- ____if not horizontal (pitch and yaw >= epsilon)
- ______wait for Copterix to be horizontal (pitch and yaw < epsilon)
- ______go to 3.
- ____if drift is big enough (move size > threshold)
- ______go to 12.
- ____if we don’t find enough features to track
- ______go to 1.
- ask PID to incline Copterix toward the good direction (we have to decide an angle)
- wait a chosen time (we have to be over-precise on this data)
- ask PID to set Copterix horizontal
- go to 1.
The real difficulty of this algorithm is that it infers we do own a powerful and precise PID, able to remain horizontal most of the time, and to follow an order in the better and faster possible way, which is of course not true.
That is why we are now considering the fact that we may not have time to have a excellent PID AND implement such a precise algorithm; we will talk about it tomorrow with our teachers.
Sur le même sujet :