#include <Servo.h>

int pumpPin = 3;  // 气泵引脚 
int addPin = 5;   // 充气引脚
int descPin = 6;  // 吸气引脚

Servo servoPump;  // 气泵
Servo servoAdd;   // 充气
Servo servoDesc;  // 吸气

// 人体存在传感器引脚
int humanPin = 7;


void setup() {
  // 串口通信波特率
  Serial.begin(9600);
  // 人体存在传感器 输入模式
  pinMode(humanPin, INPUT);
  // 设定气泵、充气、吸气控制引脚
  servoPump.attach(pumpPin);
  servoAdd.attach(addPin);
  servoDesc.attach(descPin);

  servoPump.write(0);  // 停止
  servoAdd.write(0);
  servoDesc.write(0);
}

void loop() {
  // 0: 有人      1: 没有人
  // c/c++
  // = 赋值符号
  int humanVal = digitalRead(humanPin);
  Serial.println(humanVal);

  // 如果 humanVal 等于 0（判断）
  // servoPump.write(180);
  // servoAdd.write((1-humanVal) * 180);
  // servoDesc.write(humanVal * 180);

  // 充气
  if (humanVal == 0) {     // 有人

    servoPump.write(180);  // 充气
    servoAdd.write(180);
    servoDesc.write(0);
    delay(300);

    servoPump.write(180);     //  吸气
    servoAdd.write(0);
    servoDesc.write(180);
    delay(300);
  }else{

    servoPump.write(180);  // 充气
    servoAdd.write(180);
    servoDesc.write(0);
    delay(2000);

    servoPump.write(180);     //  吸气
    servoAdd.write(0);
    servoDesc.write(180);
    delay(2000);
  }

  //  充气
  // servoPump.write(180);     // 工作
  // servoAdd.write(180);
  // servoDesc.write(0);
  // delay(1000);

  //  吸气
  // servoPump.write(180);     // 工作
  // servoAdd.write(0);
  // servoDesc.write(180);
  // delay(1000);
}