本文素材来源于北方民族大学 机电工程学院
作者:牟义达、黄瑞翔、李涛
指导老师:田国禾、张春涛
1. 自主行走功能验证
实验目的:让机器人小车行驶500ms后停500ms,循环重复。
实验器材:计算机、消防机器人小车。
实验步骤:设计自主行走功能检验程序;将双轴驱动直流电机连接于控制板上9、10引脚上;编译、烧录控制程序;锂电池插再控制板上给其供电;打开控制板电源开关;观察小车驱动轮的状态。
实验结果:小车驱动轮在控制板电源开启时转动,转动500ms后停下,之后往复循环。
实验结论:小车能按照指定功能执行操作,具备自主行走能力。
2. 火源检测功能验证
实验目的:让机器人小车检测火源并使机器人灭火装置定位至火源处。
实验器材:计算机、消防机器人小车、打火机、蜡烛一根。
实验步骤:设计火源检测功能检验程序;将舵机1、2分别连接于控制板的3、8引脚上;编译、烧录验证程序;控制板连接锂电池;在光照度不强的场地点燃蜡烛并将蜡烛固定摆放;将消防机器人小车与距蜡烛保持合适距离(因光照强度的不同传感器的有效触发距离不同),可以不断改变蜡烛的摆放位置;打开控制板开关;观察小车检测装置的运行状态。
实验结论:小车的检测装置在一定范围内检测,范围内检测完成之后若中途检测到火源则会定位到火源处。消防机器人小车具备检测火源的功能。
3. 灭火功能验证
实验目的:使灭火装置对准火源,开启灭火装置,检验是否能完成灭火工作。
实验器材:计算机、消防机器人小车、蜡烛一根、打火机。
实验步骤:设计灭火功能检验程序;将灭火装置连接于控制板上;编译、烧录检验程序;连接锂电池于控制板上;点燃蜡烛并固定摆放;使灭火装置对准火源并保持合适距离;打开控制板电源;观察蜡烛是否被吹灭。
实验结论:灭火装置开启时蜡烛很快被吹灭,消防小车灭火装置具备灭火功能。
4. 消防机器人小车功能整体验证
实验目的:检测消防小车能否按照所设计的消防程序进行消防作业。
实验器材:计算机、消防机器人小车、蜡烛一根、打火机一个。
实验步骤:将设计好的总程序编译、烧录至控制板;将驱动直流电机、两个舵机、灭火装置分别接线于控制板;点燃蜡烛并固定摆放于合适位置;将消防机器人小车放置距离蜡烛1m处,开启控制板电源;观察消防机器人的运行状态。
实验结论:消防机器人小车能完成消防作业,程序设计合理。
① 消防机器人控制程序
#include <Servo.h> Servo myservo1; //定义两个舵机 Servo myservo2; int pos1 = 0; //舵机初始角度 int pos2 = 0; const int buttonPin = A2; // 传感器端口设为A2 int buttonState = 0; //设一个转换库 void setup() { Serial.begin(9600); //初始化串口 myservo1.attach(3); //舵机接线端口设为3和8 myservo2.attach(8); pinMode(5,OUTPUT); //定义5、6、9、10、11为输出端口 pinMode(6,OUTPUT); pinMode(9,OUTPUT); pinMode(10,OUTPUT);
} void loop() { buttonState = digitalRead(buttonPin); //读取A0的电平并存于转换库里面 myservo1.write(150); //舵机1定在150度 Serial.println(" 舵机1定在150度") delay(3000); digitalWrite(5,1); //车四个轮子驱动前进 digitalWrite(6,0); digitalWrite(9,HIGH); digitalWrite(10,HIGH); delay(500); //0.5秒延迟 digitalWrite(5,1); //车停下来 digitalWrite(6,1); digitalWrite(9,HIGH); digitalWrite(10,HIGH); Serial.println(" 舵机2开始正摆动"); for(pos1 = 120; pos1 < 170; pos1 += 10) // 舵机1开始正摆动 { myservo1.write(pos1); for(pos2 = 20; pos2 < 160; pos2 += 1) // 舵机2开始正摆动 { myservo2.write(pos2); if(digitalRead(buttonPin)) //如果火焰传感器触发(A0被至1),将pos2此时的值记下并保存于buttonState中 { buttonState=pos2; duoji1jiaodu=pos1; } Serial.println(buttonState); //串口监视器返回buttonState值 delay(60); } }
if(buttonState) //非零即为真 { Serial.println(" 舵机转至火焰处"); myservo1.write(duoji1jiaodu); myservo2.write(buttonState); delay(3000); while(digitalRead(buttonPin)) //检测到火时一直开启风扇 { Serial.println(" 风扇一直开"); digitalWrite(9,HIGH); digitalWrite(10,LOW); delay(3000); } Serial.println(" 火灭了,风扇关了,小车前进"); delay(500); //停0.5秒 digitalWrite(5,1); //车停下来 digitalWrite(6,1); digitalWrite(9,HIGH); digitalWrite(10,HIGH);
}
else { digitalWrite(5,1); //车四个轮子驱动前进 digitalWrite(6,0); delay(500); //停3秒 digitalWrite(5,1); //车停下来 digitalWrite(6,1); Serial.println(" 舵机1 2开始负摆动"); for(pos1 = 170; pos1>120; pos2 .= 10) //舵机1开始负摆动 { for(pos2 = 160; pos2>20; pos2 .= 1) //舵机2开始负摆动 { myservo2.write(pos2); if(digitalRead(buttonPin)) //如果火焰传感器触发 (A0被至1),将pos2此时的值记下并保存于buttonState中 { buttonState=pos2; duoji1jiaodu=pos1;
} Serial.println(buttonState); delay(60); } if(buttonState) //非零即为真 { myservo1.write(duoji1jiaodu); myservo2.write(buttonState); delay(3000); while(digitalRead(buttonPin)) //检测到火时一直开启风扇 { digitalWrite(9,HIGH); digitalWrite(10,LOW); delay(3000); } Serial.println(" 火灭了,风扇关了,小车前进"); delay(500); //停3秒 digitalWrite(5,1); //车停下来 digitalWrite(6,1); digitalWrite(9,HIGH); digitalWrite(10,HIGH);
} } } } |
② 小车自主行走功能验证程序代码
void setup() { pinMode(9,OUTPUT); //定义9、10引脚为输出引脚 pinMode(10,OUTPUT); } void loop() { digitalWrite(9,HIGH); //9引脚输出高电平 digitalWrite(10,LOW); //10引脚输出低电平 delay(500); //延迟0.5秒 digitalWrite(9,HIGH); //9、10引脚输出高电平 digitalWrite(10,HIGH); } 检测功能验证程序代码 #include <Servo.h> Servo myservo1; //定义两个舵机 Servo myservo2; int pos1 = 0; //舵机初始角度 int pos2 = 0; const int buttonPin = A0; // 传感器端口设为A0 int buttonState = 0; //设一个转换库 void setup() { myservo1.attach(3); //舵机接线端口设为3和8 myservo2.attach(8);
} void loop() { buttonState = digitalRead(buttonPin); //读取A0的电平并存于转换库里面 myservo1.write(150); //舵机1定在150度 for(pos2 = 20; pos2 < 160; pos2 += 1) // 舵机2开始正摆动 { myservo2.write(pos2); if(digitalRead(buttonPin)) //如果火焰传感器触发(A0被至1),将pos2此时的值记下并保存于buttonState中 { buttonState=pos2; } delay(60); }
if(buttonState) //非零即为真 { myservo2.write(buttonState); }
else { for(pos2 = 160; pos2>20; pos2 .= 1) //舵机2开始负摆动 { myservo2.write(pos2); if(digitalRead(buttonPin)) //如果火焰传感器触发(A0被至1),将pos2此时的值记下并保存于buttonState中 buttonState=pos2; delay(60); } if(buttonState) //非零即为真 { myservo2.write(buttonState);
} } } |
③ 灭火功能验证程序代码
void setup() { pinMode(5,OUTPUT); //定义5、6为输出端口 pinMode(6,OUTPUT); } void loop() { digitalWrite(5,1); //5引脚输出高电平 digitalWrite(6,0); //6引脚输出低电平 } |
关于移动消防机器人的完整内容可参考基于机器视觉的移动消防机器人
-----------------------------------------------完结---------------------------------------------------