[go: up one dir, main page]

CN102929295B - 一种基于单片机的自动调平控制装置及调平方法 - Google Patents

一种基于单片机的自动调平控制装置及调平方法 Download PDF

Info

Publication number
CN102929295B
CN102929295B CN201210441535.3A CN201210441535A CN102929295B CN 102929295 B CN102929295 B CN 102929295B CN 201210441535 A CN201210441535 A CN 201210441535A CN 102929295 B CN102929295 B CN 102929295B
Authority
CN
China
Prior art keywords
steering gear
axis
chip microcomputer
loading platform
unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201210441535.3A
Other languages
English (en)
Other versions
CN102929295A (zh
Inventor
王广君
张怀
曾旭明
冀连杰
郝玉君
邹琴
鲍卫岗
张鹏凯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China University of Geosciences
Original Assignee
China University of Geosciences
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China University of Geosciences filed Critical China University of Geosciences
Priority to CN201210441535.3A priority Critical patent/CN102929295B/zh
Publication of CN102929295A publication Critical patent/CN102929295A/zh
Application granted granted Critical
Publication of CN102929295B publication Critical patent/CN102929295B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Devices For Indicating Variable Information By Combining Individual Elements (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种基于单片机的自动调平控制装置,包括设备和自动控制部分,设备部分设有载物平台,X、Y轴向舵机,基座,X、Y轴向转动机构和三轴加速度传感器,在基座上安装有X、Y轴向转动机构,X、Y轴向舵机安装在X、Y轴向转动机构上,两台舵机的旋转轴相互垂直,载物平台装在X、Y轴向转动机构上方;三轴加速度传感器装在载物平台下底面;自动控制部分由单片机控制单元,舵机调节单元,倾角传感器水平检测单元和液晶显示单元组成。单片机内置的A/D采样传感器输出信号,并产生两路PWM驱动信号控制两台舵机旋转相应的角度,动态调整载物平台使其保持水平。本装置体积小精度高,适用范围广,可与经纬仪等仪器结合,调平方便快捷。

Description

一种基于单片机的自动调平控制装置及调平方法
技术领域
本发明涉及一种基于单片机的自动调平控制装置及调平方法,具体地说是一种能为安置在载物平台上的仪器设备提供高精度的水平基准面的采用单片机自动调平的控制装置及调平方法,适合用于水准仪、经纬仪等测绘仪器的自动调平。
背景技术
在现代国防与民用技术中,常常需要把某些设备精确地调整到水平位置,以提高设备系统的工作性能,达到某一指标要求。以往调平装置的研究主要集中在如水平仪、测角仪及测斜仪等角度测量方面,而角度测量与自动控制结合的技术较少。现在很多测量设备都是机械式的水平调整方式,如地质水文勘探、土木工程测量中广泛应用的水准仪、经纬仪等测绘仪器,该类仪器在使用中一个共同的特点就是需要使用者手动调平。由于受人主观因素的影响,调平的速度和精度得不到保证,耗时长,精度低。但当前设备越来越向自动化智能化的方向发展,工作台的自动调平,尤其是应用于野外测量、实验中及与仪器的结合的工作台实现水平自动调整是很有必要的,因此开发与仪器设备结合实现自动调平的控制装置,具有较好的应用价值。
发明内容
本发明的目的是提供一种精度较高,体积小,适用范围广,使用方便快捷,能够为放置在载物平台上的仪器设备提供高精度的水平基准面的基于单片机的自动调平控制装置及调平方法。
为了实现上述功能,本发明所采取的技术方案是:提供一种基于单片机的自动调平控制装置,包括设备部分和自动控制部分,所述的设备部分设有载物平台,X轴向舵机,Y轴向舵机,基座,X、Y轴向转动机构和三轴加速度传感器;所述的自动控制部分设有单片机控制单元,舵机调节单元,倾角传感器水平检测单元和液晶显示单元;
所述的设备部分在基座上安装有X、Y轴向转动机构,X轴向舵机和Y轴向舵机安装在有两个轴相互正交垂直的X、Y轴向转动机构上,X轴向舵机和Y轴向舵机的旋转轴相互垂直,载物平台安装在X、Y轴向转动机构上方;三轴加速度传感器安装在载物平台下底面;
所述的自动控制部分的单片机控制单元与舵机调节单元连接,单片机控制单元还分别与倾角传感器水平检测单元和液晶显示单元互连;单片机控制单元采用MSP430F169单片机作主控器作为自动控制部分的核心,单片机控制单元提供2个I/O口与舵机驱动电路电连接,单片机内置A/D提供3个I/O口与倾角传感器水平检测单元电连接,单片机控制单元用于实现对舵机调节单元、倾角传感器水平检测单元和液晶显示单元的控制;舵机调节单元设有X轴向舵机和Y轴向舵机的驱动电路,舵机调节单元用作调节X轴向舵机和Y轴向舵机的X、Y正交轴向的角度动作执行器,X轴向舵机和Y轴向舵机转动的角度通过改变单片机控制单元内部的定时器产生的脉冲宽度调制信号的占空比来实现;倾角传感器水平检测单元采用MMA7260三轴加速度传感器,三轴加速度传感器的X、Y轴分别与X轴向舵机和Y轴向舵机的旋转轴平行;所述的液晶显示单元连接的12864液晶显示器安装在载物平台上方,实时显示载物平台X、Y轴向的倾斜角度数值。
本发明所述的单片机控制单元采用MSP430F169单片机作为主控器。本发明单片机控制单元选用MSP430F169单片机,是因为其具有高集成度和低功耗的特点,使其非常适合于电池供电和空间受限的场合。
本发明所述的单片机控制单元提供2个I/O口与舵机驱动电路电连接。
本发明所述的单片机控制单元中单片机内置A/D提供3个I/O口与倾角传感器水平检测单元电连接。
本发明还提供一种应用基于单片机的自动调平控制装置的调平方法,所述的高精度的MMA7260三轴加速度传感器实时检测载物平台的水平偏移角度,单片机控制单元通过MSP430F169内置的模数转换器A/D采集所述传感器输出的电信号,对倾角传感器水平检测单元输出信息的A/D数据不断计算分析载物平台当前状态与水平状态X、Y两个轴向的偏移的角度差,单片机根据计算结果产生两路PWM驱动控制信号,控制X轴向舵机与Y轴向舵机两个轴旋转相应的角度,实时动态调整载物平台,使载物平台一直处于水平状态,液晶显示器实时显示载物平台X、Y轴向的倾角α、β的角度值。
本发明基于单片机的自动调平控制装置及调平方法与现有技术相比具有如下优点:
1、本发明采用高精度的倾角传感器和小体积大扭力、步进精度高的舵机,可以快速实现载物平台自动调平,为放置在载物平台上的测绘仪器提供高精度水平基准面,为实现高精度测量打下基础。
2、本发明的液晶显示单元的液晶显示器能显示当前使用的平台X、Y轴向的倾角角度,既方便使用者了解载物平台上仪器的水平偏移角度信息,必要时候又能作为数字电子水平仪使用,提高了使用的方便程度。
3、本发明采用的单片机、倾角传感器均是小体积、低功耗芯片,安装所需空间小,控制装置的工作电源可采用电池供电,适合野外移动场合的应用。
4、使用本发明的装置为实现高精度的测量打下基础,同时也能为相关工作者减轻工作负担,工作者可以将更多的时间用于测量上而不是花大量的时间调整仪器。本装置精度较高,体积小,适用范围广。
附图说明
图1为本发明基于单片机的自动调平控制装置的设备部分安装结构示意图。
图2为本发明自动调平装置的自动控制部分结构框图。
图3为本发明自动调平装置的两路舵机的电源和接口电路图。
图4为本发明自动调平装置中采用MMA7260三轴加速度传感器的电路图。
图5为本发明自动调平装置的主控MSP430F169单片机的工作电路图。
图6为本发明自动调平装置中采用12864液晶显示器的电路图。
图7为本发明自动调平装置的电源模块电路图。
图8为本发明自动调平装置的载物平台调平坐标示意图。
上述图中:1-载物平台,2-X轴向舵机,3-Y轴向舵机,4-基座,5-X、Y轴向转动机构,6-三轴加速度传感器,10-舵机调节单元,11-倾角传感器水平检测单元,12-单片机控制单元,13-液晶显示单元。
具体实施方式
下面结合附图和实施例对本发明的装置作详细具体的说明。
实施例1:本发明提供的一种基于单片机的自动调平控制装置,其结构如图1,2所示,包括设备部分和自动控制部分,所述的设备部分设有载物平台1,X轴向舵机2,Y轴向舵机3,基座4,X、Y轴向转动机构5和三轴加速度传感器6,在基座4上安装有X、Y轴向转动机构5,X轴向舵机2和Y轴向舵机3安装在有两个轴相互正交垂直的X、Y轴向转动机构5上,X轴向舵机2和Y轴向舵机3的旋转轴相互垂直,X轴向舵机、Y轴向舵机采用精度高、小体积、大扭力的数字舵机,在图1中Y轴向舵机3被底座部分遮挡,图中仅见到Y轴向舵机3的主轴。载物平台1安装在X、Y轴向转动机构5上方;三轴加速度传感器6安装在载物平台1下底面。
所述的自动控制部分设有单片机控制单元12,舵机调节单元10,倾角传感器水平检测单元11和液晶显示单元13。单片机控制单元12与舵机调节单元10连接,单片机控制单元12还与倾角传感器水平检测单元11和液晶显示单元13互连;单片机控制单元12作为自动控制部分的核心用于实现对舵机调节单元、倾角传感器水平检测单元和液晶显示单元的控制;两台舵机的驱动控制信号来自单片机。单片机通过与倾角传感器水平检测单元互连,采集处理倾角传感器输出电信号,做出相应的处理,完成一系列控制功能。
舵机调节单元10用于调节X轴向舵机和Y轴向舵机的X、Y正交轴向的角度动作执行器,X轴向舵机2、Y轴向舵机3转动的角度通过改变单片机内部定时器产生的脉冲宽度(PWM)调制信号的占空比来实现;倾角传感器水平检测单元11连接三轴加速度传感器6,三轴加速度传感器6的X、Y轴分别与X轴向舵机2和Y轴向舵机3的旋转轴平行;所述的液晶显示单元连接的液晶显示器安装在载物平台上方,实时显示载物平台X、Y轴向的倾斜角度数值。
本实施例中单片机控制单元采用MSP430F169单片机作为主控器,倾角传感器水平检测单元采用MMA7260三轴加速度传感器,液晶显示单元采用12864液晶显示器。
以下为本实施例中各模块的工作方式:
舵机电源和接口电路如图3。其中U3为开关型稳压芯片TPS5430,为两路舵机提供工作电源,P4、P5分别为单片机控制单元与两路舵机的接口,舵机控制信号分别与单片机的P4.0和P4.1连接。
实施例中倾角传感器水平检测单元选用MMA7260,是因为其在单一芯片上集成3个相互独立、测量方向相互垂直的敏感元的测量模块,当加速度引起质量块的相对位置变化时,电容值也发生变化,然后经过电容电压转化电路和放大滤波电路后输出与加速度成正比的电压信号。
采用MMA7260三轴加速度传感器电路如图4,MMA7260的第1引脚和第2引脚分别通过电阻P2、P3上拉并和单片机的P1.0和P1.1连接,第3引脚与VCC33连接,第4引脚与GND连接,第5、6、7、8、9、10、11及16引脚均无电气连接,第12引脚与单片机P1.2连接,第13、14、15引脚为传感器输出电信号引脚,分别通过电阻R11、R10、R9与单片机的P6.0、P6.1、P6.2连接。
单片机控制单元采用的主控MSP430F169单片机,其工作电路如图5,图中电阻R1、复位按键RESET1、电容C0组成复位电路,Y1为低速晶振,Y2为高速晶振,二者共同构成单片机的片外晶振电路。
液晶显示部分采用12864液晶显示器的电路如图6,滑动电阻RP0调节液晶背景灯亮度,液晶8位数据口即第7至第14引脚分别与单片机P2.0至P2.7连接,液晶第4引脚与单片机P3.0连接,读写控制引脚5与P3.1连接,使能控制引脚6与P3.2连接,片选引脚15和16分别与单片机P3.3与P3.4连接,复位引脚17与单片机P3.5连接。
电源模块电路如图7,U0为AMS1085电源芯片,为系统提供正5伏电源,U1为LM1117电源芯片,为系统提供正3.3伏电源。
本发明的载物平台1的调平坐标如图8,ABCD表示载物平台,α表示载物平台与水平面在X轴方向的角度值,β表示载物平台与水平面在Y轴方向的角度值。不论载物平台如何倾斜,其调平运动过程均可以分解为X轴向和Y轴向两个方向角度的调节。
本发明的自动调平控制装置具体工作方式如下:高精度的MMA7260倾角传感器固定装在载物平台1上,实时检测载物平台的水平偏移角度,MSP430F169单片机内置的模数转换器(A/D)采样所述的传感器输出电信号,根据采样得到的数据不断计算载物平台1当前状态与水平状态X、Y两个轴向的偏移的角度差,单片机根据计算结果产生两路PWM驱动控制信号,控制X轴向舵机2与Y轴向舵机3两个轴旋转相应的角度,动态调整载物平台1,使载物平台1一直处于水平状态。液晶显示器实时显示载物平台X、Y轴向的倾角α、β的角度值。
本实施例中所选芯片仅为1个举例,其中倾角传感器水平检测单元可选用其他任意能够实现角度检测功能的高精度传感器;舵机调节单元可选用其他任意匹配的高精度、大扭力舵机;液晶显示单元可根据配置需要选用其他类型的显示器。
本发明的自动调平控制装置体积小精度高,适用范围广,可与经纬仪等仪器结合,调平方便快捷,可广泛应用于地质水文勘探、土木工程测量中,尤其适合用于水准仪、经纬仪等测绘仪器的自动调平,使测绘过程变得快捷方便,同时提高测绘数据的精度。

Claims (2)

1.一种基于单片机的自动调平控制装置,包括设备部分和自动控制部分,所述的设备部分设有载物平台,X轴向舵机,Y轴向舵机,基座,X、Y轴向转动机构和三轴加速度传感器;所述的自动控制部分设有单片机控制单元,舵机调节单元,倾角传感器水平检测单元和液晶显示单元;其特征在于:
所述的设备部分在基座上安装有X、Y轴向转动机构,X轴向舵机和Y轴向舵机安装在有两个轴相互正交垂直的X、Y轴向转动机构上,X轴向舵机和Y轴向舵机的旋转轴相互垂直,载物平台安装在X、Y轴向转动机构上方;三轴加速度传感器安装在载物平台下底面;所述的自动控制部分的单片机控制单元与舵机调节单元连接,单片机控制单元还分别与倾角传感器水平检测单元和液晶显示单元互连;单片机控制单元采用MSP430F169单片机作主控器作为自动控制部分的核心,单片机控制单元提供2个I/O口与舵机驱动电路电连接,单片机内置A/D提供3个I/O口与倾角传感器水平检测单元电连接,单片机控制单元用于实现对舵机调节单元、倾角传感器水平检测单元和液晶显示单元的控制;舵机调节单元设有X轴向舵机和Y轴向舵机的驱动电路,舵机调节单元用作调节X轴向舵机和Y轴向舵机的X、Y正交轴向的角度动作执行器,X轴向舵机和Y轴向舵机转动的角度通过改变单片机控制单元内部的定时器产生的脉冲宽度调制信号的占空比来实现;倾角传感器水平检测单元采用MMA7260三轴加速度传感器,三轴加速度传感器的X、Y轴分别与X轴向舵机和Y轴向舵机的旋转轴平行;所述的液晶显示单元连接的12864液晶显示器安装在载物平台上方,实时显示载物平台X、Y轴向的倾斜角度数值。
2.一种应用权利要求1所述的基于单片机的自动调平控制装置的调平方法,其特征在于:所述的高精度的MMA7260三轴加速度传感器实时检测载物平台的水平偏移角度,单片机控制单元通过MSP430F169内置的模数转换器A/D采集所述传感器输出的电信号,对倾角传感器水平检测单元输出信息的A/D数据不断计算分析载物平台当前状态与水平状态X、Y两个轴向的偏移的角度差,单片机根据计算结果产生两路PWM驱动控制信号,控制X轴向舵机与Y轴向舵机两个轴旋转相应的角度,实时动态调整载物平台,使载物平台一直处于水平状态,液晶显示器实时显示载物平台X、Y轴向的倾角α、β的角度值。
CN201210441535.3A 2012-11-08 2012-11-08 一种基于单片机的自动调平控制装置及调平方法 Expired - Fee Related CN102929295B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210441535.3A CN102929295B (zh) 2012-11-08 2012-11-08 一种基于单片机的自动调平控制装置及调平方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210441535.3A CN102929295B (zh) 2012-11-08 2012-11-08 一种基于单片机的自动调平控制装置及调平方法

Publications (2)

Publication Number Publication Date
CN102929295A CN102929295A (zh) 2013-02-13
CN102929295B true CN102929295B (zh) 2015-04-15

Family

ID=47644123

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210441535.3A Expired - Fee Related CN102929295B (zh) 2012-11-08 2012-11-08 一种基于单片机的自动调平控制装置及调平方法

Country Status (1)

Country Link
CN (1) CN102929295B (zh)

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104457784A (zh) * 2013-09-16 2015-03-25 刘危 能模拟tc-9a垂直陀螺功能及故障的仿真器
CN103488191B (zh) * 2013-09-27 2016-01-20 浙江水利水电学院 一种分布式调平控制器电路
CN104677357A (zh) * 2013-11-27 2015-06-03 哈尔滨恒誉名翔科技有限公司 一种基于单片机的小型稳定平台
CN104215229B (zh) * 2014-08-07 2017-05-24 广州市中海达测绘仪器有限公司 Rtk设备调节方法、系统及rtk测量方法
CN104949651B (zh) * 2015-07-21 2017-04-19 爱易成技术(天津)有限公司 水准尺自动安平装置
CN105823464A (zh) * 2016-04-25 2016-08-03 南昌航空大学 一种可自动调节角度的精密电子水平仪
CN105883666B (zh) * 2016-06-13 2018-09-21 龙岩学院 一种平衡升降运载装置
CN106003738A (zh) * 2016-08-08 2016-10-12 刘庆芳 一种3d打印机的打印平台调平装置
CN106800057B (zh) * 2016-12-14 2019-08-02 歌尔科技有限公司 一种双轮机器人平稳停车方法和系统
CN109143916B (zh) * 2017-11-16 2023-08-18 湖北汉丹机电有限公司 自适应水平调整装置
CN108437733B (zh) * 2018-03-15 2020-07-24 中国农业大学 高速农用车辆平台预检测主动调平系统及调平方法
CN108363404B (zh) * 2018-03-15 2020-09-29 中国农业大学 高精度农用车辆平台预检测主动调平系统及调平方法
CN108422825B (zh) * 2018-03-15 2020-07-24 中国农业大学 农用车辆作业平台预检测主动调平系统及调平方法
CN108981649A (zh) * 2018-06-28 2018-12-11 国家电网公司 一种用于线路弧垂测量的自调平装置
CN109263399A (zh) * 2018-11-22 2019-01-25 合肥学院 一种具有倾角可调节功能的艺术设计用画板
CN110617822A (zh) * 2019-09-27 2019-12-27 浙江大华机器人技术有限公司 导航仪、车辆及导航仪的自动调平方法
CN113395562B (zh) * 2020-03-13 2022-04-01 海信视像科技股份有限公司 一种显示设备及开机动画显示方法
CN116124192B (zh) * 2023-04-14 2023-07-11 迈泽锐(武汉)工业技术有限公司 传感器安装结构及传感器系统

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101551673A (zh) * 2009-03-30 2009-10-07 零八一电子集团有限公司 多点电动支撑平台的自动调平系统
CN101881626A (zh) * 2010-06-04 2010-11-10 上海市七宝中学 自校准水平载物装置
CN202267481U (zh) * 2011-07-13 2012-06-06 浙江海洋学院 一种小型水平稳定平台

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09198114A (ja) * 1996-01-23 1997-07-31 Nikon Corp Xyステージの移動制御方法
JP2005331402A (ja) * 2004-05-20 2005-12-02 Sumitomo Heavy Ind Ltd ステージ装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101551673A (zh) * 2009-03-30 2009-10-07 零八一电子集团有限公司 多点电动支撑平台的自动调平系统
CN101881626A (zh) * 2010-06-04 2010-11-10 上海市七宝中学 自校准水平载物装置
CN202267481U (zh) * 2011-07-13 2012-06-06 浙江海洋学院 一种小型水平稳定平台

Also Published As

Publication number Publication date
CN102929295A (zh) 2013-02-13

Similar Documents

Publication Publication Date Title
CN102929295B (zh) 一种基于单片机的自动调平控制装置及调平方法
CN202126265U (zh) 一种动态旋转调制的陀螺寻北仪
CN204831330U (zh) 一种三轴转台的姿态传感器测试系统
CN1948707B (zh) 基于磁阻和倾角传感器的捷联式钻孔测斜仪
CN202372173U (zh) 一种基于mems加速度计的便携式倾角传感器
CN205014978U (zh) 基于mems重力检测的数字水平仪
CN204631274U (zh) 一种定向器及空心包体应变计的安装设备
CN207423155U (zh) 基于双轴倾角检测的平面倾角测量系统
CN212843624U (zh) 一种便携式三轴光纤陀螺测姿系统
CN101762266B (zh) 二维数字倾角传感器
CN205561830U (zh) 一种可自动调节角度的精密电子水平仪
CN102927976B (zh) 一体化空间信息测量方法与装置
CN104536458A (zh) 一种便携式飞参数据标校方法及装置
CN109916385A (zh) 一种多工作模式飞机备用罗盘校验仪
CN205228472U (zh) 室内定位轨迹追踪器
CN216815436U (zh) 手工具的转动角度测量装置
CN104749639A (zh) 一种金属物体探测定位器
CN101329919A (zh) 一种转台调平方法
CN216485505U (zh) 一种多功能双目激光检测系统
CN105300353A (zh) 基于过采样技术的高精度倾角测量仪
CN206891435U (zh) 建筑工程造价现场测绘装置
CN201138205Y (zh) 多功能数字地质罗盘
CN206281486U (zh) 一种新型超低功耗倾角测量仪
CN203744924U (zh) 多功能角度测量工具
CN203550947U (zh) 一种用于监测机床水平变化的电子水平仪

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20150415

Termination date: 20151108

EXPY Termination of patent right or utility model