以树莓派arm架构
以超声波测距+蜂鸣器+舵机 实现开盖、关盖
#include<stdio.h>
#include<wiringPi.h> // 调用WiringPi库
#include<sys/time.h> // 超声波测距头文件
#include<softPwm.h> //调用PWM库
#define Echo 5 //超声波端口
#define Trig 4 //超声波端口
#define BEEP 21 //蜂鸣器
#define DUOJI 3 //舵机端口
void initBeep()
{
pinMode(BEEP,OUTPUT); //初始化蜂鸣器
}
void initDUOJI()
{
pinMode(DUOJI,PWM_OUTPUT); //初始化舵机
}
void initChaoSB()
{
pinMode(Echo,INP