CN106041929A - 一种用于六自由度机器人的控制方法 - Google Patents
一种用于六自由度机器人的控制方法 Download PDFInfo
- Publication number
- CN106041929A CN106041929A CN201610473531.1A CN201610473531A CN106041929A CN 106041929 A CN106041929 A CN 106041929A CN 201610473531 A CN201610473531 A CN 201610473531A CN 106041929 A CN106041929 A CN 106041929A
- Authority
- CN
- China
- Prior art keywords
- node
- token
- data
- sent
- address
- 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 56
- 230000008569 process Effects 0.000 claims abstract description 17
- 230000005540 biological transmission Effects 0.000 claims abstract description 14
- 238000003860 storage Methods 0.000 claims description 18
- 238000001514 detection method Methods 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 8
- 238000009826 distribution Methods 0.000 claims description 8
- 230000015572 biosynthetic process Effects 0.000 claims description 7
- 241000854291 Dianthus carthusianorum Species 0.000 claims description 6
- 238000002372 labelling Methods 0.000 claims description 5
- 230000001186 cumulative effect Effects 0.000 claims description 4
- 125000004122 cyclic group Chemical group 0.000 claims description 3
- 239000003999 initiator Substances 0.000 claims description 3
- 230000004044 response Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 9
- 238000005516 engineering process Methods 0.000 description 7
- 238000010276 construction Methods 0.000 description 5
- 238000012423 maintenance Methods 0.000 description 4
- 230000001154 acute effect Effects 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 230000000739 chaotic effect Effects 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 238000013500 data storage Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000015556 catabolic process Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008034 disappearance Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Small-Scale Networks (AREA)
Abstract
本发明实施例公开了一种用于六自由度机器人的控制方法，涉及自动控制技术领域，能够在提高工业机器人控制效率的基础上，增强工业机器人的计算能力。本发明包括：至少六个节点，每一个节点包括伺服器，和加载伺服器上的DSP控制板卡；各节点间通过总线进行物理连接，总线采用Ethernet总线并形成微型局域网进行信息传输。控制***中的任一节点启动后，检测是否为群首节点G；若是则开始令牌初始化过程，若不是则等待令牌初始化指令到达。当令牌初始化完成后，检测当前是否存在待发送数据需要发送；若是，则当令牌到达时发送待发送数据；若否则发送令牌信息，并循环令牌初始化完成后的过程，直至控制***关闭。本发明适用于六自由度机器人的控制***。
Description
技术领域
本发明涉及自动控制技术领域，尤其涉及一种用于六自由度机器人的控制方法。
背景技术
由于DSP(运动控制板卡)的经济性较高，且可靠性能够满足大部分的生产环境的要求，因此目前被广泛使用的工业机器人普遍采用PC机+DSP运动控制板卡的方案。另一方面，由于DSP的设计性能的限制，使得工业机器人的控制***的控制性能受限于DSP性能，在实际应用中，可控制的轴数大都限制在6轴左右。
而近年来，随着PC机技术的发展，基于PC机总线设计的控制***已经发展到可以控制21个轴甚至于27个轴。但是由于DSP板卡的性能并没有较大的改进，依然采用PC机+DSP板卡的主从结构设计，会导致PC机负载剧增；并且由于PC机+DSP板卡的主从结构设计中，通讯采用线束方式，当节点增多时线束数量也会随之剧增，极大的影响了控制性能，并增加了维护成本；还由于PC机+DSP板卡的主从结构设计中，数据存储于PC机，当PC机发生故障时往往会导致整个控制***功能丧失，且日常维护时若涉及到PC机停机，则整个控制***都必须停机，进而导致整个生产线停转，成本十分高昂；当节点增多时控制***中流转的信息也会剧增，从而导致信息存储混乱，从而造成***错误。这些问题都导致了现有的PC机+DSP运动控制板卡的方案难以在提高工业机器人控制效率的基础上，有效控制主机的负载压力，工业机器人的计算能力难有进一步的改善空间。
发明内容
本发明的实施例提供一种用于六自由度机器人的控制方法，能够提高工业机器人控制效率的基础上，减轻主机的负载压力，增强工业机器人的计算能力。
为达到上述目的，本发明的实施例采用如下技术方案：
用于一种控制***的方法，所述控制***包括：至少六个节点，每一个节点包括伺服器，和加载伺服器上的DSP控制板卡；各节点间通过总线进行物理连接，所述总线采用Ethernet总线并形成微型局域网进行信息传输。
所述方法包括：所述控制***中的任一节点启动后，检测是否为群首节点G；若是则开始令牌初始化过程，若不是则等待令牌初始化指令到达。
当令牌初始化完成后，检测当前是否存在待发送数据需要发送；若是，则当令牌到达时发送所述待发送数据；若否则发送令牌信息，并循环令牌初始化完成后的过程，直至所述控制***关闭。
在每一个节点中还包括共享存储区(GS)，其中，各节点中的共享存储区在逻辑上拥有统一地址空间，各节点中的共享存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中。通过所述Ethernet总线广播全局性数据，并由各节点将所述全局性数据存储至所述共享存储区；通过所述Ethernet总线对全网广播对于共享存储区的修改数据的修改信息，其中，各节点对共享存储区的访问采用P-V互锁方式；
在每一个节点中还包括私有存储区(PS)，其中，各节点中的私有存储区在逻辑上拥有互不相同的地址空间，各节点中的私有存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中。一个节点存储、维护和修改这一个节点的私有存储区中的数据；并通过所述Ethernet总线访问另一个节点中的私有存储区中的数据。
所述令牌初始化完成后的过程，还包括：在每个检测周期，检测其中一个节点是否收到所述令牌信息，其中，所述检测周期大于一个数据帧在所述令牌环网络上流转一周的时间；若所述检测周期超期时所述其中一个节点没有收到所述令牌信息，则竞争产生新令牌，并将新令牌在所述令牌环网络上流转，其它节点根据所述新令牌的生成号判定继续竞争或退出，且产生新令牌的节点首先获得信息发送权；若所述其中一个节点上存在比当前令牌更新的生成号，则丢弃原令牌，当所述令牌信息传回所述其中一个节点时，更改令牌号为所述更新的生成号。
本发明实施例提供的用于六自由度机器人的控制方法，采用多主平行结构设计，由伺服单元与控制器构成“节点”，各伺服单元带有独立的控制器，从而解决了PC机+DSP板卡的主从结构设计中PC机负载剧增的问题，以及解决了节点增多时线束数量也会随之剧增的问题；采用总线进行节点(即各伺服单元的控制器)间通信，且节点间通信采用令牌环逻辑进行通信抉择的令牌环逻辑设计，从而解决了节点增多时控制***中流转的信息也会剧增，从而导致信息存储混乱的问题；在多主平行结构基础上，信息流分布上采用全局--所有者设计。具体在信息流分布中，采用全局-所有者结构进行信息分类；其中，按照信息分类情况，全局的信息在公共存储区进行共享存储；按照信息分类情况，所有者信息在各节点中进行私有存储，从而解决了PC机+DSP板卡的主从结构设计中，数据存储于PC机，当PC机发生故障时往往会导致整个控制***功能丧失的问题。与现有技术相比较，本发明基于现有总线技术和令牌环网技术，采用分布式通信对六自由度工业机器人进行六轴控制，建立了完整的令牌访问控制策略、全局-所有者资源控制策略。该方法具有实现简单、应用方便，且与其他总线兼容，便于拓展的特点。在能够提高工业机器人控制效率的基础上，减轻主机的负载压力，增强工业机器人的计算能力。
附图说明
为了更清楚地说明本发明实施例中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其它的附图。
图1是本实施例提供的六自由度机器人组件分布式调度的物理结构示意图；
图2是本实施例提供的令牌环通信抉择方案的实例示意图；
图3是本实施例提供的令牌帧结构示意图；
图4是本实施例提供的通讯抉择流程图；
图5是本实施例提供的组件共享存储流程图；
图6是本实施例提供的组件私有数据的存储流程图。
具体实施方式
为使本领域技术人员更好地理解本发明的技术方案，下面结合附图和具体实施方式对本发明作进一步详细描述。下文中将详细描述本发明的实施方式，所述实施方式的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的，仅用于解释本发明，而不能解释为对本发明的限制。本技术领域技术人员可以理解，除非特意声明，这里使用的单数形式“一”、“一个”、“所述”和“该”也可包括复数形式。应该进一步理解的是，本发明的说明书中使用的措辞“包括”是指存在所述特征、整数、步骤、操作、元件和/或节点，但是并不排除存在或添加一个或多个其他特征、整数、步骤、操作、元件、节点和/或它们的组。应该理解，当我们称元件被“连接”或“耦接”到另一元件时，它可以直接连接或耦接到其他元件，或者也可以存在中间元件。此外，这里使用的“连接”或“耦接”可以包括无线连接或耦接。这里使用的措辞“和/或”包括一个或更多个相关联的列出项的任一单元和全部组合。本技术领域技术人员可以理解，除非另外定义，这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是，诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义，并且除非像这里一样定义，不会用理想化或过于正式的含义来解释。
本发明实施例提供一种用于六自由度机器人的控制方法，所述方法用于一种如图1所示的控制***，所述控制***包括：至少六个节点，每一个节点包括伺服器，和加载伺服器上的DSP控制板卡；各节点间通过总线进行物理连接，所述总线采用Ethernet总线并形成微型局域网进行信息传输。其中，如图1所示的控制***在采用多主平行结构的基础上，使用总线进行节点间通信，以便使六自由度机器人实现负载均衡的分布式控制。
所述方法包括：
所述控制***中的任一节点启动后，检测是否为群首节点G；若是则开始令牌初始化过程，若不是则等待令牌初始化指令到达。
当令牌初始化完成后，检测当前是否存在待发送数据需要发送；若是，则当令牌到达时发送所述待发送数据；若否则发送令牌信息，并循环令牌初始化完成后的过程，直至所述控制***关闭。
例如：如图4所示的，在采用本实施例中所述Ethernet总线进行总线通信后，可以采用令牌环逻辑进行通信抉择的过程，其中包括：***中任一节电启动后，首先按照是否是节点G进行令牌初始化，若是节点G则起始令牌初始化过程，若不是节点G则等待令牌初始化指令到达。然后等待令牌初始化完成。在令牌初始化完成后，进入令牌链路维护，在存在数据要发送的情况下，当令牌到达时发送数据，否则就仅发送令牌信息，然后再进行令牌链路维护阶段，如此循环，直至结束网络链路。
在本实施例中，在每一个节点中还包括共享存储区(GS)，其中，各节点中的共享存储区在逻辑上拥有统一地址空间，各节点中的共享存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中。具体的，通过所述Ethernet总线广播全局性数据，并由各节点将所述全局性数据存储至所述共享存储区。通过所述Ethernet总线对全网广播对于共享存储区的修改数据的修改信息。
本实施例中，全局信息进行共享存储的方式包括：在如图1所示的各节点中开辟GS(Global Storage，共享存储区)，全局性数据由Ethernet总线进行广播发送，各节点在共享存储区对全局性数据进行存储。在逻辑上共享存储区拥有统一地址空间，在物理上共享存储区共占用6块地址空间，分布于6个节点中。其中，各节点对共享存储区的访问采用P-V互锁方式，对共享存储区数据的修改将通过总线对全网广播。
进一步的，如图5所示，在各节点中进行共享存储的流程包括：在节点中以Flash进行数据存储。若节点中已经存在全局存储区，则直接使用，若不存在，则开辟全局存储区Global_Data。然后监视总线数据，若在总线上有全局数据写入，则起始P-V操作，对节点中的全局数据进行改写。若本节点对全局数据进行修改，则在P-V操作后，将修改后的数据送到总线上。
在本实施例中，在每一个节点中还包括私有存储区(PS)，其中，各节点中的私有存储区在逻辑上拥有互不相同的地址空间，各节点中的私有存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中。具体的，一个节点存储、维护和修改这一个节点的私有存储区中的数据。并通过所述Ethernet总线访问另一个节点中的私有存储区中的数据。
在本实施例中，进行私有存储的方式包括：在如图1所示的各节点中开辟PS(Private Storage，私有存储区)，私有数据由各节点进行存储、维护和修改，需要进行信息交互时，由请求方发起通信，所有者进行响应。进一步的，如图6所示，在各节点中进行私有数据存储的过程包括：在节点中以Flash进行数据存储。若节点中已经存在所有者存储区，则直接使用，若不存在，则开辟所有者存储区Private_Data。然后监视总线数据，若在总线上出现本节点的数据操作，则判断其权限。若其没有对本节点所有者数据进行操作的权限，则拒绝，然后返回总线数据监视。若其有对本节点所有者数据进行操作的权限，则与全局数据一样进行相应的读写和修改操作。
在本实施例中，所述令牌初始化过程包括：
由群首节点G生成初始化令牌消息，并随机发送给G的邻居节点I，并向I告知G为群首节点，同时标记I为G的其后继节点。I收到所述初始化令牌消息后，标记I的其后继节点，在每一个节点上重复标记其后继节点的过程，直至G收到G的邻居节点K发送的G为K的后继节点消息后，确定令牌环网络建立完毕，所述令牌环网络的网络地址为G的MAC地址。
例如：如图2所示，在6个节点间定义令牌优先级次序。然后令牌在各节点间依次传递。其中，令牌初始化过程即令牌环网络形成过程。由实现定义的群首节点G负责生成一个初始化令牌消息，随机发送给邻居节点I，告知G为首站点，同时标记I为其后继节点，I收到消息后，采用相同方式进行标记，当G收到其邻居节点K发送的G为K的后继节点消息后，令牌环网络形成。该令牌环的网络地址即是G的MAC地址。
所述令牌初始化完成后的过程，包括：
I在发送数据时首先将数据帧packetI的令牌位置为零，并发送数据帧。若一个节点存在待发送数据需要发送，则在所述一个节点转发所述数据帧packetI时，将所述数据帧packetI的令牌位置为这一个节点的标号，当所述数据帧packetI回到I时，将发送权转交至这一个节点。
例如：基于令牌的数据传送过程包括：节点I在发送数据时首先将数据帧packetI的令牌位置零，将数据帧发送出去。如果节点J有数据要发送，则在其转发packetI时，将packetI的令牌位置为J，当packetI回到I节点时，节点I知道J有数据发送，则将发送权转交给J。如果令牌为空，则说明此时没有其他节点要发送数据，I可以继续进行数据发送。
所述令牌初始化完成后的过程，还包括：
在每个检测周期，检测其中一个节点是否收到所述令牌信息，其中，所述检测周期大于一个数据帧在所述令牌环网络上流转一周的时间。若所述检测周期超期时所述其中一个节点没有收到所述令牌信息，则竞争产生新令牌，并将新令牌在所述令牌环网络上流转，其它节点根据所述新令牌的生成号判定继续竞争或退出，且产生新令牌的节点首先获得信息发送权。若所述其中一个节点上存在比当前令牌更新的生成号，则丢弃原令牌，当所述令牌信息传回所述其中一个节点时，更改令牌号为所述更新的生成号。
具体的，由于网络可能出现节点缺失或干扰的情况，可能导致令牌的丢失或多个令牌出现，因此还需要对令牌进行维护。其中，等待确认的时间(检测周期)必须大于一个数据帧在环上行走一周的时间Tsend，如果令牌没有丢失，该节点必然会第二次收到，从而避免产生新的令牌。若超期没有收到，则竞争产生新令牌。新令牌在环上运行时，其他节点可以根据令牌的生成号判断继续竞争还是退出。如果某一节点有一个比当前令牌更新的生成号，则所述某一节点声明为它的令牌号，丢弃原令牌，当令牌转回该节点时，发生令牌号变化，便知道有一个更新的令牌，从而退出竞争。令牌绕环一周后，新的令牌产生。产生新令牌的节点首先获得信息发送权。
在本实施例中，在所述令牌信息中令牌的帧结构包括：帧控制字段、环地址、目的地址、源地址、序列号、生成序列号、下一个获得令牌的节点地址、待发送的数据、接收数据响应位、循环冗余纠错码。其中，所述帧控制字段用于表示定义帧类型，所述环地址用于表明令牌所属的令牌环网络，当令牌每经过一个节点所述序列号就累加1且返回到令牌环网络的发起站时清零，所述生成序列号初始值为0，令牌在令牌环网络循环一周，则生成序列号累加1。
例如：如图3所示，为本实施例中令牌帧结构一种可能的实例，其中各字段定义如下：
FC：帧控制字段(Frame Control)。定义帧类型，如代表一般令牌，特殊令牌，数据帧，设置前导，设置后继等。
RA：环地址(Ring Address)表明令牌属于哪个令牌环网络，以区别不同令牌环上的令牌。
DA：目的地址(Destination Address)如果为令牌帧，则DA代表该节点地址，如果帧为数据帧，则DA代表发送数据的目的地址。
SA：源地址(Source Address)。
Seq：序列号(Sequence Number)初始值为0，当令牌每经过一个节点，序列号就加1，当返回到令牌环的发起站时，Seq就清零。
GenSeq：生成序列号(Generation Sequence)初始值为0，令牌循环一周，声称序列号就加1。
NRA：下一个获得令牌的节点地址(Next Ring Address)。
Data：发送的数据，在数据帧中有效。
ACK：接收数据响应位，在数据帧中有效。
CRC：循环冗余纠错码，在数据帧中有效。
其中，全局信息和所有者信息按照其关联度进行分类，在***设计阶段进行全局信息和所有者信息的定义。例如表1所示，本实施例中基于全局-所有者结构的分类方法进行机器人控制***分类的部分数据。
表1
本实施例可应用于六自由度工业机器人，也可用于相似的其他机器人，该方法与物理层具体的实现型号并无直接联系，只要求驱动模块带有总线接口即可实现。可广泛应用于各种机器人的***设计中。
本发明实施例提供的用于六自由度机器人的控制方法，采用多主平行结构设计，由伺服单元与控制器构成“节点”，各伺服单元带有独立的控制器，从而解决了PC机+DSP板卡的主从结构设计中PC机负载剧增的问题，以及解决了节点增多时线束数量也会随之剧增的问题；采用总线进行节点(即各伺服单元的控制器)间通信，且节点间通信采用令牌环逻辑进行通信抉择的令牌环逻辑设计，从而解决了节点增多时控制***中流转的信息也会剧增，从而导致信息存储混乱的问题；在多主平行结构基础上，信息流分布上采用全局--所有者设计。具体在信息流分布中，采用全局-所有者结构进行信息分类；其中，按照信息分类情况，全局的信息在公共存储区进行共享存储；按照信息分类情况，所有者信息在各节点中进行私有存储，从而解决了PC机+DSP板卡的主从结构设计中，数据存储于PC机，当PC机发生故障时往往会导致整个控制***功能丧失的问题。与现有技术相比较，本发明基于现有总线技术和令牌环网技术，采用分布式通信对六自由度工业机器人进行六轴控制，建立了完整的令牌访问控制策略、全局-所有者资源控制策略。该方法具有实现简单、应用方便，且与其他总线兼容，便于拓展的特点。在能够提高工业机器人控制效率的基础上，减轻主机的负载压力，增强工业机器人的计算能力。
本说明书中的各个实施例均采用递进的方式描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点说明的都是与其他实施例的不同之处。尤其，对于设备实施例而言，由于其基本相似于方法实施例，所以描述得比较简单，相关之处参见方法实施例的部分说明即可。以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求的保护范围为准。
Claims (7)
1.一种用于六自由度机器人的控制方法，其特征在于，所述方法用于一种控制***，所述控制***包括：至少六个节点，每一个节点包括伺服器，和加载伺服器上的DSP控制板卡；各节点间通过总线进行物理连接，所述总线采用Ethernet总线并形成微型局域网进行信息传输；
所述方法包括：
所述控制***中的任一节点启动后，检测是否为群首节点G；
若是则开始令牌初始化过程，若不是则等待令牌初始化指令到达；
当令牌初始化完成后，检测当前是否存在待发送数据需要发送；
若是，则当令牌到达时发送所述待发送数据；若否则发送令牌信息，并循环令牌初始化完成后的过程，直至所述控制***关闭。
2.根据权利要求1所述的控制方法，其特征在于，在每一个节点中还包括共享存储区(GS)，其中，各节点中的共享存储区在逻辑上拥有统一地址空间，各节点中的共享存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中；
通过所述Ethernet总线广播全局性数据，并由各节点将所述全局性数据存储至所述共享存储区；
通过所述Ethernet总线对全网广播对于共享存储区的修改数据的修改信息，其中，各节点对共享存储区的访问采用P-V互锁方式。
3.根据权利要求1所述的控制方法，其特征在于，在每一个节点中还包括私有存储区(PS)，其中，各节点中的私有存储区在逻辑上拥有互不相同的地址空间，各节点中的私有存储区在物理上共占用至少六块地址空间，所述至少六块地址空间分布于所述控制***中的至少六个节点中；
一个节点存储、维护和修改这一个节点的私有存储区中的数据；
并通过所述Ethernet总线访问另一个节点中的私有存储区中的数据。
4.根据权利要求1所述的控制方法，其特征在于，所述令牌初始化过程包括：
由群首节点G生成初始化令牌消息，并随机发送给G的邻居节点I，并向I告知G为群首节点，同时标记I为G的其后继节点；
I收到所述初始化令牌消息后，标记I的其后继节点，在每一个节点上重复标记其后继节点的过程，直至G收到G的邻居节点K发送的G为K的后继节点消息后，确定令牌环网络建立完毕，所述令牌环网络的网络地址为G的MAC地址。
5.根据权利要求4所述的控制方法，其特征在于，所述令牌初始化完成后的过程，包括：
I在发送数据时首先将数据帧packetI的令牌位置为零，并发送数据帧；
若一个节点存在待发送数据需要发送，则在所述一个节点转发所述数据帧packetI时，将所述数据帧packetI的令牌位置为这一个节点的标号，当所述数据帧packetI回到I时，将发送权转交至这一个节点。
6.根据权利要求4所述的控制方法，其特征在于，所述令牌初始化完成后的过程，还包括：
在每个检测周期，检测其中一个节点是否收到所述令牌信息，其中，所述检测周期大于一个数据帧在所述令牌环网络上流转一周的时间；
若所述检测周期超期时所述其中一个节点没有收到所述令牌信息，则竞争产生新令牌，并将新令牌在所述令牌环网络上流转，其它节点根据所述新令牌的生成号判定继续竞争或退出，且产生新令牌的节点首先获得信息发送权；
若所述其中一个节点上存在比当前令牌更新的生成号，则丢弃原令牌，当所述令牌信息传回所述其中一个节点时，更改令牌号为所述更新的生成号。
7.根据权利要求1-6中任意一项所述的控制方法，其特征在于，在所述令牌信息中令牌的帧结构包括：帧控制字段、环地址、目的地址、源地址、序列号、生成序列号、下一个获得令牌的节点地址、待发送的数据、接收数据响应位、循环冗余纠错码；
其中，所述帧控制字段用于表示定义帧类型，所述环地址用于表明令牌所属的令牌环网络，当令牌每经过一个节点所述序列号就累加1且返回到令牌环网络的发起站时清零，所述生成序列号初始值为0，令牌在令牌环网络循环一周，则生成序列号累加1。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610473531.1A CN106041929B (zh) | 2016-06-24 | 2016-06-24 | 一种用于六自由度机器人的控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610473531.1A CN106041929B (zh) | 2016-06-24 | 2016-06-24 | 一种用于六自由度机器人的控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN106041929A true CN106041929A (zh) | 2016-10-26 |
| CN106041929B CN106041929B (zh) | 2018-03-30 |
Family
ID=57166434
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610473531.1A Expired - Fee Related CN106041929B (zh) | 2016-06-24 | 2016-06-24 | 一种用于六自由度机器人的控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106041929B (zh) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109471713A (zh) * | 2017-09-07 | 2019-03-15 | 北京京东尚科信息技术有限公司 | 用于查询信息的方法和装置 |
| CN110071860A (zh) * | 2019-04-01 | 2019-07-30 | 深圳前海达闼云端智能科技有限公司 | 机器人通信方法、机器人通信***及机器人 |
| EP3684560A4 (en) * | 2017-09-18 | 2021-06-09 | Verb Surgical Inc. | ROBOTIC SURGICAL SYSTEM AND METHOD FOR COMMUNICATING SYNCHRONOUS AND ASYNCHRONOUS INFORMATION TO AND FROM NODES OF A ROBOTIC ARM |
| US11419690B2 (en) | 2017-09-18 | 2022-08-23 | Verb Surgical Inc. | Robotic surgical system having a communication network of a ring topology and method for use therewith |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101196739A (zh) * | 2007-11-26 | 2008-06-11 | 东方电气集团东方汽轮机有限公司 | 冗余配置的自控***及配置方法 |
| CN101582824A (zh) * | 2008-05-13 | 2009-11-18 | 施耐德电器工业公司 | 关于控制局域网总线从节点设备的节点号自动分配方法 |
| US20090312868A1 (en) * | 2008-06-11 | 2009-12-17 | Tsuyoshi Tojo | Manipulator and manipulator posture control method |
| CN103203748A (zh) * | 2013-04-08 | 2013-07-17 | 布法罗机器人科技（苏州）有限公司 | 外骨骼机器人控制***及控制方法 |
| CN104690726A (zh) * | 2014-08-29 | 2015-06-10 | 北京精密机电控制设备研究所 | 一种空间机械臂运动控制*** |
| CN105680735A (zh) * | 2016-02-03 | 2016-06-15 | 中国科学院自动化研究所 | 基于arm处理器的四轴伺服电机运动控制卡及方法 |
-
2016
- 2016-06-24 CN CN201610473531.1A patent/CN106041929B/zh not_active Expired - Fee Related
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101196739A (zh) * | 2007-11-26 | 2008-06-11 | 东方电气集团东方汽轮机有限公司 | 冗余配置的自控***及配置方法 |
| CN101582824A (zh) * | 2008-05-13 | 2009-11-18 | 施耐德电器工业公司 | 关于控制局域网总线从节点设备的节点号自动分配方法 |
| US20090312868A1 (en) * | 2008-06-11 | 2009-12-17 | Tsuyoshi Tojo | Manipulator and manipulator posture control method |
| CN103203748A (zh) * | 2013-04-08 | 2013-07-17 | 布法罗机器人科技（苏州）有限公司 | 外骨骼机器人控制***及控制方法 |
| CN104690726A (zh) * | 2014-08-29 | 2015-06-10 | 北京精密机电控制设备研究所 | 一种空间机械臂运动控制*** |
| CN105680735A (zh) * | 2016-02-03 | 2016-06-15 | 中国科学院自动化研究所 | 基于arm处理器的四轴伺服电机运动控制卡及方法 |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109471713A (zh) * | 2017-09-07 | 2019-03-15 | 北京京东尚科信息技术有限公司 | 用于查询信息的方法和装置 |
| CN109471713B (zh) * | 2017-09-07 | 2022-11-08 | 北京京东尚科信息技术有限公司 | 用于查询信息的方法和装置 |
| EP3684560A4 (en) * | 2017-09-18 | 2021-06-09 | Verb Surgical Inc. | ROBOTIC SURGICAL SYSTEM AND METHOD FOR COMMUNICATING SYNCHRONOUS AND ASYNCHRONOUS INFORMATION TO AND FROM NODES OF A ROBOTIC ARM |
| US11266474B2 (en) | 2017-09-18 | 2022-03-08 | Verb Surgical Inc. | Robotic surgical system and method for communicating synchronous and asynchronous information to and from nodes of a robotic arm |
| US11419690B2 (en) | 2017-09-18 | 2022-08-23 | Verb Surgical Inc. | Robotic surgical system having a communication network of a ring topology and method for use therewith |
| CN110071860A (zh) * | 2019-04-01 | 2019-07-30 | 深圳前海达闼云端智能科技有限公司 | 机器人通信方法、机器人通信***及机器人 |
| CN110071860B (zh) * | 2019-04-01 | 2021-11-09 | 达闼机器人有限公司 | 机器人通信方法、机器人通信***及机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN106041929B (zh) | 2018-03-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106041929A (zh) | 一种用于六自由度机器人的控制方法 | |
| CN101170483B (zh) | 一种路由交换设备堆叠的方法 | |
| CN107733855A (zh) | 一种可同时支持公有链、联盟链及私有链的区块链***及应用方法 | |
| CN112217683B (zh) | 跨异构链数据可达性处理方法、***、介质、设备、终端 | |
| CN107360025A (zh) | 一种分布式存储***集群监控方法及设备 | |
| Chalopin et al. | Tight bounds for black hole search with scattered agents in synchronous rings | |
| Mi et al. | Connectivity restorability of mobile ad hoc sensor network based on k-hop neighbor information | |
| US10033666B2 (en) | Techniques for virtual Ethernet switching of a multi-node fabric | |
| CN105975694B (zh) | 构建解决组合***问题的级联贝叶斯网络的方法 | |
| CN109068336B (zh) | 一种基于小世界网络理论的平行车联网建模方法 | |
| Nguyen et al. | Multiple peer chord rings approach for device discovery in IoT environment | |
| Syed et al. | An energy efficiency distributed routing algorithm based on HAC clustering method for WSNs | |
| CN108599141B (zh) | 多能源局域网快速动态自适应识别方法 | |
| Singh et al. | Creating an adaptive network of hubs using Schelling's model | |
| CN115208578B (zh) | 一种基于区块链的无人机集群信息一致性共享方法 | |
| CN110493792A (zh) | 一种无人机蜂群***的构建方法及*** | |
| Cooper et al. | Dispersion processes | |
| Zhang et al. | Self-healing for mobile robot networks with motion synchronization | |
| Lin et al. | Multi‐narrow type obstacle avoidance algorithm for UAV swarm based on game theory | |
| Baek et al. | Decentralized algorithms for consensus-based power packet distribution | |
| Avin et al. | Faster rumor spreading: Breaking the log n barrier | |
| CN111633656A (zh) | 一种空间多机器人协同操作的分布式能量均衡方法 | |
| Aznar et al. | L-system-driven self-assembly for swarm robotics | |
| Du et al. | Robust control of backward conflict free systems with resources using Petri nets | |
| Kothapalli et al. | Information gathering in adversarial systems: Lines and cycles |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180330 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |