forumsousmarin.fr

Code : Tout sélectionner

// Initialisation

//Debut de boucle
   //Recevoir les données de la radio
   //Traiter les signeaux puis sortir x et y
   //Transformer x et y en pwm
   //Sortir les infos sur les ports dédiés
   //Gérer le retour d'info
   //Vers écran / leds / voyants
   //Attendre 90ms -> temps nécessaire au refesh d'un cycle PWM compatible avec un servomoteur ou un variateur
//Boucler

Code : Tout sélectionner

//Ici on lance l'initialisation
void setup() {
	Serial.begin(57600); //Liaison de type série à 57600 bauds
	pinMode(3, INPUT); //La pin 3 sera en mode input (entrée) donc elle ne pourra pas fournir de signal. Seulement en recevoir
}

//Ici on commance la boucle
void loop() {

	int compteurAttenteFrame = 1;	//Initialisation d'un compteur d'attente de frame de type integer
	
	//Attente de la première frame
	while(pulseIn(3, LOW) < 5000) {
		//Ne jamais laisser un while vide. Donc ici ajoute toi un compteur tel que
		compteurAttenteFrame++;	//Ici on ajoute "1" à chaque passage
		
		//Sécurisation au cas ou aucune framme ne viendrais
		//Si il se passe plus de 10 passages
		if(compteurAttenteFrame >= 10) {
			break; //Sortir de la boucle.
		}
		
		//Ici c'est qu'une idée de ce qu'il faudrais faire mais ça te donne une piste. Franchement, a la place du break, je mettrait un voyant de type LED. Du moins pour indiquer le défaut
	} 
	
	//Durant la boucle on prends la position de la voie
	//Gaffe, tu l'a pas d'initialisation de channumber. Je pense qu'un int avec le nombre de voie devrais être mis en haut.
	for(int x=0; x<=channumber-1; x++) {
		//Stock dans un tableau, toujours non déclarer, les voies.
		//Tel que value[0] = 10, value[1] = 100, ..., value[x] = val de la voie x...
		value[x]=pulseIn(3, LOW);
	}
	
	//Ici on fait l'inverse de la précédente fonction. On traite les données issue du tableau en des sorties donnés.
	for(int x=0; x<=channumber-1; x++) {
		//Ecrire sur le port série la valeur du tableau correspondante
		Serial.print(value[x]); //Print the value
		
		//Espace
		Serial.print(" ");
		
		//Valeur contenu dans le tableau
		value[x]=0; //Clear the value afeter is printed
	}
	
	//Saute une ligne
	Serial.println("");
}

Code : Tout sélectionner

#include <Servo.h> // Pour contrôler le moteur on utilise la librairie servo.

Servo mServo;  // Déclaration de la variable du moteur (semblable à celle d'un servo).

int inPotPin = 1; // Analog input pin #1 reads pot value (ici l'auteur du code emploie un potentiomètre pour réguler le régime de son brushless)
int outPinPPM = 11; // PPM output pin #11 (sortie prochainement attachée au moteur).

int throttlePulse = 1500; // Valeur de la largeur des impulsions, 1500 = 0%

int pulseDelay = 300; // Délais entre chaque impulsion (cette valeur varie-t-elle selon les moteurs/ESC ?)
int pulseMin = 700; // Largeur d'impuslion minimale, 700 = -100%
int pulseMax = 2300; // Largeur d'impulsion maximale, 2300 = +100%

void setup()
{
  mServo.attach(outPinPPM, pulseMin, pulseMax); // Attache le moteur à outPinPPM (sortie 11), et déclare la fourchette de largeur d'impulsion.
  mServo.writeMicroseconds(throttlePulse);  // Initialise le moteur en régime neutre (0%) pour que la sécurité embarquée dans l'ESC ne refuse pas le démarrage du moteur.

}

void loop()
{
  throttlePulse = map(analogRead(inPotPin), 0, 1023, pulseMin, pulseMax); // Etalonne la valeur sortante du pot pour correspondre à la fourchette de largeur d'impulsion.
  mServo.writeMicroseconds(throttlePulse); // Envoie la valeur de largeur d'impulsion voulue à l'ESC pour obtenir la vitesse moteur souhaitée.
  delayMicroseconds(pulseDelay); // Delais entre cette impulsion et la suivante.
}