Revision history [back]

Adolfo Rodriguez T i write here because i can write more text.

So I write in void function to turn on/off a blink each time i run a rostopic pub to check if when i run rostopic pub the program enter in void function. when i pub to two servos the blink state change, but when i pub to three servos blink doesn't change, so i think the problem can be this.

void servo_cb( const sensor_msgs::JointState &giro)

{

digitalWrite(13, HIGH-digitalRead(13));

servo.write((int)giro.position[0]);

servo1.write((int)giro.position[1]);

servo2.write((int)giro.position[2]);

}