一种位置检测算法及装置

文档序号:403860 发布日期:2021-12-17 浏览:3次 >En<

阅读说明:本技术 一种位置检测算法及装置 (Position detection algorithm and device ) 是由 胡孟友 于 2021-09-16 设计创作,主要内容包括:本发明涉及测量装置领域,具体涉及一种位置检测算法及装置,支撑架与底座固定连接,通过转向电机转动带动传动齿轮转动,从而可以带动指向杆转动,锁紧套设置在指向杆的两侧,锁紧套可以滑动夹紧指向杆以固定位置,转轮与指向杆转动连接,使得转轮可以相对指向杆转动,通过测量器壳对转轮的转动角度进行测量,然后结合转轮的半径就可以计算移动距离,最后一圈的转动角度通过测量尺进行测量。通过指向杆可以使得转轮沿任意方向移动进行测量,然后通过锁紧套可以对指向杆的位置进行锁定,使得移动更加稳定,然后通过测量器和测量尺结合对移动的长度和位置进行测量,使得可以更加精确地、低成本地对位置进行检测。(The invention relates to the field of measuring devices, in particular to a position detection algorithm and a position detection device. Can make the runner remove along arbitrary direction through directional pole and measure, then can lock the position of directional pole through the lock sleeve for it is more stable to remove, then combines to measure the length and the position of removing through caliber and dipperstick, makes can detect the position more accurately, with low costs.)

一种位置检测算法及装置

技术领域

本发明涉及测量装置领域,尤其涉及一种位置检测算法及装置。

背景技术

目前市场上的位置测量工具很多,例如:发条尺、卷尺、盒尺、皮尺等。用这些测量工具可以精确的测量较小尺度的直线长度。但在较大尺度,精度要求不高的野外电缆铺设、建筑施工等领域,特别是需要测量曲线长度时,使用很不方便,检测精度低。

发明内容

本发明的目的在于提供一种位置检测算法及装置,旨在解决现有的设备位置检测精度较低的问题。

为实现上述目的,第一方面,本发明提供了一种位置检测装置,包括支撑组件、测量组件和控制器,所述支撑组件包括底座、支撑架、指向杆、转向电机、传动齿轮和锁紧套,所述支撑架与所述底座固定连接,并位于所述底座的一侧,所述转向电机设置在所述支撑架的一侧,所述传动齿轮与所述转向电机连接,并与所述指向杆啮合,所述锁紧套设置在所述指向杆的两侧,所述测量组件包括转轮、测量器、测量尺和防滑圈,所述转轮与所述指向杆转动连接,并位于所述指向杆靠近所述底座的一侧,所述测量器设置在所述转轮的一侧,所述测量尺设置在所述转轮的一侧,所述防滑圈与所述转轮固定连接,并位于所述转轮外侧。

其中,所述支撑组件还包括推手,所述推手与所述底座转动连接,并位于所述底座的一侧。

通过手持所述推手可以更加方便地移动本装置。

其中,所述锁紧套包括夹紧电机、双螺纹螺杆和两个滑块,两个所述滑块滑动设置在所述指向杆的两侧,所述双螺纹螺杆与两个所述滑块螺纹连接,两个所述滑块位于所述双螺纹螺杆的两侧,所述夹紧电机的输出端与所述双螺纹螺杆连接。

所述夹紧电机可以带动所述双螺纹螺杆转动,从而可以带动两个所述滑块相互靠近而夹紧所述转向器,从而可以锁定移动方向,避免在移动过程中偏位。

其中,所述转轮具有刻度线,所述刻度线分布在所述转轮的圆周上。

所述刻度线便于分辨所述转轮最后一圈的移动距离。

其中,所述测量尺包括尺体、转杆和霍尔传感器,所述尺体具有磁铁,所述尺体与所述支撑架固定连接,并位于所述转轮的一侧,所述转杆与所述尺体转动连接,并位于所述尺体的一侧,所述霍尔传感器设置在所述转杆上。

所述尺体用于竖直提供参考,通过转动所述转杆和所述刻度线上的刻度对齐,所述霍尔传感器会和所述磁铁之间的距离产生变化,从而可以计算出转动角度,便于更加准确地计算出最后一圈的距离。

其中,所述测量器包括光栅和光电传感器,所述光栅与所述转轮固定连接,并位于所述转轮的一侧,所述光电传感器设置在所述光栅的一侧,并与所述控制器连接。

所述光栅跟随所述转轮一起转动,从而可以通过所述光电传感器根据接收信号的明暗变化计算转轮转过的圈数和角度,以计算装置的位置,同时也可以得出长度。

其中,所述控制器包括获取单元、计算单元和显示单元,所述获取单元与所述霍尔传感器和所述光电传感器连接,所述计算单元与所述获取单元连接,所述显示单元与所述计算单元连接。

第二方面,本发明还提供一种位置检测算法,包括:分别获取光电传感器得到的光信号和霍尔传感器产生的磁信号;

将光信号结合转轮半径计算圈数距离;

基于磁信号计算霍尔传感器到磁铁的移动距离;

基于移动距离和霍尔传感器到转动中心的距离计算转动角度;

基于转动角度和转轮半径计算剩余距离;

将圈数距离和剩余距离相加得到移动距离。

本发明的一种位置检测算法及装置,所述支撑架与所述底座固定连接,并位于所述底座的一侧,通过所述支撑架和所述底座对整个装置进行支撑,所述转向电机设置在所述支撑架的一侧,所述传动齿轮与所述转向电机连接,并与所述指向杆啮合,通过所述转向电机转动,可以带动所述传动齿轮转动,从而可以带动所述指向杆转动,所述锁紧套设置在所述指向杆的两侧,所述锁紧套可以滑动夹紧所述指向杆以固定位置,或者松开以允许所述指向杆自由移动。所述测量组件包括转轮、测量器、测量尺和防滑圈,所述转轮与所述指向杆转动连接,并位于所述指向杆靠近所述底座的一侧,使得所述转轮可以相对所述指向杆转动,所述测量器设置在所述转轮的一侧,通过所述测量器壳对所述转轮的转动角度进行测量,然后结合所述转轮的半径就可以计算移动距离,所述测量尺设置在所述转轮的一侧,由于光栅是具有多个高精度孔的圆板,孔越多,就越准确,但是成本就越高,因此本发明采用普通的光栅以计算圈数,最后一圈的转动角度通过所述测量尺进行测量,所述防滑圈与所述转轮固定连接,并位于所述转轮外侧,通过所述防滑圈与地面接触以提高摩擦力,避免所述转轮打滑导致计算出错。通过指向杆可以使得转轮沿任意方向移动进行测量,然后通过所述锁紧套可以对所述指向杆的位置进行锁定,使得移动更加稳定,然后通过所述测量器和所述测量尺结合对移动的长度和位置进行测量,使得可以更加精确地、低成本地对位置进行检测和测量。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。

图1是本发明的一种位置检测装置的底部结构图;

图2是本发明的一种位置检测装置的第二底部结构图;

图3是本发明的一种位置检测装置的顶部结构图;

图4是本发明的一种位置检测装置的正面结构图;

图5是本发明的一种位置检测装置的侧面图;

图6是本发明的控制器的结构图;

图7是本发明的一种位置检测算法的流程图。

1-支撑组件、2-测量组件、3-控制器、11-底座、12-支撑架、13-指向杆、14-转向电机、15-传动齿轮、16-锁紧套、17-推手、18-定位杆、19-转动电机、20-后轮、21-转轮、22-测量器、23-测量尺、24-防滑圈、31-获取单元、32-计算单元、33-显示单元、161-夹紧电机、162-双螺纹螺杆、163-滑块、211-刻度线、221-光栅、222-光电传感器、231-尺体、232-转杆、233-霍尔传感器、2311-磁铁。

具体实施方式

下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。

在本发明的描述中,需要理解的是,术语“长度”、“宽度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,在本发明的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。

请参阅图1~图6,本发明提供一种位置检测装置:

包括支撑组件1、测量组件2和控制器3,所述支撑组件1包括底座11、支撑架12、指向杆13、转向电机14、传动齿轮15和锁紧套16,所述支撑架12与所述底座11固定连接,并位于所述底座11的一侧,所述转向电机14设置在所述支撑架12的一侧,所述指向杆13与所述支撑架12转动连接,并位于所述转向电机14的一侧,所述传动齿轮15与所述转向电机14连接,并与所述指向杆13啮合,所述锁紧套16设置在所述指向杆13的两侧,所述测量组件2包括转轮21、测量器22、测量尺23和防滑圈24,所述转轮21与所述指向杆13转动连接,并位于所述指向杆13靠近所述底座11的一侧,所述测量器22设置在所述转轮21的一侧,所述测量尺23设置在所述转轮21的一侧,所述防滑圈24与所述转轮21固定连接,并位于所述转轮21外侧。

在本实施方式中,所述支撑架12与所述底座11固定连接,并位于所述底座11的一侧,通过所述支撑架12和所述底座11对整个装置进行支撑,所述转向电机14设置在所述支撑架12的一侧,所述传动齿轮15与所述转向电机14连接,并与所述指向杆13啮合,通过所述转向电机14转动,可以带动所述传动齿轮15转动,从而可以带动所述指向杆13转动,所述锁紧套16设置在所述指向杆13的两侧,所述锁紧套16可以滑动夹紧所述指向杆13以固定位置,或者松开以允许所述指向杆13自由移动。所述测量组件2包括转轮21、测量器22、测量尺23和防滑圈24,所述转轮21与所述指向杆13转动连接,并位于所述指向杆13靠近所述底座11的一侧,使得所述转轮21可以相对所述指向杆13转动,所述测量器22设置在所述转轮21的一侧,通过所述测量器22壳对所述转轮21的转动角度进行测量,然后结合所述转轮21的半径就可以计算移动距离,所述测量尺23设置在所述转轮21的一侧,由于光栅221是具有多个高精度孔的圆板,孔越多,就越准确,但是成本就越高,因此本发明采用普通的光栅221以计算圈数,最后一圈的转动角度通过所述测量尺23进行测量,所述防滑圈24与所述转轮21固定连接,并位于所述转轮21外侧,通过所述防滑圈24与地面接触以提高摩擦力,避免所述转轮21打滑导致计算出错。通过指向杆13可以使得转轮21沿任意方向移动进行测量,然后通过所述锁紧套16可以对所述指向杆13的位置进行锁定,使得移动更加稳定,然后通过所述测量器22和所述测量尺23结合对移动的长度和位置进行测量,使得可以更加精确地、低成本地对位置进行检测和测量。

