galvo-serial.ino

#include <Servo.h>

Servo yservo;  
Servo xservo; 
#define LASER_PIN 3
#define X_PIN 10
#define Y_PIN 9


void setup() {
 Serial.begin(9600);

 yservo.attach(Y_PIN);  
 xservo.attach(X_PIN);
 pinMode(LASER_PIN, OUTPUT);
}

void loop() {
  while (Serial.read() != '$') ;  // Wait for $

  int laser = Serial.parseInt(); 
  int x = Serial.parseInt();
  int y = Serial.parseInt(); 
  
  setPosition(x, y);
  if(laser == 1){
    laserOn();
  }else {
    laserOff();
  }
}

void laserOn() {
  digitalWrite(LASER_PIN, HIGH);
}

void laserOff() {
  digitalWrite(LASER_PIN, LOW);
}

void setPosition(int x, int y) {
  yservo.write(y);    
  xservo.write(x);
}