Tweet
#include <Bounce.h>
#include <AccelStepper.h>
// Branchement du moteur
#define motorPin1 7
#define motorPin2 8
#define motorPin3 9
#define motorPin4 11
AccelStepper stepper(AccelStepper::FULL4WIRE, motorPin1, motorPin3, motorPin2, motorPin4);
FlightSimFloat KNOTS;
void setup() {
stepper.setMaxSpeed(700.00);
stepper.setAcceleration(300.00);
stepper.setSpeed(700.00);
KNOTS = XPlaneRef("sim/cockpit2/gauges/indicators/airspeed_kts_pilot");
KNOTS.onChange(viewKNOTS);
//Bounce kval = Bounce(KNOTS, 10);
}
void loop() {
FlightSim.update();
if (stepper.distanceToGo() == 0) {
stepper.moveTo(0.00);
}
stepper.run();
}
void viewKNOTS(float kval){
if ((KNOTS >= 0) and (KNOTS <40))
{
kval = map(KNOTS, 0, 40, 0, 185);
}
else if ((KNOTS >= 40) and (KNOTS <100))
{
kval = map(KNOTS, 40, 100.00, 185.00, 935.00);
}
else if ((KNOTS >= 100.00) and (KNOTS <120.00))
{
kval = map(KNOTS, 100.00, 120.00, 935.00, 1180.00);
}
else if ((KNOTS >= 120.00) and (KNOTS <200.00))
{
kval = map(KNOTS, 120.00, 200.00, 1180.00, 1800.00);
}
else if ((KNOTS >= 200.00))
{
kval = 1800.00;
}
//DEBUG
Serial.print("kval : ");
Serial.print(kval); //Valeur de pas du moteur
Serial.print("\t");
Serial.print("KNOTS : "); //Valeurs d'X-Plane
Serial.print(KNOTS);
Serial.println();
stepper.moveTo(kval);
stepper.runSpeedToPosition();
}
kval : 129.00 KNOTS : 28.04 kval : 129.00 KNOTS : 28.10 kval : 129.00 KNOTS : 28.16 kval : 129.00 KNOTS : 28.23 kval : 129.00 KNOTS : 28.29 kval : 129.00 KNOTS : 28.35 kval : 129.00 KNOTS : 28.41 kval : 129.00 KNOTS : 28.47 kval : 129.00 KNOTS : 28.54 kval : 129.00 KNOTS : 28.60 kval : 129.00 KNOTS : 28.66 kval : 129.00 KNOTS : 28.72 kval : 129.00 KNOTS : 28.79 kval : 129.00 KNOTS : 28.86 kval : 129.00 KNOTS : 28.94 kval : 134.00 KNOTS : 29.01 kval : 134.00 KNOTS : 29.08 kval : 134.00 KNOTS : 29.15 kval : 134.00 KNOTS : 29.21 kval : 134.00 KNOTS : 29.29 kval : 134.00 KNOTS : 29.35 kval : 134.00 KNOTS : 29.42 kval : 134.00 KNOTS : 29.48 kval : 134.00 KNOTS : 29.55 kval : 134.00 KNOTS : 29.61 kval : 134.00 KNOTS : 29.67 kval : 134.00 KNOTS : 29.73 kval : 134.00 KNOTS : 29.79 kval : 134.00 KNOTS : 29.85 kval : 134.00 KNOTS : 29.91 kval : 134.00 KNOTS : 29.97
long map(long x, long in_min, long in_max, long out_min, long out_max)
//*****************************************************************************
// FONCTION mapFloat
//*****************************************************************************
float mapFloat (float x, float in_min, float in_max, float out_min, float out_max)
{
return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}
//*****************************************************************************
void viewKNOTS(float in_Knots)
{
float kval;
if ((in_Knots >= 0.0f) and (in_Knots < 40.0f))
{
kval = map(in_Knots, 0.0f, 40.0f, 0.0f, 185.0f);
}
else if ((in_Knots >= 40.0f) and (in_Knots < 100.0f))
{
kval = map(in_Knots, 40.0f, 100.0f, 185.0f, 935.0f);
}
else if ((in_Knots >= 100.0f) and (in_Knots < 120.0f))
{
kval = map(in_Knots, 100.0f, 120.0f, 935.0f, 1180.0f);
}
else if ((in_Knots >= 120.0f) and (in_Knots < 200.0f))
{
kval = map(in_Knots, 120.0f, 200.0f, 1180.0f, 1800.0f);
}
else if ((in_Knots >= 200.0f))
{
kval = 1800.0f;
}
//DEBUG
Serial.print("kval : ");
Serial.print(kval); //Valeur de pas du moteur
Serial.print("\t");
Serial.print("KNOTS : "); //Valeurs d'X-Plane
Serial.print(in_Knots);
Serial.println();
stepper.moveTo(kval);
stepper.runSpeedToPosition();
}
void viewKNOTS(float in_Knots)
{
float kval;
if(in_Knots >= 200.0f)
{
kval = 1800.0f;
}
else if(in_Knots >= 120.0f)
{
kval = map(in_Knots, 120.0f, 200.0f, 1180.0f, 1800.0f);
}
else if(in_Knots >= 100.0)
{
kval = map(in_Knots, 100.0f, 120.0f, 935.0f, 1180.0f);
}
else if(in_Knots >= 40.0f)
{
kval = map(in_Knots, 40.0f, 100.0f, 185.0f, 935.0f);
}
else(in_Knots >= 0.0f)
{
kval = map(in_Knots, 0.0f, 40.0f, 0.0f, 185.0f);
}
stepper.moveTo(kval);
stepper.runSpeedToPosition();
}
#include <Bounce.h>
#include <AccelStepper.h>
// Branchement du moteur
#define motorPin1 7
#define motorPin2 8
#define motorPin3 9
#define motorPin4 11
AccelStepper stepper(AccelStepper::FULL4WIRE, motorPin1, motorPin3, motorPin2, motorPin4);
FlightSimFloat KNOTS;
void setup() {
stepper.setMaxSpeed(700.00);
stepper.setAcceleration(300.00);
stepper.setSpeed(700.00);
KNOTS = XPlaneRef("sim/cockpit2/gauges/indicators/airspeed_kts_pilot");
KNOTS.onChange(viewKNOTS);
//Bounce kval = Bounce(KNOTS, 10);
}
void loop() {
FlightSim.update();
if (stepper.distanceToGo() == 0) {
stepper.moveTo(0.00);
}
stepper.run();
}
float mapFloat (float x, float in_min, float in_max, float out_min, float out_max)
{
return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}
void viewKNOTS(float kval){
if ((KNOTS >= 0.0) and (KNOTS < 40.0))
{
kval = mapFloat (KNOTS, 0.0, 40.0, 0.0, 185.0);
}
else if ((KNOTS >= 40.0) and (KNOTS < 100.0))
{
kval = mapFloat (KNOTS, 40.0, 100.0, 185.0, 935.0);
}
else if ((KNOTS >= 100.0) and (KNOTS < 120.0))
{
kval = mapFloat (KNOTS, 100.0, 120.0, 935.0, 1180.0);
}
else if ((KNOTS >= 120.0) and (KNOTS < 200.0))
{
kval = mapFloat (KNOTS, 120.0, 200.0, 1180.0, 1800.0);
}
else if ((KNOTS >= 200.0))
{
kval = 1800.0;
}
//DEBUG
Serial.print("kval : ");
Serial.print(kval); //Valeur de pas du moteur
Serial.print("\t");
Serial.print("KNOTS : "); //Valeurs d'X-Plane
Serial.print(KNOTS);
Serial.println();
stepper.moveTo(kval);
stepper.runSpeedToPosition();
}
//*****************************************************************************
// Programme Arduino : KValeur_KNots
//*****************************************************************************
// Nom du programme pour l'afficher sur le terminal série et/ou de l'écran LCD.
const char NOM_DU_PROGRAMME [17] = "KValeur_KNots";
/*
Écrit par : thierryhl et L'ami René
Date : 2014-07-01
Ce code source est sous licence publique générale GNU (GNU General Public
Licence "GPL"), désignation « open source », ou « code source ouvert ».
Référence : http://www.fsffrance.org/index.fr.html
Ce programme est un logiciel libre; vous pouvez le redistribuer et / ou le
modifier selon les termes de la licence GNU V2. Ce programme est distribué
dans l'espoir qu'il sera utile, mais SANS AUCUNE GARANTIE, sans même la
garantie implicite de COMMERCIALISATION ou D'ADAPTATION À UN USAGE
PARTICULIER. Voir la GNU General Public License, Version 2 pour plus de
détails.
Ce code source se veut didactique, c'est pourquoi les commentaires y prennent
une très grande place. Mais cela ne doit pas vous effrayez, au contraire, cela
devrait vous rassurez en facilitant la compréhension du code source.
*/
//*****************************************************************************
// Produits requis pour ce programme :
//*****************************************************************************
/*
Liste alphabétique des composantes d'électroniques
1 x Arduino Nano 328 V3.0:
http://arduino.cc/en/Main/ArduinoBoardNano
http://dx.com/p/nano-v3-0-avr-atmega328-p-20au-module-board-usb-cable-for-arduino-118037
1 x Bouton-Interrupteur "Self-Locking Switch" à 6 pattes :
http://www.dx.com/p/8-x-8mm-self-locking-switch-blue-white-black-20-piece-pack-119702
1 x Connecteur à Prise Baril 2.1mm mâle :
http://www.robotshop.com/ca/fr/adaptateur-9v-a-prise-baril-21mm-v2.html
1 x Connecteur à Prise Baril 2.1mm "DC Jack Adapters" femelle :
http://www.dx.com/p/dc-jack-adapter-with-screw-thread-10-piece-pack-122741
1 x Planche d'expérimentation « BreadBoard » Mini (400 trous).
http://www.circuittest.com/mb-400-breadboard-white.html
1 x Transformateur 110V à 9V, 1A, câble 100cm pour Arduino :
http://dx.com/p/Arduino-9v-1a-power-adapter-black-2-flat-pin-plug-100cm-cable-126288
Et des petits câbles électriques et connecteurs appropriés (Réf. : MB-940,
MB-910, MB-900, MB-102J, LS-MMPJ-6, LS-FFPJ-6, etc.).
Fils de raccordement pour le bricolage électronique (65 pièces) :
http://dx.com/p/breadboard-jumper-wires-for-electronic-diy-65-cable-pack-118826
Paquet de 40 fils mono brin male femelle de 20cm :
http://dx.com/p/male-to-female-dupont-breadboard-jumper-wires-for-arduino-40-piece-pack-20cm-length-146935
Paquet de 40 fils mono brin femelle femelle de 20cm :
http://dx.com/p/dupont-line-1p-1p-40-pack-20cm-length-121338
Paquet de 70 fils mono brin male male de 12 à 24cm :
http://dx.com/p/breadboard-jumper-wires-for-electronic-diy-70-cable-pack-80208
Breadboard Jumper Cord Kit pour Arduino (140 pièces) :
http://dx.com/p/breadboard-jumper-wire-cord-kit-for-arduino-diy-140-piece-pack-138220
2,54mm 1x40 Pin Breakaway tête droite (10 Pieces) :
http://www.dx.com/p/2-54mm-1x40-pin-breakaway-straight-male-header-10-piece-pack-144191
Résistance de 1/4 Watt (de 100 Ohm ~ 2.4 KOhm), Kit de 270 :
http://dx.com/p/jtron-1-4w-colored-ring-resistor-pack-100-ohm-2k-27-kinds-10-pcs-blue-sliver-270-pcs-288760
Autres liens en rapport avec le sujet :
http://www.mon-club-elec.fr/pmwiki_mon_club_elec/pmwiki.php?n=MAIN.ArduinoExpertSerie2
http://www.mon-club-elec.fr/pmwiki_mon_club_elec/pmwiki.php?n=MAIN.ArduinoExpertSerieCanTerminalPC
*/
//*****************************************************************************
//*****************************************************************************
// Circuit à réaliser.
//*****************************************************************************
/*
Dans cette section, toutes les connexions des composantes du montage sont
listées, qu'ils soient utilisés ou non, et cela pour éviter tout oublie et
rendre le copier / coller par bloc complet pour une pièce, plus facile d'un
montage à l'autre. Le plus souvent possible le libellé de la pièce précédé du
nom court de la pièce est utilisé, par exemple « ARDUINO_A3 », pour la broche
analogique A3 d'une carte contrôleur Arduino Uno R3.
Plaque d'expérimentation « BreanBoard » :
Pour identifier les broches d'une plaque d'expérimentation « BreanBoard »,
comme dans le jeu de bataille navale "Battle Ship", les lignes sont
identifiées pas des numéros, ici, de 1 a 63 et les colonnes sont identifiées
par lettre des lettres, ici, de a a j et des signes « + » et « - ». Donc
(i10) indique l'intersection de la colonne « i » avec la ligne numéro « 10 ».
Pour une broche des colonnes négatives ou GND, c'est (-) et pour une broche
des colonnes positives ou VCC, c'est (+). Entre parenthèse « ( » et « ) »,
c'est pour bien spécifier une position de la planche d'expérimentation et
pour éviter toutes confusions.
*/
/*
Câblage de l'Arduino Nano R3.0 sur une plache « BreadBoard » Mini (400 trous) :
[ARDUINO_13_SCK_DEL dans (c2) et D12 dans (g2), etc.]
ARDUINO_USB : Câble USB à l'ordinateur;
ARDUINO_13_SCK_DEL :
ARDUINO_3_3V :
ARDUINO_REF :
ARDUINO_A0 :
ARDUINO_A1 :
ARDUINO_A2 :
ARDUINO_A3 :
ARDUINO_A4_SDA :
ARDUINO_A5_SCL :
ARDUINO_A6 :
ARDUINO_A7 :
ARDUINO_5V : (a13) -- (+13G); (+17G) -- (+17D)
ARDUINO_RST2 :
ARDUINO_GND2 :
ARDUINO_VIN :
ARDUINO_1_TX :
ARDUINO_0_RX :
ARDUINO_RST1 :
ARDUINO_GND1 : (j13) -- (-13D); (-17D) -- (-17G)
ARDUINO_2_INT1 :
ARDUINO_3_INT2_PWM :
ARDUINO_4 :
ARDUINO_5_PWM :
ARDUINO_6_PWM :
ARDUINO_7 : CONTROLE_MOTEUR_1_IN1
ARDUINO_8 : CONTROLE_MOTEUR_1_IN2
ARDUINO_9_PWM : CONTROLE_MOTEUR_1_IN3
ARDUINO_10_SS_PWM :
ARDUINO_11_MOSI_PWM : CONTROLE_MOTEUR_1_IN4
ARDUINO_12_MISO :
Câblage pour le connecteur 2.1mm sur la planche d'expérimentation et l'Arduino :
CONNECTEUR_1_VIN : (j30); +Pile 9V ou Transformateur 9V
CONNECTEUR_1_GND : (-29D); -Pile 9V ou Transformateur 9V
Câblage pour les deux moteurs pas à pas :
CONTROLE_MOTEUR_1_VIN = +5V~12V
CONTROLE_MOTEUR_1_GND = -5V~12V
CONTROLE_MOTEUR_1_IN1 = ARDUINO_7
CONTROLE_MOTEUR_1_IN2 = ARDUINO_8
CONTROLE_MOTEUR_1_IN3 = ARDUINO_9_PWM
CONTROLE_MOTEUR_1_IN4 = ARDUINO_11_MOSI_PWM
CONTROLE_MOTEUR_1_OUT1 = MOTEUR_1_D1
CONTROLE_MOTEUR_1_OUT2 = MOTEUR_1_D2
CONTROLE_MOTEUR_1_OUT3 = MOTEUR_1_D3
CONTROLE_MOTEUR_1_OUT4 = MOTEUR_1_D4
CONTROLE_MOTEUR_1_OUT5 = MOTEUR_1_D5
Câblage pour le bouton 6 pattes sur la planche d'expérimentation :
INTERRUPTEUR_1_OUT_1 : (i30); CONNECTEUR_1_VIN
INTERRUPTEUR_1_OUT_2 : (i29)
INTERRUPTEUR_1_OUT_3 : (i28)
INTERRUPTEUR_1_OUT_4 : (g28)
INTERRUPTEUR_1_OUT_5 : (g29); (f29) -- (c16); ARDUINO_VIN
INTERRUPTEUR_1_OUT_6 : (g30)
*/
//*****************************************************************************
//*****************************************************************************
// Directives de compilation pour le nombre de broches à initialiser.
//*****************************************************************************
// Pour initialiser toutes les broches de l'Arduino pour ne pas causer de faux
// départ dû à une ancienne configuration du montage...
#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__)
#define NombreDeBroche 79
#elif defined(__AVR_ATmega32U4__)
#define NombreDeBroche 79
#elif defined(__AVR_ATmega32U4__)
#define NombreDeBroche 21
#elif defined(__AVR_AT90USB646__) || defined(__AVR_AT90USB1286__)
#define NombreDeBroche 21
#elif defined(__AVR_ATmega128__) ||defined(__AVR_ATmega1281__)||defined(__AVR_ATmega2561__)
#define NombreDeBroche 21
#else
#define NombreDeBroche 21
#endif
//*****************************************************************************
//*****************************************************************************
// Inclusion des librairies utilisées.
//*****************************************************************************
#include "Bounce.h"
/*
Fichier contenant ...
*/
#include "AccelStepper.h"
/*
Bibliothque de contrôle des moteur pas à pas.
*/
//*****************************************************************************
//*****************************************************************************
// Déclaration des constantes.
//*****************************************************************************
/*
Par convention, pour nommer une constante, nous utiliserons des noms écrits
tout en majuscule, en capitale, ce qui facilitera leur repérage et rendra le
code plus facilement compréhensible. Le mot devant notre nom de constante
indique à l'Arduino l'espace mémoire à réserver pour stocker cette donnée.
Après le nom de notre constante, on lui attribue sa valeur.
*/
//*****************************************************************************
//*****************************************************************************
// Constantes des connecteurs.
//*****************************************************************************
// Branchement des broches du moteur pas à pas numéro 1 :
const byte CONTROLE_MOTEUR_1_IN1 = 7;
const byte CONTROLE_MOTEUR_1_IN2 = 8;
const byte CONTROLE_MOTEUR_1_IN3 = 9;
const byte CONTROLE_MOTEUR_1_IN4 = 11;
//*****************************************************************************
//*****************************************************************************
// Déclaration des autres constantes de travail.
//*****************************************************************************
//*****************************************************************************
//*****************************************************************************
// Déclaration des variables globales.
//*****************************************************************************
/*
Par convention, pour nommer une variable, nous utiliserons des noms écrits
avec une majuscule pour la première lettre de chaque mot composant le nom de la
variable, ce qui facilitera leur repérage et rendra le code plus facilement
compréhensible. Le mot devant notre nom de variable indique à l'Arduino l'espace
mémoire à réserver pour stocker cette donnée. Après le nom de notre variable, on
lui attribue sa valeur.
*/
// Creation de la structure de donnée par X-Plane :
FlightSimFloat KNots;
//
float KValeur = 0.0;
//*****************************************************************************
//*****************************************************************************
// Création en mémoire des objets pour les interfaces des périphériques.
//*****************************************************************************
// Création du contrôle du moteur pas à pas numéro 1 :
AccelStepper Moteur_1 (AccelStepper::FULL4WIRE, CONTROLE_MOTEUR_1_IN1,
CONTROLE_MOTEUR_1_IN3,
CONTROLE_MOTEUR_1_IN2,
CONTROLE_MOTEUR_1_IN4);
//*****************************************************************************
//*****************************************************************************
// FONCTION InitialiserToutesLesBroches
//*****************************************************************************
void InitialiserToutesLesBroches ()
{
// Initialiser toutes les broches de l'Arduino pour ne pas causer de faux
// départ dû à une ancienne configuration du montage...
for (int i = 0; i <= NombreDeBroche; i = i + 1)
{
pinMode (i, OUTPUT);
digitalWrite (i, 0);
}
}
//*****************************************************************************
//*****************************************************************************
// FONCTION mapFloat
//*****************************************************************************
// Fonction équivalente à « map (); », mais qui travaille avec des variables de
// type à virgule flottante « float ».
float mapFloat (float x, float in_min, float in_max, float out_min, float out_max)
{
return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}
//*****************************************************************************
//*****************************************************************************
// FONCTION viewKNots.
//*****************************************************************************
void viewKNots (float KValeur)
{
if ((KNots >= 0.0) and (KNots < 40.0))
{
KValeur = mapFloat (KNots, 0.0, 40.0, 0.0, 185.0);
}
else if ((KNots >= 40.0) and (KNots < 100.0))
{
KValeur = mapFloat (KNots, 40.0, 100.0, 185.0, 935.0);
}
else if ((KNots >= 100.0) and (KNots < 120.0))
{
KValeur = mapFloat (KNots, 100.0, 120.0, 935.0, 1180.0);
}
else if ((KNots >= 120.0) and (KNots < 200.0))
{
KValeur = mapFloat (KNots, 120.0, 200.0, 1180.0, 1800.0);
}
else if ((KNots >= 200.0))
{
KValeur = 1800.0;
}
//DEBUG
Serial.print ("KValeur : ");
Serial.print (KValeur); //Valeur de pas du moteur.
Serial.print ("\t");
Serial.print ("KNots : ");//Valeurs d'X-Plane.
Serial.print (KNots);
Serial.println ();
Moteur_1.moveTo (KValeur);
Moteur_1.runSpeedToPosition ();
}
//*****************************************************************************
//*****************************************************************************
// FONCTION SETUP = Code d'initialisation.
//*****************************************************************************
/*
La fonction setup () est exécutée en premier et 1 seule fois, au démarrage du
programme. Pour éviter de mettre des composantes sous tension avec la dernière
version du programme chargé dans l'Arduino, nous utilions une boucle « while »,
tant qu'une première action n'est pas accomplie par l'utilisateur, on ne fait
rien (Télécommande, bouton, etc.).
L'activation du rappel au + interne des connecteurs en entrée si nécessaire.
L'instruction « digitalWrite (pin, HIGH); » écrit la valeur HIGH, qui vaux 1
sur le connecteur en entrée, ce qui active la résistance de "rappel au +"
(pullup) au plus de ce connecteur. L'utilisation de cette résistance interne
est une protection minimale pour l'intégrité physique pour la puce principale.
*/
void setup ()
{
// Ici les instructions à exécuter au démarrage.
// Initialiser toutes les broches de l'Arduino pour ne pas causer de faux
// départ dû à une ancienne configuration du montage...
InitialiserToutesLesBroches ();
// IMPORTANT : régler le terminal côté PC avec la même valeur de
// transmission.
Serial.begin (115200);
Serial.println ();
Serial.print (NOM_DU_PROGRAMME);
Serial.println ();
Moteur_1.setMaxSpeed (700.0);
Moteur_1.setAcceleration (300.0);
Moteur_1.setSpeed (700.0);
KNots = XPlaneRef ("sim/cockpit2/gauges/indicators/airspeed_kts_pilot");
KNots.onChange (viewKNots);
//Bounce KValeur = Bounce (KNots, 10);
}
//*****************************************************************************
//*****************************************************************************
// FONCTION LOOP = Boucle sans fin = coeur du programme.
//*****************************************************************************
// La fonction loop() s'exécute sans fin en boucle aussi longtemps que
// l'Arduino est sous tension.
void loop()
{
// Ici les instructions à exécuter par le programme principal.
FlightSim.update();
if (Moteur_1.distanceToGo () == 0)
{
Moteur_1.moveTo (0);
}
Moteur_1.run ();
}
//*****************************************************************************
Commentaire