函数重载、函数模板在四轴飞行器中的实际应用

86 阅读 0 评论 57 点赞

我是靠谱客的博主舒心火龙果，最近开发中收集的这篇文章主要介绍函数重载、函数模板在四轴飞行器中的实际应用，觉得挺不错的，现在分享给大家，希望可以做个参考。

概述

1、今日主题

背景：
曾经在大三参加2017全国大学生电子设计竞赛，当时做的是四旋翼自主飞行器探测跟踪的题目，我是负责主控这一块的，中后期整个过程主要都是调试，在调试的过程中，我们需要将飞行器的各类数据上传至地面站上位机来观测飞行器的姿态，通过波形判断控制算法的鲁棒性，以便更好的调节控制参数。地面站有固定的的数据传输协议，根据协议进行编程，通过串口蓝牙无线传输，在电脑上就可以看到波形了。

问题：
由于各数据的数据类型不太一致，个数有一样的也有不一样的，针对每一次的调试就需要定义不同的函数，这可怎么办呢？用C语言编程思维惯性，第一反应当然就是根据需求定义多个不同的函数，粘贴复制，增加参数，粘贴复制，修改…，搞定！写完之后发现函数名要取得不一致，或者有的干脆用同一个函数名加数字123进行区别，调用的时候用哪个函数、要确定好每一个参数，一一对应，搞着搞着人都搞蒙了…

思考：
那要怎么解决这个问题呢？有没有什么办法能够进行优化的呢？

实践演练

解决思路：

1、学了C++自然就想到了C++支持函数重载，通过重载，对一个函数名赋予新的含义，让一个函数名可以多用。

1.1、于是将数据传输的函数名都定义为一样的：DataSendToUSART1();解决了定义多个函数名混淆不清的情况；

1.2、然后根据不同的需求定义不同的函数，实现不同的数据传输；例如：

// 传输三维姿态角
void DataSendToUSART1(float roll,float pitch,float yaw)
{
unsigned char i = 0;
unsigned char cnt = 0, sum = 0;
unsigned int mTemp;
unsigned char dataToSend[50];
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0x01;
dataToSend[cnt++]=0;
mTemp = (int)(roll*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (int)(pitch*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (int)(yaw*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
dataToSend[3] = cnt-4;
/* 和校验 */
for(i = 0; i < cnt; i++)
sum+= dataToSend[i];
dataToSend[cnt++] = sum;
/* 串口发送数据 */
for(i = 0; i < cnt; i++)
printf("%c", dataToSend[i]);
}
// 传输X ,Y,方向速度PID输出，高度
void DataSendToUSART1(int speed_X_PID,int speed_Y_PID,uint16_t height)
{
unsigned char i = 0;
unsigned char cnt = 0, sum = 0;
unsigned int mTemp;
unsigned char dataToSend[50];
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0xF1;
dataToSend[cnt++]=0;
mTemp = (int)(speed_X_PID);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (int)(speed_Y_PID);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (uint16_t)(height);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
dataToSend[3] = cnt-4;
/* 和校验 */
for(i = 0; i < cnt; i++)
sum+= dataToSend[i];
dataToSend[cnt++] = sum;
/* 串口发送数据 */
for(i = 0; i < cnt; i++)
printf("%c", dataToSend[i]);
}

在调用函数时，系统会根据给出的信息找到与之匹配的函数，然后进行调用。写完之后发现真的太棒了，这样我就不用一一去找什么时候用哪个函数了，只要直接调用就可以了

2、名字的问题是解决了，但是我的函数还是那么多个呀，程序还是很多重复的，不够精简，看起来还是很头疼啊，怎么办呢？

2.1、这时候我就根据传输的数据进行分类，我发现，有一些函数只是形参的类型不同，而函数的参数个数以及函数体（传输数据的程序）是一致的，于是想能不能定义一个通用的函数，这样就可以将只是形参类型不同的函数统一，大大的精简程序代码。

2.2、这时候，就到了C++的函数模板出场的时候了，通过定义一个通用的函数，函数的类型和形参类型不具体指定，用一个虚拟的类型来代表。例如：

template <typename T>
void DataSendToUSART1(T a,T b,T c)
{
unsigned char i = 0;
unsigned char cnt = 0, sum = 0;
unsigned int mTemp;
unsigned char dataToSend[50];
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0xAA;
dataToSend[cnt++]=0x01;
dataToSend[cnt++]=0;
mTemp = (int)(a*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (int)(b*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
mTemp = (int)(c*100);
dataToSend[cnt++] = BYTE1(mTemp);
dataToSend[cnt++] = BYTE0(mTemp);
dataToSend[3] = cnt-4;
/* 和校验 */
for(i = 0; i < cnt; i++)
sum+= dataToSend[i];
dataToSend[cnt++] = sum;
/* 串口发送数据 */
for(i = 0; i < cnt; i++)
printf("%c", dataToSend[i]);
}
int main()
{
float roll = 1.0f,float pitch = 2.0f,float yaw = 3.0f;
DataSendToUSART1(roll,pitch,yaw);// 调用模板函数，此时T被float 取代
return 0;
}