MultiWii

Solokirrik
skyrider:

Можно попробовать желтые провода местами поменять.


/* Set the minimum throttle command sent to the ESC (Electronic Speed Controller)
   This is the minimum value that allow motors to run at a idle speed  */
//#define MINTHROTTLE 1300 // for Turnigy Plush ESCs 10A
#define MINTHROTTLE 1120 // for Super Simple ESCs 10A
//#define MINTHROTTLE 1190

/* The type of multicopter */
//#define GIMBAL
//#define BI
//#define TRI
//#define QUADP
#define QUADX
//#define Y4
//#define Y6
//#define HEX6
//#define HEX6X
//#define FLYING_WING //experimental

#define YAW_DIRECTION 1 // if you want to reverse the yaw correction direction
//#define YAW_DIRECTION -1

#define I2C_SPEED 100000L     //100kHz normal mode, this value must be used for a genuine WMP
//#define I2C_SPEED 400000L   //400kHz fast mode, it works only with some WMP clones

#define PROMINI  //Arduino type
//#define MEGA

//enable internal I2C pull ups
#define INTERNAL_I2C_PULLUPS

//****** advanced users settings   *************

/* Failsave settings - added by MIS
   Failsafe check pulse on THROTTLE channel. If the pulse is OFF (on only THROTTLE or on all channels) the failsafe procedure is initiated.
   After FAILSAVE_DELAY time of pulse absence, the level mode is on (if ACC or nunchuk is avaliable), PITCH, ROLL and YAW is centered
   and THROTTLE is set to FAILSAVE_THR0TTLE value. You must set this value to descending about 1m/s or so for best results.
   This value is depended from your configuration, AUW and some other params.
   Next, afrer FAILSAVE_OFF_DELAY the copter is disarmed, and motors is stopped.
   If RC pulse coming back before reached FAILSAVE_OFF_DELAY time, after the small quard time the RC control is returned to normal.
   If you use serial sum PPM, the sum converter must completly turn off the PPM SUM pusles for this FailSafe functionality.*/
#define FAILSAFE                                  // Alex: comment this line if you want to deactivate the failsafe function
#define FAILSAVE_DELAY     10                     // Guard time for failsafe activation after signal lost. 1 step = 0.1sec - 1sec in example
#define FAILSAVE_OFF_DELAY 200                    // Time for Landing before motors stop in 0.1sec. 1 step = 0.1sec - 20sec in example
#define FAILSAVE_THR0TTLE  (MINTHROTTLE + 200)    // Throttle level used for landing - may be relative to MINTHROTTLE - as in this case


/* The following lines apply only for a pitch/roll tilt stabilization system
   It is not compatible with Y6 or HEX6 or HEX6X
   Uncomment the first line to activate it */
//#define SERVO_TILT
#define TILT_PITCH_MIN    1020    //servo travel min, don't set it below 1020
#define TILT_PITCH_MAX    2000    //servo travel max, max value=2000
#define TILT_PITCH_MIDDLE 1500    //servo neutral value
#define TILT_PITCH_PROP   10      //servo proportional (tied to angle) ; can be negative to invert movement
#define TILT_ROLL_MIN     1020
#define TILT_ROLL_MAX     2000
#define TILT_ROLL_MIDDLE  1500
#define TILT_ROLL_PROP    10

/* I2C gyroscope */
//#define ITG3200
//#define L3G4200D

/* I2C accelerometer */
//#define ADXL345
//#define BMA020
//#define BMA180
//#define NUNCHACK  // if you want to use the nunckuk as a standalone I2C ACC without WMP

/* I2C barometer */
//#define BMP085

/* I2C magnetometer */
//#define HMC5843
//#define HMC5883

/* ADC accelerometer */ // for 5DOF from sparkfun, uses analog PIN A1/A2/A3
//#define ADCACC

/* The following lines apply only for specific receiver with only one PPM sum signal, on digital PIN 2
   IF YOUR RECEIVER IS NOT CONCERNED, DON'T UNCOMMENT ANYTHING. Note this is mandatory for a Y6 setup
   Select the right line depending on your radio brand. Feel free to modify the order in your PPM order is different */
