/* Sweep
 by BARRAGAN <http://barraganstudio.com>
 This example code is in the public domain.

 modified 8 Nov 2013
 by Scott Fitzgerald
 http://www.arduino.cc/en/Tutorial/Sweep
*/

#include <Servo.h>

// 创建一个servo(舵机)控制对象
Servo myservo;  // create servo object to control a servo
// twelve servo objects can be created on most boards

// 储存舵机位置
int pos = 0;    // variable to store the servo position

// 初始化
void setup() {
  // 绑定myservo到9号针脚,后面只能通过9号针脚控制myservo
  myservo.attach(9);  // attaches the servo on pin 9 to the servo object
}

// 死循环
void loop() {
  // 从0转到180度
  for (pos = 0; pos <= 180; pos += 1) { // goes from 0 degrees to 180 degrees
    // in steps of 1 degree
    myservo.write(pos);              // tell servo to go to position in variable 'pos'
    delay(15);                       // waits 15ms for the servo to reach the position
  }
  
  // 从180度转到0度
  for (pos = 180; pos >= 0; pos -= 1) { // goes from 180 degrees to 0 degrees
    myservo.write(pos);              // tell servo to go to position in variable 'pos'
    delay(15);                       // waits 15ms for the servo to reach the position
  }
}

/**
 * servo control program
 * 
 * @author dongyado<dongyado@gmail.com>
 */

#include<Servo.h>

Servo unlockServo; // 开门舵机
Servo phoneServo;  // 电话舵机

int pos = 0;

int maxPhonePos  = 90; // phoneServe最大角度
int maxUnlockPos = 30; // unlockServe最大角度

String comdata = ""; // 存储接收的指令

void setup() {
  
    Serial.begin(9600); // 监听串口,波特率9600
    
    // connect 
    unlockServo.attach(9);
    phoneServo.attach(10);
  
    //reset
    unlockServo.write(0);
    phoneServo.write(maxPhonePos);
    
    delay(200); // 延时是为了等待舵机转动完成
    
    // disconnect
    unlockServo.detach();
    phoneServo.detach();
}

void loop() {

    //接收串口发来的数据
    while (Serial.available() > 0)  
    {
        comdata += char(Serial.read());
        delay(10);
    }
    
    // 接收到数据
    if (comdata.length() > 0)
    {
        // connect 
        unlockServo.attach(9);
        phoneServo.attach(10);

        // 判断指令
        if (comdata == "open" || comdata == "1" ) {
            
            // get the phone up 
            for (pos = maxPhonePos; pos >= 1; pos -=1 ){
              phoneServo.write(pos);
              delay(10);  
            }

            delay(500);
            
            // press the button of open door
            for (pos = 1; pos < maxUnlockPos; pos+=1) {
                unlockServo.write(pos);
                delay(10);
            }

            delay(200);

            //release the unlock button
            for (pos = maxUnlockPos; pos >= 1; pos -=1 ){
              unlockServo.write(pos);
              delay(10);  
            }

            // get the phone down            
            for (pos = 1; pos < maxPhonePos; pos+=1) {
                phoneServo.write(pos);
                delay(10);
            }
        }

        //Serial.println(comdata);

        // disconnect
        unlockServo.detach();
        phoneServo.detach();
    } 

 
    delay(10);
    comdata = "";
}