机器谱 发表于 2023-12-29 09:36:26

机器人制作开源方案 | 森林管理员

本帖最后由 机器谱 于 2023-12-29 09:36 编辑

作者:李佳骏、常睿康、张智斌、李世斌、高华耸单位:山西能源学院指导老师:赵浩成、郜敏1. 研究背景
      森林作为地球上可再生自然资源及陆地生态的主体,在人类生存和发展的历史中起着不可代替的作用,它不仅能提供国家建设和人民生活所需的木材及林副产品,而且还肩负着释放氧气调节气候环境,涵养水源、保持水土、防风固沙、美化环境、净化空气、减少噪音及旅游保健等多种使命,同时森林还是农牧业稳产高产的重要条件。然而,森林火灾是森林最危险的敌人,也是林业最可怕的灾害,也会给森林带来最有害、具有毁灭性的后果。森林火灾不只是烧毀片片森林,伤害林内动物,而旦还降低森林的更新能力,引起土壤的贫瘠和破坏森林涵养水源的作用,甚至号致生态环境失去平衡。2019年3月30日,四川省凉山州木里县就曾经发生过一次非常严重的森林火灾。2019年3月30日是一个雨天,木里县喇嘛寺沟附近下午5点左右出现了雷雨天气,虽然只是一次持续了30秒左右的阵雨,但是隆隆雷声却一直回荡在天空,不绝于耳。下午6点时一场森林火灾在山上悄然而至,起火点位于海拔3800余米的山上,山中地形复杂,遍布沟壑,无论是交通还是通讯情况都非常不好,消防官兵难以迅速赶往现场进行救援。经过相关部门得知消息后初步判断本次火灾的原因,可能是由于之前降兩时的雷击导致,多个起火点都位于山崖上,火场平均海拔高达4千米。31日下午,689位救火人员带着各种设备登山,前往海拔4000余米的原始森林开展救火工作,由于当日风向不定,风力风向突变导致山火爆燃形成一个巨大的火球。救火人员兵分两路进行避险,其中一路安全撤离,另一路的27位森林消防指战员和三名地方救火人员就此和其他人失去了联系。4月2日早晨六点30分,田火山山上的明火终于被扑灭。而制作山林隔离带是有效制止森林大火蔓延的的有效方式,且该方面大多是通过人工下地来完成的,所以我们设计了一款可通过远程遥控来实现砍伐、运输一体化的全地形机器人,减少人工的需求量和危险性。同时,目前生活中的伐木大多由人工实地操作,我们的作品也可以代替其完成系统化的作业。

2. 主要功能
       本小组作品的主要功能有在大火发生时,及时进入火场中,对还未涉及到的地域进行砍伐树木,降低火灾面积。本小车为全地形小车,可以适应森林中的各种地形,如山坡、地坑等等。小车一侧设有抓夹,在另一侧砍伐完树木后抓夹可以及时将树枝抓起放到车后部,最终由小车将其带出森林。在救援的同时小车前部设有摄像头以及湿度传感器,实时监控并记录火灾情况。本作品不仅可以用作在森林防护中制作隔离带的一体化工作,也可以用作日常生活中做伐木一体机器人使用。

3. 场景调研
       森林火灾的起因主要有两大类:人为火和自然火。人为火包括:生产性火源(农、林、牧业生产用火,林副业生产用火,工矿运输生产用火等)、非生产性火源(野外吸烟、做饭、烧纸、取暖等)、故意纵火。自然火包括:雷电火、自燃等。由于我国的森林火灾中,由吸烟、烧荒和上坟烧纸引起的火灾占了绝大多数,所以我们小组场地模拟森林火灾的起因为烧荒。在实际的地形中会存在山坡和小断层,我们小组在模拟时,模拟机器人爬小山坡和爬小台阶(断层)。同时,模拟了砍伐树木的过程,再砍伐完后,车另一侧的抓夹会将树木夹起搬运出森林。在进行就救援以及砍伐树木时,车前的摄像头可进行实时监控,可记录下在砍伐树木时周遭的实时动态,同时还有湿度传感器的实时监测。

4. 机器人本体技术路线说明
       ① 机械结构:整体车身分为两部分,前端车体运用柔性结构,并采用履带式车轮,后部采用传统轮胎,有着很好的抓地力。车体大致结合军用坦克的履带的优越性并结合实际,改装了后置轮胎,使得前后轮可以通过配合,从而顺利翻越一些工作途中所遇到的障碍。
