Go Down

Topic: Arduino + pololu + servo (Read 721 times) previous topic - next topic

altair8080

Bonjour,

Je souhaite réaliser le montage suivant :
Arduino + pololu SSC03A + 2 servo moteurs (pan tilt)

Le montage actuel est
TX 1 arduino ==> SIN pololu
power 5V ==> + servo moteur
GND ==> - servo moteur

sur la carte pololu un wire Vcs= Vcc

sur la carte pololu servo 0 le moteur gauche/droite
sur le servo 1 moteur haut/bas

L'objectif est de pouvoir contrôler le pan/tilt par le nunchuck (la parti nunchuck me permet déjà d'avoir des valeurs).

Ce qu'il me manque est la partie contrôle des servos moteurs où je vais pouvoir donner des paramètres et contrôler les moteurs.

J'ai bien cette partie qui me permet de positionner un servo à la fois mais cela ne semble pas être parfait
Code: [Select]

void put(int servo, int angle)
{
 //servo is the servo number (typically 0-7)
 //angle is the absolute position from 500 to 5500

 unsigned char buff[6];

 unsigned int temp;
 unsigned char pos_hi,pos_low;

 //Convert the angle data into two 7-bit bytes
 temp=angle&0x1f80;
 pos_hi=temp>>7;
 pos_low=angle & 0x7f;

 //Construct a Pololu Protocol command sentence
 buff[0]=0x80; //start byte
 buff[1]=0x01; //device id
 buff[2]=0x04; //command number
 buff[3]=servo; //servo number
 buff[4]=pos_hi; //data1
 buff[5]=pos_low; //data2

 //Send the command to the servo controller
 for(int i=0;i<6;i++){
   Serial.print(buff[i],BYTE);
 }
}


Merci de vos conseils et/ou lien

Go Up