Pages: [1]   Go Down
Author Topic: Arduino + pololu + servo  (Read 542 times)
0 Members and 1 Guest are viewing this topic.
0
Offline Offline
Newbie
*
Karma: 0
Posts: 17
Arduino rocks
View Profile
 Bigger Bigger  Smaller Smaller  Reset Reset

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:
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
Logged

Pages: [1]   Go Up
Jump to: