Arduino_XY/Arduino_XY_no_GUI_no_LCD.ino

/*
Arduino XY code version with NO Graphical User Interface (GUI) running on the Raspberry Pi
As well as no LCD connected to report coordinates
*/

#include <Servo.h>


/* Declare pins for servo output */
const int servo_x_Pin = 9; 
const int servo_y_Pin = 10;

/* Analog input pins for Joystick XY values */
const int JoyStick_X = 0; // pin number for x
const int JoyStick_Y = 1; // pin number for y

/* Declare flag pin to send digital output to the RASPBERRY PI */
const int signal_pin = 12;

/* Declare 2 servo objects to control de degrees of freedom of the XY Stage */
Servo servo_x;
Servo servo_y;  


/* Set up the default position of the servos: in the middle */
int servo_x_Angle = 90; 
int servo_y_Angle = 90;

/* Actuation flag: not moving */
bool actuating = false;


/* Joystick sensitivity */
const int threshold = 64;

 
void setup() 
{
  /* Communicate to the RASPBERRY PI if the Arduino is
  actuating (the stage is moving) or listening */
  pinMode(signal_pin, OUTPUT);   // to send 1 bit message to pi
  digitalWrite(signal_pin, LOW); // not actuating

  /* Prepare the servos */
  servo_x.attach(servo_x_Pin);
  servo_y.attach(servo_y_Pin);


  /* Position at the center of the scanning area 
  (x,y) = (90,90) */
  servo_x.write(servo_x_Angle); 
  servo_y.write(servo_y_Angle);  


  delay(50); 
}


void loop() 
{ 
  /* X movement (signal detection) */
  /* X.UP */
  if ((analogRead(JoyStick_X) > (512 + threshold)) && actuating == false) 
        {
        if(servo_x_Angle < 180) servo_x_Angle++;
         actuating = true;  
        }    

          
  /* X.DOWN */
  if ((analogRead(JoyStick_X) < (512 - threshold)) && actuating==false) 
        {
         if(servo_x_Angle > 0)servo_x_Angle--;
         actuating = true;
        }

  /* Y movement (signal detection) */
  /* Y.UP */
  if ((analogRead(JoyStick_Y) > (512 + threshold)) && actuating==false) 
        {
         if (servo_y_Angle < 180 ) {servo_y_Angle++;}
         actuating= true;  
        }


  /* Y.DOWN */
  if ((analogRead(JoyStick_Y) < (512 - threshold)) &&  actuating==false) 
        {
         if (servo_y_Angle > 0) {servo_y_Angle--;}
         actuating = true;
        }
        



  /* Move */
  if (actuating == true)
        {  
         digitalWrite(signal_pin, HIGH);     //  Actuating          
         servo_x.write(servo_x_Angle); 
         servo_y.write(servo_y_Angle);        
         delay(500);
         actuating = false;
         digitalWrite(signal_pin, LOW);     // Not actuating
        }
}