BOA NOITE GALERA

Curso automação, Estou montando um projeto para apresentar na facu

uma esteira separadora de caixas.

minha logica é (m1) motor de passo com rotação continua da correia da esteira, e 2 servos motores (m2) e (m3) um na frente do outro

servo 1 joga a primeira caixa que passar para direita servo 2 joga a segunda caixa que passar para esquerda a 3 caixa passa direto. mas infelizmente minha aula de programação em #C foram fracas, entao nao consegui aprender muito. gostaria de saber se alguém entenda de programa em #C poderia me ajudar. no momento achei esses dois programas 1 do motor de passo programa 2 do servo, mas nao sei como fazer a junção dos dois códigos para ter a minha logica. se alguém poder me ajudar ficarei muito muito grato.

não consegui colocar anexar a foto infelismente 

programa motor de passo

void setup() {

  pinMode(8, OUTPUT);

  pinMode(9, OUTPUT);

  digitalWrite(8, LOW);

  digitalWrite(9, LOW);

}

 void loop()

{   

    digitalWrite(9, HIGH);

    delayMicroseconds(10);

     digitalWrite(9, LOW);

    delayMicroseconds(300);

}

 alternativa com dois servo motores um girando no sentido contrário ao outro.

/*

Sketch: Este programa ira girar o eixo de um servomotor para direita ou esquerda lendo o estado de dois botoes assim identificados. Alternativa com dois servos girando em sentido contrario.

*/

#include <Servo.h>

const int botaoDireita = 2;    // identifica o pino do botao a direita

const int botaoEsquerda = 3;   // identifica o pino do botao a esquerda

const int servo1 = 4;          // identifica o pino do servomotor

const int servo2 = 5;          // identifica o pino do servomotor

Servo servoMotor1;             // declara um objeto tipo Servo

Servo servoMotor2;             // declara um objeto tipo Servo

int angulo = 90;               // controla a posicao do eixo

void setup() {

 pinMode(botaoDireita, INPUT);

 digitalWrite(botaoDireita, HIGH);

 pinMode(botaoEsquerda, INPUT);

 digitalWrite(botaoEsquerda, HIGH);

 servoMotor1.attach(servo1);    // conecta o motor ao pino de controle

 servoMotor1.write(angulo);     // gira o servo ate o ponto do meio

 servoMotor2.attach(servo2);    // conecta o motor ao pino de controle

 servoMotor2.write(angulo);     // gira o servo ate o ponto do meio

}

void loop() {

 if(digitalRead(botaoDireita) == LOW) {     // botao direita pressionado

  if(angulo < 180) {

   angulo = angulo + 1;

  }

 } else {

   if(digitalRead(botaoEsquerda) == LOW) {  // botao esquerda pressionado

    if(angulo > 0) {

     angulo = angulo - 1;

    }

   }

 }

 servoMotor1.write(angulo);

 servoMotor2.write(180 - angulo);

 delay(5);

}