CN108089575B - 自移动设备定位装置和方法 - Google Patents
自移动设备定位装置和方法 Download PDFInfo
- Publication number
- CN108089575B CN108089575B CN201711185175.4A CN201711185175A CN108089575B CN 108089575 B CN108089575 B CN 108089575B CN 201711185175 A CN201711185175 A CN 201711185175A CN 108089575 B CN108089575 B CN 108089575B
- Authority
- CN
- China
- Prior art keywords
- boundary line
- electromagnetic sensor
- self
- voltage
- induced voltage
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
Abstract
本发明涉及一种自移动设备定位装置和方法,该装置包括第一电磁传感器及第二电磁传感器,用于当第一感应电压大于等于主控器的第一输出端输出的参考电压时输出同步采样信号的比较器,用于输出所述参考电压,且根据比较器输出的同步采样信号采样第二电磁传感器所输出的第二感应电压,当所述边界线位于所述第一电磁传感器和第二电磁传感器之间时,所述主控器根据所述第一感应电压与所述第二感应电压的关系,判断所述自移动设备相对于边界线的位置是否偏离预设相对位置。上述自移动设备定位装置和系统,通过比较器和主控器即可以实现边界线位置精确检测和定位,抛弃传统的高性能AD,在保证了高可靠性检测感应强度和高精度的前提下,降低了成本,应用范围较为广泛。
Description
技术领域
本发明涉及自动控制领域,特别是涉及一种自移动设备定位装置和方法。
背景技术
自移动设备在运行的过程中是自动控制的,因此其对定位的要求比较高,传统技术中是采用高性能AD(数模转换器)实现同步实时双通道采样,从而实现边界线相对位置检测的,但是该种方式成本高昂,不利于推广。
发明内容
基于此,有必要提供一种自移动设备定位装置和方法,其可以实现边界线位置精确检测和定位,成本低,可靠性强。
一种同步采样装置,所述装置包括第一电磁传感器,第二电磁传感器,比较器和主控器,所述第一电磁传感器用于在与边界线互感时输出第一感应电压,所述第二电磁传感器用于在与所述边界线互感时输出第二感应电压;所述比较器的第一输入端与所述第一电磁传感器的输出端相连接,第二输入端与主控器的第一输出端相连接,所述比较器用于当所述第一感应电压大于等于所述主控器的第一输出端输出的参考电压时,输出同步采样信号;所述主控器的第一输入端与所述比较器的输出端相连接,第二输入端与所述第二电磁传感器的输出端相连接,第三输入端与所述第一电磁传感器的输出端相连接,所述主控器用于输出所述参考电压,根据所述比较器输出的同步采样信号采样所述第二电磁传感器所输出的第二感应电压。
在其中一个实施例中,所述第一电磁传感器与所述第二电磁传感器均包括电感、电容、第一电阻、第二电阻与运算放大器,所述电感的第一端、所述电容的第一端以及所述运算放大器的第一输入端相连接,所述电感的第二端、所述电容的第二端、所述第一电阻的第一端相连接后接地,所述第一电阻的第二端、所述第二电阻的第一端以及所述运算放大器的第二输入端相连接,所述第二电阻的第二端与所述运算放大器的输出端相连接,所述运算放大器的输出端为所述第一电磁传感器或所述第二电磁传感器的输出端。
在其中一个实施例中,所述电容为可调电容。
在其中一个实施例中,所述装置还包括计时器,所述计时器用于记录比较器相邻两次输出的同步采样信号之间的时间间隔;所述主控器还用于比较所述时间间隔与所述边界线的信号周期之间的大小,且当所述时间间隔与所述边界线的信号周期之间的差值在预设范围内时,采样所述第二电磁传感器所输出的第二感应电压。
在其中一个实施例中,所述同步采样信号为所述比较器输出的触发沿信号。
在其中一个实施例中,所述主控器还用于在所述时间间隔与所述边界线的信号周期之间的差值大于等于所述预设范围的上限值时,降低所述主控器的第一输出端的输出的参考电压的大小;当所述时间间隔与所述边界线的信号周期之间的差值小于等于所述预设范围的下限值时,升高所述主控器的第一输出端的输出的参考电压的大小。
一种自移动设备定位装置,包括设置于所述自移动设备上的如上任一实施例所述的同步采样装置,当所述边界线位于所述第一电磁传感器和第二电磁传感器之间时,所述主控器根据所述第一感应电压与所述第二感应电压的关系,判断所述自移动设备相对于边界线的位置是否偏离预设相对位置。
在其中一个实施例中,若所述第一感应电压与所述第二感应电压的差值满足预设条件,则所述主控器判断自移动设备未偏离所述预设相对位置。
在其中一个实施例中,若所述第一感应电压与所述第二感应电压的差值不满足所述预设条件,则所述主控器判断自移动设备偏离所述预设相对位置。
在其中一个实施例中,所述预设条件为所述第一感应电压与所述第二感应电压的差值等于0。
在其中一个实施例中,所述装置还包括驱动控制模块,所述驱动控制模块的输入端与所述主控器的输出端相连接,当所述自移动设备相对于边界线的位置偏离所述预设相对位置时,所述驱动控制模块控制所述自移动设备转向,使得所述第一感应电压与所述第二感应电压的差值满足预设条件。
一种同步采样方法,包括以下步骤:与边界线互感的第一电磁传感器输出第一感应电压;比较所述第一感应电压与预设的参考电压的大小,在所述第一感应电压大于等于所述参考电压时输出同步采样信号;根据所述同步采样信号采集第二电磁传感器与边界线互感的第二感应电压。
在其中一个实施例中,所述方法还包括:记录相邻两次输出的同步采样信号之间的时间间隔。
在其中一个实施例中,所述根据所述同步采样信号采集第二电磁传感器与边界线互感的第二感应电压的步骤,包括:当所述时间间隔与所述边界线的信号周期之间的差值在预设范围内时,采集所述第二电磁传感器与所述边界线互感的第二感应电压。
在其中一个实施例中,所述记录相邻两次输出的同步采样信号之间的时间间隔的步骤具体为:记录相邻两次输出的触发沿信号之间的时间间隔。
在其中一个实施例中,所述方法还包括:当所述时间间隔与所述边界线的信号周期之间的差值大于等于所述预设范围的上限值时,减少所述参考电压的大小;当所述时间间隔与所述边界线的信号周期之间的差值小于等于所述预设范围的下限值时,增加所述参考电压的大小。
在其中一个实施例中,所述与边界线互感的第一电磁传感器输出第一感应电压的步骤之前还包括:根据所述边界线的信号周期调节所述第一电磁传感器的频率和所述第二电磁传感器的频率为所述边界线的固有频率。
一种自移动设备定位方法,包括如上任一实施例所述的同步采样方法,所述自移动设备定位方法还包括当边界线位于所述第一电磁传感器和第二电磁传感器之间时,根据所述第一感应电压与所述第二感应电压的关系,判断自移动设备判断所述自移动设备相对于边界线的位置是否偏离预设相对位置。
在其中一个实施例中,若所述第一感应电压与所述第二感应电压的差值满足预设条件,则所述主控器判断自移动设备相对于边界线的位置未偏离所述预设相对位置。
在其中一个实施例中,若所述第一感应电压与所述第二感应电压的差值不满足所述预设条件,则所述主控器判断自移动设备相对于边界线的位置偏离所述预设相对位置。
在其中一个实施例中,所述预设条件为所述第一感应电压与所述第二感应电压的差值等于0。
在其中一个实施例中,所述方法还包括:当所述自移动设备相对于边界线的位置偏离所述预设相对位置时,控制所述自移动设备转向,使得所述第一感应电压与所述第二感应电压的差值满足预设条件。
上述自移动设备定位装置和系统,通过比较器和主控器即可以实现边界线位置精确检测和定位,抛弃传统的高性能AD,在保证了高可靠性检测感应强度和高精度的前提下,降低了成本,应用范围较为广泛。
附图说明
图1为一实施例中自移动设备定位装置的结构示意图;
图2为图1所示实施例中的自移动设备定位装置的一应用场景图;
图3为图1所示实施例中的电磁传感器的结构示意图;
图4为图3所示实施例中的电磁传感器与边界线互感后的波形图;
图5为图1所示实施例中的自移动设备定位装置正常运行时的波形图;
图6为图1所示实施例中的自移动设备定位装置非正常运行时的波形图;
图7为图1所示实施例中的自移动设备定位装置非正常运行时的另一波形图;
图8为一实施例中自移动设备定位方法的流程图;
图9为图8所示实施例中的自移动设备定位方法的一应用图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用于解释本发明,并不用于限定本发明。
在详细说明根据本发明的实施例前,应该注意到的是,所述的实施例主要在于与自移动设备定位装置和方法相关的步骤和系统组件的组合。因此,所属系统组件和方法步骤已经在附图中通过常规符号在适当的位置表示出来了,并且只示出了与理解本发明的实施例有关的细节,以免因对于得益于本发明的本领域普通技术人员而言显而易见的那些细节模糊了本发明的公开内容。
在本文中,诸如左和右,上和下,前和后,第一和第二之类的关系术语仅仅用来区分一个实体或动作与另一个实体或动作,而不一定要求或暗示这种实体或动作之间的任何实际的这种关系或顺序。术语“包括”、“包含”或任何其他变体旨在涵盖非排他性的包含,由此使得包括一系列要素的过程、方法、物品或者设备不仅包含这些要素,而且还包含没有明确列出的其他要素,或者为这种过程、方法、物品或者设备所固有的要素。
请参阅图1所示,图1为一实施例中同步采样装置的结构示意图,在该实施例中,该装置可以包括设置于自移动设备上的第一电磁传感器、设置于自移动设备上的第二电磁传感器、比较器以及主控器。其中,比较器的第一输入端与第一电磁传感器的输出端相连接,比较器的第二输入端与主控器的第一输出端相连接,主控器的第一输入端与比较器的输出端相连接,该主控器的第二输入端与第二电磁传感器的输出端相连接,该主控器的第三输入端与第一电磁传感器的输出端相连接。
在该实施例中,请参阅图2所示,图2为图1所示实施例中的同步采样装置应用于自移动设备中,通过比较同步采样装置检测得到的两个电压确定自移动设备的前进方向上的中轴线与边界线的相对位置关系。可以理解的是,也可以确定自移动设备的第一电磁传感器或任一固定位置与边界线的相对位置关系。这里的相对位置关系指的是自移动设备的中轴线与边界线的左右相对位置关系,如自移动设备位于边界线上或中轴线在边界线的左侧1cm或右侧1cm等。其中,如图所示,边界线表示为垂直于纸面向里,根据右手定则,即用右手握住通电直导线,让大拇指指向电流的方向,那么四指的指向就是磁感线的环绕方向,图2中所示的虚线即边界线所产生的磁感线的方向,第一电磁传感器用于在与边界线互感时输出第一感应电压V1,第二电磁传感器用于在与边界线互感时输出第二感应电压V2。如果自移动设备是沿边界线行走的,即自移动设备的底盘的中心位于边界线上,则第一感应电压V1和第二感应电压V2相等(由于第一电磁传感器和第二电磁传感器是完全相同的),因此在实际应用中,可以通过检测同一时间第一感应电压V1和第二感应电压V2的大小来定位自移动设备,从而确保第一感应电压V1和第二感应电压V2是在同一时间检测的成为该实施例要解决的最重要的技术问题。
在该实施例中,可以通过设置比较器和主控器来实现第一感应电压V1和第二感应电压V2的同步采样。其中,继续参阅图1所示,主控器输出参考电压VDA至比较器的第二输入端,从而比较器可以在第一感应电压V1大于等于主控器输出的参考电压VDA时,输出同步采样信号。在该实施例中,主控器可以根据比较器输出的同步采样信号采样第二电磁传感器所输出的第二感应电压V2,且当第一感应电压V1和第二感应电压V2的大小不相等时,输出自移动设备相对于边界线的位置偏离预设相对位置的结果,当第一感应电压V1和第二感应电压V2的大小相等时,输出自移动设备相对于边界线的位置未偏离预设相对位置的结果。
该实施例中的自移动设备定位装置通过比较器和主控器即可以实现边界线位置精确检测和定位,抛弃传统的高性能AD,在保证了高可靠性检测感应强度和高精度的前提下,降低了成本,应用范围较为广泛。且一般在10位数模转换(用于将主控器产生的数字信号的参考电压转换为模拟信号的参考电压)和10位模数转换(用于将比较器输出的模拟信号转换为数字信号),且第一电磁传感器和第二电磁传感器之间的间距为15cm,第一电磁传感器和第二电磁传感器的高度为15cm的条件下,本实施例中的装置可以精确稳定测量偏离位置精度≤0.5mm,在更大放大倍数下,该精度可以更高。
在其中一个实施例中,请参阅图3所示,图3为图1所示实施例中的电磁传感器的结构示意图,在该实施例中,第一电磁传感器和第二电磁传感器完全相同,且第一电磁传感器与第二电磁传感器均可以包括电感L、电容C、第一电阻R1、第二电阻R2与运算放大器A,电感L的第一端、电容C的第一端以及运算放大器A的第一输入端相连接,电感L的第二端、电容C的第二端、第一电阻R1的第一端相连接后接地,第一电阻R1的第二端、第二电阻R2的第一端以及运算放大器A的第二输入端相连接,第二电阻R2的第二端与运算放大器A的输出端相连接,运算放大器A的输出端为第一电磁传感器或第二电磁传感器的输出端。该实施例中的电磁传感器结构简单,操作方便,成本低廉。
在其中一个实施例中,电容C可以为可调电容。这样可以通过设置电容C的电容值来调节谐振频率,以避开干扰频率。请参阅图4所示,图4为图3所示实施例中的电磁传感器与边界线互感后的波形图,其横坐标t表示时间,纵坐标表示V表示电压,其可以通过调节电容C的电容值将谐振频率调节为边界线的固有频率,从而保证谐振后的波形未失真。
请参阅图5所示,图5为图1所示实施例中的自移动设备定位装置正常运行时的波形图,其横坐标t表示时间,纵坐标表示V表示电压,在该实施例中,主控器输出一参考电压VDA,第一电磁传感器与边界线互感输出第一感应电压V1,当第一感应电压V1大于等于参考电压VDA时,比较器输出同步采样信号,主控器采样第二电磁传感器与边界线互感所输出的第二感应电压V2,如图5中所示的采样点M和N,从而实现第一电磁传感器和第二电磁传感器的同步采样。
在上述实施例中比较器输出的两相邻的同步采样信号之间的时间间隔在预设范围内,从而保证在边界线的一个信号周期内只采样一次,保证了装置的稳定性。在其中一个实施例中,装置还可以包括计时器,计时器可以用于记录比较器相邻两次输出的同步采样信号之间的时间间隔TD。主控器还可以用于判断时间间隔TD与边界线的信号周期T之间的大小,且当时间间隔TD与边界线的信号周期T之间的差值在预设范围内时,采样第二电磁传感器所输出的第二感应电压V2。在其中一个实施例中该预设范围可以为5/6T~7/6T之间,其中T为边界线的信号周期。在其中一个实施例中,同步采样信号可以为比较器输出的触发沿信号。具体可以参见图5所示的波形图中的上升沿触发信号,在图5中,比较器每次输出上升沿信号,则触发计时器工作,计算与上一次产生上升沿信号之间的时间间隔,如果该时间间隔在预设范围内,则同步采样第二感应电压V2。在该实施例中采样第一感应电压V1和第二感应电压V2之间的时间差与比较器的带宽、主控器的转换时间、系统响应延迟和边沿触发到启动主控器采样的时间等有关。但是该时间差可以通过提高上述的比较器、主控器的性能控制在微秒级,从而远远超过一般高性能ARM芯片的AD采样模块的采样频率,在低成本下实现高性能的同步采样。
在其中一个实施例中,当参考电压VDA较小时,请参阅图6所示,图6为图1所示实施例中的自移动设备定位装置非正常运行时的波形图,其横坐标t表示时间,纵坐标表示V表示电压。在该实施例中,由于参考电压VDA较小,在边界线的一个信号周期T内,存在多个第一感应电压V1等于参考电压VDA的情况,从而导致比较器在边界线的一个信号周期T内输出多个同步采样信号,即存在干扰或其他低幅信号触发。因此主控器还用于当时间间隔TD与边界线的信号周期T之间的差值小于等于预设范围的下限值时,升高主控器的第一输出端的输出的参考电压VDA的大小,从而保证比较器在边界线的一个信号周期T内输出一个同步采样信号,提高装置的稳定性。
在其中一个实施例中,当参考电压VDA较大时,请参阅图7所示,图7为图1所示实施例中的自移动设备定位装置非正常运行时的另一波形图,其横坐标t表示时间,纵坐标表示V表示电压。在该实施例中,由于参考电压VDA较大,在边界线的一个信号周期T内,不存在第一感应电压V1等于参考电压VDA的情况,比较器不会输出同步采样信号,在该种情况下,主控器还用于当时间间隔TD与边界线的信号周期T之间的差值大于等于预设范围的上限值时,降低主控器的第一输出端的输出的参考电压VDA的大小,在实际应用中,可以在超过边界线的一个信号周期T内未检测到比较器输出的同步采样信号时,降低主控器的第一输出端输出的参考电压VDA的大小,从而保证在边界线的每个信号周期T内,都能够准确追踪到第一感应电压V1的峰值,在本实施例中,该峰值可以看成第一感应电压V1的较高值,如图5中采样点M和N所示。
在其中一个实施例中,装置还可以包括驱动控制模块,驱动控制模块的输入端与主控器的输出端相连接,当自移动设备相对于边界线的位置偏离预设相对位置时,控制自移动设备转向,使得第一感应电压与第二感应电压的差值满足预设条件。
在其中一个实施例中,第一感应电压V1可以为:第二感应电压V2可以为:其中V1为第一感应电压,V2为第二感应电压,d为边界线偏离第一电磁传感器的距离,L为第一电磁传感器与第二电磁传感器之间的距离,K1为第一电磁传感器系数,K2为第二电磁传感器系数,h1为第一电磁传感器的高度,h2为第二电磁传感器的高度,当第一电磁传感器与第二电磁传感器的连线与地面平行时,即第一电磁传感器与第二电磁传感器处于同一高度时,K1=K2,h1=h2。因此如果在实际应用中需要求解边界线偏离第一电磁传感器的距离d,则可以通过上述公式进行求解。在本实施例中,由于边界线偏离第一电磁传感器的距离与V1-V2(第一感应电压和第二感应电压的差)之间是一一对应关系,因此在操作过程中不需要计算出边界线偏离第一电磁传感器的距离d,可以直接根据V1-V2的大小来判断出自移动设备是否偏离预设相对位置,从而在整个装置的工作状态中,对主控器的资源占用较少,控制简单,结果精度高可靠。
在其中一个实施例中,预设条件可以为第一感应电压与第二感应电压的差值等于0,相应的,预设相对位置为边界线位于自移动设备前进方向的中轴线上,当边界线未保持在中轴线而发生偏移时,即可以理解为自移动设备偏离预设相对位置。
在其中一个实施例中,预设条件也可以为第一感应电压与第二感应电压的差值为一个不等于0的固定值,相应的,预设相对位置未边界线位于自移动中轴线的左侧或右侧的某一位置,当自移动设备向左或向右偏离,即自移动设备偏离预设相对位置。具体的预设条件可以根据与自移动设备实现对接的充电站的位置进行设置。
在其中一个实施例中,同步采样方法可以包括以下步骤:
S601:与边界线互感的第一电磁传感器输出第一感应电压V1。
S602:比较所述第一感应电压V1与预设的参考电压的大小VDA,在所述第一感应电压V1大于等于所述参考电压VDA时输出同步采样信号。
S604:根据同步采样信号采集第二电磁传感器与边界线互感的第二感应电压V2。
请参阅图8所示,图8为一实施例中自移动设备定位方法的流程图,在该实施例中,该方法可以包括以下步骤:
S801:与边界线互感的第一电磁传感器输出第一感应电压V1。
S802:比较所述第一感应电压V1与预设的参考电压的大小VDA,在所述第一感应电压V1大于等于所述参考电压VDA时输出同步采样信号。
S804:根据同步采样信号采集第二电磁传感器与边界线互感的第二感应电压V2。
S806:判断第一感应电压V1与第二感应电压V2的关系。
S808:当第一感应电压V1和第二感应电压V2的差值不满足预设条件,判断自移动设备相对于边界线的位置偏离预设相对位置。
S810:当第一感应电压V1和第二感应电压V2的差值满足预设条件,判断自移动设备相对于边界线的位置未偏离预设相对位置。
该实施例中的自移动设备定位方法通过比较器和主控器即可以实现边界线位置精确检测和定位,抛弃传统的高性能AD,在保证了高可靠性检测感应强度和高精度的前提下,降低了成本,应用范围较为广泛。
在其中一个实施例中,该方法还可以包括记录相邻两次输出的同步采样信号之间的时间间隔TD;根据同步采样信号采集第二电磁传感器与边界线互感的第二感应电压V2的步骤,包括:当时间间隔TD与边界线的信号周期T之间的差值在预设范围内时,采集第二电磁传感器与边界线互感的第二感应电压V2。在其中一个实施例中,可以通过中断来实现上述功能,请参阅图9所示,图9为图8所示实施例中的自移动设备定位方法的一应用图。在该实施例中,首先初始化装置,并在第一电磁传感器和第二电磁传感器开启后,开启中断,当检测到同步采样信号时,中断触发,并计算相邻的中断间隔TD,即记录比较器相邻两次输出的同步采样信号之间的时间间隔TD,在其中一个实施例中可以为记录相邻两次输出的触发沿信号之间的时间间隔。
可以继续参见图9所示,该方法还可以包括:当时间间隔TD与边界线的信号周期T之间的差值大于等于预设范围的上限值时,减少参考电压VDA的大小。在其中一个实施例中可以以设定幅度Vdown以及时间比(TD/T)减少参考电压VDA。当时间间隔TD与边界线的信号周期T之间的差值小于等于预设范围的下限值时,增加参考电压VDA的大小。在其中一个实施例中可以以设定幅度Vup以及时间比(TD/T)抬升参考电压VDA。在其中一个实施例中预设范围的上限值可以为7/6T,T为边界线的信号周期,预设范围的下限值可以为5/6T。
在其中一个实施例中,与边界线互感的第一电磁传感器输出第一感应电压V1的步骤之前还包括:根据边界线的信号周期T调节第一电磁传感器的频率和第二电磁传感器的频率为边界线的固有频率。在实际应用中,可以通过改变电容C的电容值来进行调节。
在其中一个实施例中,方法还可以包括当输出自移动设备相对于边界线的位置偏离预设相对位置的结果时,控制自移动设备转向,使得自移动设备回到预设相对位置。在其中一个实施例中,可以通过PID控制算法,实时调整自移动设备的左右驱动轮的PWM占空比,以使得自移动设备回到预设相对位置。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (21)
1.一种同步采样装置,其特征在于,所述装置包括第一电磁传感器,第二电磁传感器,比较器和主控器,
所述第一电磁传感器用于在与边界线互感时输出第一感应电压,所述第二电磁传感器用于在与所述边界线互感时输出第二感应电压;
所述比较器的第一输入端与所述第一电磁传感器的输出端相连接,第二输入端与主控器的第一输出端相连接,所述比较器用于当所述第一感应电压大于等于所述主控器的第一输出端输出的参考电压时,输出同步采样信号;
所述主控器的第一输入端与所述比较器的输出端相连接,第二输入端与所述第二电磁传感器的输出端相连接,第三输入端与所述第一电磁传感器的输出端相连接,所述主控器用于输出所述参考电压,根据所述比较器输出的同步采样信号采样所述第二电磁传感器所输出的第二感应电压;
当所述边界线位于所述第一电磁传感器和第二电磁传感器之间时,所述主控器用于根据所述第一感应电压与所述第二感应电压的关系,判断自移动设备相对于边界线的位置是否偏离预设相对位置。
2.根据权利要求1所述的同步采样装置,其特征在于,所述第一电磁传感器与所述第二电磁传感器均包括电感、电容、第一电阻、第二电阻与运算放大器,所述电感的第一端、所述电容的第一端以及所述运算放大器的第一输入端相连接,所述电感的第二端、所述电容的第二端、所述第一电阻的第一端相连接后接地,所述第一电阻的第二端、所述第二电阻的第一端以及所述运算放大器的第二输入端相连接,所述第二电阻的第二端与所述运算放大器的输出端相连接,所述运算放大器的输出端为所述第一电磁传感器或所述第二电磁传感器的输出端。
3.根据权利要求2所述的同步采样装置,其特征在于,所述电容为可调电容。
4.根据权利要求1所述的同步采样装置,其特征在于,所述装置还包括计时器,所述计时器用于记录比较器相邻两次输出的同步采样信号之间的时间间隔;
所述主控器还用于比较所述时间间隔与所述边界线的信号周期之间的大小,且当所述时间间隔与所述边界线的信号周期之间的差值在预设范围内时,采样所述第二电磁传感器所输出的第二感应电压。
5.根据权利要求4所述的同步采样装置,其特征在于,所述同步采样信号为所述比较器输出的触发沿信号。
6.根据权利要求4所述的同步采样装置,其特征在于,所述主控器还用于在所述时间间隔与所述边界线的信号周期之间的差值大于等于所述预设范围的上限值时,降低所述主控器的第一输出端的输出的参考电压的大小;当所述时间间隔与所述边界线的信号周期之间的差值小于等于所述预设范围的下限值时,升高所述主控器的第一输出端的输出的参考电压的大小。
7.一种自移动设备定位装置,包括如权利要求1至6任意一项所述的同步采样装置,设置于自移动设备,其特征在于,当所述边界线位于所述第一电磁传感器和第二电磁传感器之间时,所述主控器根据所述第一感应电压与所述第二感应电压的关系,判断所述自移动设备相对于边界线的位置是否偏离预设相对位置。
8.根据权利要求7所述的自移动设备定位装置,其特征在于,若所述第一感应电压与所述第二感应电压的差值满足预设条件,则所述主控器判断自移动设备未偏离所述预设相对位置。
9.根据权利要求8所述的自移动设备定位装置,其特征在于,若所述第一感应电压与所述第二感应电压的差值不满足所述预设条件,则所述主控器判断自移动设备偏离所述预设相对位置。
10.根据权利要求8所述的自移动设备定位装置,其特征在于,所述预设条件为所述第一感应电压与所述第二感应电压的差值等于0。
11.根据权利要求7所述的自移动设备定位装置,其特征在于,所述装置还包括驱动控制模块,所述驱动控制模块的输入端与所述主控器的输出端相连接,当所述自移动设备相对于边界线的位置偏离所述预设相对位置时,所述驱动控制模块控制所述自移动设备转向,使得所述第一感应电压与所述第二感应电压的差值满足预设条件。
12.一种自移动设备定位方法,其特征在于,所述方法包括以下步骤:
与边界线互感的第一电磁传感器输出第一感应电压;
比较所述第一感应电压与预设的参考电压的大小,在所述第一感应电压大于等于所述参考电压时输出同步采样信号;
根据所述同步采样信号采集第二电磁传感器与边界线互感的第二感应电压;
当边界线位于所述第一电磁传感器和第二电磁传感器之间时,根据所述第一感应电压与所述第二感应电压的关系,判断自移动设备相对于边界线的位置是否偏离预设相对位置。
13.根据权利要求12所述的自移动设备定位方法,其特征在于,所述方法还包括:
记录相邻两次输出的同步采样信号之间的时间间隔。
14.根据权利要求13所述的自移动设备定位方法,其特征在于,所述根据所述同步采样信号采集第二电磁传感器与边界线互感的第二感应电压的步骤,包括:
当所述时间间隔与所述边界线的信号周期之间的差值在预设范围内时,采集所述第二电磁传感器与所述边界线互感的第二感应电压。
15.根据权利要求14所述的自移动设备定位方法,其特征在于,所述记录相邻两次输出的同步采样信号之间的时间间隔的步骤具体为:
记录相邻两次输出的触发沿信号之间的时间间隔。
16.根据权利要求14所述的自移动设备定位方法,其特征在于,所述方法还包括:
当所述时间间隔与所述边界线的信号周期之间的差值大于等于所述预设范围的上限值时,减少所述参考电压的大小;
当所述时间间隔与所述边界线的信号周期之间的差值小于等于所述预设范围的下限值时,增加所述参考电压的大小。
17.根据权利要求12所述的自移动设备定位方法,其特征在于,所述与边界线互感的第一电磁传感器输出第一感应电压的步骤之前还包括:
根据所述边界线的信号周期调节所述第一电磁传感器的频率和所述第二电磁传感器的频率为所述边界线的固有频率。
18.根据权利要求12所述的自移动设备定位方法,其特征在于,若所述第一感应电压与所述第二感应电压的差值满足预设条件,则判断所述自移动设备相对于边界线的位置未偏离所述预设相对位置。
19.根据权利要求18所述的自移动设备定位方法,其特征在于,若所述第一感应电压与所述第二感应电压的差值不满足所述预设条件,则判断所述自移动设备相对于边界线的位置偏离所述预设相对位置。
20.根据权利要求12所述的自移动设备定位方法,其特征在于,所述预设条件为所述第一感应电压与所述第二感应电压的差值等于0。
21.根据权利要求12所述的自移动设备定位方法,其特征在于,所述方法还包括:
当所述自移动设备相对于边界线的位置偏离所述预设相对位置时,控制所述自移动设备转向,使得所述第一感应电压与所述第二感应电压的差值满足预设条件。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2016110410020 | 2016-11-23 | ||
CN201611041002 | 2016-11-23 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108089575A CN108089575A (zh) | 2018-05-29 |
CN108089575B true CN108089575B (zh) | 2021-08-10 |
Family
ID=62172199
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711185175.4A Active CN108089575B (zh) | 2016-11-23 | 2017-11-23 | 自移动设备定位装置和方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108089575B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111913479B (zh) * | 2019-05-09 | 2024-03-19 | 苏州科瓴精密机械科技有限公司 | 自移动设备的行走控制方法、装置、设备及存储介质 |
CN113778069A (zh) * | 2020-06-10 | 2021-12-10 | 纳恩博(北京)科技有限公司 | 电移动装置、充电桩和控制电移动装置的方法 |
CN115373375B (zh) * | 2021-05-18 | 2023-08-18 | 未岚大陆(北京)科技有限公司 | 机器人的返回充电桩的方法、装置、机器人及存储介质 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1030873A (en) * | 1962-03-23 | 1966-05-25 | Ass Elect Ind | Improvements relating to vehicle guidance systems |
CN1087736A (zh) * | 1992-08-31 | 1994-06-08 | 佳能株式会社 | 串行打印机 |
CN1846141A (zh) * | 2003-09-09 | 2006-10-11 | 株式会社爱德万测试 | 校准比较器电路 |
CN102735746A (zh) * | 2011-04-15 | 2012-10-17 | 北京化工大学 | 金属管道漏磁信号封闭式检测装置及数据高速传输方法 |
US8319491B2 (en) * | 2009-02-03 | 2012-11-27 | Infineon Technologies Ag | System including circuit that determines calibration values |
CN102890505A (zh) * | 2011-07-18 | 2013-01-23 | 苏州宝时得电动工具有限公司 | 边界系统 |
CN103018686A (zh) * | 2011-09-27 | 2013-04-03 | 精工电子有限公司 | 磁传感器装置 |
CN103208956A (zh) * | 2013-04-28 | 2013-07-17 | 西安科技大学 | 电机霍尔位置传感器安装误差自动检测与补偿装置及方法 |
CN103718410A (zh) * | 2011-05-31 | 2014-04-09 | 维斯塔斯风力系统集团公司 | 用于产生针对电网的电压变化的惯性响应的系统和方法 |
CN105652228A (zh) * | 2015-12-30 | 2016-06-08 | 威海华菱光电股份有限公司 | 磁传感器补正装置和方法 |
CN107040170A (zh) * | 2017-03-14 | 2017-08-11 | 中国科学院长春光学精密机械与物理研究所 | 一种小功率永磁同步电机控制系统及控制方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62183214A (ja) * | 1986-02-07 | 1987-08-11 | Canon Inc | ピ−ク検出回路 |
WO1989010464A1 (fr) * | 1988-04-19 | 1989-11-02 | Blis | Procede et dispositif pour surveiller la progression dans le sol d'une tete de forage |
JP2876335B2 (ja) * | 1990-05-10 | 1999-03-31 | 有限会社タクマ精工 | 自走式台車における駆動輪上下動装置 |
CN1144924A (zh) * | 1995-06-07 | 1997-03-12 | 梁志勇 | 开关型边缘位移控制装置 |
DE19642871C2 (de) * | 1996-10-17 | 2001-06-13 | Reinhausen Maschf Scheubeck | Meßschaltung für Spannungsregler |
DE10032257C2 (de) * | 2000-07-03 | 2003-06-05 | Infineon Technologies Ag | Verfahren und Vorrichtung zur offsetspannungsfreien Spannungsmessung und Einstellung der Spannung einer Referenzspannungsquelle einer integrierten Halbleiterschaltung |
US7642788B2 (en) * | 2006-12-04 | 2010-01-05 | Fluke Corporation | Voltage measurement instrument and method having improved automatic mode operation |
JP4835960B2 (ja) * | 2009-04-24 | 2011-12-14 | 村田機械株式会社 | 移動体システム |
JP5366681B2 (ja) * | 2009-06-29 | 2013-12-11 | 株式会社ワコム | 位置検出装置 |
CN102183687A (zh) * | 2011-02-18 | 2011-09-14 | 广西师范大学 | 基于交流采样的can传输的三相电力电流传感器 |
CN103369270B (zh) * | 2013-06-29 | 2016-08-10 | 天津大学 | 大动态数字像素传感器相关双采样方法 |
CN104237623B (zh) * | 2014-10-08 | 2017-04-12 | 武汉弈飞科技有限公司 | 一种高精度电流传感器检测电路及其检测方法 |
CN105353695B (zh) * | 2015-12-10 | 2017-09-05 | 成都理工大学 | 一种反馈型事件驱动式模拟信号变频采集电路和集采方法 |
CN105824312B (zh) * | 2016-03-14 | 2018-09-25 | 山东拓步教育科技有限公司 | 一种基于霍尔定位系统的精确定位装置及定位方法 |
-
2017
- 2017-11-23 CN CN201711185175.4A patent/CN108089575B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1030873A (en) * | 1962-03-23 | 1966-05-25 | Ass Elect Ind | Improvements relating to vehicle guidance systems |
CN1087736A (zh) * | 1992-08-31 | 1994-06-08 | 佳能株式会社 | 串行打印机 |
CN1846141A (zh) * | 2003-09-09 | 2006-10-11 | 株式会社爱德万测试 | 校准比较器电路 |
US8319491B2 (en) * | 2009-02-03 | 2012-11-27 | Infineon Technologies Ag | System including circuit that determines calibration values |
CN102735746A (zh) * | 2011-04-15 | 2012-10-17 | 北京化工大学 | 金属管道漏磁信号封闭式检测装置及数据高速传输方法 |
CN103718410A (zh) * | 2011-05-31 | 2014-04-09 | 维斯塔斯风力系统集团公司 | 用于产生针对电网的电压变化的惯性响应的系统和方法 |
CN102890505A (zh) * | 2011-07-18 | 2013-01-23 | 苏州宝时得电动工具有限公司 | 边界系统 |
CN103018686A (zh) * | 2011-09-27 | 2013-04-03 | 精工电子有限公司 | 磁传感器装置 |
CN103208956A (zh) * | 2013-04-28 | 2013-07-17 | 西安科技大学 | 电机霍尔位置传感器安装误差自动检测与补偿装置及方法 |
CN105652228A (zh) * | 2015-12-30 | 2016-06-08 | 威海华菱光电股份有限公司 | 磁传感器补正装置和方法 |
CN107040170A (zh) * | 2017-03-14 | 2017-08-11 | 中国科学院长春光学精密机械与物理研究所 | 一种小功率永磁同步电机控制系统及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108089575A (zh) | 2018-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108089575B (zh) | 自移动设备定位装置和方法 | |
US10966021B2 (en) | Transducer controller and method therefor | |
EP3074779B1 (en) | Inductive position sensing with single channel interface to multiple resonant sensors | |
JP4897886B2 (ja) | 静電容量型近接センサおよび近接検知方法 | |
WO2015135318A1 (zh) | 指纹检测电路和指纹检测装置 | |
US9575096B2 (en) | Systems and methods to monitor current in switching converters | |
US20140306680A1 (en) | External Ramp Autotuning for Current Mode Control of Switching Converter | |
CN107453733B (zh) | 一种温度自适应的铁氧体开关驱动器 | |
US20210389842A1 (en) | Detection device | |
KR101394465B1 (ko) | 터치 감지 장치 구동 방법 및 이를 이용한 터치 감지 장치 | |
CN109917179B (zh) | 基于功率器件寄生电感的电流检测系统及电流检测方法 | |
US9337725B2 (en) | Output current control in a boundary conduction mode buck converter | |
CN110741542A (zh) | 半导体元件的驱动电路 | |
KR20180121357A (ko) | 브리지 센서 바이어싱 및 판독방법 | |
CN102298084A (zh) | 电流传感器 | |
US10578654B2 (en) | Apparatus and methods for processing sensed current | |
US20150222256A1 (en) | Signal processing circuit | |
CN105976861B (zh) | 一种利用spwm控制实现的大功率忆阻器电路 | |
KR20210089217A (ko) | 타이밍 감지 회로를 위한 자기장 펄스 전류 감지 | |
US9857496B2 (en) | Positioning device | |
WO2020144951A1 (ja) | ゲート駆動装置、スイッチング装置 | |
CN112953181A (zh) | 固定导通时间电源转换器的电流检测电路及方法 | |
JP5275310B2 (ja) | Dc−dc変換器及びdc−dc変換器用回路 | |
KR101731088B1 (ko) | 정전용량센서 잡음 제거 장치 | |
US20210365058A1 (en) | Analog front end with pulse width modulation current compensation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |