Archives de catégorie : NAVIO+ & Raspberry PI

NAVIO+ & Raspberry PI

MyPiDrone : Créer votre propre module MAVproxy pour contrôler le RPI2

Le Raspberry PI2 consomme entre 1A et 2A selon que le Wifi est activé ou pas et ce module MAVproxy (MyPiModule) va donc permettre de préserver la batterie et de contrôler diverses fonctions du RPI2 (wifi AP, video Wifibroadcast,  shutdown, reboot etc.) depuis la radio (Taranis X9D opentx dans notre exemple)

Les fonctions principales de MyPiModule (module MAVProxy) :

  • Fonction my_battery_check :
    • Préserver le voltage minimum de la batterie si le Drone est en mode STANDBY et si les moteurs ne sont pas armés. Dans ces conditions avec une batterie faible le module exécute l’arrêt du RaspBerry PI2 (init 0)
  • Fonction my_rc_check :
    • Exécute un shutdown of RPI2 depuis la radio:
      • Conditions: STANDBY + DISARMED
      • sur la radio: LOW YAW (RC4) et ROLL HIGH (RC1)
    • Exécute un reboot of RPI2 depuis la radio:
      • Conditions: STANDBY + DISARMED
      • Sur la radio: LOW YAW (RC4) et ROLL LOW (RC1)
    • Active/ déactive le réseau  wireless depuis la radio wlan0:
      • RC8 LOW : wlan0 DOWN et SINGLE MODE OFF
      • RC8 range LOW_MARK-100 to LOW_MARK : set mode STABILIZE
      • RC8 MIDDLE : SINGLE MODE ON
      • RC8 range HIGH_MARK to HIGH_MARK+100 : set mode RTL
      • RC8 HIGH : ifup wlan0
    • Active/ déactive la vidéo avec le wifibroadcast wlan1 depuis la radio:
      • RC6 LOW (déja utilisé pour contrôler la stabilité gauche de la caméra): Video wifibroadcast ON
      • RC6 HIGH (déja utilisé pour contrôler la stabilité droite de la caméra): Video wifibroadcast OFF
    • Rejoue la vidéo avec la radio:
      • Conditions: STANDBY + DISARMED
      • Sur la radio: LOW YAW (RC4) and PITCH HIGH (RC2)

Logs: /var/log/mavproxy_MyPiModule.log


Configuration de la radio pour contrôler MyPiModule :

mypidrone1_tarot_mypimodule_radio_control_v1-1


  • Parmètre des fonctions et de la télémétrie :
    (à changer dans  /.mavinit.scr or /root/.mavinit.scr si nécessaire).

    • mydelayinit: : 30 secondes de délais pour annuler le reboot ou le shutdown.
    • myminremain : 10% (niveau bas de la batterie).
    • myminvolt : 10V (voltage bas de la batterie).
    • mytimebat : 5sec entre deux mesures de la batterie
    • mytimerc : 5sec entre deux évaluation des canaux de la radio.
    • mytimeTText : 0.5sec de rafraichissement du texte sur la vidéo
    • myrcvideo : canal pour contrôler la vidéo on / off, defaut 6.
    • myrcyaw and myrcroll and myrcpitch : canal pour contrôler le shutdown, reboot, redo video, defaut 4, 1, 2.
    • myrcnet : canal pour contrôler wlan0 on/off, defaut 8
    • mychanneltx : Wifibroadcast 2.4Ghz (CH 11) or 2.3Ghz (CH -19)
    • mydebug : True or False
    • myinterfaceadmin : wlan0
    • myinterfacetx : wlan1
    • mylog : /var/log/mavproxy_MyPiModule.log
    • mylogverbose : True or False
    • mypipeout : /tmp/MyPiCamera.pipeout : voir start_tx_and_recording_with_raspivid_video_input.sh
    • myseqinit : 15sec avant de démarrer les mesures
    • myseqpoll : 10sec entre deux contrôles des états (réseau, enregistrement vidéo,  flightmode)
    • myvideopath : /root/fpv/videos
  • Fonction pour la vidéo :
    • Vidéos and photos sont stockés dans /root/fpv/videos directory
    • Vidéo Wifibroadcast ON/OFF (defaut ON) : RC6 LOW (OFF) or RC6 HIGH (ON)
    • Enregistrement vidéo en format h264 sur la card SD : automatique start/stop avec drone Armed/Disarmed
    • Photos en format JPEG sur la card SD (une prise par minute) : automatique start/stop avec drone Armed/Disarmed
    • Revue de la dernière vidéo en Wifibroadcast (redo video) : STANDBY + DISARMED, LOW YAW (RC4) et PITCH HIGH (RC2) (MyPiModule est en pause pendant cette action)
  • Fonctions en mode console :
    • mybat : état de la batterie
    • myshut : exécute un shutdown (une deuxième fois avant 30 secondes la shutdown est annulé)
    • myreboot : exécute un reboot (une deuxième fois avant 30 secondes la reboot est annulé)
    • myrtl : set RTL mode
    • mystabilize : set STABILIZE mode

