CÓDIGO DEL BRAZO ROBÓTICO

#include <Servo.h>

Servo hombro, codo, muñeca, pinzas, base;

int phombro, pcodo, pmuñeca, ppinzas ,pbase, contador=0;

void setup(){

hombro.attach(13);

codo.attach(12);

muñeca.attach(11);

pinzas.attach(10);

base.attach(9);

Serial.begin(9600);

void loop(){

if(contador==0)

phombro=hombro.read();

pcodo=codo.read();

pmuñeca=muñeca.read();

ppinzas=pinzas.read();

pbase=base.read();

hombro.write(phombro);

codo.write(pcodo);

muñeca.write(pmuñeca);

pinzas.write(ppinzas);

base.write(pbase);

contador++;

dato='x';

dato=Serial.read();

switch(dato)

case 'a':

while(Serial.read()!='x';

if(phombro>=175)

phombro=175;

if(phombro<=180 && phombro>=0)

 {

phombro++;

hombro.write(phombro);

delay(15);

break;

case 'b':

while(Serial.read()!='x';

if(phombro<=5)

phombro=5:

if(phombro<=180 && phombro>=0)

phombro--;

hombro.write(phombro);

delay(15);

break;