图4.2 AD程序的流程图
4.2.4 航向角的求解
在编写DSP算法时,为了方便,一般都是采用高级语言(如C语言)。本设计的微处理器采用的是TMS320F2812ADSP芯片,采用C语言编写程序。
DSP芯片得到的AD转换输出值是一个12位的数据,需将其还原为实际值才能利用,公式(2-3)~(2-5)进行航向角的解算。以x轴为例,设AD采样后的12位数为VHEX,将其作为无符号数处理,输入AD的模拟量Vx应为:
(4-1)
传感器输出信号的实际电压设为Hx,K1为放大倍数,参考电压为2.5V,则:
(4-2)
同理可得另外两个轴的实际电压为Hy,Hz。
航向角求解子程序:
航向的求解关键在于将它们转化到平面坐标系的四个象限和x、y轴的正
负半轴上,以使航向角可以在360度的范围内连续变化。
#define PI 3.1415926
float GetHeading(float x,float y)
{
float HeadAngle;//定义航向角返回
if((Hexx>0)&&(Heyy)=0)
HeadAngle=0.0;//x轴正半轴
if((Hexx=0)&&(Heyy)<0)
HeadAngle=90.0://s轴负半轴
if((Hexx<0)&&(Heyy)=0)
HeadAngle=150.0://x轴负半轴
if((Hexx=0)&&(Heyy)>0)
HeadAngle=270.0://y轴正半轴
if((Hexx>0)&&(Heyy)<0)
HeadAngle=-180*(atan(Heyy/Hexx))/PI;//第四象限
if(Hexx>0)
HeadAngle=180-180*(atan(Heyy/Hexx))/PI://第二、三象限
if((Hexx>0)&&(Heyy)>0)
HeadAngle=360-180*(atan(Heyy/Hexx))/PI;//第一象限
}
4.3 小结
本章首先介绍了软件开发平台CCS,阐述了软件开发的一般步骤。在对电子磁罗盘的程序组成有了整体了解之后,对整个系统的软件进行了模块化分析,确定各个模块的功能。在此基础上,设计了系统主程序和各子程序的工作流程,并在ICETEK-F2812-A评估板上予以实现。
5 电子磁罗盘系统调试
系统调试过程中,硬件调试和软件调试是相辅相成的,许多硬件错误是在软件调试过程中被发现和纠正的。硬件是软件功能实现的基础,如果硬件调试不通过,软件设计将无从谈起,因此当出现问题时,一般先检查是否是硬件电路故障,排除明显的硬件故障之后,在此基础上再和软件进行联合调试,直至系统正常运行。
5.1 硬件调试
硬件检查最基本的工作是检查电路板走线和元器件焊接是否正确,包括错焊、少焊、多焊的检查。由于本系统体积小,相应元器件的封装均为表贴式,要求焊接时焊锡要尽量少但必须保证没有虚焊,同时引脚之间也不能有短路现象;必须保证电源供电的正、负极连接正确;用万用表测量电路板电阻值保证非零,以确保电路端对地不存在短路。
完成基本的电气焊接检查之后,需要对电路板加电,检查各单元电路是否按照设计要求正常工作。加电后,观察电路板有无异常现象,如冒烟、异等,若有,应立即断开电源并进行故障的检查与排除。没有明显的异常现象之后,要加电测量电路关键点的电压,如供电电压、仪器放大器参考电压等;一切正常之后,需要检查各单元电路是否正常工作,如仪器放大器倍数是否准确等。通过不断检查电气连接、调整参数设置或者更换元器件,直至使各单元电路工作正常,符合设计要求。
- 上一篇:大功率LED灯芯温度特性测试技术研究
- 下一篇:DEFORM圆柱体坯料压缩变形过程应变场分布的研究
-
-
-
-
-
-
-
当代大学生慈善意识研究+文献综述
酸性水汽提装置总汽提塔设计+CAD图纸
乳业同业并购式全产业链...
十二层带中心支撑钢结构...
中考体育项目与体育教学合理结合的研究
大众媒体对公共政策制定的影响
电站锅炉暖风器设计任务书
杂拟谷盗体内共生菌沃尔...
java+mysql车辆管理系统的设计+源代码
河岸冲刷和泥沙淤积的监测国内外研究现状