CN107340776A - 一种全方位智能跟随行李箱及其控制方法 - Google Patents
一种全方位智能跟随行李箱及其控制方法 Download PDFInfo
- Publication number
- CN107340776A CN107340776A CN201710794810.2A CN201710794810A CN107340776A CN 107340776 A CN107340776 A CN 107340776A CN 201710794810 A CN201710794810 A CN 201710794810A CN 107340776 A CN107340776 A CN 107340776A
- Authority
- CN
- China
- Prior art keywords
- msub
- msubsup
- mrow
- mtd
- ultrasonic
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000009184 walking Effects 0.000 claims abstract description 7
- 238000005457 optimization Methods 0.000 claims description 9
- 238000009826 distribution Methods 0.000 claims description 5
- 230000003321 amplification Effects 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 3
- 238000000354 decomposition reaction Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 3
- 230000002441 reversible effect Effects 0.000 claims description 3
- 238000007493 shaping process Methods 0.000 claims description 3
- 230000005021 gait Effects 0.000 claims description 2
- 230000015572 biosynthetic process Effects 0.000 claims 1
- 239000000203 mixture Substances 0.000 claims 1
- 238000003786 synthesis reaction Methods 0.000 claims 1
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000002604 ultrasonography Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000012369 In process control Methods 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 238000010965 in-process control Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 210000003205 muscle Anatomy 0.000 description 1
- 230000033764 rhythmic process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- A—HUMAN NECESSITIES
- A45—HAND OR TRAVELLING ARTICLES
- A45C—PURSES; LUGGAGE; HAND CARRIED BAGS
- A45C13/00—Details; Accessories
- A45C13/18—Devices to prevent theft or loss of purses, luggage or hand carried bags
-
- A—HUMAN NECESSITIES
- A45—HAND OR TRAVELLING ARTICLES
- A45C—PURSES; LUGGAGE; HAND CARRIED BAGS
- A45C5/00—Rigid or semi-rigid luggage
- A45C5/04—Trunks; Travelling baskets
- A45C5/045—Travelling baskets
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/42—Simultaneous measurement of distance and other co-ordinates
-
- 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/12—Target-seeking control
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- General Electrical Machinery Utilizing Piezoelectricity, Electrostriction Or Magnetostriction (AREA)
Abstract
本发明公开了一种全方位智能跟随行李箱，其包括发射装置和箱体，所述发射装置包括电源，控制组件A和超声波发射器，所述箱体上设有四个超声波接收器和行走装置，所述四个超声波接收器位于同一接收平面上，发射装置通过超声波发射器向超声波接收器发送超声波信号，所述行走装置包括控制组件B和全向轮组，所述全向轮组包括至少三个全向轮及其各自对应的驱动马达，控制组件B接收超声波接收器的信号后向所述驱动马达发送驱动信号，驱动马达根据接收的驱动信号驱动全向轮行走。本发明的行李箱大大提高了定位和跟踪过程的准确性；其次，车轮采用全向轮，使转弯和行走更方便。
Description
技术领域
本发明涉及一种全方位智能跟随行李箱及其控制方法，属于智能控制技术领域。
背景技术
随着社会现代化的快速发展，人们工作节奏加快，以及人们对生活品质要求的不断提高，出差和旅行，已成为大家工作和生活必不可少的一部分。在出差或旅行中，很多人会为拎着重重的行李箱而烦恼。目前行李箱多为拉杆式，需要人工拖拽，耗费体力，在行走过程中多有不便。
虽然，现在也出现了一些智能行李箱，但这些行李箱仍存在一些缺陷，主要有：(1)通常只能用单种传感器：如用蓝牙传感器进行避障而不是跟随。(2)有的用超声波的，只有三个接收器，其定位不精确，反应不灵敏，只可以得出1组粗略值，而不能得到精准值。(3)不能全方位移动，所以不方便。
发明内容
本发明的目的在于提供一种定位精确、反应灵敏、移动更方便的全方位智能跟随行李箱。
本发明采取的技术方案是：一种全方位智能跟随行李箱，其包括发射装置和箱体，所述发射装置包括电源，控制组件A和超声波发射器，所述箱体上设有四个超声波接收器和行走装置，所述四个超声波接收器位于同一接收平面上，发射装置通过超声波发射器向超声波接收器发送超声波信号，所述行走装置包括控制组件B和全向轮组，所述全向轮组包括至少三个全向轮及其各自对应的驱动马达，控制组件B接收超声波接收器的信号后向所述驱动马达发送驱动信号，驱动马达根据接收的驱动信号驱动全向轮行走。
进一步的，所述控制组件B的处理器采用单片机，且控制组件B包括相互通信的主单片机和从单片机，所述主单片机连接四个超声波接收器并接收四个超声波接收器的信号，所述从单片机通过电机驱动电路连接驱动马达，驱动马达带动全向轮转动。
进一步的，所述全向轮和驱动马达通过轮架和底板安装在箱体底部，轮架与底板连接，且在轮架和底板之间设有伸缩部件，该伸缩部件包括减震轴和减振弹簧，减振弹簧套装在减震轴上。
进一步的，所述全向轮组包括三个全向轮和三个驱动马达，所述三个全向轮呈三角分布，并等分均匀的安装在箱体下方，所述三个驱动马达互成120°角。
进一步的，所述控制组件B上的单片机与超声波接收器之间设有超声波接收电路，所述超声波接收电路采用芯片CX20106对超声波信号进行放大和整形，所述芯片CX20106的管脚1连接超声波接收器的正相输出端，管脚2依次通过电阻R3A和电容E11连接超声波接收器的反相输出端，管脚3通过电容E12连接超声波接收器的反相输出端，管脚4直接连接超声波接收器的反相输出端，管脚5通过电阻R5A连接电源，管脚6通过电容C3接地，管脚7连接单片机信号输入端，且管脚7还通过上拉电阻R4A连接电源，管脚8直接接电源。
进一步的，所述控制组件A的处理器采用单片机，在该单片机与超声波发射器之间设有超声波发射电路，所述超声波发射电路采用芯片LM386对输出信号进行功率放大，所述芯片LM386的管脚1通过电容E1和电阻R1A连接管脚8，管脚2和管脚4接地，管脚3连接单片的单片机信号输出端，管脚5通过电容E10连接超声波发射器的正相输入端，同时管脚5还通过电容C1和R2A连接超声波发射器的反相输入端并接地，管脚6连接电源，管脚7通过电容C2连接超声波发射器的反相输入端并接地。
进一步的，所述驱动马达的转速控制采用PWM波实现，电机驱动电路为一个由分立元件制作的直流电动机可逆双极型桥式驱动器，其功率元件由4支N沟道功率管组成。
进一步的，所述的四个超声波接收器设置在容纳箱体的顶部，且四个超声波接收器呈矩形分布。
本发明采取的另一技术方案是：一种全方位智能跟随行李箱的控制方法，其包括以下步骤：
S1：用户佩戴发射装置，在行走过程中，发射装置周期性发送超声波信号；
S2：行走装置上的四个超声波接收器接收到超声波信号后，分别将信号发送至控制组件B，控制组件B根据接收到的四个超声波信号，计算出发射装置的坐标位置，具体计算方法为：
首先，根据四个超声波接收器的位置构建三维坐标系，并将四个超声波接收器的坐标定义为：
(x1,y1,z1)＝(0，0,0)，(x2,y2,z2)＝(n,0,0)，(x3,y3,z3)＝(0,m,0)，(x4,y4,z4)＝(n,m,0)；
通过使用超声波传感器可以获得从发射器到接收器间的距离(d1,d2,d3,d4)，结果是：
其中：d1，d2，d3，d4分别为四个超声波接收器坐标(0，0，0)，(n，0，0),(0，m，0),(n,m,0)与超声波发射器之间的距离；
然后做一个减法线性化，即①-④，②-④，③-④，得：
之后再做一个矩阵，即令：
由此，上式简化为：AX＝b；
再采用最小二乘优化方法优化目标：
对X求导，得：2AT(Ax-b)＝0；
即获得一组最优解：X＝(ATA)-1ATb；
如此，根据最后一个方程和实际情况，相应得出发射器的优化坐标T(x,y,z)；
S3：控制组件B获得发射装置的坐标位置后，向所述全向轮组发送指令信号，并对发射装置进行跟踪。
进一步的，所述控制组件B根据发射装置的坐标位置控制行走装置的行进方向和行进速度，控制组件B对接收的数据进行处理和分析，然后将数据处理成带马达的全向轮组不同的速度，由速度的分解和合成，箱体将沿着应该去的方向行驶。
本发明的有益效果如下：
1)实现无需控制，纯自动定位跟踪，使用更便捷，符合实际和出国人士的需求。
2)适用范围广，凡是有地面的区域都可以使用本设备。
3)超声波设备定位精确，反应更灵敏。
4)采用全向轮组，对地摩擦小，转弯更方便，在遇到崎岖不平的路面对其造成的冲击时，各全向轮均可以相对支架沿竖直方向单独或者同时沿竖直方向滑动，能够灵活适应路面的起伏，从而起到缓冲作用，以减少对移动工具运输时的震动。
同时，三个驱动马达互成120°角，这种三角形结构可以保证整个驱动平台以3组马达环绕的轴心为中心做自身旋转运动，可以配合驱动平台直线运动到达目标点的过程中调整整个箱体的姿态，从而达到终态所需的姿态角度。
5)现有行李箱一般设置三个超声波接收器，只可以计算得出1组发射装置位置的空间坐标的计算值，由于存在着无法避免的系统测量误差和计算误差，该采用三个接收器方法计算出的一组坐标值往往与发射装置实际位置之间存在较大误差，从而容易导致定位不精确，反应不灵敏。本发明箱体上设置四个超声波接收器，这四个接收器共有四个坐标值，每三个坐标值可以相应确定一组超声波发射装置的坐标值，总共可以确定四组发射装置的坐标值，再通过最小二乘优化法进行优化处理，得到一组坐标值，使发射器到达四个接收器的距离最短，提高了定位与跟踪的抗干扰性和准确度。
6)采用独特设计的全向轮作为驱动轮，实现任意方向上的瞬时运动，提高了运动效率和便捷性。
本发明的附加方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
图1是本发明的电路原理框图。
图2是本发明的结构示意图。
图3是全向轮安装示意图。
图4是全向轮与驱动马达连接示意图。
图5是超声波发射电路图。
图6是超声波接收电路图。
图7是电机驱动电路图。
图8是依据四个超声波接收器建立的三维坐标系。
图9是PI算法的结构。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
如图1-4所示，一种全方位智能跟随行李箱，其包括发射装置1和箱体2，所述发射装置1包括电源101，控制组件A102和超声波发射器103，所述箱体2上设有四个超声波接收器201和行走装置202，所述四个超声波接收器201位于同一接收平面上(该接收平面可以为水平平面，竖直平面或倾斜平面)，发射装置1通过超声波发射器103向超声波接收器201发送超声波信号，所述行走装置202包括控制组件B205和全向轮组206，所述全向轮组206包括至少三个全向轮207及其各自对应的驱动马达203，控制组件B205接收超声波接收器201的信号后向所述驱动马达203发送驱动信号，驱动马达203根据接收的驱动信号驱动全向轮207行走。上述超声波发射器103和超声波接收器201均可采用市售常规产品。
本发明的控制组件B205的处理器采用单片机，该单片机可以优先选用ArduinoMega2560单片机，且控制组件B205包括相互通信的主单片机和从单片机，所述主单片机连接四个超声波接收器201并接收四个超声波接收器201的信号，所述从单片机通过电机驱动电路连接驱动马达203，驱动马达203带动全向轮207转动。
优选的，所述全向轮207和驱动马达203通过轮架208和底板204安装在箱体底部，轮架208与底板204连接，且在轮架208和底板204之间设有伸缩部件209，该伸缩部件209包括减震轴和减振弹簧，减振弹簧套装在减震轴上。
优选的，所述全向轮组包括三个全向轮207和三个驱动马达203，所述三个全向轮203呈三角分布，并等分均匀的安装在箱体下方，所述三个驱动马达203互成120°角。
优选的，本发明的四个超声波接收器201设置在容纳箱体202的顶部，且四个超声波接收器201呈矩形分布。这四个接收器共有四个坐标值，每三个坐标值可以相应确定一组超声波发射装置的坐标值，总共可以确定四组发射装置的坐标值，再通过最小二乘优化法进行优化处理，得到一组坐标值，使发射器到达四个接收器的距离最短，提高了定位的抗干扰性和准确度。
如图5所示，所述控制组件B205上的单片机与超声波接收器之间设有超声波接收电路，所述超声波接收电路采用芯片CX20106对超声波信号进行放大和整形，所述芯片CX20106的管脚1连接超声波接收器的正相输出端，管脚2依次通过电阻R3A和电容E11连接超声波接收器的反相输出端，管脚3通过电容E12连接超声波接收器的反相输出端，管脚4直接连接超声波接收器的反相输出端，管脚5通过电阻R5A连接电源，管脚6通过电容C3接地，管脚7连接单片机信号输入端，且管脚7还通过上拉电阻R4A连接电源，管脚8直接接电源。
如图6所示，所述控制组件A的处理器采用单片机，该单片机可以优先选用ArduinoNano单片机，在该单片机与超声波发射器之间设有超声波发射电路，所述超声波发射电路采用芯片LM386对输出信号进行功率放大，所述芯片LM386的管脚1通过电容E1和电阻R1A连接管脚8，管脚2和管脚4接地，管脚3连接单片的单片机信号输出端，管脚5通过电容E10连接超声波发射器的正相输入端，同时管脚5还通过电容C1和R2A连接超声波发射器的反相输入端并接地，管脚6连接电源，管脚7通过电容C2连接超声波发射器的反相输入端并接地。
如图7所示，所述驱动马达的转速控制采用PWM波实现，控制组件B205通过电机驱动电路启动驱动马达运行，所述电机驱动电路为一个由分立元件制作的直流电动机可逆双极型桥式驱动器，其功率元件由4支N沟道功率管组成。
本发明利用超声波传感器检测到的发射器与四个接收器间的距离(d1,d2,d3,d4)，算出发射器相对于所建坐标系的空间坐标，从而进行定位跟踪，具体方法为：
首先，如图8所示，根据四个超声波接收器的位置构建三维坐标系，并将四个超声波接收器的坐标定义为：
(x1,y1,z1)＝(0，0,0)，(x2,y2,z2)＝(n,0,0)，(x3,y3,z3)＝(0,m,0)，(x4,y4,z4)＝(n,m,0)；通过使用超声波传感器可以获得从发射器到接收器间的距离(d1,d2,d3,d4)，结果是：
其中：d1，d2，d3，d4分别为四个超声波接收器坐标(0，0，0)，(n，0，0),(0，m，0),(n,m,0)与超声波发射器之间的距离；
然后将上式做一个减法线性化，即①-④，②-④，③-④，得：
之后再做一个矩阵，即令：
由此，上式简化为：AX＝b；
再采用最小二乘优化方法优化目标：
对X求导，得：2AT(Ax-b)＝0；
即获得一组最优解：X＝(ATA)-1ATb；
如此，根据最后一个方程和实际情况，相应得出发射器的优化坐标T(x,y,z)；
依据上述算法，得到发射装置的坐标位置后，所述控制组件B对接收的数据进行处理和分析，然后将数据处理成带马达的全向轮组不同的速度，由速度的分解和合成，箱体将沿着应该去的方向行驶。
本发明中，全向轮的数量优选为三个，且三个全向轮等分均匀的安装在箱体下方，同时三个驱动马达互成120°角。
其中，全向轮旋转线速度(v1,v2,v3)和轴上的速度分量(vx,vy,vz)与载体角速度(ω)的关系如下：
式中：为驱动轮间的夹角，L为箱体中心到轮子中心的水平距离，相当于以轮子为圆，L为半径。
获得车轮的速度后，保持每个车轮的速度是下一个问题。由于地面对它有摩擦力，不同地方的摩擦力也不同，因此必须保持理想的速度。本发明采用PI算法，即在过程控制中，按全向轮速度偏差的比例(P)、积分(I)来调节矫正速度使之保持理想状态(全向轮速度恒定)。
如图9所示，通过接收到的输入值，计算输出和输入之间的误差。然后将其放入PI控制器中，pwm可以保持在一定值左右。可以使用以下公式实现：
pwm＝e(k)×Kp+Ki∑e(k)。
其中：pwm是采用PI控制技术将输入值通过公式转化成的脉冲宽度调制波值，Kp为比例调节系数，是一个大于0的数，Ki为积分调节系数，e(k)为命令值与输出值之间的偏差。
以上显示和描述了本发明的基本原理、主要特征和优点。本领域的普通技术人员应该了解，上述实施例不以任何形式限制本发明的保护范围，凡采用等同替换等方式所获得的技术方案，均落于本发明的保护范围内。
本发明未涉及部分均与现有技术相同或可采用现有技术加以实现。
Claims (10)
1.一种全方位智能跟随行李箱，其特征在于它包括发射装置(1)和箱体(2)，所述发射装置(1)包括电源(101)，控制组件A(102)和超声波发射器(103)，所述箱体(2)上设有四个超声波接收器(201)和行走装置(202)，所述四个超声波接收器(201)位于同一接收平面上，发射装置(1)通过超声波发射器(103)向超声波接收器(201)发送超声波信号，所述行走装置(202)包括控制组件B(205)和全向轮组(206)，所述全向轮组(206)包括至少三个全向轮(207)及其各自对应的驱动马达(203)，控制组件B(205)接收超声波接收器(201)的信号后向所述驱动马达(203)发送驱动信号，驱动马达(203)根据接收的驱动信号驱动全向轮(207)行走。
2.根据权利要求1所述的一种全方位智能跟随行李箱，其特征在于所述控制组件B(205)的处理器采用单片机，且控制组件B(205)包括相互通信的主单片机和从单片机，所述主单片机连接四个超声波接收器(201)并接收四个超声波接收器(201)的信号，所述从单片机通过电机驱动电路连接驱动马达(203)，驱动马达(203)带动全向轮(207)转动。
3.根据权利要求1或2所述的一种全方位智能跟随行李箱，其特征在于所述全向轮(207)和驱动马达(203)通过轮架(208)和底板(204)安装在箱体底部，轮架(208)与底板(204)连接，且在轮架(208)和底板(204)之间设有伸缩部件(209)，该伸缩部件(209)包括减震轴和减振弹簧，减振弹簧套装在减震轴上。
4.根据权利要求1或2所述的一种全方位智能跟随行李箱，其特征在于所述全向轮组包括三个全向轮(207)和三个驱动马达(203)，所述三个全向轮(203)呈三角分布，并等分均匀的安装在箱体下方，所述三个驱动马达(203)互成120°角。
5.根据权利要求2所述的一种全方位智能跟随行李箱，其特征在于所述控制组件B(205)上的单片机与超声波接收器之间设有超声波接收电路，所述超声波接收电路采用芯片CX20106对超声波信号进行放大和整形，所述芯片CX20106的管脚1连接超声波接收器的正相输出端，管脚2依次通过电阻R3A和电容E11连接超声波接收器的反相输出端，管脚3通过电容E12连接超声波接收器的反相输出端，管脚4直接连接超声波接收器的反相输出端，管脚5通过电阻R5A连接电源，管脚6通过电容C3接地，管脚7连接单片机信号输入端，且管脚7还通过上拉电阻R4A连接电源，管脚8直接接电源。
6.根据权利要求1所述的一种全方位智能跟随行李箱，其特征在于所述控制组件A的处理器采用单片机，在该单片机与超声波发射器之间设有超声波发射电路，所述超声波发射电路采用芯片LM386对输出信号进行功率放大，所述芯片LM386的管脚1通过电容E1和电阻R1A连接管脚8，管脚2和管脚4接地，管脚3连接单片的单片机信号输出端，管脚5通过电容E10连接超声波发射器的正相输入端，同时管脚5还通过电容C1和R2A连接超声波发射器的反相输入端并接地，管脚6连接电源，管脚7通过电容C2连接超声波发射器的反相输入端并接地。
7.根据权利要求1所述的一种全方位智能跟随行李箱，其特征在于所述驱动马达的转速控制采用PWM波实现，控制组件B(205)通过电机驱动电路启动驱动马达(203)运行，所述电机驱动电路为一个由分立元件制作的直流电动机可逆双极型桥式驱动器，其功率元件由4支N沟道功率管组成。
8.根据权利要求1所述的一种全方位智能跟随行李箱，其特征在于所述的四个超声波接收器(201)设置在箱体(2)的顶部，且四个超声波接收器(201)呈矩形分布。
9.一种用于权1至权8任一项所述的全方位智能跟随行李箱的控制方法，其包括以下步骤：
S1：用户佩戴发射装置，在行走过程中，发射装置周期性发送超声波信号；
S2：箱体上的四个超声波接收器接收到超声波信号后，分别将信号发送至控制组件B，控制组件B根据接收到的四个超声波信号，计算出发射装置的坐标位置，具体计算方法为：
首先，根据四个超声波接收器的位置构建三维坐标系，并将四个超声波接收器的坐标定义为：
(x1,y1,z1)＝(0，0,0)，(x2,y2,z2)＝(n,0,0)，(x3,y3,z3)＝(0,m,0)，(x4,y4,z4)＝(n,m,0)；
通过使用超声波发射器和超声波接收器可以获得两者间的距离(d1,d2,d3,d4)，结果是：
其中：d1，d2，d3，d4分别为四个超声波接收器坐标(0，0，0)，(n，0，0),(0，m，0),(n,m,0)与超声波发射器之间的距离；
然后将上式做一个减法线性化，即①-④，②-④，③-④，得：
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mi>x</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mi>y</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msup>
<msub>
<mi>d</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mi>x</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mi>y</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msup>
<msub>
<mi>d</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mi>x</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mi>y</mi>
<mo>+</mo>
<mo>(</mo>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
<mi>z</mi>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msup>
<msub>
<mi>d</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
之后再做一个矩阵，即令：
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>X</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>x</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>y</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>z</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>b</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>x</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>z</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>x</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mo>&lsqb;</mo>
<msubsup>
<mi>d</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>d</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>x</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>4</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>y</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>z</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
由此，上式简化为：AX＝b；
再采用最小二乘优化方法优化目标：
对X求导，得：2AT(Ax-b)＝0；
即获得一组最优解：X＝(ATA)-1ATb；
如此，根据最后一个方程和实际情况，相应得出发射器的优化坐标T(x,y,z)；
S3：控制组件B获得发射装置的坐标位置后，向所述全向轮组发送指令信号，对发射装置进行跟踪。
10.根据权利要求9所述的全方位智能跟随行李箱的控制方法，其特征在于：所述控制组件B根据发射装置的坐标位置控制行走装置的行进方向和行进速度，控制组件B对接收的数据进行处理和分析，然后将数据处理成带马达的全向轮组不同的速度，由速度的分解和合成，箱体沿着应该去的方向行驶。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710794810.2A CN107340776B (zh) | 2017-09-06 | 2017-09-06 | 一种全方位智能跟随行李箱及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710794810.2A CN107340776B (zh) | 2017-09-06 | 2017-09-06 | 一种全方位智能跟随行李箱及其控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107340776A true CN107340776A (zh) | 2017-11-10 |
| CN107340776B CN107340776B (zh) | 2018-07-20 |
Family
ID=60215203
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710794810.2A Active CN107340776B (zh) | 2017-09-06 | 2017-09-06 | 一种全方位智能跟随行李箱及其控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107340776B (zh) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108008395A (zh) * | 2017-12-01 | 2018-05-08 | 深圳市联红技术有限责任公司 | 一种超声波灭飞行昆虫的系统及方法 |
| CN108930890A (zh) * | 2018-07-20 | 2018-12-04 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
| CN108954245A (zh) * | 2018-08-03 | 2018-12-07 | 西南石油大学 | 一种基于激光信号的自适应舞台追踪装置及方法 |
| CN109188412A (zh) * | 2018-07-12 | 2019-01-11 | 江苏大学 | 一种自动跟随行李箱及其定位跟随防撞方法 |
| CN109240308A (zh) * | 2018-11-12 | 2019-01-18 | 辽东学院 | 自动跟踪购物车 |
| CN110250699A (zh) * | 2019-07-24 | 2019-09-20 | 上海库康科技有限公司 | 一种离合驱动的智能跟随行李箱 |
| US10698418B2 (en) | 2018-08-07 | 2020-06-30 | Trustech Technology Corporation | Target-following carrier |
| CN111505612A (zh) * | 2019-12-04 | 2020-08-07 | 上海理工大学 | 一种智能行李箱系统 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20070276540A1 (en) * | 2006-05-16 | 2007-11-29 | Akinobu Okuda | Robot, radio detection system, radio detection method and recording medium storing radio detection processing program |
| CN202041852U (zh) * | 2011-04-13 | 2011-11-16 | 北京航空航天大学 | 一种基于超声波控制的非接触式自动跟踪运输车 |
| CN204241692U (zh) * | 2014-12-18 | 2015-04-01 | 黑龙江科技大学 | 倒车报警装置 |
| CN105231614A (zh) * | 2015-08-31 | 2016-01-13 | 杭州国辰机器人科技有限公司 | 自动跟踪行李箱 |
| CN105652861A (zh) * | 2014-10-17 | 2016-06-08 | 北京建筑大学 | 移动式机器人座椅控制方法 |
| CN205696218U (zh) * | 2016-06-17 | 2016-11-23 | 陈春茂 | 一种智能行李箱 |
| CN106997204A (zh) * | 2017-04-20 | 2017-08-01 | 四川建筑职业技术学院 | 一种基于超声波的自动跟随系统 |
-
2017
- 2017-09-06 CN CN201710794810.2A patent/CN107340776B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20070276540A1 (en) * | 2006-05-16 | 2007-11-29 | Akinobu Okuda | Robot, radio detection system, radio detection method and recording medium storing radio detection processing program |
| CN202041852U (zh) * | 2011-04-13 | 2011-11-16 | 北京航空航天大学 | 一种基于超声波控制的非接触式自动跟踪运输车 |
| CN105652861A (zh) * | 2014-10-17 | 2016-06-08 | 北京建筑大学 | 移动式机器人座椅控制方法 |
| CN204241692U (zh) * | 2014-12-18 | 2015-04-01 | 黑龙江科技大学 | 倒车报警装置 |
| CN105231614A (zh) * | 2015-08-31 | 2016-01-13 | 杭州国辰机器人科技有限公司 | 自动跟踪行李箱 |
| CN205696218U (zh) * | 2016-06-17 | 2016-11-23 | 陈春茂 | 一种智能行李箱 |
| CN106997204A (zh) * | 2017-04-20 | 2017-08-01 | 四川建筑职业技术学院 | 一种基于超声波的自动跟随系统 |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108008395A (zh) * | 2017-12-01 | 2018-05-08 | 深圳市联红技术有限责任公司 | 一种超声波灭飞行昆虫的系统及方法 |
| CN109188412A (zh) * | 2018-07-12 | 2019-01-11 | 江苏大学 | 一种自动跟随行李箱及其定位跟随防撞方法 |
| CN108930890A (zh) * | 2018-07-20 | 2018-12-04 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
| CN108930890B (zh) * | 2018-07-20 | 2023-08-01 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
| CN108954245A (zh) * | 2018-08-03 | 2018-12-07 | 西南石油大学 | 一种基于激光信号的自适应舞台追踪装置及方法 |
| US10698418B2 (en) | 2018-08-07 | 2020-06-30 | Trustech Technology Corporation | Target-following carrier |
| CN109240308A (zh) * | 2018-11-12 | 2019-01-18 | 辽东学院 | 自动跟踪购物车 |
| CN110250699A (zh) * | 2019-07-24 | 2019-09-20 | 上海库康科技有限公司 | 一种离合驱动的智能跟随行李箱 |
| CN111505612A (zh) * | 2019-12-04 | 2020-08-07 | 上海理工大学 | 一种智能行李箱系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107340776B (zh) | 2018-07-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107340776B (zh) | 一种全方位智能跟随行李箱及其控制方法 | |
| CN104626152B (zh) | 工业机器人主动柔顺控制方法及装置 | |
| CN107160963A (zh) | 轮式运动底盘 | |
| CN206644887U (zh) | 基于myRIO平台的声控智能车 | |
| CN106527425A (zh) | 全方位智能随动小车及其控制方法 | |
| CN105334853A (zh) | 双核高速四轮微微鼠冲刺控制器 | |
| CN205087089U (zh) | 一种基于无线控制的双轮自平衡小车 | |
| CN106379409A (zh) | 角度可控动力差速全向轮及其控制方法以及全向移动平台 | |
| CN106828643A (zh) | 一种全方向运动球形机器人 | |
| CN110119146A (zh) | 一种自跟随平衡小车的控制系统及方法 | |
| CN107145151A (zh) | 一种自动跟随动力结构及其系统 | |
| CN104898594B (zh) | 一种用于水下机器人群协同控制的通信装置与方法 | |
| CN206039291U (zh) | 一种兼具自主导航及远程遥控的六足机器人 | |
| CN108334088A (zh) | 一种智能跟随装置及控制方法 | |
| CN207008409U (zh) | 一种全方位智能跟随行李箱 | |
| CN107656528A (zh) | 一种基于stm32的两轮无线遥控智能小车 | |
| CN104914871A (zh) | 倒立摆系统的动态平衡控制方法及智能平衡车控制系统 | |
| CN116021938B (zh) | 旱地田间四轮电驱全向移动机器人 | |
| CN203032789U (zh) | 自调平五轮勘测车 | |
| CN207273234U (zh) | 一种导向机器人 | |
| CN206906892U (zh) | 一种自动跟随动力结构及其系统 | |
| CN106997204A (zh) | 一种基于超声波的自动跟随系统 | |
| WO2021025720A1 (en) | Accompanying control of locomotion device | |
| CN207937864U (zh) | 采用多路外部环境检测模块实现机器人自动回充的装置 | |
| CN109144074A (zh) | 一种基于dsp的智能高尔夫球车及智能跟随方法 |
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 |