冲刺电赛之电磁炮的制作-控制层

        来了来了,有点迟,今天给大家讲一下电磁炮控制层的代码。首先人机交互,我这里和题目要求的有一点点的不一样,题目说是用键盘控制,我选择用的是蓝牙,型号HC-08,这是我用过HC系列最好用的,个人而言哈,用蓝牙的命令0x01 0x02 0x03 0x04进行四个任务的转换,还有角度和距离的输入,这个是软件层最外层的框架。代码如下:

if(mian_U_data->stata == 2)
		{
			
			if(flag == 0)
			{
				fashe();
				sign = sign_usart;
			}
			if(sign != sign_usart)
			{
				flag = 0;
			}
			flag = 1;
			
		}
			
		if(mian_U_data->stata == 3)
		{
			TIM_SetCompare2(TIM4,1100);
			TIM_SetCompare3(TIM4,1000);
			if(flag == 1 || flag == 0 )
			{
				fashe();
				sign = sign_usart;
			}
			if(sign != sign_usart)
			{
				flag = 0;
			}
			
			flag = 2;
		}
		if(mian_U_data->stata == 4)
		{
			
			TIM_SetCompare2(TIM4,800);
			shoot_task();
		}
		if(mian_U_data->stata == 5)
		{
			if(mian_U_data->add_x == 13 && sign_x == 0)
			{
				add_x += 10;
				sign = sign_usart;
			}
			if(mian_U_data->add_x == 10 && sign_x == 0)
			{
				add_x -= 10;
				sign = sign_usart;
			}
			if(mian_U_data->add_x == 14 && sign_x == 0)
			{
				add_y += 10;
				sign = sign_usart;
			}
			if(mian_U_data->add_x == 15 && sign_x == 0)
			{
				add_y -= 10;
				sign = sign_usart;
			}
			sign_x = 1;	
			if(sign != sign_usart)
			{
				sign_x = 0;
			}
			TIM_SetCompare2(TIM4,1100+add_x); 
			TIM_SetCompare3(TIM4,1000+add_y); 
			
		}
if(com_data == 1)
			{
				PC_SendString((u8*)"任务一\n 任务内容:\n");
				PC_SendString((u8*)"形靶放置在靶心距离定标点 200~300cm 间,且在中心轴线上的位置处,键盘输入距离 d 值,电磁炮将弹丸发射至该位置,距离偏差的绝对值不大于 50cm\n");
				PC_SendString((u8*)"请输入距离\n");   
					
			}
			if(com_data == 2)
			{
				PC_SendString((u8*)"任务二\n任务内容:\n");
				PC_SendString((u8*)"用键盘给电磁炮输入环形靶中心与定标点的距离d及与中心轴线的偏\
				离角度 a ,一键启动后,电磁炮自动瞄准射击,按击中环形靶环数计\
				分;若脱靶则不计分\n");
				PC_SendString((u8*)"请输入距离 和 偏角\n");
					
				TIM_SetCompare2(TIM4,800);
				com_data = USART3->DR;
			}
			if(com_data == 3)
			{
				PC_SendString((u8*)"任务三\n任务内容:\n电磁炮进入自动瞄准状态\n并在10s之内发射\n");
				delay_ms(10);
//				PC_SendString((u8*)"倒计时开始\n");
//				Usart_Receive_Data(com_data);
//				for(i =0;i<10;i++)
//				{
//					USART_SendData(USART3,i);
//					delay_ms(1000);
//					
//				}
			}
			if(com_data == 4)
			{
				PC_SendString((u8*)"手动控制模式\n");
			}
			Usart_Receive_Data(com_data);

任务编写

然后就是编写任务了,对于任务一,任务二,逻辑都很简单,最主要的部分是任务三,全自动模式,首先是openmv的数据解析,这里要和上位机对应好帧头和帧尾,我用的是一帧一帧的的解析的方法,没有用DMA,对DMA不是很熟练,就没有用,DMA可以减轻CPU的负担,这里CPU得负担还不是很重,可以不要用也没关系。代码如下:

openmv_data.c

#include "openmv_data.h"
#include "stm32f10x.h"
int openmv[5];//stm32接收数据数组
//int8_t OpenMV_X;          /*OPENMV X 轴反馈坐标*/
//int8_t OpenMV_Y;          /*OPENMV X 轴反馈坐标*/

static OM_data openmv_data_t ;
int i=0;

void Openmv_Receive_Data(int16_t data)//接收Openmv传过来的数据
{
//	openmv_data_t.panduan = 1;
	static u8 state = 0;
	if(state==0&&data==0xB3)
	{
		state=1;
		openmv[0]=data;
	}
	else if(state==1&&data==0XB3)
	{
		state=2;
		openmv[1]=data;
	}
	else if(state==2)
	{
		state=3;
		openmv[2]=data;
	}
	else if(state==3)
	{
		state = 4;
		openmv[3]=data;
	}

	else if(state==4)		//检测是否接受到结束标志
	{
        if(data == 0x5B)
        {
            state = 0;
            openmv[4]=data;
            Openmv_Data();
        }
        else if(data != 0x5B)
        {
            state = 0;
            for(i=0;i<5;i++)
            {
                openmv[i]=0x00;
            }           
        }
	}    
	else
		{
			state = 0;
            for(i=0;i<5;i++)
            {
                openmv[i]=0x00;
            }
		}
}

void Openmv_Data(void)
{
    openmv_data_t.OpenMV_X=openmv[2];
    openmv_data_t.OpenMV_Y=openmv[3];
	openmv_data_t.panduan = openmv[1];

}
OM_data* get_OM_data_point(void)
{
    return &openmv_data_t;
}


openmv_data.h

#ifndef __OPENMV_DATA_H
#define	__OPENMV_DATA_H

#include "stm32f10x.h"
void Openmv_Data(void);
void Openmv_Receive_Data(int16_t data);

typedef  struct
{
	
	int OpenMV_X;          /*OPENMV X 轴反馈坐标*/
	int OpenMV_Y;          /*OPENMV X 轴反馈坐标*/
	int panduan;
}OM_data;

OM_data* get_OM_data_point(void);
#endif

习惯了用指针传递数据的方式,所以这里就这样用了,本来可以用全局变量的,看你的习惯了。

整体框架

到了最重要的部分了,逻辑的编写,

         这个结构相信参加过机甲大师的人都比较熟悉,本人在学校的机甲大师团队担任的是电控组组长的职务,对大疆的代码也有深入的研读,对这种风格也是比较认可的,也比较善于利用,如果大家对机甲大师感兴趣欢迎私聊我,和我进行技术交流和探讨。

        我这里定义变量是用了一个结构体,不是很规范的操作,但是这样只是方便调试观察变量,你们可以根据自己的分类进行修改。

 今天就写到着吧,明天继续,最近电赛延期了,还在等,想了解电赛的小伙伴,可以来找我私聊,平时QQ用的多,

我的QQ488628560

 

  • 3
    点赞
  • 14
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值