Pages: [1]   Go Down
Author Topic: [Solucionado] Problema con ¿interferencia servo?  (Read 956 times)
0 Members and 1 Guest are viewing this topic.
Offline Offline
Newbie
*
Karma: 1
Posts: 48
Si eres un fanático de la electrónica o informática visita www.tuelectronica.es
View Profile
WWW
 Bigger Bigger  Smaller Smaller  Reset Reset

Hola a todos,
tengo un problema con el siguiente codigo:
Code:
/*
Radar Arduino v1.0
Autor: FjRamirez
Email: email@tuelectronica.es
Fecha: 15/04/2013
*/

#include <Servo.h>            // Añade la libreria Servo
Servo leftRightServo;         // Crea una variable servo
int leftRightPos = 0;         // Variable para la posición del servo (grados)
const int numReadings = 1;    // Numero de lecturas en cada posición
int index = 0;                // Contador para el número de lectura
long total = 0;               // the total of all readings
int average = 0;              // the average
int echoPin = 53;              // the SRF05's echo pin
int trigPin = 51;              // the SRF05's init pin
long duration = 0;  // variable for reading the pulse
int distance = 0;   // variable for storing distance
 
/* setup the pins, servo and serial port */
void setup() {
leftRightServo.attach(12,700,2400);
Serial.begin(9600); // Establece la velocidad de datos del puerto serie
pinMode(trigPin, OUTPUT); // Establece pin como salida
pinMode(echoPin, INPUT); // Establece pin como entrada
digitalWrite(trigPin, LOW); // Pone el pin a un estado logico bajo
}
 
void loop() {  
  for(leftRightPos = 0; leftRightPos < 180; leftRightPos++) {  // De izquierda a derecha.
  leftRightServo.write(leftRightPos);
    for (index = 0; index<numReadings; index++) {            // take x number of readings from the sensor and average them
    // Pulso de 10us para inicial el modulo
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    duration = pulseIn(echoPin, HIGH, 17400); //Devuelve la longitud del pulso del pin Echo en us (3metros maximo)
      if (!duration){
      duration=17400;
      }
    distance = duration/58;                               // convert to centimetres
    total = total + distance;                              // update total
    delay(100);  
    }
    
  average = total/numReadings;                               // create average reading  
  total = 0;
  
  Serial.print("X");                                         // print leading X to mark the following value as degrees
  Serial.print(leftRightPos);                                // current servo position
  Serial.print("V");                                         // preceeding character to separate values
  Serial.println(average);                                   // average of sensor readings  
}


  for(leftRightPos = 180; leftRightPos > 0; leftRightPos--) {  // De derechas a izquierda
  leftRightServo.write(leftRightPos);
    for (index = 0; index<numReadings; index++) {            // take x number of readings from the sensor and average them
    // Pulso de 10us para inicial el modulo
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);
    duration = pulseIn(echoPin, HIGH, 17400); //Devuelve la longitud del pulso del pin Echo en us (3metros maximo)
      if (!duration){
      duration=17400;
      }
    distance = duration/58;                               // convert to centimetres
    total = total + distance;                              // update total
    delay(100);  
    }
    
  average = total/numReadings;                               // create average reading  
  total = 0;
  
  Serial.print("X");                                         // print leading X to mark the following value as degrees
  Serial.print(leftRightPos);                                // current servo position
  Serial.print("V");                                         // preceeding character to separate values
  Serial.println(average);                                   // average of sensor readings
  }
}

Es un sensor de ultrasonidos con un servo, y hace un barrido de 180º para medir distancias. El caso que cuando conecto el servo no marca los valores de distancia correctamente. No esta montado el sensor en el servo, lo pongo para medir una distancia fija, y sin conectar el pin de datos del servo, me mide correctamente, pero cuando conecto el pin de datos del servo, hay errores de una manera sistematica:

Sin el servo conectado:

X3V174
X4V174
X5V174
X6V174
X7V174
X8V174
X9V174
X10V174
X11V174
X12V174
X13V174

Con el servo conectado:

X5V175
X6V137
X7V175
X8V135
X9V175
X10V137
X11V174
X12V134
X13V174
X14V134
X15V174
X16V135
X17V174

X es la posición del servo, y V la distancia en cm (175-174), como veis, se va alternando una medida incorrecta con otra correcta.

He probado con varios servos y nada, hace lo mismo. No entiendo el porque... Alguna sugerencia¿?¿?¿?
« Last Edit: April 26, 2013, 06:30:47 am by fjramirez » Logged

Spain
Offline Offline
God Member
*****
Karma: 25
Posts: 956
Arduino rocks
View Profile
 Bigger Bigger  Smaller Smaller  Reset Reset

