智能婴儿车

/*!
 * MindPlus
 * uno
 *
 */
#include <DFRobot_Servo.h>
#include <DFRobot_NeoPixel.h>
#include <DFRobot_HuskyLens.h>
// 函数声明
void DF_ChuShi();
void DF_ZhanKai();
// 创建对象
Servo             servo_10;
Servo             servo_11;
Servo             servo_8;
Servo             servo_9;
DFRobot_NeoPixel  neoPixel_A2;
DFRobot_HuskyLens huskylens;


// 主程序开始
void setup() {
	servo_10.attach(10);
	servo_11.attach(11);
	servo_8.attach(8);
	servo_9.attach(9);
	neoPixel_A2.begin(A2, 3);
	huskylens.beginI2CUntilSuccess();
	huskylens.writeAlgorithm(ALGORITHM_FACE_RECOGNITION);
	DF_ChuShi();
}
void loop() {
	huskylens.request();
	if (huskylens.isLearned(1)) {
		if (huskylens.isAppear(1,HUSKYLENSResultBlock)) {
			neoPixel_A2.setRangeColor(0, 3, 0x00FF00);
			delay(5000);
			neoPixel_A2.setRangeColor(0, 3, 0x000000);
		}
		else {
			if ((analogRead(A1)==1)) {
				neoPixel_A2.setRangeColor(0, 3, 0xFF0000);
				delay(5000);
				neoPixel_A2.setRangeColor(0, 3, 0x000000);
			}
		}
	}
	if ((digitalRead(13)==1)) {
		DF_ZhanKai();
	}
	if ((digitalRead(12)==1)) {
		DF_ChuShi();
	}
	if ((digitalRead(A0)==1)) {
		digitalWrite(4, HIGH);
		digitalWrite(7, HIGH);
		analogWrite(5, 255);
		analogWrite(6, 255);
	}
}


// 自定义函数
void DF_ChuShi() {
	servo_10.angle(abs(125));
	servo_11.angle(abs(125));
	servo_8.angle(abs(128));
	servo_9.angle(abs(178));
}
void DF_ZhanKai() {
	servo_10.angle(abs(60));
	servo_11.angle(abs(180));
	servo_8.angle(abs(180));
	servo_9.angle(abs(125));
}