一种新型双齿式侧向泊车机器人控制系统和方法
文献发布时间:2023-06-19 10:10:17
技术领域
本发明属于泊车机器人技术领域,涉及一种停车场用将车辆航运到或搬离停车位的自动化设备,具体地说是一种新型双齿式侧向泊车机器人控制系统和方法。
背景技术
目前,停车场的单层航运机器人基本上都采用四抓结构,左、右各一个行走臂加中间两根夹持臂,通过一个行走臂和一个夹持臂的运动将车辆轮胎夹起来通过行走臂的移动实现车辆的搬运。这种机构需要单独为中间的两个夹持臂各设计一套移动机构,不仅增加了结构的复杂程度,而且增加重量和制造成本,有必要加以改进。
目前已经出现了二爪式泊车机器人,但该机器人的两个叉臂位于车架的两端,占用空间仍然很大。并且,两个主动轮和万向轮之间位置关系的经常变化,若都做为主动轮,其行进算法较为复杂。
发明内容
鉴于现有技术中存在上述技术问题,本发明的目的是针对现有的四爪式泊车机器人存在结构冗余,制造成本高的问题,及现有二爪式泊车机器人占用空间大,不适合全部安装位主动轮的问题,设计一种新型双齿式侧向泊车机器人及其控制系统和方法。
本发明的技术方案如下所述:
本发明所述一种新型双齿式侧向泊车机器人包括:呈一字形结构的横梁100、一对结构对称相同的左叉臂200和右叉臂300、一对固定架110和一对舵轮120;两个所述固定架110通过一个或数个导轨结构130与横梁100的左侧、右侧、上侧或下侧相连接,所述固定架110的一侧与一个舵轮120固定连接,另一侧与左叉臂200或右叉臂300固定连接;左叉臂200和右叉臂300分别安装在横梁100的同一侧;左叉臂200和右叉臂300上分别安装一个万向轮340。
在上述技术方案中,直接使用舵轮作为左叉臂200和右叉臂300在横梁上移动的驱动结构,减少了额外的叉臂驱动装置,节省了成本。并且,从四个叉臂减少为两个叉臂,缩小了泊车机器人的占用空间,结构简单。同时,两个舵轮140和两个万向轮340的连线永远是一个矩形,在设计泊车机器人行进算法时,不需要复杂的计算和推演。
在进一步的技术方案中,所述左叉臂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间的距离增加而逐渐减小。再进一步的,所述轮胎托架331的上表面与左叉臂200或右叉臂300的上表面之间存在≥10mm的高度差。再进一步的,最外面一排滚动轴套336为三角形的垫块339。再进一步的,所述横向支架3382为块状结构,所述第一后侧支架3384和第二后侧支架3386的底部设置了一个或多个横向的固定支架333。
在更进一步的技术方案中,所述左叉臂200的辊毂限位座330位于其左侧,右叉臂300的辊毂限位座330位于其右侧,将车辆抬离地面时左叉臂200和右叉臂300作相离运动;或者左叉臂200的辊毂限位座330位于其右侧,右叉臂300的辊毂限位座330位于其左侧,将车辆抬离地面时左叉臂200和右叉臂300作相对运动。前一种方式,将车辆抬离地面时,左叉臂200和右叉臂300插入车辆的两排车轮之间,左叉臂200和右叉臂300作相离运动,将两排轮胎都抬离地面;后一种方式,将车辆抬离地面时,左叉臂200和右叉臂300插入车辆的两排车轮外侧,左叉臂200和右叉臂300作相对运动,将两排轮胎都抬离地面。
在进一步的技术方案中,所述万向轮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的速率和运行时间可以随意控制α的大小,实现任意方向转动轮子的滚动方向的目的。
在进一步的技术方案中,所述万向轮340为主动驱动万向轮。这样,泊车机器人的四个轮子都是主动驱动的。
在进一步的技术方案中,所述横梁100上与左叉臂200和右叉臂300同侧的中间设有光电感应器140,用于检测车辆的位置和车辆轮胎距等参数。
本发明提供一种新型双齿式侧向泊车机器人控制系统,所述控制系统包括行进模块、测量模块、导航模块和总控制器。
所述行进模块,包括舵轮和万向轮,用于根据总控制器发出的行进控制指令驱动泊车机器人移动,以及调整左叉臂和右叉臂的相对位置;
测量模块,包括光电感应器,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元;
所述输入输出单元,用于获取用户的确定存车或取车的信号;
所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制导航模块计算泊车机器人的行进路线、控制行进模块驱动泊车机器人移动和驱动左叉臂和右叉臂移动;
所述距离判定单元,用于获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元;同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离。
本发明还提供上述新型双齿式侧向泊车机器人控制系统的控制方法,所述方法包括:
S1:输入输出单元收到用户确定存车或取车的信号以后,控制指令单元控制行进模块驱动泊车机器人靠近车辆的一侧;
距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,继续判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离;
所述预定的第一搬运距离是保证泊车机器人不会撞到车辆,又不会距离车辆太远的距离;
S2:控制指令单元控制测量模块测量车辆的轴距,并将其发送给距离判定单元;
S3:控制指令单元控制行进模块同时调整左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,若是,则控制指令单元控制行进模块停止驱动叉臂移动,若否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S4:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S5:控制指令单元控制行进模块同时分别向泊车机器人两端或者中间移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定左叉臂接触轮胎一侧和右叉臂接触轮胎一侧之间的距离是否大于轴距,若是,则控制指令单元控制行进模块停止驱动左叉臂和右叉臂,若否,则进行下一次判定。
进一步的技术方案中,所述控制方法还包括:
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制行进模块同时分别向泊车机器人的中间或者两端移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是,则控制指令单元控制行进模块停止驱动左叉臂或右叉臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆。
本发明具有如下有益效果:
1、本发明的控制系统中,将泊车机器人的行进控制和叉臂的移动控制都集中的行进模块中,简化了管理流程,同时省去了现有的用于夹持轮胎的两根叉臂,并且将舵轮作为叉臂的驱动装置,省去了叉臂移动装置,不仅简化了整机结构,而且提高了其灵活性,大大降低了生产成本。
2、两个舵轮和两个万向轮的连线永远是一个矩形,且在叉臂移动过程,这个矩形只有一对边的长度在改变,在设计泊车机器人行进算法时,不需要复杂的计算和推演。
3、采用了叉臂插入两排轮胎内侧的方式将车辆抬离地面,可缩短车架的长度,进一步减少泊车机器人的占用空间。
4、所述的泊车机器人用可防掉落的叉臂利用轮毂限位座与安装在轮毂限位座中的轮胎托架之间的高度差,阻碍轮胎在叉臂上可能发生的滑动,以实现防止车辆掉落的目的;
5、本发明所述轮胎托架在接触到轮胎后可以向地面发生一定偏转,降低轮胎爬上轮胎托架所需的力,能够轻松抬起较重的车辆或前后配重相差较大的车辆,该轮胎托架是一种自适应结构,不需要另外设计驱动装置,节约能源,降低成本。
附图说明
图1为本发明实施例1的泊车机器人的俯视图;
图2为本发明实施例1的泊车机器人的侧视图;
图3为本发明实施例的泊车机器人叉臂的立体结构图;
图4为本发明实施例的泊车机器人叉臂的一个轮胎托架的立体结构图;
图5为本发明实施例的泊车机器人叉臂的另一个轮胎托架的仰视图;
图6为本发明实施例的泊车机器人叉臂的万向轮结构示意图;
图7为本发明实施例的泊车机器人叉臂的万向轮的剖视图;
图8为本发明实施例2的泊车机器人的俯视图;
图9为本发明实施例中泊车机器人管理系统结构示意图;
其中,100为横梁,110为固定架,120为舵轮,130为导轨结构,140为光电感应器,200为左叉臂,300为右叉臂,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为固定件。
具体实施方式
为了更清楚地说明本发明的技术方案,下面将结合具体实施例和附图进行说明,显而易见地,下面描述中的实施例仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些实施例获得其他的实例。
实施例1
如图1-7所示,本实施例涉及一种新型双齿式侧向泊车机器人,所述机器人包括:呈一字形结构的横梁100、一对结构对称相同的左叉臂200和右叉臂300、一对固定架110和一对舵轮120;两个所述固定架110通过一个或数个导轨结构130与横梁100的左侧、右侧、上侧或下侧相连接,所述固定架110的一侧与一个舵轮120固定连接,另一侧与左叉臂200或右叉臂300固定连接;左叉臂200和右叉臂300分别安装在横梁100的同一侧;左叉臂200和右叉臂300上分别安装一个万向轮340。
所述左叉臂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间的距离增加而逐渐减小。再进一步的,所述轮胎托架331的上表面与左叉臂200或右叉臂300的上表面之间存在≥10mm的高度差。再进一步的,最外面一排滚动轴套336为三角形的垫块339。再进一步的,所述横向支架3382为块状结构,所述第一后侧支架3384和第二后侧支架3386的底部设置了一个或多个横向的固定支架333。
所述左叉臂200的辊毂限位座330位于其左侧,右叉臂300的辊毂限位座330位于其右侧,将车辆抬离地面时左叉臂200和右叉臂300作相离运动。将车辆抬离地面时,左叉臂200和右叉臂300插入车辆的两排车轮之间,左叉臂200和右叉臂300作相离运动,将两排轮胎都抬离地面。
所述万向轮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同侧的中间设有光电感应器140,用于检测车辆的位置和车辆轮胎距等参数。
本实施例中,直接使用舵轮作为叉臂200和叉臂300在横梁上移动的驱动结构,减少了额外的叉臂驱动装置,节省了成本。并且,从四个叉臂减少为两个叉臂,缩小了泊车机器人的占用空间,结构简单。同时,两个舵轮140和两个万向轮340的连线永远是一个矩形,在设计泊车机器人行进算法时,不需要复杂的计算和推演。
实施例2
本实施例涉及一种新型双齿式侧向泊车机器人,其结构与实施例1基本相同,只有左叉臂200和右叉臂300、万向轮340的结构略有不同。
如图3、4和8所示,左叉臂200的辊毂限位座330位于其右侧,右叉臂300的辊毂限位座330位于其左侧,将车辆抬离地面时左叉臂200和右叉臂300作相对运动。将车辆抬离地面时,左叉臂200和右叉臂300插入车辆的两排车轮外侧,左叉臂200和右叉臂300作相对运动,将两排轮胎都抬离地面。
所述万向轮340为主动驱动万向轮。
实施例3
如图9所示,本实施例涉及实施例1中的新型双齿式侧向泊车机器人控制系统,述控制系统包括行进模块、测量模块、导航模块和总控制器。
所述行进模块,包括舵轮和万向轮,用于根据总控制器发出的行进控制指令驱动泊车机器人移动,以及调整左叉臂和右叉臂的相对位置;
测量模块,包括光电感应器,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元;
所述输入输出单元,用于获取用户的确定存车或取车的信号;
所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制导航模块计算泊车机器人的行进路线、控制行进模块驱动泊车机器人移动和驱动左叉臂和右叉臂移动;
所述距离判定单元,用于获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元;同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离。
本实施例还涉及上述新型双齿式侧向泊车机器人控制系统的控制方法,所述方法包括:
S1:输入输出单元收到用户确定存车或取车的信号以后,控制指令单元控制行进模块驱动泊车机器人靠近车辆的一侧;
距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,继续判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离;
所述预定的第一搬运距离是保证泊车机器人不会撞到车辆,又不会距离车辆太远的距离;
S2:控制指令单元控制测量模块测量车辆的轴距,并将其发送给距离判定单元;
S3:控制指令单元控制行进模块同时调整左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,若是,则控制指令单元控制行进模块停止驱动叉臂移动,若否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S4:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S5:控制指令单元控制行进模块同时分别向泊车机器人两端移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定左叉臂接触轮胎一侧和右叉臂接触轮胎一侧之间的距离是否大于轴距,若是,则控制指令单元控制行进模块停止驱动左叉臂和右叉臂,若否,则进行下一次判定。
进一步的技术方案中,所述控制方法还包括:
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制行进模块同时分别向泊车机器人的中间移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是,则控制指令单元控制行进模块停止驱动左叉臂或右叉臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆。
实施例4
如图9所示,本实施例涉及实施例2中的新型双齿式侧向泊车机器人控制系统,所述控制系统包括行进模块、测量模块、导航模块和总控制器。
所述行进模块,包括舵轮和万向轮,用于根据总控制器发出的行进控制指令驱动泊车机器人移动,以及调整左叉臂和右叉臂的相对位置;
测量模块,包括光电感应器,用于检测车辆的轴距;
导航模块,用于计算泊车机器人的行进路线;
总控制器,包括输入输出单元、控制指令单元、距离判定单元;
所述输入输出单元,用于获取用户的确定存车或取车的信号;
所述控制指令单元用于发出控制指令,以便控制测量模块测量轴距、控制导航模块计算泊车机器人的行进路线、控制行进模块驱动泊车机器人移动和驱动左叉臂和右叉臂移动;
所述距离判定单元,用于获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元;同时用于获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离或是否小于或等于第二搬运距离。
本实施例还涉及上述新型双齿式侧向泊车机器人控制系统的控制方法,所述方法包括:
S1:输入输出单元收到用户确定存车或取车的信号以后,控制指令单元控制行进模块驱动泊车机器人靠近车辆的一侧;
距离判定单元获取车辆与泊车机器人间的距离,并判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离,若是,则控制指令单元控制行进模块停止驱动泊车机器人,若否,继续判定车辆与泊车机器人间的距离是否小于或等于第一搬运距离;
所述预定的第一搬运距离是保证泊车机器人不会撞到车辆,又不会距离车辆太远的距离;
S2:控制指令单元控制测量模块测量车辆的轴距,并将其发送给距离判定单元;
S3:控制指令单元控制行进模块同时调整左叉臂和右叉臂的位置;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,若是,则控制指令单元控制行进模块停止驱动叉臂移动,若否,则维持现状;
所述预定差值,是为了保证泊车机器人驶向车辆时,叉臂或挡臂不会撞到车辆的轮胎;
S4:控制指令单元控制行进模块驱动泊车机器人驶向车辆;
距离判定单元获取车辆与泊车机器人的车架间的距离,并判定车辆与泊车机器人间的距离是否小于或等于预定的第二搬运距离,并将判定结果发送给控制指令单元,若是则控制指令单元控制行进模块停止驱动泊车机器人,若否,则进行下一次判定;
所述第二搬运距离,是为了保证泊车机器人能够将车辆左右两侧的四个轮胎都夹抱住,又不会撞到车辆;
S5:控制指令单元控制行进模块同时分别向泊车机器人中间移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定左叉臂接触轮胎一侧和右叉臂接触轮胎一侧之间的距离是否大于轴距,若是,则控制指令单元控制行进模块停止驱动左叉臂和右叉臂,若否,则进行下一次判定。
进一步的技术方案中,所述控制方法还包括:
S6:控制指令单元控制导航模块计算泊车机器人的行进路线,并将其发送给控制指令单元,再控制行进模块驱动泊车机器人驶向车辆将要停放的停车位上;
S7:控制指令单元控制行进模块同时分别向泊车机器人的两端移动左叉臂和右叉臂;
距离判定单元获取两个叉臂间的距离,并判定车辆的轴距与两个叉臂间的距离的差值是否大于或等于预定差值,并将判定结果发送给控制指令单元,若是,则控制指令单元控制行进模块停止驱动左叉臂或右叉臂;
S8:控制指令单元控制行进模块驱动泊车机器人从侧面驶离车辆。
本发明未涉及部分均与现有技术相同或可采用现有技术加以实现。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
- 一种新型双齿式侧向泊车机器人控制系统和方法
- 一种新型双齿式侧向泊车机器人