Arduino-робот из картона

#include  
#include 

#define RIGHT_HAND_PIN  2
#define LEFT_HAND_PIN  3
#define HEAD_PIN   4

#define TRIGGER_PIN  7
#define ECHO_PIN   6

Servo rightHand; 
Servo leftHand;
Servo head;
Ultrasonic ultrasonic(TRIGGER_PIN, ECHO_PIN);


void setup() {
  Serial.begin(9600);
  rightHand.attach(RIGHT_HAND_PIN);
  leftHand.attach(LEFT_HAND_PIN);
  head.attach(HEAD_PIN);
} 
 
 
void loop() { 
  head.write(90);
  delay(1000);
  
  float cmMsec;
  long microsec = ultrasonic.timing();
  cmMsec = ultrasonic.convert(microsec, Ultrasonic::CM);
  
  Serial.print("CM: ");
  Serial.println(cmMsec);
  
  head.write(135);
  delay(1000);
  
  head.write(45);
  delay(1000);

  head.write(90);
  
  leftHand.write(0);
  rightHand.write(0);
  delay(500);
  leftHand.write(180);
  rightHand.write(180);
  delay(500);
}