https://28846868.s21i.faiusr.com/4/ABUIABAEGAAgueXfqwYogIyt-QQwtQY49wI!600x600.png.webphttps://28846868.s21i.faiusr.com/4/ABUIABAEGAAgzuXfqwYo2PmewQEw0Aw45QY!450x450.png.webp       ② 驱动系统:该车加装了6个双直流电机共同驱动,六个电机同时驱动,为小车提供了足够的动力,减少了动力的损失,为通过障碍物提供了足够的动力条件,电锯有单舵机制作的机械臂和电机控制的电锯体实现横向自由伸展,砍伐树木。机械爪由两个舵机控制的机械臂和单舵机控制的爪体构成,可实现横向伸展并调整爪子的摆动,实现抓取。
       ③ 控制系统:主板采用了Basra主控板,通过ESP8266Wi-Fi模块与电脑连接实现远程实时无限操作,通过摄像头、温湿度传感器来实时反馈现场情况,为人们的勘测和救援提供信息帮助。
       ④ 感知系统:车体全程操作由人工在远程通过WiFi模块实时操作,在车体的前方和中段均装有摄像头,前部摄像头可帮我我们锁定目标树木的方向,也可以规避障碍物,在侧端的摄像头可对目标数目进行定位,当其进入合适位置后进行砍伐和搬运。在车的顶部同时也装配了温湿度传感器,对周围环境进行监控,并及时反馈,为人工救援行动提供保障。

5. 示例程序#include <Servo.h>

int _ABVAR_1_data = 0 ;

int in1 = 5;

int in2 = 6;

int in3 = 9;

int in4 = 10;

int in5 = 12;

int SERVO_SPEED=20;                                        //定义舵机转动快慢的时间

int ACTION_DELAY=200;                                    //定义所有舵机每个状态时间间隔

Servo myServo;

int f = 50;                                                   //定义舵机每个状态间转动的次数,以此来确定每个舵机每次转动的角度

int servo_port = {3,4,7,8};                            //定义舵机引脚

int servo_num = sizeof(servo_port) / sizeof(servo_port);   //定义舵机数量

float value_init = {10, 40, 20, 40};                //定义舵机初始角度

//10, 110, 20, 40chu    100, 110, 60, 30   kaishi   100, 40, 60, 30zhua   100, 40, 40, 30qi    10, 40, 60, 30weizhi   

//float value_init = {10, 130, 60, 30};                //定义舵机初始角度

//float value_init = {0, 40, 40, 40};

void setup()

{

Serial.begin(9600);

pinMode(in1, OUTPUT);

pinMode(in2, OUTPUT);

pinMode(in3, OUTPUT);

pinMode(in4, OUTPUT);

    pinMode(in5, OUTPUT);



       for(int i=0;i<servo_num;i++){

    ServoGo(i,value_init);

}

}

void ServoStart(int which)

{

if(!myServo.attached())myServo.attach(servo_port);

pinMode(servo_port, OUTPUT);

}

void ServoStop(int which)

{

myServo.detach();

digitalWrite(servo_port,LOW);

}

void ServoGo(int which , int where)

{

if(where!=200)

{

    if(where==201) ServoStop(which);

    else

    {

      ServoStart(which);

      myServo.write(where);

    }

}

}

void servo_move(float value0, float value1, float value2, float value3)

{

float value_arguments[] = {value0, value1, value2, value3};

float value_delta;

for(int i=0;i<servo_num;i++)

{

    value_delta = (value_arguments - value_init) / f;

}

for(int i=0;i<f;i++)

{

    for(int k=0;k<servo_num;k++)

    {

      value_init = value_delta == 0 ? value_arguments : value_init + value_delta;

      /**************************串口查看输出*****************************/

//      Serial.print(value_init);

//      Serial.print(" ");

    }

//    Serial.println();

      /**************************串口查看输出*****************************/



    for(int j=0;j<servo_num;j++)

    {

      ServoGo(j,value_init);

    }

    delay(SERVO_SPEED);

}

delay(ACTION_DELAY);

}

void loop()