Shutdown et reboot peuvent être annulés  (cancel) en exécutant une deuxième fois la fonction depuis la radio ou les commandes en mode console dans le délai des 30 secondes avant leur exécution. Le STATUSTEXT de progression est affiché sur l’écran 2 de la télémétrie sur la radio.

Un YAW MAX de 3 secondes (ARMED) annule aussi toutes les demandes de shutdown ou de reboot en cours.


Voici la Procédure de test du module :

  1. Installer MAVproxy avec git clone : https://github.com/Dronecode/MAVProxy.git
  2. Créer votre module MAVProxy/modules/mavproxy_MyPiModule.py : code à télécharger ici : git clone https://github.com/MyPiDrone/MyPiModule.git
  3. python setup.py build install
  4. démarrer ardupilot :

/usr/bin/ArduCopter-quad -A /dev/ttyAMA0 -C udp:127.0.0.1:14550

  1. démarrer MAVProxy (en mode console retirer –deamon) :

/usr/local/bin/mavproxy.py –master=udp:127.0.0.1:14550 –quadcopter –out=/dev/ttyUSB0,57600 –default-modules=’MyPiModule’ –daemon

Vous pouvez aussi charger le module lorsque MAVProxy est déjà démarré avec la commande : module load MyPiModule ou module reload MyPiModule

Il possible d’ajouter ce chargement automatique à /.mavinit.scr ou /root/.mavinit.scr en ajoutant la ligne module load MyPiModule

Par défaut MAVproxy charge dix modules au minimum et l’option –default-modules=’MyPiModule’ permet de ne charger que la liste des modules souhaités (séparateur virgule) : ceci permet de consommer moins de CPU sur le RPI2 et donc moins de batterie.

    1. Observer le comportement dans le fichier log :

tail -f /var/log/mavproxy_MyPiModule.log

Exemple :


2016-02-27 08:41:19 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11617 MyCurrent 150 MyRemaining 97 MyRC2Raw 0 MyRC3Raw 0 : Reboot ByRadio
2016-02-27 08:41:19 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11617 MyCurrent 150 MyRemaining 97 Reboot ByRadio after 30sec
2016-02-27 08:41:19 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11617 MyCurrent 150 MyRemaining 97 MySeverity 1 MyStatusText Reboot ByRadio after 30sec at 08h41m19s
2016-02-27 08:41:20 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11617 MyCurrent 150 MyRemaining 97 MySeverity 6 MyStatusText SIMPLE mode on
2016-02-27 08:41:23 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11574 MyCurrent 164 MyRemaining 97 LowVolt >10000 or LowRemain >10 : Good status
2016-02-27 08:41:24 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11579 MyCurrent 147 MyRemaining 97 ifup wlan0 RPI2
2016-02-27 08:41:24 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11579 MyCurrent 147 MyRemaining 97 cmd [‘ifup’, ‘wlan0’] sdtout
2016-02-27 08:41:24 INFO Armed: False MyState: 3 Mythrottle 0 MyVolt 11579 MyCurrent 147 MyRemaining 97 cmd [‘ifup’, ‘wlan0’] stderr ifup: interface wlan0 already configured


Exemple de STATUSTEXT sur la radio (menu screen2 telem2.lua) :

20160228_113522_mypimodule

Visiter  : https://github.com/MyPiDrone

Tous les sujets :

Pages