CN1251841C - 一种模块化可变结构蛇形机器人 - Google Patents
一种模块化可变结构蛇形机器人 Download PDFInfo
- Publication number
- CN1251841C CN1251841C CN 02144565 CN02144565A CN1251841C CN 1251841 C CN1251841 C CN 1251841C CN 02144565 CN02144565 CN 02144565 CN 02144565 A CN02144565 A CN 02144565A CN 1251841 C CN1251841 C CN 1251841C
- Authority
- CN
- China
- Prior art keywords
- joint module
- snake
- joint
- module
- motion
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
本发明公开一种模块化可变结构蛇形机器人。它由多个相同结构的单自由度的关节模块组成,每个关节模块具有伺服控制器、活动板、连接板,所述关节模块通过活动板、连接板依次相连,通过相邻关节模块的方向差为0和/或90度的连接方式构成蛇体结构,每个关节模块的伺服控制器分别与控制板相连,再与主控计算机中控制程序信号相通。根据应用背景需要,本发明可用同样数量的关节模块组成能实现两维运动的蛇形机器人,也可组成能实现三维运动的蛇形机器人。它具有模块化、可变结构的特点,便于加工、制造、调试,易于维护和更换,扩展了蛇形机器人的适应能力和应用范围。
Description
技术领域
本发明涉及机器人研究和工程领域,具体是一种模块化可变结构蛇形机器人。
背景技术
蛇形机器人具有稳定性好、横截面小、柔性等特点,能在各种粗糙、陡峭、崎岖的复杂地形上行走,并可攀爬障碍物,这是以轮子或腿作为行走工具的机器人难以做到的。目前,蛇形机器人一般由多个关节模块组成,关节模块的内部结构为液压或电动,具有单自由度或多自由度运动方式,虽关节模块的内部结构和功能各有不同,但由于关节模块间的连接方式只有一种,只能构成一种结构的蛇形机器人。这种单一的构成方式使蛇形机器人的应用受到很大限制,即具有三维运动功能的蛇形机器人虽适用于三维空间,但在平面运动时造成垂直运动部分的浪费。具有二维运动功能的蛇形机器人不适用于三维空间运动。
发明内容
为了克服上述由于蛇形机器人构成方式使应用受限的不足,本发明的目的是提出一种模块化可变结构蛇形机器人。它改善了适应能力,扩大了应用范围。
为了实现上述目的,本实用新型的技术方案是:由多个相同结构的关节模块组成,每个关节模块为单自由度,具有伺服控制器、活动板、连接板,所述关节模块通过活动板、连接板依次相连,还包括控制板、主控计算机,通过相邻关节模块方向差至少有一个为90度的连接方式构成三维运动蛇体结构,每个关节模块的伺服控制器分别与控制板相连,再通过标准的RS232串口与主控计算机中控制程序信号相通;
所述关节模块按相邻的关节模块方向差90度方式首尾依次连接,而相间隔的两个关节模块方向相同,构成三维运动结构;关节模块连接结构为二维运动结构与三维运动结构相结合方式,即所述一部分关节模块按方向相同的方式首尾依次连接,构成二维运动结构;所述另一部分关节模块按相邻的关节模块方向差90度方式首尾依次连接,而相间隔的两个关节模块方向相同,构成三维运动结构;
所述主控计算机中控制程序,用于将每个关节模块的位置量传给控制板,由控制板将位置量分别送给相应的关节模块上的伺服控制器,从而使由关节模块构成的蛇体实现多种运动方式;具体流程为:首先初始化,使每个关节模块的位置处于零位,让蛇体成一条直线,然后判断蛇体运动方式,根据运动方式计算每个关节模块的位置值,具体为:是平面蜿蜒运动时,计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是平面蜿蜒运动,再判断是翻滚运动否,是翻滚运动时,计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是翻滚运动,再判断是否是侧动,是侧动,则计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;然后再判断是否运动?结果为“是”,则返回重新判断关节模块运动方式;否则结束程序;
所述平面蜿蜒运动是控制水平轴上关节模块的关节保持直线,而垂直轴上关节模块的关节呈正弦变化;采用的算法公式为:
其中:α0是蛇体运动的初始弯角,Kn是在蛇体内传播的正弦波的个数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率;
所述侧向运动是控制垂直轴上关节模块的关节和水平轴上关节模块的关节都呈正弦变化,两个曲线之间有一个相位差δφ;侧向运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播正弦波的个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,δ为两个关节模块运动曲线的相位差,K1是曲率;
所述翻滚运动是控制垂直轴上关节模块的关节和水平轴上关节模块的关节变化,使其每一方向的关节运动的角度沿蛇体轴线无变化,垂直轴与水平轴构成的两个互相垂直平面内的一段弧的合成作用使整个蛇体处于力不平衡状态,两个曲线之间有一个相位差为π/2;所述翻滚运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播波的正弦波个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率。
本发明具有如下有益效果:
1.具有模块化、可变结构的特点。本发明模块化的设计使得每个关节模块结构相同,便于加工、制造、调试,同时也易于维护和更换。
2.改善了适应能力,扩大了应用范围。本发明可变结构的设计,使用户可以根据应用背景构造蛇形机器人的结构,扩展了蛇形机器人的适应能力和应用范围;如:本发明蛇形机器人适用于三维空间,而且也适用于平面运动方式,在平面运动时可以采用二维运动功能的蛇形机器人结构,避免了垂直运动部分的浪费。
附图说明
图1为单自由度的关节模块结构示意图。
图2为两个关节模块按相同方向连接的连接示意图。
图3-1为二维运动的蛇形机器人构形图。
图3-2为二维运动的蛇形机器人示意图。
图4-1为主控计算机与控制板控制8个关节模块实施例电控原理图。
图4-2为主控计算机、控制板、伺服控制器之间连接线路图。
图5为主控计算机的程序流程图。
图6-1为两个关节模块按相差90度方向连接的连接示意图。
图6-2为由多个关节模块按相差90度方向连接的三维运动的蛇形机器人示意图。
图7为二维运动结构与三维运动结构相结合的另一实施例蛇形机器人结构示意图。
具体实施方式
实施例1
由多个相同的单自由度的关节模块组成,每个单自由度的关节模块具有伺服控制器、活动板、连接板,所述关节模块通过活动板、连接板依次相连,其中所述关节模块如图1所示,包括连接板1、固定板2、伺服控制器3、转轴4、活动板5、仿蛇皮材料的底面7,所述底面7安装在活动板5的底部,活动板5为凵形,开口朝一侧,水平放置,其位于上、下方的两侧壁通过转轴4与伺服控制器3活动连接,活动板5可随转轴转动,伺服控制器3与固定板2相连接,固定板2为凵形,开口朝向与活动板5开口朝向相反,水平放置,底部与连接板1固连,至少由8个关节模块组成一个蛇形机器人,行走路线为S形;转轴4为关节模块的关节;
一个单自由度的关节模块与另一个单自由度的关节模块通过连接板1、活动板5相连,具体说是连接板1、活动板5上有四个对称分布的连接孔,通过螺丝可以将两个关节模块按相同方向连接起来,如图2、3-1、3-2所示。本实施例尺寸为640×36×60mm。
每个关节模块的伺服控制器3(通过三芯接插件)分别与控制板相连,再通过标准的RS232串口与主控计算机中控制程序信号相通;具体是每个关节模块有一个伺服控制器(为标准产品,型号为JR4721,产地为日本,也可自制),其电器接口为三根线(控制信号、电源、地),通过三芯接插件与控制板相连,由控制板控制(图1中标号6为来自伺服控制器3的接线)。其中:每个关节模块的电器接口相同,可以互换。
所述安装在活动板5下部的仿蛇皮材料底面7,具有横向磨擦系数和纵向磨擦系数相差很大的特性,其横向磨擦系数比纵向磨擦系数大10~100倍。
控制板为标准产品,型号为SSC II,一块控制板可以控制8个伺服控制器。主控计算机与控制板通过标准的RS232串口相连。
在本实施例中,采用一块控制板(分别接5V、9V电源),通过8个伺服控制器3控制8个关节模块,其电控原理图如图4-1所示;主控计算机、控制板、伺服控制器之间具体的连接线路如图4-2所示。
如图5所示,所述主控计算机中控制程序,用于将每个关节模块的位置量传给控制板,由控制板将位置量分别送给相应的关节模块上的伺服控制器3,从而使由关节模块构成的蛇体实现多种运动方式;具体流程为:首先初始化,使每个关节模块的位置处于零位,让蛇体成一条直线,然后判断蛇体运动方式(平面蜿蜒运动、翻滚运动、侧动等),根据运动方式计算每个关节模块的位置值,具体为:是平面蜿蜒运动时,则计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是平面蜿蜒运动,再判断是翻滚运动否,是翻滚运动时,计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是翻滚运动,再判断是否是侧动,是侧动,则计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;然后再判断是否运动?结果为“是”,则返回重新判断关节模块运动方式;否则结束程序。其中:
1)平面蜿蜒运动:控制水平轴上关节模块的关节保持直线,而垂直轴上关节模块的关节呈正弦变化;采用的算法公式为:
其中:α0是蛇体运动的初始弯角,Kn是在蛇体内传播的正弦波的个数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率。
2)侧向运动:控制垂直轴上关节模块的关节和水平轴上关节模块的关节都呈正弦变化,两个曲线之间有一个相位差δφ;侧向运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播正弦波的个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,δφ为两个关节模块运动曲线的相位差,K1是曲率;
3)翻滚运动:控制垂直轴上关节模块的关节和水平轴上关节模块的关节变化,使其每一方向的关节运动的角度沿蛇体轴线无变化,垂直轴与水平轴构成的两个互相垂直平面内的一段弧的合成作用使整个蛇体处于力不平衡状态,两个曲线之间有一个相位差为π/2;所述翻滚运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播波的正弦波个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率。
主控计算机与控制板之间通过RS232串口将每个关节模块的位置量传给控制板,位置量的数据传送方法是:第一个字节为同步字(255),第二个字节为关节模块号(0-7),第三个字节为位置值(0-254),例如,让第二个关节模块位置为45度,应送255,1,63,由控制板将位置量分别送给相应的关节模块,从而使本发明蛇形机器人实现各种运动。其中:平面蜿蜒运动包括转向、前进或后退。
实施例2
所述多个单自由度的关节模块,按应用的需要,都可互换,组成许多种结构的蛇形机器人,如图6-1、6-2所示,通过螺丝采用活动板5、连接板1将每个单自由度的关节模块按相邻的关节模块方向差90度、间隔的两个关节模块方向相同的方式连接,构成三维运动的蛇形机器人;运动方式亦为平面蜿蜒运动、翻滚运动、侧动等。
实施例3
本发明还可以组成三维运动与二维运动相结合的结构,如前部是三维运动,后部是二维运动的蛇形机器人结构,或后部是三维运动,前部是二维运动的蛇形机器人结构,或前后部是三维运动,中部是二维运动的蛇形机器人结构;本实施例采用前部是三维运动,后部是二维运动的蛇形机器人结构,如图7所示,运动方式亦为平面蜿蜒运动、翻滚运动、侧动等。
上列详细说明是针对本发明之可行实施例的具体说明,并非用以限制本发明的专利保护范围,凡未脱离本发明技艺精神所为的等效实施或变更如组合成其它结构的蛇形机器人,均应包含于本申请案的专利保护范围中。
Claims (7)
1.一种模块化可变结构蛇形机器人,由多个相同结构的关节模块组成,每个关节模块为单自由度,具有伺服控制器、活动板、连接板,所述关节模块通过活动板、连接板依次相连,还包括控制板、主控计算机,每个关节模块的伺服控制器分别与控制板相连,再通过标准的RS232串口与主控计算机中控制程序信号相通;其特征在于:通过相邻关节模块方向差至少有一个为90度的连接方式构成三维运动蛇体结构。
2.按照权利要求1所述模块化可变结构蛇形机器人,其特征在于:所述关节模块按相邻的关节模块方向差90度方式首尾依次连接,而相间隔的两个关节模块方向相同,构成三维运动结构。
3.按照权利要求1所述模块化可变结构蛇形机器人,其特征在于:关节模块连接结构为二维运动结构与三维运动结构相结合方式,即所述一部分关节模块按方向相同的方式首尾依次连接,构成二维运动结构;所述另一部分关节模块按相邻的关节模块方向差90度方式首尾依次连接,而相间隔的两个关节模块方向相同,构成三维运动结构。
4.按照权利要求1所述模块化可变结构蛇形机器人,其特征在于:所述主控计算机中控制程序,用于将每个关节模块的位置量传给控制板,由控制板将位置量分别送给相应的关节模块上的伺服控制器,从而使由关节模块构成的蛇体实现多种运动方式;具体流程为:首先初始化,使每个关节模块的位置处于零位,让蛇体成一条直线,然后判断蛇体运动方式,根据运动方式计算每个关节模块的位置值,具体为:是平面蜿蜒运动时,计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是平面蜿蜒运动,再判断是翻滚运动否,是翻滚运动时,计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;不是翻滚运动,再判断是否是侧动,是侧动,则计算每个关节模块的位置值,向控制板传送每个关节模块的位置值;然后再判断是否运动?结果为“是”,则返回重新判断关节模块运动方式;否则结束程序。
5.按照权利要求4所述模块化可变结构蛇形机器人,其特征在于:所述平面蜿蜒运动是控制水平轴上关节模块的关节保持直线,而垂直轴上关节模块的关节呈正弦变化;采用的算法公式为:
其中:α0是蛇体运动的初始弯角,Kn是在蛇体内传播的正弦波的个数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率。
6.按照权利要求4所述模块化可变结构蛇形机器人,其特征在于:所述侧向运动是控制垂直轴上关节模块的关节和水平轴上关节模块的关节都呈正弦变化,两个曲线之间有一个相位差δφ;侧向运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播正弦波的个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,δ为两个关节模块运动曲线的相位差,K1是曲率。
7.按照权利要求4所述模块化可变结构蛇形机器人,其特征在于:所述翻滚运动是控制垂直轴上关节模块的关节和水平轴上关节模块的关节变化,使其每一方向的关节运动的角度沿蛇体轴线无变化,垂直轴与水平轴构成的两个互相垂直平面内的一段弧的合成作用使整个蛇体处于力不平衡状态,两个曲线之间有一个相位差为π/2;所述翻滚运动采用的算法公式为:
其中:αθ0蛇体水平平面内正弦波的初始弯角,αφ0蛇体垂直平面内正弦波的初始弯角,Kn是蛇体内传播波的正弦波个数,nθ为垂直平面运动的关节模块数,nφ为水平平面运动的关节模块数,L是蛇体长,s是尾部关节模块沿蛇形曲线轴线方向的虚位移,l是每一关节模块的长度,i代表任意一个关节模块,K1是曲率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 02144565 CN1251841C (zh) | 2002-11-06 | 2002-11-06 | 一种模块化可变结构蛇形机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 02144565 CN1251841C (zh) | 2002-11-06 | 2002-11-06 | 一种模块化可变结构蛇形机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1498730A CN1498730A (zh) | 2004-05-26 |
CN1251841C true CN1251841C (zh) | 2006-04-19 |
Family
ID=34232019
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 02144565 Expired - Fee Related CN1251841C (zh) | 2002-11-06 | 2002-11-06 | 一种模块化可变结构蛇形机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN1251841C (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695833B (zh) * | 2009-10-22 | 2011-05-04 | 重庆交通大学 | 叶片轮式蛇形机器人 |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100410128C (zh) * | 2006-09-28 | 2008-08-13 | 哈尔滨工业大学 | 一种适用于煤矿矿井搜索探测的履带式多关节铰接机器人 |
WO2008046566A1 (de) * | 2006-10-13 | 2008-04-24 | Robotics Technology Leaders Gmbh | Wurmförmiger mechanismus |
CN101279620B (zh) * | 2008-05-26 | 2010-06-02 | 山东科技大学 | 可重组蚕-蛇混合形机器人及由其构成的搜救机器人*** |
CN101791803A (zh) * | 2010-03-17 | 2010-08-04 | 上海大学 | 高刚度可拆式机器人手臂关节连接装置 |
CN102274638B (zh) * | 2011-05-31 | 2013-09-04 | 深圳华强文化科技集团股份有限公司 | 一种仿真蟒蛇机器人 |
CN102353804A (zh) * | 2011-06-30 | 2012-02-15 | 浙江工业大学 | P-p结构蛇形机器人的爬行速度测量方法 |
JP5243580B2 (ja) | 2011-08-01 | 2013-07-24 | Thk株式会社 | 負荷制御システムおよび負荷駆動システム |
CN102416622B (zh) * | 2011-09-13 | 2013-10-16 | 上海交通大学 | 仿生蛇嘴机构 |
CN102416626B (zh) * | 2011-12-13 | 2014-10-08 | 东南大学 | 一种模块化自重构机器人的单元模块 |
CN103056876B (zh) * | 2013-01-16 | 2015-03-04 | 北京化工大学 | 变刚度并联关节蛇形机器人机构 |
CN103831840A (zh) * | 2014-03-31 | 2014-06-04 | 东南大学 | 一种用于机器人的基于套索驱动的搜索机构 |
CN104669256B (zh) * | 2015-01-06 | 2016-06-08 | 泰华宏业(天津)机器人技术研究院有限责任公司 | 蛇形机器人的平坦路面行进姿态控制方法 |
CN105033991B (zh) * | 2015-06-05 | 2017-06-27 | 常熟理工学院 | 单向被动轮接触机构的蛇形机器人及其控制方法 |
CN107116543B (zh) * | 2017-05-24 | 2020-05-26 | 哈尔滨工业大学 | 一种模块化可重构的蛇形机器人 |
CN107175682B (zh) * | 2017-05-24 | 2019-11-05 | 哈尔滨工业大学 | 一种模块化蛇形机器人关节 |
CN112550505B (zh) * | 2020-12-18 | 2022-04-22 | 航天恒星科技有限公司 | 一种适用于狭小空间操作的模块化机器人 |
-
2002
- 2002-11-06 CN CN 02144565 patent/CN1251841C/zh not_active Expired - Fee Related
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695833B (zh) * | 2009-10-22 | 2011-05-04 | 重庆交通大学 | 叶片轮式蛇形机器人 |
Also Published As
Publication number | Publication date |
---|---|
CN1498730A (zh) | 2004-05-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1251841C (zh) | 一种模块化可变结构蛇形机器人 | |
CN101700621B (zh) | 完全解耦三维移动并联机器人机构 | |
CN103217986B (zh) | 具有球面纯滚性质的二自由度并联转动机构 | |
CN101704244B (zh) | 2-rrt&rrs三自由度空间并联机器人机构 | |
CN110027692A (zh) | 一种利用波动鳍推进的水陆两栖机器人 | |
CN102765087B (zh) | 一种模块化自重构机器人及其变形控制方法 | |
CN2576433Y (zh) | 模块化可变结构蛇形机器人 | |
CN104552247B (zh) | 一种三自由度混联机器人机构 | |
CN1291821C (zh) | 一种具有地面适应能力的蛇形机器人 | |
CN104440921A (zh) | 一种多平移自由度平行四边形复杂运动副 | |
CN100540395C (zh) | 潜器全方位推进器控制装置 | |
CN100348378C (zh) | 一种三自由度解耦并联机构 | |
CN113459069B (zh) | 一种可重构自由度形式的三自由度并联机构 | |
CN203726486U (zh) | 蛇形侦查机器人 | |
CN1769005A (zh) | 大工作空间三维移动并联机器人机构 | |
CN101966507B (zh) | 空间四自由度并联机构及喷涂机器人 | |
CN101704243B (zh) | 2-ppt&pps三自由度空间并联机器人机构 | |
CN1651186A (zh) | 用于机器人操作的三维平移并联机构 | |
CN107520835A (zh) | 变胞并联机构 | |
CN1954975A (zh) | 一类rupu运动链及其组成或衍生的并联机器人机构 | |
CN102815347A (zh) | 一种模块化可重构单链式爬行机器人及其行进方法 | |
CN1261279C (zh) | 实现多方位立卧加工的三轴并联主轴头机构 | |
CN101700655A (zh) | 大工作空间三维移动并联机器人机构 | |
CN102275163A (zh) | 一种球面并联运动机构 | |
CN1557609A (zh) | 结构解耦三自由度并联机器人机构 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C19 | Lapse of patent right due to non-payment of the annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |