TA的每日心情 无聊 2019-10-27 08:38
签到天数: 20 天
[LV.4]偶尔看看III
代码如下
#include <Wire.h>
int distance=5;
void d(char Inward_outward,char direction_of,int speed,double few_seconds)
{
if(Inward_outward="q" && direction_of="s")
{
analogWrite(3,speed);
delay(few_seconds);
}else if(direction_of="x" && Inward_outward="q")
{
analogWrite(4,speed);
delay(few_seconds);
}else if(Inward_outward="h" && direction_of="s")
{
analogWrite(5,speed);
delay(few_seconds);
}else if(Inward_outward="h" && direction_of="x")
{
analogWrite(6,speed);
delay(few_seconds);
}
}
float rkcs()
{//入口超声波
pinMode(A0,OUTPUT);//入口的超声波trig接A0
digitalWrite(A0,LOW);
delayMicroseconds(2);
digitalWrite(A0,HIGH);
delayMicroseconds(10);
digitalWrite(A0,LOW);
pinMode(A1, INPUT);//echo a1
return pulseIn(A1,HIGH,30000/58.0);
}
float ckcs()
{//出口超shen
pinMode(A2,OUTPUT);//trig
digitalWrite(A2,0);
delayMicroseconds(2);
digitalWrite(A2,1);
delayMicroseconds(2);
digitalWrite(A2,0);
pinMode(A3,INPUT);//echo
return pulseIn(A3,1,30000/58.0);//换算
}
void setup()
{
pinMode(3,OUTPUT);
pinMode(4,OUTPUT);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);
d("h","x",200,1000);
}
void loop()
{
}
void entrance()//入口
{
if(rkcs<5)
{
d("q","s",200,1);
}
void _export()//出口
{
}
void _delay(float seconds)
{
long endTime = millis() + seconds * 1000;
while(millis() < endTime)_loop();
}