/*
  Programma:robopad.ino
  Programma di gestione robot tramite 1Sheeld
  e lo shield virtuale GamePad

  Su Arduino sono utilizzati i seguenti pin
  Pin GND -> Pin GND modulo L9110/buzzer
  Pin Vin -> Pin VCC modulo L9110
  Pin  2 -> Pin Buzzer
  Pin 5 -> Pin A-1A modulo L9110
  Pin 6 -> Pin A-1B modulo L9110
  Pin 10-> Pin B-1A modulo L9110
  Pin 11-> Pin B-1B modulo L9110
  Pin 13-> Pin Led

   Ultima modifica il 24/8/2016

  Applicazione realizzata da Adriano Gandolfo
  Sito https://www.adrirobot.it
  Blog http://it.emcelettronica.com/author/adrirobot
  Pagina Facebook https://www.facebook.com/Adrirobot-318949048122955
  Istagram https://www.instagram.com/adrirobot/
  This example code is in the public domain.
*/

#define CUSTOM_SETTINGS
#define INCLUDE_GAMEPAD_SHIELD

/* Include 1Sheeld library. */
#include <OneSheeld.h>

/* Numero pin a cui è collegato il LED */
int ledPin = 13 ;
/* Numero pin a cui è collegato il Burrer */
int buzzerPin = 2 ;
/* Configuratione del pin del modulo L9110. */
int A_1A = 5;
int A_1B = 6;
int B_1A = 10;
int B_1B = 11;

void setup()
{
  /* Start communication. */
  OneSheeld.begin();
  /* Imposta il pin LED come output. */
  pinMode(ledPin, OUTPUT);
  /* Imposta il pin Buzzer come output. */
  pinMode(buzzerPin, OUTPUT);
  /* Impostazione del modulo motore . */
  pinMode(A_1A, OUTPUT);  // IN1 motore A
  pinMode(A_1B, OUTPUT);  // IN2 motore A
  pinMode(B_1A, OUTPUT);  // IN3 motore B
  pinMode(B_1B, OUTPUT);  // IN4 motore B
}
void loop()
{
  /* Accende il LED quando il pulsante rosso è premuto. */
  if (GamePad.isRedPressed())
  {
    digitalWrite(ledPin, HIGH);
  }
  else
  {
    digitalWrite(ledPin, LOW);
  }
  /* Attiva il buzzer quando il pulsante blu è premuto. */
  if (GamePad.isBluePressed())
  {
    digitalWrite(buzzerPin, HIGH);
  }
  else
  {
    /* Disattiva il buzzer */
    digitalWrite(buzzerPin, LOW);
  }
  if (GamePad.isUpPressed())
  {
    robot_SX();
  }
  else if (GamePad.isDownPressed())
  {
    robot_DX();
  }
  else if (GamePad.isRightPressed())
  {
    robot_avanti();
  }
  else if (GamePad.isLeftPressed())
  {
    robot_indietro();
  }
  else
  {
    robot_stop();
  }
}

void robot_avanti()
{
  digitalWrite(A_1A, HIGH);
  digitalWrite(A_1B, LOW);
  digitalWrite(B_1A, LOW);
  digitalWrite(B_1B, HIGH);
}
void robot_indietro()
{
  digitalWrite(A_1A, LOW);
  digitalWrite(A_1B, HIGH);
  digitalWrite(B_1A, HIGH);
  digitalWrite(B_1B, LOW);
}
void robot_DX()
{
  digitalWrite(A_1A, LOW);
  digitalWrite(A_1B, HIGH);
  digitalWrite(B_1A, LOW);
  digitalWrite(B_1B, HIGH);
}
void robot_SX()
{
  digitalWrite(A_1A, HIGH);
  digitalWrite(A_1B, LOW);
  digitalWrite(B_1A, HIGH);
  digitalWrite(B_1B, LOW);
}

void robot_stop()
{
  digitalWrite(A_1A, LOW);
  digitalWrite(A_1B, LOW);
  digitalWrite(B_1A, LOW);
  digitalWrite(B_1B, LOW);
}