{

/*   servo_move(10, 40, 20, 40);

   delay(500);

       servo_move(100, 20, 20, 40);

   delay(500);

   servo_move(100, 110, 20, 40);

   delay(500);

   servo_move(100, 110, 60, 40);

   delay(500);   

    servo_move(100, 40, 60, 40);

   delay(500);

servo_move(10, 40, 60, 40);

   delay(500);

servo_move(10, 40, 20, 40);*/

_ABVAR_1_data = Serial.read() ;

if (( ( _ABVAR_1_data ) == ( 1 ) ))

{

       analogWrite(in1, 0);                        

      analogWrite(in2, 0);

      analogWrite(in3, 0);

      analogWrite(in4, 160);

      delay (10);

}

if (( ( _ABVAR_1_data ) == ( 2 ) ))

{

for(int i=0;i<10;i++)

{

    analogWrite(in1, 160);

      analogWrite(in2, 0);

      analogWrite(in3, 0);

      analogWrite(in4, 0);

      delay (10);

}

}

if (( ( _ABVAR_1_data ) == ( 12 ) ))

{   

   for(int i=0;i<10;i++)

{

servo_move(190, 40, 20, 130);

analogWrite(in1,150);

      analogWrite(in2,0);   

      analogWrite(in4,150);

      analogWrite(in3,0);

    delay (1000);

}

}

if (( ( _ABVAR_1_data ) == ( 3 ) ))

{   

   

analogWrite(in1,150);

      analogWrite(in2,0);   

      analogWrite(in4,150);

      analogWrite(in3,0);

    delay (1000);

}

if (( ( _ABVAR_1_data ) == ( 0 ) ))

{       analogWrite(in1,0);

      analogWrite(in2,0);   

      analogWrite(in4,0);

      analogWrite(in3,0);

}

if (( ( _ABVAR_1_data ) == ( 4) ))   //jixiebi1

{   

servo_move(10, 40, 40, 130);

delay(500);

delay(500);

   delay(500);

analogWrite(in5, 250);

   delay(500);

}

if (( ( _ABVAR_1_data ) == ( 5) ))   //jixiebi1

{   

servo_move(10, 40, 20, 60);

   delay(500);

analogWrite(in5, 0);

}

if (( ( _ABVAR_1_data ) == ( 7) ))   //10, 110, 20, 40chu    100, 110, 60, 30   kaishi   100, 40, 60, 30zhua   100, 40, 40, 30qi    10, 40, 60, 30weizhi   

{   

servo_move(100, 110, 60, 30);

   delay(500);



}

if (( ( _ABVAR_1_data ) == ( 8) ))   //qi

{   

servo_move(100, 40, 60, 30);

   delay(500);



}

if (( ( _ABVAR_1_data ) == ( 9) ))   //fan

{   

servo_move( 100, 40, 40, 30);

delay(1000);



}

if (( ( _ABVAR_1_data ) == ( 10) ))   //fan

{   

servo_move( 10, 40, 60, 30);

delay(1000);



}

if (( ( _ABVAR_1_data ) == ( 11) ))   //fan

{   

    servo_move(10, 40, 20, 40);

   delay(500);

       servo_move(100, 20, 20, 40);

   delay(500);

   servo_move(100, 130, 20, 40);

   delay(500);

   servo_move(100, 130, 50, 40);

   delay(500);   

    servo_move(100, 40, 50, 40);

   delay(500);

servo_move(10, 40, 50, 40);

   delay(500);

servo_move(10, 40, 20, 40);

}

}
6. 创新点
      小车行进结构利用“太极”式刚柔结合进行翻越障碍。当小车遇到有一定角度的倾斜坡的时候,此时小车的刚性材料组成的车轮即可派上用场,通过调整履带的旋转自由度,使得小车在上坡的过程中不会发射管前倾和后倾。在小车遇到有断崖(台阶)的地面环境时,其柔性材料做成的车轮,经过调整前轮的自由度和前轮和后轮之间的距离,可以做出俯仰抬头的动作,从而轻松爬上断崖(台阶}。与此同时,俩种不同材料组成的车轮,也解决了在移动过程中出现的打滑问题,使小车的稳定性更高。其次,小车的机械臂可以180°进行旋转,不仅使小车在工作时候可接触的范围更广,还减小了车的体积,从而加快了小车的速度,车身在此期间也可以保持到最佳的位置。在此期间,同时可以利用小车体积小的优势,可以顺利通过小的隧道进行工作。最后,我们设计的小车使其重心集中在了整个小车的最中心,减少了了在通过障碍工作途中造成小车前倾或者后倾,从而翻车的情况,加强了小车的稳定性。

7. 作品难点
       ① 本作品在左右两侧分别装有不同的机械结构,应对其进行有效合理的位置和结构设计,保证其相对应与其他传感器的配合。
       ② 小车在运行过程中需通过不同的障碍结构,而由于车身较小,故掌握小车在登台阶和上坡时的平衡很是关键,防止侧翻。故我们在进行上(下)坡(台阶)会将左右机械臂摆至前(后)进行平衡。
       ③ 在小车砍到设计的隔离带树木后,放在车后方拉出时,怎么样去寻找最合适的路线去拉走树木,从而防止其他树木在路途中阻挡砍到的树木撤离火源。

更多详情请见 :【S043】森林管理员 https://www.robotway.com/h-col-309.html
页: [1]
查看完整版本: 机器人制作开源方案 | 森林管理员