//#define SERIAL_SUM_PPM         PITCH,YAW,THROTTLE,ROLL,AUX1,AUX2,CAMPITCH,CAMROLL //For Graupner/Spektrum
//#define SERIAL_SUM_PPM         ROLL,PITCH,THROTTLE,YAW,AUX1,AUX2,CAMPITCH,CAMROLL //For Robe/Hitec/Futaba
//#define SERIAL_SUM_PPM         PITCH,ROLL,THROTTLE,YAW,AUX1,AUX2,CAMPITCH,CAMROLL //For some Hitec/Sanwa/Others

/* interleaving delay in micro seconds between 2 readings WMP/NK in a WMP+NK config
   if the ACC calibration time is very long (20 or 30s), try to increase this delay up to 4000
   it is relevent only for a conf with NK */
#define INTERLEAVING_DELAY 3000

/* for V BAT monitoring
   after the resistor divisor we should get [0V;5V]->[0;1023] on analog V_BATPIN
   with R1=33k and R2=51k
   vbat = [0;1023]*16/VBATSCALE */
#define VBAT              // comment this line to suppress the vbat code
#define VBATSCALE     131 // change this value if readed Battery voltage is different than real voltage
#define VBATLEVEL1_3S 107 // 10,7V
#define VBATLEVEL2_3S 103 // 10,3V
#define VBATLEVEL3_3S 99  // 9.9V

/* when there is an error on I2C bus, we neutralize the values during a short time. expressed in microseconds
   it is relevent only for a conf with at least a WMP */
#define NEUTRALIZE_DELAY 100000

/* this is the value for the ESCs when thay are not armed
   in some cases, this value must be lowered down to 900 for some specific ESCs */
#define MINCOMMAND 1000

/* this is the maximum value for the ESCs at full power
   this value can be increased up to 2000 */
#define MAXTHROTTLE 1850

/* This is the speed of the serial interface. 115200 kbit/s is the best option for a USB connection.*/
#define SERIAL_COM_SPEED 115200

/* In order to save space, it's possibile to desactivate the LCD configuration functions
   comment this line only if you don't plan to used a LCD */
#define LCD_CONF

/* to use Cat's whisker TEXTSTAR LCD, uncomment following line.
   Pleae note this display needs a full 4 wire connection to (+5V, Gnd, RXD, TXD )
   Configure display as follows: 115K baud, and TTL levels for RXD and TXD, terminal mode
   NO rx / tx line reconfiguration, use natural pins */
//#define LCD_TEXTSTAR

/* motors will not spin when the throttle command is in low position
   this is an alternative method to stop immediately the motors */
//#define MOTOR_STOP

/* some radios have not a neutral point centered on 1500. can be changed here */
#define MIDRC 1500

/* experimental
   camera trigger function : activated via AUX1 UP, servo output=A2 */
//#define CAMTRIG
#define CAM_SERVO_HIGH 2000  // the position of HIGH state servo
#define CAM_SERVO_LOW 1020   // the position of LOW state servo
#define CAM_TIME_HIGH 1000   // the duration of HIGH state servo expressed in ms
#define CAM_TIME_LOW 1000    // the duration of LOW state servo expressed in ms

/* you can change the tricopter servo travel here */
#define TRI_YAW_CONSTRAINT_MIN 1020
#define TRI_YAW_CONSTRAINT_MAX 2000
#define TRI_YAW_MIDDLE 1500

//****** end of advanced users settings *************
soliada

Вопрос к Гуру в области характеристик датчиков. Для гироскопа L3G4200D есть таблица
Table 22. DR and BW configuration setting
DR <1:0> BW <1:0> ODR [Hz] Cut-Off
00 00 100 12.5
00 01 100 25
00 10 100 25
00 11 100 25
01 00 200 12.5
01 01 200 25
01 10 200 50
01 11 200 70
10 00 400 20
10 01 400 25
10 10 400 50
10 11 400 110
11 00 800 30
11 01 800 35
11 10 800 50
11 11 800 110

На что влияют,точнее что значат эти величины ODR [Hz] Cut-Off ?
Full Scale selection.
(00: 250 dps; 01: 500 dps; 10: 2000 dps; 11: 2000 dps) Какую чувствительность необходимо выставить?