¿De donde alimentas el servo, no sera del propio arduino?
Logged

CUIDADO !! MIS POST NO SON APTOS PARA MENORES. SI ERES MENOR DE 14 AÑOS DEBES DE LEERLOS ACOMPAÑADO DE UN ADULTO

Offline Offline
Newbie
*
Karma: 1
Posts: 48
Si eres un fanático de la electrónica o informática visita www.tuelectronica.es
View Profile
WWW
 Bigger Bigger  Smaller Smaller  Reset Reset

¿De donde alimentas el servo, no sera del propio arduino?

mmmm... si!! smiley-lol Pero creo que arduino es capaz de alimentar un servo no¿?¿?¿?¿?¿? De eso va a ser¿?¿? es un miniservo de 9g, no se exactamente cuanto consume, pero seguro que muy poco. (creo!!)
El caso es que antes lo alimentaba por USB, pero si lo conecto a una fuente de alimentación me hace menos interferencias...
« Last Edit: April 16, 2013, 01:53:22 pm by fjramirez » Logged

Spain
Offline Offline
God Member
*****
Karma: 25
Posts: 956
Arduino rocks
View Profile
 Bigger Bigger  Smaller Smaller  Reset Reset

¿De donde alimentas el servo, no sera del propio arduino?

mmmm... si!! smiley-lol Pero creo que arduino es capaz de alimentar un servo no¿?¿?¿?¿?¿? De eso va a ser¿?¿? es un miniservo de 9g, no se exactamente cuanto consume, pero seguro que muy poco. (creo!!)
El caso es que antes lo alimentaba por USB, pero si lo conecto a una fuente de alimentación me hace menos interferencias...

Crees mal...  smiley-lol

¿A que no se te ha ocurrido averiguar cuanta corriente puede dar un arduino o cuanto consume tu servo?

Alimentalo aparte y "veras la luz"
Logged

CUIDADO !! MIS POST NO SON APTOS PARA MENORES. SI ERES MENOR DE 14 AÑOS DEBES DE LEERLOS ACOMPAÑADO DE UN ADULTO

Offline Offline
Newbie
*
Karma: 1
Posts: 48
Si eres un fanático de la electrónica o informática visita www.tuelectronica.es
View Profile
WWW
 Bigger Bigger  Smaller Smaller  Reset Reset


Crees mal...  smiley-lol

¿A que no se te ha ocurrido averiguar cuanta corriente puede dar un arduino o cuanto consume tu servo?

Alimentalo aparte y "veras la luz"

En principio, del tutorial del que parto lo conecta directamente en arduino... pero usa una media de varias medidas (10) realizadas en una misma posición. Con esta configuración parece que funciona, pero yo lo puse para que solo hiciera una medida en cada posición y apareció el error. Puede ser que el autor hiciera esa "chapuza" para corregir el error que yo tengo porque... 10 medidas en una misma posición...¿?¿?

Voy a probar con alimentación externa y os comento. Espero que funcione, porque es un proyecto que tengo que exponer este jueves... smiley-lol
Logged

Spain
Offline Offline
God Member
*****
Karma: 25
Posts: 956
Arduino rocks
View Profile
 Bigger Bigger  Smaller Smaller  Reset Reset

Los servos consumen mucha corriente, no dejan de ser motores...

El arduino solo puede dar 40mA por pata y hasta un limite (no recuerdo cuanto) no en todas a la vez...

Aparte, cualquier motor o bobina mete unas interferencias de la leche en las conmutaciones...

Vi el esquema del autor y discrepo en la forma de conectarlo.
Logged

CUIDADO !! MIS POST NO SON APTOS PARA MENORES. SI ERES MENOR DE 14 AÑOS DEBES DE LEERLOS ACOMPAÑADO DE UN ADULTO

Offline Offline
Newbie
*
Karma: 1
Posts: 48
Si eres un fanático de la electrónica o informática visita www.tuelectronica.es
View Profile
WWW
 Bigger Bigger  Smaller Smaller  Reset Reset

Los servos consumen mucha corriente, no dejan de ser motores...

El arduino solo puede dar 40mA por pata y hasta un limite (no recuerdo cuanto) no en todas a la vez...

Aparte, cualquier motor o bobina mete unas interferencias de la leche en las conmutaciones...

Vi el esquema del autor y discrepo en la forma de conectarlo.

Tenias toda la razón, a veces se da por sentado cosas tan simples como esas y las descartas en primer lugar. Gracias por la ayuda!! Puedes ver un tutorial completo en http://arduino.cc/forum/index.php/topic,162891.0.html
Logged

Pages: [1]   Go Up
Jump to: