CN112225128A - 一种挡臂可折叠的外叉车泊车机器人控制系统和方法 - Google Patents

一种挡臂可折叠的外叉车泊车机器人控制系统和方法 Download PDF

Info

Publication number
CN112225128A
CN112225128A CN202011236445.1A CN202011236445A CN112225128A CN 112225128 A CN112225128 A CN 112225128A CN 202011236445 A CN202011236445 A CN 202011236445A CN 112225128 A CN112225128 A CN 112225128A
Authority
CN
China
Prior art keywords
arm
module
distance
fork
vehicle
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.)
Withdrawn
Application number
CN202011236445.1A
Other languages
English (en)
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.)
Jiangsu Xiaobaitu Intelligent Manufacturing Technology Co Ltd
Original Assignee
Jiangsu Xiaobaitu Intelligent Manufacturing Technology Co Ltd
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 Jiangsu Xiaobaitu Intelligent Manufacturing Technology Co Ltd filed Critical Jiangsu Xiaobaitu Intelligent Manufacturing Technology Co Ltd
Priority to CN202011236445.1A priority Critical patent/CN112225128A/zh
Publication of CN112225128A publication Critical patent/CN112225128A/zh
Priority to CN202111322366.7A priority patent/CN115140682A/zh
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/063Automatically guided
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60SSERVICING, CLEANING, REPAIRING, SUPPORTING, LIFTING, OR MANOEUVRING OF VEHICLES, NOT OTHERWISE PROVIDED FOR
    • B60S13/00Vehicle-manoeuvring devices separate from the vehicle
    • B60S13/02Turntables; Traversers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/0755Position control; Position detectors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/07563Fork-lift trucks adapted to be carried by transport vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/07568Steering arrangements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/07572Propulsion arrangements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/07581Remote controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/07586Suspension or mounting of wheels on chassis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/0759Details of operating station, e.g. seats, levers, operator platforms, cabin suspension
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/08Masts; Guides; Chains
    • B66F9/085Multiple forks, i.e. more than one pair mounted on a single mast or with more than one mast
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/12Platforms; Forks; Other load supporting or gripping members
    • B66F9/14Platforms; Forks; Other load supporting or gripping members laterally movable, e.g. swingable, for slewing or transverse movements
    • B66F9/142Movements of forks either individually or relative to each other
    • B66F9/144Movements of forks relative to each other - independent
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/12Platforms; Forks; Other load supporting or gripping members
    • B66F9/16Platforms; Forks; Other load supporting or gripping members inclinable relative to mast
    • B66F9/165Foldable forks, i.e. where only the horizontal section moves
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/12Platforms; Forks; Other load supporting or gripping members
    • B66F9/18Load gripping or retaining means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66FHOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
    • B66F9/00Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
    • B66F9/06Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
    • B66F9/075Constructional features or details
    • B66F9/20Means for actuating or controlling masts, platforms, or forks
    • B66F9/24Electrical devices or systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Civil Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Manipulator (AREA)

Abstract

本发明属于泊车机器人技术领域,公开一种挡臂可折叠的外叉车泊车机器人的控制系统及其控制方法。所述控制系统包括行进模块、叉臂移动模块、挡臂驱动模块、测量模块、导航模块和总控制器;所述行进模块,用于根据总控制器发出的行进控制指令驱动泊车机器人移动;叉臂移动模块,用于驱动叉臂移动;挡臂驱动模块,用于驱动挡臂移动、打开和折叠;测量模块,用于检测车辆的轴距;导航模块,用于计算泊车机器人的行进路线;总控制器,包括输入输出单元、控制指令单元、距离判定单元和阻力判定单元。通过挡臂与轮胎先接触后,通过挡臂移动受到的阻力来判断轮胎是否被抬高,有效反映了轮胎与对应的叉臂的状态,避免叉臂过度移动造成轮胎再次脱落的情况。

Description

一种挡臂可折叠的外叉车泊车机器人控制系统和方法
技术领域
本发明属于泊车机器人技术领域,涉及一种停车场用将车辆搬运到或搬离停车位的自动化设备,具体地说是一种挡臂可折叠的外叉车泊车机器人控制系统及控制方法。
背景技术
随着社会的发展,经济的提高,汽车数量急剧增加,家用汽车已是各户必备交通工具,各城市泊车难的问题也随之而来,泊车排队、找车位时间长,传统的司机自己找车位泊车的方法已经不能满足现在各城市泊车需求。为了减少找车位的时间,市场上出现了不同结构的泊车机器人。
其中,一种通过从侧面插入车辆底部并夹抱轮胎来抬起车辆的泊车机器人具有很广泛的应用前景。通常,这种泊车机器人采用四爪结构,包括一个带有移动轮的U型框架主体和四个可以在框架主体的长边上滑动的夹持用的叉臂。这种结构的泊车机器人占地空间大,重量高,并且由于叉臂下没有支撑结构,结构不稳定,容易出现车辆侧滑的问题。另外,现有市场还出现了一种两爪结构的泊车机器人,包括一个“一”字型的框架主体和两个带有外向轮的可以在框架主体上滑动的叉臂。这种结构的泊车机器人改变了框架主体的形状,减少了叉臂的数量,并在叉臂下方增加了万向轮支撑结构。但是,在受到较大颠簸时,仍然有车辆滑脱的隐患。同时,在搬运前后配重差距较大的车辆时,可能出现在挤压车胎过程中会出现车辆配重轻的一侧的轮胎直接越过叉臂,而配重重的一侧的轮胎还没有被挤压上叉臂的情况,限制了这种结构的泊车机器人的应用范围。
发明内容
鉴于现有技术中存在上述技术问题,本发明的目的之一是针对现有的两爪式泊车机器人在搬运前后配重差距较大的车辆时,出现的不能将车辆挤压到叉臂上的技术问题,以及车辆容易滑脱的问题,设计一种挡臂可折叠的外叉车泊车机器人及其控制系统和方法。
本发明的技术方案如下所述:
本发明所述挡臂可折叠的外叉车泊车机器人包括:
车架100,该车架100呈一字形结构;
主动行走装置140,该主动行走装置140安装在车架100的上,用于驱动车架100移动;
结构对称相同的左叉臂200和右叉臂300,左叉臂200和右叉臂300分别安装在车架100同一侧的两端,二者之间的距离可调;
万向轮340,该万向轮340安装在左叉臂200和右叉臂300上,以满足泊车机器人的行驶要求,并作为支撑结构;
结构对称相同的左挡臂500和右挡臂600,左挡臂500和右挡臂600可移动的安装在车架100上,位于左叉臂200和右叉臂300的中间,且分别与左叉臂200和右叉臂300组合使用,用于在左叉臂200和右叉臂300夹起车辆的过程中限制车辆的前后移动并确认车轮是否已经被抬起;所述左挡臂500和右挡臂600可在电机的驱动下向上折叠。
左叉臂200和右叉臂300能够从车辆侧面伸入车辆底部前轮的前方和后轮的后方,并能够沿着车架100作相对运动,分别挤压前轮和后轮,促使车轮爬上左叉臂200和右叉臂300,从而使车辆脱离地面;同时,左挡臂500和右挡臂600能够从车辆侧面伸入车辆底部前轮和后轮的中间,并分别向前轮和后轮移动,当接触到车轮时停止移动。为了避免因为车辆前后配重差较大而出现的在挤压轮胎时车辆较轻的一侧直接越过左叉臂200或右叉臂300的情况,上述技术方案,增加了左挡臂500和右挡臂600,当车辆较轻的一侧的轮胎在左叉臂200或右叉臂300的挤压下,爬上左叉臂200或右叉臂300,此时,原本接触到轮胎的左挡臂500或右挡臂600因轮胎位置升高而不再能接触到轮胎,此时,不需要再移动左叉臂200或右叉臂300,只需要移动另外一个叉臂,以将另一个轮胎挤压到另一个叉臂上,使整个车辆脱离地面,从而避免车辆较轻的一侧直接越过左叉臂200或右叉臂300。
但是,同时控制叉臂和挡臂的流程较为复杂,对于前后配重差不大的车辆来说,没有必要同时使用叉臂和挡臂来抬起车辆。对于这些车辆,只需要左叉臂和右叉臂即可实现将车辆抬起的目的。因而,将左挡臂500和右挡臂600设计为可向上折叠的结构。对于一般车辆,先仅用左叉臂200和右叉臂300尝试将车辆抬起,若不能将车辆抬起,再将左挡臂500和右挡臂600打开,通过左挡臂500和右挡臂600限制车辆的前后移动并确认车轮是否已经被抬起,将车辆抬起。
所述左挡臂500和右挡臂600,与左叉臂200和右叉臂300位于同一水平面上。在更进一步的技术方案中,左挡臂500和左叉臂200可以共用滑轨,右挡臂600和右叉臂300可以共用滑轨,或者左挡臂500和左叉臂200分别与不同的移动结构相连接,右挡臂600和右叉臂300分别与不同的移动结构相连接。当所述左挡臂500和右挡臂600,与左叉臂200和右叉臂300位于同一水平面上时,左挡臂500、右挡臂600、左叉臂200与右叉臂300四者之间的左右位置关系不变,便于控制。若左挡臂500和左叉臂200共用滑轨,右挡臂600和右叉臂300共用滑轨,则结构简单,减轻设备重量,优化制造工艺;若左挡臂500和左叉臂200分别与不同的移动结构相连接,右挡臂600和右叉臂300分别与不同的移动结构相连接,则能够分别控制,不易因故障停机。
所述左挡臂500和右挡臂600的长度至少应确保在夹起车辆时能够碰到其中一个车轮。在更进一步的技术方案中,左挡臂500和右挡臂600的长度与左叉臂200和右叉臂300的长度一致,或者左挡臂500和右挡臂600的长度长于左叉臂200和右叉臂300的长度,或者左挡臂500和右挡臂600的长度短于左叉臂200和右叉臂300的长度。左挡臂500和右挡臂600只有满足上述长度要求,才能保证实现限制车辆移动和确认车轮是否已经被抬起的效果,否则,车辆就可能在挡臂和挤压力作用下发生侧滑,同时出现在搬运前后配重差距较大的车辆时,出现的不能将车辆挤压到叉臂上的情况。在左挡臂500和右挡臂600的长度仅能够限制车辆靠近车架100一侧的轮胎的前后移动并确认车轮是否已经被抬起时,就能够达到限制整个车辆的前后移动并确保前后轮都被抬起的效果,避免出现车辆较轻的一侧直接越过左叉臂200或右叉臂300的情况。
所述左挡臂500和右挡臂600包括挡臂横板501、挡臂竖板502和线性电机,挡臂横板501和挡臂竖板502通过铰链转动连接,线性电机的一端与挡臂横板501转动连接,另一端与挡臂竖板502转动连接。随着线性单机的伸缩,左挡臂500和右挡臂600向下打开或向上折叠。
所述左挡臂500和右挡臂600的横截面可以为圆形、椭圆形、方形、三角形、多边形或其他不规则形状。左挡臂500和右挡臂600的横截面形状,并不影响其效果,但可能会对轮胎胎面造成影响,甚至引起爆胎。
所述左挡臂500和右挡臂600上套有弹性保护套。弹性保护套可以避免夹起车辆时对车辆轮胎的损伤和避免左挡臂500和右挡臂600因碰撞产生的损伤。
所述左挡臂500和右挡臂600均连接有一个挡臂移动装置510,并通过该挡臂移动装置510实现左挡臂500和右挡臂600在车架100上的移动。所述的挡臂移动装置510包括移动电机511、L型安装板512、第三导轨滑块机构513、第四导轨滑块机构514和齿条515,L形安装板512与左挡臂500或右挡臂600相连的同时与第三导轨滑块机构513或第四导轨滑块机构514相连,第三导轨滑块机构513及第四导轨滑块机构514固定在车架100上;移动电机511安装在L形安装板512上,移动电机511的输出轴上安装有主动齿轮,主动齿轮与固定在车架110上的齿条515相啮合,移动电机511带动主动齿轮转动,主动齿轮与齿条啮合从而带动L形安装板512在车架110上移动。
所述左叉臂200和右叉臂300对应轮胎的位置设有轮毂限位座330,所述轮毂限位座330中安装有轮胎托架331。
所述轮胎托架331包括滚动组件332、固定块334和弹簧335。所述滚动组件332包括滚动轴套336、滚子轴337和轴架338。所述滚动轴套336套在滚子轴337上,所述滚子轴337排成两排或两排以上安装在轴架338上。所述轴架338包括一个横向支架3381、两个第一纵向支架3382和一个或多个第二纵向支架3383。所述横向支架3381位于滚动组件332的后侧。所有第一纵向支架3382和第二纵向支架3383相互平行。所述第一纵向支架3382为两个转动连接的片状结构,分别为第一后侧支架3384和前侧支架3385,所述第二纵向支架3383为两个转动连接的片状结构,分别为第二后侧支架3386和前侧支架3385。第一后侧支架3384位于滚动组件332的左右两侧,第二后侧支架3386位于滚动组件332的中部,且都与横向支架3381固定连接。所述滚子轴337安装在两个纵向支架之间。所述第一纵向支架3382的第一后侧支架3384端的外侧固定安装有第一固定块3341,其前侧支架3385端的外侧固定安装第三固定块3343,其前侧支架3385靠近转动连接结构的位置的外侧固定安装有第二固定块3342。所述片状的弹簧335的一端固定在第一固定块3341上,并穿过第二固定块3342和第三固定块3343。
所述轮胎托架331通过第一后侧支架3384与轮毂限位座330固定连接。再进一步的,全部或者远离横向支架3381的两排或两排以上所述滚动轴套336的直径随着与横向支架3381间的距离增加而逐渐减小。再进一步的,最外面一排滚动轴套336为三角形的垫块339。再进一步的,所述横向支架3382为块状结构,所述第一后侧支架3384和第二后侧支架3386的底部设置了一个或多个横向的固定支架333。
所述左叉臂200的辊毂限位座330位于其右侧,右叉臂300的辊毂限位座330位于其左侧,将车辆抬离地面时左叉臂200和右叉臂300作相对运动。将车辆抬离地面时,左叉臂200和右叉臂300插入车辆的前轮的前方或后轮的后方,左叉臂200和右叉臂300作相对运动,将两排轮胎都抬离地面。
所述的左叉臂200和右叉臂300圴连接有一个叉臂移动装置310,并通过该叉臂移动装置310实现左叉臂200和右叉臂300之间的距离可调,所述的叉臂移动装置310包括移动电机311、L型安装板312、第一导轨滑块机构313、第二导轨滑块机构314和齿条315,L形安装板312与左叉臂200或右叉臂300相连的同时与第一导轨滑块机构313及第二导轨滑块机构314相连,第一导轨滑块机构313及第二导轨滑块机构314固定在车架100上;移动电机311安装在L形安装板312上,移动电机311的输出轴上安装有主动齿轮,主动齿轮与固定在车架110上的齿条相啮合,移动电机311带动主动齿轮转动,主动齿轮与齿条啮合从而带动L形安装板312在车架110上移动。在更进一步的技术方案中,左挡臂500和左叉臂200共用导轨和齿条,右挡臂600和右叉臂300共用导轨和齿条。
所述万向轮340,包括轮子341、旋转体344、锥齿轮组345和电机348;所述锥齿轮组345包括水平放置的环状齿轮3451和由电机348驱动的小齿轮3452;所述轮子341位于旋转体344的中心孔内,且所述旋转体344的内圈和环状齿轮3451内侧分别与轮子341的轮毂342固定连接,驱动电机348通过带动锥齿轮组345带动轮子341主动转向。
所述万向轮340的轮子341安装在轮轴343上,所述轮轴343通过固定件349固定安装在轮毂342内,所述旋转体344为交叉滚子轴承,所述交叉滚子轴承的外圈固定在左叉臂200或右叉臂300上,所述电机348通过减速器7驱动小齿轮3452,并安装在电机固定架346上,所述电机固定架346安装在左叉臂200或右叉臂300上,所述锥刺轮组为弧齿螺旋锥齿轮,所述小齿轮3452的中心轴与环状齿轮3451的中心轴的夹角为90°。在上述万向轮340使用时,所述旋转体344的外圈固定安装在设备的底座上。电机348未启动时,旋转体344的内圈与外圈相对静止,万向轮不能随意转动。当电机348启动,且电机348带动小齿轮3452转动,小齿轮3452带动环状齿轮3451转动角度α时,环状齿轮3451带动旋转体344的内圈和轮毂342转动角度α,而旋转体344的外圈由于固定在设备底座上,不会发生转动。其中,角度α的范围是0°≤α≤360°。并且,调整电机348的速率和运行时间可以随意控制α的大小,实现任意方向转动轮子的滚动方向的目的。
所述车架100上与左叉臂200和右叉臂300同侧设有光电感应器400,用于检测车辆的位置、车辆轴距等参数。
所述车架100由前板110、后板120以及中板130组成,中板130的分别与前板110和后板120固定连接。
本发明提供一种挡臂可折叠的外叉车泊车机器人的控制系统,所述控制系统包括行进模块、叉臂移动模块、挡臂驱动模块、测量模块、导航模块和总控制器。
所述行进模块,包括主动行走装置和万向轮,用于根据总控制器发出的行进控制指令驱动泊车机器人移动;
叉臂移动模块,包括叉臂移动装置,用于驱动叉臂移动;
挡臂驱动模块,包括挡臂移动装置和折叠结构,用于驱动挡臂移动、打开和折叠;
测量模块,包括光电感应器,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元和阻力判定单元;所述输入输出单元,用于获取用户的确定存车或取车的信号;所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制叉臂移动模块驱动叉臂移动、控制挡臂驱动模块驱动挡臂移动及挡臂的打开和折叠、控制导航模块计算泊车机器人的行进路线和控制行进模块驱动泊车机器人移动;所述距离判定单元,用于获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,并将判定结果发送给控制指令单元,同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离;所述阻力判定单元,用于判定左挡臂或右挡臂的移动是否受到的阻力,以及左叉臂或右叉臂的移动是否受到的阻力,并将获取结果和判定结果发送给控制指令单元。
本发明还提供上述挡臂可折叠的外叉车泊车机器人控制系统的控制方法,所述方法包括:
S1:控制指令单元控制挡臂驱动模块打开折叠的左挡臂和右挡臂;
S2:控制指令单元控制挡臂驱动模块和叉臂移动模块同时调整左挡臂和右挡臂、左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,若所有判定结果都为是,则控制指令单元控制叉臂移动模块停止驱动叉臂移动,控制挡臂驱动模块停止驱动挡臂移动,若其中一个或两个判定结果为否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S3:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S4:控制指令单元控制挡臂驱动模块同时分别向泊车机器人的两端移动左挡臂和右挡臂;
阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂,若否,则进行下一次判定;
S5:控制指令单元控制叉臂移动模块同时分别向泊车机器人的中间移动左叉臂和右叉臂;
阻力判定单元判定左叉臂或右叉臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,若是,则再次判定左挡臂或右挡臂的移动是否受到阻力;
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制叉臂移动模块同时分别向泊车机器人的两端移动左叉臂和右叉臂,同时,控制挡臂驱动模块同时分别向泊车机器人的中间移动左挡臂和右挡臂;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,或者控制挡臂驱动模块停止驱动左挡臂或右挡臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆。
在上述步骤S5中,当控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂后,控制挡臂驱动模块向泊车机器人的两端移动左挡臂或右挡臂;阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂。
在上述步骤S8中,还包括:距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否大于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定。
上述控制方法还包括下述步骤:
S9:控制指令单元控制挡臂驱动模块将左挡臂和右挡臂折叠起来。
在上述泊车机器人控制方法中,左叉臂和右叉臂作相对运动来挤压轮胎,在获取车辆轴距后,左叉臂和右叉臂分别向泊车机器人的两端移动,左挡臂和右挡臂分别向泊车机器人的中间移动;在挤压轮胎时,左叉臂和右叉臂分别向泊车机器人的中间移动,左挡臂和右挡臂分别向泊车机器人的两端移动;在放置车辆时,左叉臂和右叉臂分别向泊车机器人的两端移动,左挡臂和右挡臂分别向泊车机器人的中间移动。
以左挡臂和左叉臂为例,在向泊车机器人两端移动左挡臂时,当左挡臂第一次受到阻力,表明左挡臂已经碰到了车轮,可以停止继续移动了。当该车轮受到左叉臂的挤压力,爬上左叉臂时,车轮因为离开地面而其位置升高,这样,原本碰到该车轮的左挡臂,不再能够碰到该车轮,当其向泊车机器人两端移动时不再受到阻力。因此,当检测到左挡臂向泊车机器人的两端移动时不再受到阻力,则表明该车轮已经被左叉臂抬起,不需要继续移动左叉臂,否则该车轮可能越过左叉臂重新掉到地面上。而再次向泊车机器人中间移动左挡臂直到第二次受到阻力,表明左挡臂又一次碰到了车轮,能够防止搬运车辆时因颠簸产生的前后移动。
本发明具有如下有益效果:
1、本发明引入了挡臂结构,能够在泊车机器人抬起车辆时限制车辆的前后移动并确认车轮是否已经被抬起,以免因为车辆前后配重差较大,导致较轻的一端直接越过叉臂,造成抬起车辆失败;
2、所述控制系统和控制方法全面考虑了停车过程中可能出现的各种碰撞和误差,具有很高的可行性,尤其是通过挡臂与轮胎先接触(即移动受到阻力)后,通过挡臂移动受到的阻力来判断轮胎是否被抬高,直接有效的反映了轮胎与对应的叉臂的状态,避免叉臂过度移动造成轮胎再次脱落的情况;
3、挡臂设计为可折叠结构,对于一般车辆可以仅用左叉臂和右叉臂来抬起,以快速抬起车辆,对于前后配重差较大的车辆同时使用左叉臂和右叉臂、左挡臂和右挡臂来抬起;
4、所述的泊车机器人的叉臂利用轮毂限位座与安装在轮毂限位座中的轮胎托架之间的高度差,阻碍轮胎在叉臂上可能发生的侧向滑动,以实现防止车辆掉落的目的;
5、本发明所述轮胎托架在接触到轮胎后可以向地面发生一定偏转,降低轮胎爬上轮胎托架所需的力,能够轻松抬起较重的车辆或前后配重相差较大的车辆;
6、本发明设计的轮胎托架是一种自适应结构,不需要另外设计驱动装置,节约能源,降低成本。
附图说明
图1为本发明实施例1的泊车机器人的立体结构图;
图2为本发明实施例的泊车机器人叉臂的立体结构图;
图3为本发明实施例的泊车机器人叉臂的一个轮胎托架的立体结构图;
图4为本发明实施例的泊车机器人叉臂的另一个轮胎托架的仰视图;
图5为本发明实施例的泊车机器人叉臂的万向轮结构示意图;
图6为本发明实施例的泊车机器人叉臂的万向轮的剖视图;
图7为本发明实施例的泊车机器人控制系统结构示意图;
其中,100为车架,110为前板,120为后板,130为中板,140为主动行走装置,200为左叉臂,300为右叉臂,310为叉臂移动装置,311为移动电机,312为L型安装板,313为第一导轨滑块机构,314为第二导轨滑块机构,315为齿条,330为轮毂限位座,331为轮胎托架,332为滚动组件,333为固定支架,334为固定块,3341为第一固定块,3342为第二固定块,3343为第三固定块,335为弹簧,336为滚动轴套,337为滚子轴,338为轴架,3381为横向支架,3382为第一纵向支架,3383为第二纵向支架,3384为第一后侧支架,3385为前侧支架,3386为第二后侧支架,339为垫块,340为万向轮,341为轮子,342为轮毂,343为轮轴,344为旋转体,345为锥齿轮组,3451为环状齿轮,3452为小齿轮,346为电机固定架,347为减速器,348为电机,349为固定件,400为光电感应器,500为左挡臂,501为挡臂横板,502为挡臂竖板,510为挡臂移动装置,511为移动电机,,512为L型安装板,513为第三导轨滑块机构,514为第四导轨滑块机构,515为齿条,600为右挡臂。
具体实施方式
为了更清楚地说明本发明的技术方案,下面将结合具体实施例和附图进行说明,显而易见地,下面描述中的实施例仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些实施例获得其他的实例。
实施例1
本实施例涉及一种带有挡臂的泊车机器人,如图1所示,所述机器人包括:
车架100,该车架100呈一字形结构,其长度固定;
主动行走装置140,该主动行走装置140安装在车架100的上,用于驱动车架100移动;
结构对称相同的左叉臂200和右叉臂300,左叉臂200和右叉臂300分别安装在车架100同一侧的两端,二者之间的距离可调;
万向轮340,该万向轮340安装在左叉臂200和右叉臂300上,以满足泊车机器人的行驶要求,并作为支撑结构;
结构对称相同的左挡臂500和右挡臂600,左挡臂500和右挡臂600可移动的安装在车架100上,位于左叉臂200和右叉臂300的中间,且分别与左叉臂200和右叉臂300组合使用,用于在左叉臂200和右叉臂300夹起车辆的过程中限制车辆的前后移动并确认车轮是否已经被抬起;所述左挡臂500和右挡臂600可在电机的驱动下向上折叠。
所述左挡臂500和右挡臂600,与左叉臂200和右叉臂300位于同一水平面上,并且左挡臂500和左叉臂200共用滑轨,右挡臂600和右叉臂300共用滑轨。所述左挡臂500和右挡臂600的长度短于左叉臂200和右叉臂300的长度。所述左挡臂500和右挡臂600的横截面为矩形。在其他实施例中,所述左挡臂500和右挡臂600的横截面可以为圆形、椭圆形、方形、三角形、多边形或其他不规则形状。所述左挡臂500和右挡臂600上套有弹性保护套。
所述左挡臂500和右挡臂600包括挡臂横板501、挡臂竖板502和线性电机(未在图中显示),挡臂横板501和挡臂竖板502通过铰链转动连接,线性电机的一端与挡臂横板501转动连接,另一端与挡臂竖板501转动连接。
所述左挡臂500和右挡臂600均连接有一个挡臂移动装置510,并通过该挡臂移动装置510实现左挡臂500和右挡臂600在车架100上的移动。所述的挡臂移动装置510包括移动电机511、L型安装板512、第三导轨滑块机构513、第四导轨滑块机构514和齿条515,L形安装板512与左挡臂500或右挡臂600相连的同时与第三导轨滑块机构513或第四导轨滑块机构514相连,第三导轨滑块机构513及第四导轨滑块机构514固定在车架100上;移动电机511安装在L形安装板512上,移动电机511的输出轴上安装有主动齿轮,主动齿轮与固定在车架110上的齿条515相啮合,移动电机511带动主动齿轮转动,主动齿轮与齿条啮合从而带动L形安装板512在车架110上移动。
所述的左叉臂200和右叉臂300圴连接有一个叉臂移动装置310,并通过该叉臂移动装置310实现左叉臂200和右叉臂300之间的距离可调,所述的叉臂移动装置310包括移动电机311、L型安装板312、第一导轨滑块机构313、第二导轨滑块机构314和齿条315,L形安装板312与左叉臂200或右叉臂300相连的同时与第一导轨滑块机构313及第二导轨滑块机构314相连,第一导轨滑块机构313及第二导轨滑块机构314固定在车架100上;移动电机311安装在L形安装板312上,移动电机311的输出轴上安装有主动齿轮,主动齿轮与固定在车架110上的齿条相啮合,移动电机311带动主动齿轮转动,主动齿轮与齿条啮合从而带动L形安装板312在车架110上移动。在更进一步的技术方案中,左挡臂500和左叉臂200共用导轨和齿条,右挡臂600和右叉臂300共用导轨和齿条。
其中,左叉臂200的第一导轨滑块机构313与左挡臂500的第三导轨滑块机构513共用导轨,左叉臂200的第二导轨滑块机构314与左挡臂500的第四导轨滑块机构514共用导轨,左叉臂200和左挡臂500共用一条齿条315/515。同样,右叉臂200的第一导轨滑块机构313与右挡臂500的第三导轨滑块机构513共用导轨,右叉臂200的第二导轨滑块机构314与右挡臂500的第四导轨滑块机构514共用导轨,右叉臂200和右挡臂500共用一条齿条315/515。在其他实施例中,叉臂和挡臂可以不共用滑轨或齿条。
如图5和6所示,所述万向轮340,包括轮子341、旋转体344、锥齿轮组345和电机348;所述锥齿轮组345包括水平放置的环状齿轮3451和由电机348驱动的小齿轮3452;所述轮子341位于旋转体344的中心孔内,且所述旋转体344的内圈和环状齿轮3451内侧分别与轮子341的轮毂342固定连接,驱动电机348通过带动锥齿轮组345带动轮子341主动转向。
所述万向轮340的轮子341安装在轮轴343上,所述轮轴343通过固定件349固定安装在轮毂342内,所述旋转体344为交叉滚子轴承,所述交叉滚子轴承的外圈固定在左叉臂200或右叉臂300上,所述电机348通过减速器7驱动小齿轮3452,并安装在电机固定架346上,所述电机固定架346安装在左叉臂200或右叉臂300上,所述锥刺轮组为弧齿螺旋锥齿轮,所述小齿轮3452的中心轴与环状齿轮3451的中心轴的夹角为90°。
在上述万向轮340使用时,所述旋转体344的外圈固定安装在设备的底座上。电机348未启动时,旋转体344的内圈与外圈相对静止,万向轮不能随意转动。当电机348启动,且电机348带动小齿轮3452转动,小齿轮3452带动环状齿轮3451转动角度α时,环状齿轮3451带动旋转体344的内圈和轮毂342转动角度α,而旋转体344的外圈由于固定在设备底座上,不会发生转动。其中,角度α的范围是0°≤α≤360°。并且,调整电机348的速率和运行时间可以随意控制α的大小,实现任意方向转动轮子的滚动方向的目的。
如图2、3和4所示,所述左叉臂200和右叉臂300对应轮胎的位置设有轮毂限位座330,所述轮毂限位座330中安装有轮胎托架331。
所述轮胎托架331包括滚动组件332、固定块334和弹簧335。所述滚动组件332包括滚动轴套336、滚子轴337和轴架338。所述滚动轴套336套在滚子轴337上,所述滚子轴337排成两排或两排以上安装在轴架338上。所述轴架338包括一个横向支架3381、两个第一纵向支架3382和一个或多个第二纵向支架3383。所述横向支架3381位于滚动组件332的后侧。所有第一纵向支架3382和第二纵向支架3383相互平行。所述第一纵向支架3382为两个转动连接的片状结构,分别为第一后侧支架3384和前侧支架3385,所述第二纵向支架3383为两个转动连接的片状结构,分别为第二后侧支架3386和前侧支架3385。第一后侧支架3384位于滚动组件332的左右两侧,第二后侧支架3386位于滚动组件332的中部,且都与横向支架3381固定连接。所述滚子轴337安装在两个纵向支架之间。所述第一纵向支架3382的第一后侧支架3384端的外侧固定安装有第一固定块3341,其前侧支架3385端的外侧固定安装第三固定块3343,其前侧支架3385靠近转动连接结构的位置的外侧固定安装有第二固定块3342。所述片状的弹簧335的一端固定在第一固定块3341上,并穿过第二固定块3342和第三固定块3343。
所述轮胎托架331通过第一后侧支架3384与轮毂限位座330固定连接。再进一步的,全部或者远离横向支架3381的两排或两排以上所述滚动轴套336的直径随着与横向支架3381间的距离增加而逐渐减小。再进一步的,最外面一排滚动轴套336为三角形的垫块339。再进一步的,所述横向支架3382为块状结构,所述第一后侧支架3384和第二后侧支架3386的底部设置了一个或多个横向的固定支架333。
所述左叉臂200的辊毂限位座330位于其右侧,右叉臂300的辊毂限位座330位于其左侧,将车辆抬离地面时左叉臂200和右叉臂300作相对运动。将车辆抬离地面时,左叉臂200和右叉臂300插入车辆前轮的前方或后轮的后方,左叉臂200和右叉臂300作相对运动,将两排轮胎都抬离地面。
所述车架100上与左叉臂200和右叉臂300同侧设有光电感应器400,用于检测车辆的位置、车辆轴距等参数。
所述车架100由前板110、后板120以及中板130组成,中板130的分别与前板110和后板120固定连接。
实施例2
本实施例中涉及一种适用于实施例1的控制系统及其控制方法。
如图7所示,所述带有挡臂的泊车机器人的控制系统包括行进模块、叉臂移动模块、挡臂驱动模块、测量模块、导航模块和总控制器。
所述行进模块,包括主动行走装置140和万向轮340,用于根据总控制器发出的行进控制指令驱动泊车机器人移动;
叉臂移动模块,包括叉臂移动装置310,用于驱动叉臂移动;
挡臂驱动模块,包括挡臂移动装置和折叠结构,用于驱动挡臂移动、打开和折叠;
测量模块,包括光电感应器400,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元和阻力判定单元;所述输入输出单元,用于获取用户的确定存车或取车的信号;所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制叉臂移动模块驱动叉臂移动、控制挡臂驱动模块驱动挡臂移动及挡臂的打开和折叠、控制导航模块计算泊车机器人的行进路线和控制行进模块驱动泊车机器人移动;所述距离判定单元,用于获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,并将判定结果发送给控制指令单元,同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离;所述阻力判定单元,用于判定左挡臂或右挡臂的移动是否受到的阻力,以及左叉臂或右叉臂的移动是否受到的阻力,并将获取结果和判定结果发送给控制指令单元。
本实施例还包括上述挡臂可折叠的外叉车泊车机器人控制系统的控制方法,所述方法包括:
S1:控制指令单元控制挡臂驱动模块打开折叠的左挡臂和右挡臂;
在尝试仅使用左叉臂和右叉臂无法将车辆抬起时,启动左挡臂和右挡臂,即打开折叠的左挡臂和右挡臂。
S2:控制指令单元控制挡臂驱动模块和叉臂移动模块同时调整左挡臂和右挡臂、左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,若所有判定结果都为是,则控制指令单元控制叉臂移动模块停止驱动叉臂移动,控制挡臂驱动模块停止驱动挡臂移动,若其中一个或两个判定结果为否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S3:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S4:控制指令单元控制挡臂驱动模块同时分别向泊车机器人的两端移动左挡臂和右挡臂;
阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂,若否,则进行下一次判定;
S5:控制指令单元控制叉臂移动模块同时分别向泊车机器人的中间移动左叉臂和右叉臂;
阻力判定单元判定左叉臂或右叉臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若是,则再次判定左挡臂或右挡臂的移动是否受到阻力,若否,则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,并控制挡臂驱动模块向泊车机器人的中间移动左挡臂或右挡臂;
阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂;
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制叉臂移动模块同时分别向泊车机器人的两端移动左叉臂和右叉臂,同时,控制挡臂驱动模块同时分别向泊车机器人的两端移动左挡臂和右挡臂;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,或者控制挡臂驱动模块停止驱动左挡臂或右挡臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆;
距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否大于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
S9:控制指令单元控制挡臂驱动模块将左挡臂和右挡臂折叠起来。
在上述泊车机器人控制方法中,左叉臂和右叉臂作相对运动来挤压轮胎,在获取车辆轴距后,左叉臂和右叉臂分别向泊车机器人的两端移动,左挡臂和右挡臂分别向泊车机器人的中间移动;在挤压轮胎时,左叉臂和右叉臂分别向泊车机器人的中间移动,左挡臂和右挡臂分别向泊车机器人的两端移动;在放置车辆时,左叉臂和右叉臂分别向泊车机器人的两端移动,左挡臂和右挡臂分别向泊车机器人的中间移动。
以左挡臂和左叉臂为例,在向泊车机器人中间移动左挡臂时,当左挡臂第一次受到阻力,表明左挡臂已经碰到了车轮,可以停止继续移动了。当该车轮受到左叉臂的挤压力,爬上左叉臂时,车轮因为离开地面而其位置升高,这样,原本碰到该车轮的左挡臂,不再能够碰到该车轮,当其向泊车机器人两端移动时不再受到阻力。因此,当检测到左挡臂向泊车机器人的两端移动时不再受到阻力,则表明该车轮已经被左叉臂抬起,不需要继续移动左叉臂,否则该车轮可能越过左叉臂重新掉到地面上。而再次向泊车机器人两端移动左挡臂直到第二次受到阻力,表明左挡臂又一次碰到了车轮,能够防止搬运车辆时因颠簸产生的前后移动。
本发明未涉及部分均与现有技术相同或可采用现有技术加以实现。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。

Claims (5)

1.一种挡臂可折叠的外叉车泊车机器人的控制系统,其特征在于,所述控制系统包括行进模块、叉臂移动模块、挡臂驱动模块、测量模块、导航模块和总控制器;
所述行进模块,包括主动行走装置和万向轮,用于根据总控制器发出的行进控制指令驱动泊车机器人移动;
叉臂移动模块,包括叉臂移动装置,用于驱动叉臂移动;
挡臂驱动模块,包括挡臂移动装置和折叠结构,用于驱动挡臂移动、打开和折叠;
测量模块,包括光电感应器,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元和阻力判定单元;所述输入输出单元,用于获取用户的确定存车或取车的信号;所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制叉臂移动模块驱动叉臂移动、控制挡臂驱动模块驱动挡臂移动及挡臂的打开和折叠、控制导航模块计算泊车机器人的行进路线和控制行进模块驱动泊车机器人移动;所述距离判定单元,用于获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,并将判定结果发送给控制指令单元,同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离;所述阻力判定单元,用于判定左挡臂或右挡臂的移动是否受到的阻力,以及左叉臂或右叉臂的移动是否受到的阻力,并将获取结果和判定结果发送给控制指令单元。
2.一种如权利要求1所述的挡臂可折叠的外叉车泊车机器人控制系统的控制方法,其特征在于,所述方法包括:
S1:控制指令单元控制挡臂驱动模块打开折叠的左挡臂和右挡臂;
S2::控制指令单元控制挡臂驱动模块和叉臂移动模块同时调整左挡臂和右挡臂、左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,判定左挡臂和右挡臂之间的中点与左叉臂和右叉臂的中点是否相重合,若所有判定结果都为是,则控制指令单元控制叉臂移动模块停止驱动叉臂移动,控制挡臂驱动模块停止驱动挡臂移动,若其中一个或两个判定结果为否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S3:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S4:控制指令单元控制挡臂驱动模块同时分别向泊车机器人的两端移动左挡臂和右挡臂;
阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂,若否,则进行下一次判定;
S5:控制指令单元控制叉臂移动模块同时分别向泊车机器人的中间移动左叉臂和右叉臂;
阻力判定单元判定左叉臂或右叉臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,若是,则再次判定左挡臂或右挡臂的移动是否受到阻力;
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制叉臂移动模块同时分别向泊车机器人的两端移动左叉臂和右叉臂,同时,控制挡臂驱动模块同时分别向泊车机器人的中间移动左挡臂和右挡臂;
距离判定单元获取两个叉臂间的距离和两个挡臂间的距离,并判定车辆的轴距与两个挡臂间的距离的差值、两个叉臂间的距离与车辆的轴距的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是则控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂,或者控制挡臂驱动模块停止驱动左挡臂或右挡臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆。
3.根据权利要求2所述的控制方法,其特征在于,在步骤S5中,当控制指令单元控制叉臂移动模块停止驱动左叉臂或右叉臂后,控制挡臂驱动模块向泊车机器人的两端移动左挡臂或右挡臂;阻力判定单元判定左挡臂或右挡臂的移动是否受到阻力,并将结果发送给控制指令单元,若否,则进行下一次判定,若是,则控制指令单元控制挡臂驱动模块停止驱动左挡臂或右挡臂。
4.根据权利要求2所述的控制方法,其特征在于,在步骤S8中,还包括:距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否大于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定。
5.根据权利要求2所述的控制方法,其特征在于,所述方法还包括:
S9:控制指令单元控制挡臂驱动模块将左挡臂和右挡臂折叠起来。
CN202011236445.1A 2020-11-09 2020-11-09 一种挡臂可折叠的外叉车泊车机器人控制系统和方法 Withdrawn CN112225128A (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202011236445.1A CN112225128A (zh) 2020-11-09 2020-11-09 一种挡臂可折叠的外叉车泊车机器人控制系统和方法
CN202111322366.7A CN115140682A (zh) 2020-11-09 2021-11-09 一种挡臂可折叠的二爪式泊车机器人控制系统和方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011236445.1A CN112225128A (zh) 2020-11-09 2020-11-09 一种挡臂可折叠的外叉车泊车机器人控制系统和方法

Publications (1)

Publication Number Publication Date
CN112225128A true CN112225128A (zh) 2021-01-15

Family

ID=74123127

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011236445.1A Withdrawn CN112225128A (zh) 2020-11-09 2020-11-09 一种挡臂可折叠的外叉车泊车机器人控制系统和方法

Country Status (1)

Country Link
CN (1) CN112225128A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113233383A (zh) * 2021-05-10 2021-08-10 苏州市奇强工业设备工程有限公司 一种货叉可折叠的叉车
CN116081527A (zh) * 2023-04-11 2023-05-09 山东省泰金斯叉车属具有限公司 一种同步调距的侧移调距叉

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113233383A (zh) * 2021-05-10 2021-08-10 苏州市奇强工业设备工程有限公司 一种货叉可折叠的叉车
CN116081527A (zh) * 2023-04-11 2023-05-09 山东省泰金斯叉车属具有限公司 一种同步调距的侧移调距叉

Similar Documents

Publication Publication Date Title
CN112225128A (zh) 一种挡臂可折叠的外叉车泊车机器人控制系统和方法
CN112279158A (zh) 一种挡臂可折叠的内叉车泊车机器人控制系统和方法
CN214615717U (zh) 一种挡臂可折叠的外叉车泊车机器人
CN112431459A (zh) 一种带有挡臂的外叉车泊车机器人控制系统和方法
CN112360215A (zh) 一种具有挡臂的外叉车泊车机器人控制系统和方法
CN112459564A (zh) 一种有挡臂结构的外叉车泊车机器人控制系统和方法
CN112431463A (zh) 一种带有挡臂的内叉车泊车机器人控制系统和方法
CN214091233U (zh) 一种挡臂可伸缩的外叉车泊车机器人
CN214195746U (zh) 一种挡臂可伸缩的内叉车泊车机器人
CN112240112A (zh) 一种挡臂可折叠的外叉车泊车机器人及其停车实现方法
CN112459568A (zh) 一种有挡臂结构的内叉车泊车机器人控制系统和方法
CN112459574A (zh) 一种具有挡臂的内叉车泊车机器人控制系统和方法
CN214659182U (zh) 一种带有挡臂的内叉车泊车机器人
CN112240119A (zh) 一种挡臂可折叠的内叉车泊车机器人及其停车实现方法
CN112459575A (zh) 一种具有挡齿的内叉车泊车机器人控制系统和方法
CN112459567A (zh) 一种具有挡齿的外叉车泊车机器人控制系统和方法
CN112431461A (zh) 一种带有挡齿的外叉车泊车机器人控制系统和方法
CN112459566A (zh) 一种带有挡齿的内叉车泊车机器人控制系统和方法
CN214062498U (zh) 一种带有挡臂的双齿式泊车机器人
CN112431460A (zh) 一种有挡齿结构的外叉车泊车机器人控制系统和方法
CN112240113A (zh) 一种挡臂可伸缩的内叉车泊车机器人及其停车实现方法
CN214091231U (zh) 一种带有挡齿的外叉车泊车机器人
CN112459572A (zh) 一种有挡齿结构的内叉车泊车机器人控制系统和方法
CN112240114A (zh) 一种挡臂可伸缩的外叉车泊车机器人及其停车实现方法
CN112431462A (zh) 一种带有挡臂的双齿式泊车机器人控制系统和方法

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
WW01 Invention patent application withdrawn after publication

Application publication date: 20210115

WW01 Invention patent application withdrawn after publication