mahowik

Всем привет!

Рад поделиться новостью. Облетал сегодня MultiWii_dev_20111017. Наконецто стаб. мод. стал менее чувствительным к вибрациям и вполне (очень!!!) летабельным. Ура!!! 😃

www.multiwii.com/forum/viewtopic.php?f=8&t=793&sta…

soliada
soliada:

Вопрос к Гуру в области характеристик датчиков. Для гироскопа L3G4200D есть таблица
Table 22. DR and BW configuration setting

Сам спросил-сам отвечу. ODR [Hz] Частота опроса датчика.Величина Cut-Off пока загадка.Пробовал разные для одинаковой частоты,разници не заметил.
250 dps оказался самый чувствительный вариант.

mahowik
soliada:

Величина Cut-Off пока загадка

это частота среза НЧ фильтра… чем ниже тем лучше - меньше чувствителность к вибрациям…
к примеру для бма180 - 10гц, для бма020 - 25гц (т.к. это нижнее значение для этого датчика) + потом в ИМУ еще цифровым фильтром подрезается, т.е. реално на аксель в сумме частота среза 2-5гц (в последних дев прошивках).

Razek
kergo:

держатели балки на раме , на мотормаунтах

А подскажите под какой диаметр эти держатели балки?

devv:

Может кто укажет направление где почитать/посмотреть подробную схему подключения платки AllInOne к Arduino и настройки MultiWii ?

Да они все одинаково подключаются на разных платформах
Ардино - AllinOne
GND -> CLK Gyro
A4 -> SDA
A5 -> SCL
5V -> 5V
GND -> GND

только это для платы Allinone c LLC (5v) если без LLC (3.3v) то его надо отдельно цеплять

devv
Razek:

Да они все одинаково подключаются на разных платформах

спасибо
меня больше интересовало обозначение контактов на платке
нашел вот схемку
успокоился на время. Перечитываю тему с 1 стр. дошел пока до 76
Многое прояснилось. Есть вопросы по GUI и вкл/выкл стабилизации но думаю разберусь как скидаю железо.

Razek:

GND -> CLK Gyro

А это зачем ?
На фото виденные в инете первый разъем не трогает народ

devv
alexmos:

Насчет платки ALLINONE - припаял вывод гиры к земле сразу как рекомендовали на её страничке.

кто рекомендует и на какой страничке ?

soliada
mahowik:

это частота среза НЧ фильтра… чем ниже тем лучше - меньше чувствителность к вибрациям…

Спасибо,теперь понятно. Пробовал разные значения ODR и Сut-Off. Чисто субъективно особой разницы не чувствуется,вероятно надо настраивать и значения ПИД,но ИМХО лучше всего ODR100 Cut-Off 12.5 и ODR400 Cut-Off20(дефолтное значение).
Вот код,если кто-то использует такой гироскоп и хочет попробовать.В принципе в даташите есть таблица,пункт 7.2, какие биты для какой частоты выставлять в CTRL_REG1(20h)


#if defined(L3G4200D)
void Gyro_init() {
  delay(100);
  i2c_writeReg(0XD2+0 ,0x20 ,0x8F ); // CTRL_REG1 10001111(0x8F) 400Hz ODR, 20hz filter,00001111(0x0F) 200Hz ODR 12.5hz filter
  delay(5);
  i2c_writeReg(0XD2+0 ,0x23 ,0x80 ); // CTRL_REG4 10000000  Fuii Scale 250dps
}

void Gyro_getADC () {
  TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz
  i2c_getSixRawADC(0XD2,0x28+0x80); // Start multiple read

  GYRO_ORIENTATION(  ((rawADC[1]<<8) | rawADC[0])/20  ,
                     ((rawADC[3]<<8) | rawADC[2])/20  ,
                    -((rawADC[5]<<8) | rawADC[4])/20  );
  GYRO_Common();
}
#endif

ПС Как правильно,красиво,вставлять код в пост?

Covax
devv:

кто рекомендует и на какой страничке ?

диалог на эту тему тут rcopen.com/forum/f123/topic221574/3103 , если не запаять в один прекрасный момент самопроивзольно меняется адрес и привет, коптер могЁт упасть

