123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106 |
- /*
- 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
- }
- }
|