*
Robotix 2020

Testeur de servos

Ce code pour Arduino permet de tester les positions centrale et à 90° horaire et antihoraire (CW et CCW) de servomoteurs du type SG90. Cela permet notamment de définir la position des servos utilisée dans des mécanismes robotiques ou res quadrupèdes ou araignées ou la position précise des servos est très importante.



Lecture sur le moniteur série :
(1) 90° sens horaire
(2) position centrale
(3) 90° antihoraire

La connexion du servo sur la  carte Arduino est :
Borne 5V "rouge"
Borne GND "marron"
Borne A0 "orange"










 
#include "Servo.h"

Servo servo_A;
int ledPin = 13;
int srv_A = A0;

void setup(){
Serial.begin(9600);
Serial.println("");
Serial.println("Servo angle tester");
Serial.println("(1) 90° CW");
Serial.println("(2) Center point");
Serial.println("(3) 90° CCW");
Serial.println("-------------------");
Serial.println("");
servo_A.attach(srv_A);
pinMode(ledPin, OUTPUT);
}

void loop(){
if (Serial.available() > 0) {

char valeur = Serial.read();

switch(valeur) {
case '1':
ANGLE(10);
Serial.println("10 CW -90°"); Serial.println("-------------");
break;

case '2':
ANGLE(90);
Serial.println("90 Midpoint 0°"); Serial.println("-------------");
break;

case '3':
ANGLE(170);
Serial.println("170 CCW 90°"); Serial.println("-------------");
break;
}}}

////////////// function ///////////////

void ANGLE(int ang) { servo_A.write(ang); delay(1000);}