mahowik
soliada:

Чисто субъективно особой разницы не чувствуется

это на стенде, т.е. не в полете 😃
а вот если коптер “с вибрациями” то НЧ фильтры оч. даже могут помочь 😉

mahowik

кто нить компас HMC5883 подключал (отдельный или из оллИнВан, ФФиму)… чет не выходит откалибровать его толком… оси все правильно вроде указаны, проверял по факам www.multiwii.com/faq#How_should_be_the_sensor_axis… … калибровал, вертел каждую ось на 360гр (в течении 30сек)…

  1. юг тож вроде правильно показывает, a поворачиваешь на север - врет на 10-20гр
  2. если плату ровно погоризонту держaть то Ролл и Питч компаса не ноль. Так должно быть? Мот в Канаде поля магнитные не как у всех? 😃
Musgravehill
mahowik:

кто нить компас HMC5883 подключал

Отдельный от Иванова. Все летает.
В Программе оставляете только Roll - все графики должны совпадать по выбросам.
Потом Pitch и Yaw аналогично.
Все соосно.
В Канаде вектор маг. поля должен уходить в землю под некоторым углом.

Я на оси вообще не смотрю, у меня плата самодельная с коннекторами под датчики, воткнул покомпактнее и все.
Оси легко поочередно правятся в коде.

alexmos
mahowik:

юг тож вроде правильно показывает, a поворачиваешь на север - врет на 10-20гр

Компасс не очень точный прибор. Любой металл вблизи или проводник с током могут давать такую погрешность.
Магнитное поле не параллельно горзонту, так что это нормально. Главное от компаса в multiwii - это получение ориентации в горизонтальной плоскости. При рассчете учитывается акселерометр. Если все оси настроены правильно, то heading должен точно соответствовать поворотам вокруг YAW и не меняться при небольших наклонах.

Musgravehill
alexmos:

поворотам вокруг YAW

Ради этого нужен компас. Крен-тангаж корректируется по акселям. А курс отслеживается только по гире, которая плывет. Поэтому YAW компаса спасает ситуацию.
Мне не страшно, что квадрик немного крутится. Важно, чтобы он все 10 минут полета мог держать примерный курс и не сбивал с толку.

Covax
Musgravehill:

Ради этого нужен компас. Крен-тангаж корректируется по акселям. А курс отслеживается только по гире, которая плывет. Поэтому YAW компаса спасает ситуацию.
Мне не страшно, что квадрик немного крутится. Важно, чтобы он все 10 минут полета мог держать примерный курс и не сбивал с толку.

Так самое смешное, что без компаса мультивий летает прямее 😃 С компасом все время норовит повернуть гадина такая.

Razek
devv:

А это зачем ? На фото виденные в инете первый разъем не трогает народ

Если не вдаваться в детали то платки немного отличаются разводкой, люди кидают сполю на контактные площадки около гиры тем самым делают тоже самое, да еще забыл там может альтернативный порт у гиры ITG3200 использоваться 0x69 (7Bit) или 0x68 (7Bit) . Для BMA180 акселя использовать 0x41 (7Bit) но может и 0x40 (7Bit) работать, все зависит от того как плата разведена. Спрашивайте у продавца платы он вам расскажет какой порт использовать.

devv:

Есть вопросы по GUI и вкл/выкл стабилизации но думаю разберусь как скидаю железо.

Да гуи в мультивии жесть самый плохой из всех, напоменает поделку из 90ностых =)

devv
Razek:

люди кидают сполю на контактные площадки около гиры тем самым делают тоже самое

Что делают люди я так и не понял 😃
Меняют адрес гиры ? Фиксируют чтоб не менялся? А как он может в воздухе смениться ? не понимаю 😃

Razek
devv:

Что делают люди я так и не понял 😃 Меняют адрес гиры ? Фиксируют чтоб не менялся? А как он может в воздухе смениться ? не понимаю 😃

Они уже соединяют на самой плате клок с землей, но не на всех платах это нужно делать, в воздухе порты не меняются они настраиваются первый раз при подлкючении платы, уточняйте у продавца какие порты вам прописать чтоб заработали датчики.

Covax

Не в воздухе, а при включении питания, случаи были