NOT FINISHED YET!!! My first try to get a self built fully working Quadrocopter based on an mbed, a self built frame and some other more or less cheap parts.
Mixer/Mixer.cpp@29:8b7362a2ee14, 2012-12-15 (annotated)
- Committer:
- maetugr
- Date:
- Sat Dec 15 08:42:36 2012 +0000
- Revision:
- 29:8b7362a2ee14
- Parent:
- 28:ba6ca9f4def4
- Child:
- 30:021e13b62575
gyro only version running ESCs on 490Hz now
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
maetugr | 26:96a072233d7a | 1 | #include "Mixer.h" |
maetugr | 26:96a072233d7a | 2 | |
maetugr | 26:96a072233d7a | 3 | Mixer::Mixer() |
maetugr | 26:96a072233d7a | 4 | { |
maetugr | 26:96a072233d7a | 5 | for(int i=0; i<4; i++) |
maetugr | 26:96a072233d7a | 6 | Motor_speed[i]=0; |
maetugr | 26:96a072233d7a | 7 | } |
maetugr | 26:96a072233d7a | 8 | |
maetugr | 29:8b7362a2ee14 | 9 | void Mixer::compute(unsigned long dt, int Throttle, const float * controller_value) |
maetugr | 26:96a072233d7a | 10 | { |
maetugr | 26:96a072233d7a | 11 | // Calculate new motorspeeds |
maetugr | 28:ba6ca9f4def4 | 12 | |
maetugr | 28:ba6ca9f4def4 | 13 | for(int i=0; i<4; i++) |
maetugr | 28:ba6ca9f4def4 | 14 | Motor_speed[i] = Throttle; |
maetugr | 28:ba6ca9f4def4 | 15 | |
maetugr | 29:8b7362a2ee14 | 16 | Motor_speed[1] -= controller_value[0]; // Roll |
maetugr | 29:8b7362a2ee14 | 17 | Motor_speed[3] += controller_value[0]; |
maetugr | 29:8b7362a2ee14 | 18 | |
maetugr | 29:8b7362a2ee14 | 19 | Motor_speed[0] -= controller_value[1]; // Pitch |
maetugr | 29:8b7362a2ee14 | 20 | Motor_speed[2] += controller_value[1]; |
maetugr | 26:96a072233d7a | 21 | |
maetugr | 29:8b7362a2ee14 | 22 | #if 0 |
maetugr | 29:8b7362a2ee14 | 23 | Motor_speed[1] -= controller_value[2]; // Yaw |
maetugr | 29:8b7362a2ee14 | 24 | Motor_speed[3] -= controller_value[2]; |
maetugr | 29:8b7362a2ee14 | 25 | Motor_speed[0] += controller_value[2]; |
maetugr | 29:8b7362a2ee14 | 26 | Motor_speed[2] += controller_value[2]; |
maetugr | 29:8b7362a2ee14 | 27 | #endif |
maetugr | 26:96a072233d7a | 28 | |
maetugr | 26:96a072233d7a | 29 | for(int i = 0; i < 4; i++) // make shure no motor stands still |
maetugr | 26:96a072233d7a | 30 | Motor_speed[i] = Motor_speed[i] > 50 ? Motor_speed[i] : 50; |
maetugr | 26:96a072233d7a | 31 | } |