进一步的,所述支撑组件1还包括推手17,所述推手17与所述底座11转动连接,并位于所述定位杆18的一侧;所述支撑组件1还包括定位杆18,所述定位杆18与所述推手17转动连接,并位于所述推手17的一侧。

在本实施方式中,通过手持所述推手17可以更加方便地移动本装置。在移动到指定位置时,转动所述推手17靠近地面,使得所述定位杆18在重力作用下垂直于地面,从而可以插入地面以固定位置。

进一步的,所述支撑组件1还包括转动电机19和后轮20,所述后轮20与所述底座11转动连接,所述转动电机19的输出端与所述后轮20连接。

在本实施方式中,所述转动电机19可以带动所述后轮20转动,使得可以辅助人力前进,使得移动更加轻松。

进一步的,所述锁紧套16包括夹紧电机161、双螺纹螺杆162和两个滑块163,两个所述滑块163滑动设置在所述指向杆13的两侧,所述双螺纹螺杆162与两个所述滑块163螺纹连接,两个所述滑块163位于所述双螺纹螺杆162的两侧,所述夹紧电机161的输出端与所述双螺纹螺杆162连接。

在本实施方式中,所述夹紧电机161可以带动所述双螺纹螺杆162转动,从而可以带动两个所述滑块163相互靠近而夹紧所述转向器,从而可以锁定移动方向,避免在移动过程中偏位。

进一步的,所述转轮21具有刻度线211,所述刻度线211分布在所述转轮21的圆周上。

在本实施方式中,所述刻度线211便于分辨所述转轮21最后一圈的移动距离。

进一步的,所述测量器22包括光栅221和光电传感器222,所述光栅221与所述转轮21固定连接,并位于所述转轮21的一侧,所述光电传感器222设置在所述光栅221的一侧,并与所述控制器3连接;所述测量尺23包括尺体231、转杆232和霍尔传感器233,所述尺体231具有磁铁2311,所述尺体231与所述支撑架12固定连接,并位于所述转轮21的一侧,所述转杆232与所述尺体231转动连接,并位于所述尺体231的一侧,所述霍尔传感器233设置在所述转杆232上;所述控制器3包括获取单元31、计算单元32和显示单元33,所述获取单元31与所述霍尔传感器233和所述光电传感器222连接,所述计算单元32与所述获取单元31连接,所述显示单元33与所述计算单元32连接。

在本实施方式中,所述光栅221跟随所述转轮21一起转动,从而可以通过所述光电传感器222根据接收信号的明暗变化计算转轮21转过的圈数和角度,以计算装置的位置,同时也可以得出长度。此处只采用光栅221计算圈数以节省成本,至于最后一圈的读数,可以首先采用刻度线211读出整数值,然后不足刻度的部分,通过所述尺体231用于竖直提供参考,通过转动所述转杆232和所述刻度线211上的刻度对齐,所述霍尔传感器233会和所述磁铁2311之间的距离产生变化,从而产生相应的电信号的变化,可以计算出转动角度,便于更加准确地计算出最后一圈的距离。所述获取单元31用于获取所述光电传感器222得到的光信号和所述霍尔传感器233产生的磁信号,并通过所述计算单元32进行转换得到距离,然后通过所述显示单元33进行显示。

第二方面,请参阅图7,本发明还提供一种位置检测算法,包括:

S101分别获取光电传感器222得到的光信号和霍尔传感器233产生的磁信号;

S102将光信号结合转轮21半径计算圈数距离;

一个光信号就代表转轮21转动一圈,结合光信号和转轮21半径可以计算圈数距离。

S103基于磁信号计算霍尔传感器233到磁铁2311的移动距离;

基于霍尔效应的公式,霍尔传感器233的取值可以得到移动距离。

S104基于移动距离和霍尔传感器233到转动中心的距离计算转动角度;

转动角度的正弦值等于移动距离处以霍尔传感器233到转动中心的距离,从而可以以反三角函数计算移动距离。

S105基于转动角度和转轮21半径计算剩余距离;

S106将圈数距离和剩余距离相加得到移动距离。

以上所揭露的仅为本发明一种较佳实施例而已,当然不能以此来限定本发明之权利范围,本领域普通技术人员可以理解实现上述实施例的全部或部分流程,并依本发明权利要求所作的等同变化,仍属于发明所涵盖的范围。

14页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种地基基础工程用施工层厚度检测装置

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!