CN106292369B - 舵机的分布式控制***及方法 - Google Patents

舵机的分布式控制***及方法 Download PDF

Info

Publication number
CN106292369B
CN106292369B CN201610813715.8A CN201610813715A CN106292369B CN 106292369 B CN106292369 B CN 106292369B CN 201610813715 A CN201610813715 A CN 201610813715A CN 106292369 B CN106292369 B CN 106292369B
Authority
CN
China
Prior art keywords
steering engine
communication
data
communication controller
sent
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
Application number
CN201610813715.8A
Other languages
English (en)
Other versions
CN106292369A (zh
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.)
Zhang Xiaoli
Original Assignee
Jiangsu Xin Chen Hai Intelligent 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 Xin Chen Hai Intelligent Technology Co Ltd filed Critical Jiangsu Xin Chen Hai Intelligent Technology Co Ltd
Priority to CN201610813715.8A priority Critical patent/CN106292369B/zh
Publication of CN106292369A publication Critical patent/CN106292369A/zh
Application granted granted Critical
Publication of CN106292369B publication Critical patent/CN106292369B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L12/00—Data switching networks
    • H04L12/28—Data switching networks characterised by path configuration, e.g. LAN [Local Area Networks] or WAN [Wide Area Networks]
    • H04L12/40—Bus networks
    • H04L12/407—Bus networks with decentralised control
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L12/00—Data switching networks
    • H04L12/28—Data switching networks characterised by path configuration, e.g. LAN [Local Area Networks] or WAN [Wide Area Networks]
    • H04L12/40—Bus networks
    • H04L2012/40267—Bus for use in transportation systems
    • H04L2012/40286—Bus for use in transportation systems the transportation system being a waterborne vessel

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Combined Controls Of Internal Combustion Engines (AREA)
  • Small-Scale Networks (AREA)

Abstract

本发明公开了一种舵机的分布式控制***，包括：上位机，用于向通讯控制器发送舵机控制参数和对应的通讯ID，还用于向通讯控制器发送舵机状态获取指令和对应的通讯ID；通讯控制器，设有若干个通讯端口，用于根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口通讯端口，还用于将舵机返回的舵机状态数据上传至上位机；若干组舵机，一组舵机通过一个通讯端口连接至通讯控制器，舵机用于根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，还用于根据舵机状态获取指令返回当前状态数据。本发明还公开了一种舵机的分布式控制方法。本发明容易实现，控制简单。

Description

舵机的分布式控制***及方法
技术领域
本发明涉及自动化机器人技术领域，尤其涉及一种舵机的分布式控制***及方法。
背景技术
舵机最早应用于船舶上，由于其转角可连续控制，被广泛应用于智能小车及机器人等领域。大多数舵机控制***采用的是集中式控制方法，即通过一个控制器产生一路或多路PWM信号驱动舵机转动。控制器需要执行路径规划，计算每个舵机的目标位置、运动速度等控制参数，并产生相应的PWM信号驱动舵机转动，同时需要采集各路舵机的反馈信号方便实时跟踪调节，使各舵机以最佳性能达到指定的目标位置。
但是，集中式控制方法存在如下不足：1.当舵机数量较多时***控制难度增加、接线复杂；2.当舵机安装位置远时，控制***抗干扰能力降低等；3.控制***的控制器处理所有的控制功能，占用资源较多、负担重；4.控制***控制的舵机数量有限，不易扩展，当舵机数量比较多时，无法满足要求。
发明内容
发明目的：本发明针对现有技术存在的问题，提供一种舵机的分布式控制***。
技术方案：本发明所述的舵机的分布式控制***包括：
上位机，用于当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID，还用于当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID，以及用于在接收到舵机状态数据后根据通讯ID更新舵机状态；
通讯控制器，设有若干个通讯端口，用于根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，还用于将舵机返回的舵机状态数据和对应的通讯ID上传至上位机；
若干组舵机，一组舵机通过一个通讯端口连接至通讯控制器，舵机用于根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，还用于根据通讯控制器发送的舵机状态获取指令返回当前状态数据。
进一步的，所述上位机包括：
路径规划单元，用于对需要控制的舵机执行路径规划；
指令生成单元，用于对需要获取状态的舵机生成状态获取指令；
控制参数生成单元，用于根据规划的路径生成舵机控制参数；
数据包生成单元，用于将控制参数生成单元生成的舵机控制参数，加上其对应的通讯ID生成数据包，还用于将指令生成单元生成的状态获取指令，加上其对应的通讯ID生成数据包；
数据传输单元，用于将数据包生成单元生成的数据包发送至通讯控制器，还用于接收通讯控制器返回的舵机状态数据和对应的通讯ID；
匹配单元，用于将数据传输单元接收的通讯ID，与向通讯控制器发送舵机状态获取指令对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败；
状态更新的单元，用于在匹配单元匹配成功时，更新通讯ID对应的舵机的状态。
进一步的，所述通讯控制器包括：
第一传输单元，用于上位机和通讯控制器的数据传输；
第一映射单元，用于从第一传输单元接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；
第一数据包生成单元，用于将上位机发送的数据和目的舵机ID号生成数据包，并发送至第二数据传输单元；
第二传输单元，用于将第一数据包生成单元的数据包发送至映射出的目的端口ID对应的通讯端口，还用于接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；
第二映射单元，用于将第二传输单元接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；
第二数据包生成单元，用于将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至第一传输单元。
进一步的，所述舵机包括：
数据传输单元，用于接收通讯控制器发送的数据，以及向通讯控制器返回舵机状态数据和对应的舵机ID；
匹配单元，用于从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
舵机控制单元，用于在匹配单元匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制；
舵机状态获取单元，用于在匹配单元匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据发送至数据传输单元。
进一步的，所述上位机通过RS422连接通讯控制器，每组舵机通过一个RS485总线连接通讯控制器。
本发明所述的舵机的分布式控制方法包括步骤：
S1、当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID；
S2、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，其中，通讯控制器设有若干个通讯端口；
S3、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，其中，舵机一共有若干组，一组舵机通过一个通讯端口连接至通讯控制器；
S4、当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID；
S5、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口；
S6、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据通讯控制器发送的舵机状态获取指令返回当前状态数据；
S7、通讯控制器将舵机返回的舵机状态数据和对应的通讯ID上传至上位机；
S8、上位机接收到舵机状态数据后根据通讯ID更新舵机状态。
进一步的，步骤S1具体包括：
S11、当上位机对舵机需要进行控制时，对需要控制的舵机执行路径规划；
S12、根据规划的路径生成舵机控制参数；
S13、将生成的舵机控制参数加上其对应的通讯ID生成数据包；
S14、将数生成的数据包发送至通讯控制器；
步骤S4具体包括：
S41、当上位机需要获取舵机状态时，生成舵机状态获取指令；
S42、将舵机状态获取指令和对应的通讯ID生成数据包；
S43、将数生成的数据包发送至通讯控制器；
步骤S8具体包括：
S81、将接收的通讯ID，与向通讯控制器发送舵机状态获取指令时对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败；
S82、在匹配成功时，更新通讯ID对应的舵机的状态。
进一步的，步骤S2具体包括：
S21、通讯控制器接收上位机传输的数据；
S22、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；
S23、将上位机发送的舵机控制参数和目的舵机ID号生成数据包；
S24、将生成的数据包发送至映射出的目的端口ID对应的通讯端口；
步骤S5具体包括：
S51、通讯控制器接收上位机传输的数据；
S52、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；
S53、将上位机发送的舵机状态获取指令和目的舵机ID号生成数据包；
S54、将生成的数据包发送至映射出的目的端口ID对应的通讯端口；
步骤S7具体包括：
S71、通讯控制器接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；
S72、通讯控制器将接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；
S73、通讯控制器将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至上位机。
进一步的，步骤S3具体包括：
S31、舵机接收通讯控制器发送的数据；
S32、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
S33、在匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制；
步骤S6具体包括：
S61、舵机接收通讯控制器发送的数据；
S62、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
S63、在匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据发送至数据传输单元。
进一步的，所述上位机通过RS422连接通讯控制器，每组舵机通过一个RS485总线连接通讯控制器。
有益效果：本发明与现有技术相比，其显著优点是：
1.控制难度低、接线简单；
2.传输距离远、抗干扰能力强；
3.上位机被占资源少，负担轻；
4.可控制舵机数量多且易于扩展；
5.中继成本低。
附图说明
图1是本发明提供的舵机的分布式控制***的一个实施例的***框图；
图2是图1中上位机的单元示意图；
图3是图1中通讯控制器的单元示意图；
图4是图1中舵机的单元示意图；
图5是本发明提供的舵机的分布式控制方法的一个实施例的流程示意图；
图6是舵机控制流程示意图；
图7是舵机状态数据获取的流程示意图。
具体实施方式
如图1所示，本实施例的舵机的分布式控制***包括：上位机、通讯控制器和若干组舵机(图中有三组，每组有N个舵机)。上位机通过RS422连接通讯控制器，每组舵机通过一个RS485总线连接通讯控制器。其中，上位机用于当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID，还用于当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID，以及用于在接收到舵机状态数据后根据通讯ID更新舵机状态；通讯控制器设有若干个通讯端口，用于根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，还用于将舵机返回的舵机状态数据和对应的通讯ID上传至上位机；一组舵机通过一个通讯端口连接至通讯控制器，舵机用于根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，还用于根据通讯控制器发送的舵机状态获取指令返回当前状态数据。本***中，上位机并不直接参与舵机的实际控制，而是将舵机的控制由舵机本身的控制电路独立实现，所以舵机控制占用上位机的资源大大减少，减轻了上位机的负担。
如图2所示，上位机包括路径规划单元、指令生成单元、控制参数生成单元、数据包生成单元、数据传输单元、匹配单元和状态更新的单元。其中，路径规划单元用于对需要控制的舵机执行路径规划；指令生成单元用于对需要获取状态的舵机生成状态获取指令；控制参数生成单元用于根据规划的路径生成舵机控制参数；数据包生成单元用于将控制参数生成单元生成的舵机控制参数，加上其对应的通讯ID生成数据包(例如，图1中，1-1表示通讯ID，前面的1表示通讯端口的端口ID，后面的1表示舵机ID)，还用于将指令生成单元生成的状态获取指令，加上其对应的通讯ID生成数据包；数据传输单元用于将数据包生成单元生成的数据包发送至通讯控制器，还用于接收通讯控制器返回的舵机状态数据和对应的通讯ID；匹配单元用于将数据传输单元接收的通讯ID，与向通讯控制器发送舵机状态获取指令对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败；状态更新的单元用于在匹配单元匹配成功时，更新通讯ID对应的舵机的状态，匹配失败时丢弃数据。
如图3所示，通讯控制器包括第一传输单元、第一映射单元、第一数据包生成单元、第二传输单元、第二映射单元、第二数据包生成单元。其中，第一传输单元用于上位机和通讯控制器的数据传输；第一映射单元用于从第一传输单元接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号(例如，通讯ID为2-1，映射出通讯端口的端口ID为2，目的舵机ID号为1)；第一数据包生成单元用于将上位机发送的数据和目的舵机ID号生成数据包，并发送至第二数据传输单元；第二传输单元用于将第一数据包生成单元的数据包发送至映射出的目的端口ID对应的通讯端口，还用于接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；第二映射单元用于将第二传输单元接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；第二数据包生成单元用于将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至第一传输单元。
如图4所示，舵机包括数据传输单元、匹配单元、舵机控制单元、舵机状态获取单元。其中，数据传输单元用于接收通讯控制器发送的数据，以及向通讯控制器返回舵机状态数据和对应的舵机ID；匹配单元用于从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；舵机控制单元用于在匹配单元匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制；舵机状态获取单元用于在匹配单元匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据发送至数据传输单元。
如图5所示，本实施例的舵机的分布式控制方法包括步骤：
S1、当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID。
具体的，步骤S1包括：S11、当上位机对舵机需要进行控制时，对需要控制的舵机执行路径规划；S12、根据规划的路径生成舵机控制参数，包括目标位置、速度等参数；S13、将生成的舵机控制参数加上其对应的通讯ID生成数据包；S14、将数生成的数据包发送至通讯控制器。
例如，如图6所示，当上位机需要对通讯ID为2-1的舵机进行控制时，对该舵机执行路径规划；根据规划的路径生成舵机控制参数；将生成的舵机控制参数加上其对应的通讯ID2-1生成数据包；将数生成的数据包发送至通讯控制器。
S2、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，其中，通讯控制器设有若干个通讯端口。
具体的，步骤S2包括：S21、通讯控制器接收上位机传输的数据；S22、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；S23、将上位机发送的舵机控制参数和目的舵机ID号生成数据包；S24、将生成的数据包发送至映射出的目的端口ID对应的通讯端口。
例如，如图6所示，通讯控制器接收上位机传输的数据；从接收的数据包中，提取出通讯ID 2-1，根据2-1映射出目的端口ID为2和目的舵机ID号为1；将上位机发送的舵机控制参数和目的舵机ID号1生成数据包；将生成的数据包发送至通讯端口2。
S3、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，其中，舵机一共有若干组，一组舵机通过一个通讯端口连接至通讯控制器。
具体的，步骤S3具体包括：S31、舵机接收通讯控制器发送的数据；S32、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；S33、在匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制。
例如，如图6所示，舵机2-1接收通讯控制器发送的数据；从接收的数据中提取出目的舵机ID号为1，并与当前舵机的ID号1进行匹配，若一致，则匹配成功，否则匹配失败；在匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制。
S4、当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID。
具体的，步骤S4具体包括：S41、当上位机需要获取舵机状态时，生成舵机状态获取指令；S42、将舵机状态获取指令和对应的通讯ID生成数据包；S43、将数生成的数据包发送至通讯控制器。
例如，如图7所示，当上位机需要获取通讯ID为2-1的舵机状态时，生成舵机状态获取指令；将舵机状态获取指令和2-1生成数据包；将数生成的数据包发送至通讯控制器。
S5、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口。
具体的，步骤S5具体包括：S51、通讯控制器接收上位机传输的数据；S52、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；S53、将上位机发送的舵机状态获取指令和目的舵机ID号生成数据包；S54、将生成的数据包发送至映射出的目的端口ID对应的通讯端口。
例如，如图7所示，通讯控制器接收上位机传输的数据；从接收的数据包中，提取出通讯ID为2-1，根据通讯ID 2-1映射出目的端口ID为2和目的舵机ID号为1；将上位机发送的舵机状态获取指令和目的舵机ID号1生成数据包；将生成的数据包发送至通讯端口2。
S6、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据通讯控制器发送的舵机状态获取指令返回当前状态数据。
具体的，步骤S6具体包括：S61、舵机接收通讯控制器发送的数据；S62、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败，丢弃数据；S63、在匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据和当前舵机的ID发送至数据传输单元。
例如，如图7所示，舵机接收通讯控制器发送的数据；从接收的数据中提取出目的舵机ID号为1，与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败，丢弃数据；在匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据和舵机ID号1发送至数据传输单元。
S7、通讯控制器将舵机返回的舵机状态数据和对应的通讯ID上传至上位机。
具体的，步骤S7具体包括：S71、通讯控制器接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；S72、通讯控制器将接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；S73、通讯控制器将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至上位机。
例如，如图7所示，通讯控制器接收舵机通过通讯端口2返回的舵机状态数据和舵机ID 1；通讯控制器将接收的舵机ID 1和接收时采用的通讯端口的端口ID 2，映射为通讯ID 2-1；通讯控制器将映射的通讯ID2-1和接收的舵机状态数据打包生成数据包，并发送至上位机。
S8、上位机接收到舵机状态数据后根据通讯ID更新舵机状态。
具体的，步骤S8具体包括：S81、上位机将接收的通讯ID，与向通讯控制器发送舵机状态获取指令时对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败，丢弃数据；S82、在匹配成功时，更新通讯ID对应的舵机的状态。
例如，如图7所示，上位机将接收的通讯ID 2-1，与向通讯控制器发送舵机状态获取指令时对应的通讯ID 2-1进行匹配，若一致，则匹配成功，否则匹配失败；在匹配成功时，更新通讯ID 2-1对应的舵机的状态。
以上所揭露的仅为本发明一种较佳实施例而已，不能以此来限定本发明之权利范围，因此依本发明权利要求所作的等同变化，仍属本发明所涵盖的范围。

Claims (8)

1.一种舵机的分布式控制***，其特征在于该***包括：
上位机，用于当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID，还用于当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID，以及用于在接收到舵机状态数据后根据通讯ID更新舵机状态；
通讯控制器，设有若干个通讯端口，用于根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，还用于将舵机返回的舵机状态数据和对应的通讯ID上传至上位机；
若干组舵机，一组舵机通过一个通讯端口连接至通讯控制器，舵机用于根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，还用于根据通讯控制器发送的舵机状态获取指令返回当前状态数据；
其中，所述通讯控制器包括：
第一传输单元，用于上位机和通讯控制器的数据传输；
第一映射单元，用于从第一传输单元接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；
第一数据包生成单元，用于将上位机发送的数据和目的舵机ID号生成数据包，并发送至第二数据传输单元；
第二传输单元，用于将第一数据包生成单元的数据包发送至映射出的目的端口ID对应的通讯端口，还用于接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；
第二映射单元，用于将第二传输单元接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；
第二数据包生成单元，用于将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至第一传输单元。
2.根据权利要求1所述的舵机的分布式控制***，其特征在于：所述上位机包括：
路径规划单元，用于对需要控制的舵机执行路径规划；
指令生成单元，用于对需要获取状态的舵机生成状态获取指令；
控制参数生成单元，用于根据规划的路径生成舵机控制参数；
数据包生成单元，用于将控制参数生成单元生成的舵机控制参数，加上其对应的通讯ID生成数据包，还用于将指令生成单元生成的状态获取指令，加上其对应的通讯ID生成数据包；
数据传输单元，用于将数据包生成单元生成的数据包发送至通讯控制器，还用于接收通讯控制器返回的舵机状态数据和对应的通讯ID；
匹配单元，用于将数据传输单元接收的通讯ID，与向通讯控制器发送舵机状态获取指令对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败；
状态更新的单元，用于在匹配单元匹配成功时，更新通讯ID对应的舵机的状态。
3.根据权利要求1所述的舵机的分布式控制***，其特征在于：所述舵机包括：
数据传输单元，用于接收通讯控制器发送的数据，以及向通讯控制器返回舵机状态数据和对应的舵机ID；
匹配单元，用于从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
舵机控制单元，用于在匹配单元匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制；
舵机状态获取单元，用于在匹配单元匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据发送至数据传输单元。
4.根据权利要求1所述的舵机的分布式控制***，其特征在于：所述上位机通过RS422连接通讯控制器，每组舵机通过一个RS485总线连接通讯控制器。
5.一种舵机的分布式控制方法，其特征在于该方法包括步骤：
S1、当上位机对舵机需要进行控制时，向通讯控制器发送舵机控制参数和对应的通讯ID；
S2、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口，其中，通讯控制器设有若干个通讯端口；具体包括：S21、通讯控制器接收上位机传输的数据；S22、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；S23、将上位机发送的舵机控制参数和目的舵机ID号生成数据包；S24、将生成的数据包发送至映射出的目的端口ID对应的通讯端口；
S3、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据舵机控制参数进行舵机控制，其中，舵机一共有若干组，一组舵机通过一个通讯端口连接至通讯控制器；
S4、当上位机需要获取舵机状态时，向通讯控制器发送舵机状态获取指令和对应的通讯ID；
S5、通讯控制器根据通讯ID映射出目的端口ID和目的舵机ID号，并将目的舵机ID号和上位机发送的数据发送至映射出的目的端口ID对应的通讯端口；具体包括：S51、通讯控制器接收上位机传输的数据；S52、从接收的数据包中，提取出通讯ID，并根据通讯ID映射出目的端口ID和目的舵机ID号；S53、将上位机发送的舵机状态获取指令和目的舵机ID号生成数据包；S54、将生成的数据包发送至映射出的目的端口ID对应的通讯端口；
S6、舵机根据通讯控制器发送的目的舵机ID号进行匹配，当匹配成功时根据通讯控制器发送的舵机状态获取指令返回当前状态数据；
S7、通讯控制器将舵机返回的舵机状态数据和对应的通讯ID上传至上位机；具体包括：S71、通讯控制器接收舵机通过通讯端口返回的舵机状态数据和对应的舵机ID；S72、通讯控制器将接收的舵机ID和接收时采用的通讯端口的端口ID，映射为通讯ID；S73、通讯控制器将映射的通讯ID和接收的舵机状态数据打包生成数据包，并发送至上位机；
S8、上位机接收到舵机状态数据后根据通讯ID更新舵机状态。
6.根据权利要求5所述的舵机的分布式控制方法，其特征在于：
步骤S1具体包括：
S11、当上位机对舵机需要进行控制时，对需要控制的舵机执行路径规划；
S12、根据规划的路径生成舵机控制参数；
S13、将生成的舵机控制参数加上其对应的通讯ID生成数据包；
S14、将数生成的数据包发送至通讯控制器；
步骤S4具体包括：
S41、当上位机需要获取舵机状态时，生成舵机状态获取指令
S42、将舵机状态获取指令和对应的通讯ID生成数据包；
S43、将数生成的数据包发送至通讯控制器；
步骤S8具体包括：
S81、将接收的通讯ID，与向通讯控制器发送舵机状态获取指令时对应的通讯ID进行匹配，若一致，则匹配成功，否则匹配失败；
S82、在匹配成功时，更新通讯ID对应的舵机的状态。
7.根据权利要求5所述的舵机的分布式控制方法，其特征在于：
步骤S3具体包括：
S31、舵机接收通讯控制器发送的数据；
S32、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
S33、在匹配成功，且接收的数据是舵机控制参数时，根据该舵机控制参数对舵机进行控制；
步骤S6具体包括：
S61、舵机接收通讯控制器发送的数据；
S62、舵机从接收的数据中提取出目的舵机ID号，并与当前舵机的ID号进行匹配，若一致，则匹配成功，否则匹配失败；
S63、在匹配成功，且接收的数据是舵机状态获取指令时，将当前舵机的状态数据和当前舵机的ID发送至数据传输单元。
8.根据权利要求5所述的舵机的分布式控制方法，其特征在于：所述上位机通过RS422连接通讯控制器，每组舵机通过一个RS485总线连接通讯控制器。
CN201610813715.8A 2016-09-09 2016-09-09 舵机的分布式控制***及方法 Expired - Fee Related CN106292369B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610813715.8A CN106292369B (zh) 2016-09-09 2016-09-09 舵机的分布式控制***及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610813715.8A CN106292369B (zh) 2016-09-09 2016-09-09 舵机的分布式控制***及方法

Publications (2)

Publication Number Publication Date
CN106292369A CN106292369A (zh) 2017-01-04
CN106292369B true CN106292369B (zh) 2019-02-15

Family

ID=57711047

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610813715.8A Expired - Fee Related CN106292369B (zh) 2016-09-09 2016-09-09 舵机的分布式控制***及方法

Country Status (1)

Country Link
CN (1) CN106292369B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107015542B (zh) * 2017-04-26 2023-09-01 歌尔科技有限公司 一种总线舵机及其控制装置、控制***和控制方法
CN109696825B (zh) * 2017-10-23 2022-04-15 深圳市优必选科技有限公司 舵机的控制响应方法、装置及舵机
CN107817720B (zh) * 2017-10-24 2019-10-25 深圳市创客工场科技有限公司 一种舵机控制***和方法
CN108021076A (zh) * 2018-01-24 2018-05-11 华馨晶贸易（深圳）有限公司 一种串行分布式模块通信及控制***及方法
CN108829056A (zh) * 2018-06-19 2018-11-16 中国人民解放军陆军工程大学 一种多串口舵机控制***及其控制方法
CN112060076A (zh) * 2020-07-22 2020-12-11 深圳市优必选科技股份有限公司 一种舵机控制方法、舵机控制装置、终端及存储介质

Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20040096789A (ko) * 2003-05-10 2004-11-17 한국과학기술원 ＳｏＣ 로봇 시스템과 그 구동방법
CN201186684Y (zh) * 2008-04-18 2009-01-28 北京工业大学 一种基于rs485总线通讯的智能型电动舵机
CN201186683Y (zh) * 2008-04-18 2009-01-28 北京工业大学 一种基于rs232总线通讯的智能型电动舵机
CN101398687A (zh) * 2008-10-10 2009-04-01 北京科技大学 一种小型双足机器人的信息处理平台
CN102915010A (zh) * 2012-09-19 2013-02-06 山东神戎电子股份有限公司 基于fpga的串行通信分配装置及通信方法
CN103268691A (zh) * 2013-04-28 2013-08-28 大连海事大学 一种远洋船舶安全监测预警***及其工作方法
CN103538069A (zh) * 2013-10-21 2014-01-29 深圳先进技术研究院 一种机器人的控制方法以及装置与***
CN103823442A (zh) * 2014-02-25 2014-05-28 山河智能装备股份有限公司 一种基于can总线的智能舵机驱动器及其控制方法
CN203753267U (zh) * 2014-01-28 2014-08-06 防灾科技学院 分布式控制智能机器蛇
CN104199463A (zh) * 2014-09-15 2014-12-10 南京林业大学 一种六足仿生机器人控制***
CN102857482B (zh) * 2011-06-30 2015-11-18 北京新媒传信科技有限公司 基于多服务端的数据传输方法及***
CN105487890A (zh) * 2015-11-25 2016-04-13 天津航空机电有限公司 一种基于c51系列单片机内核的固件下载方法
CN105515978A (zh) * 2016-01-08 2016-04-20 盛科网络（苏州）有限公司 实现分布式路由、物理主机接入的方法及装置

Patent Citations (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20040096789A (ko) * 2003-05-10 2004-11-17 한국과학기술원 ＳｏＣ 로봇 시스템과 그 구동방법
CN201186684Y (zh) * 2008-04-18 2009-01-28 北京工业大学 一种基于rs485总线通讯的智能型电动舵机
CN201186683Y (zh) * 2008-04-18 2009-01-28 北京工业大学 一种基于rs232总线通讯的智能型电动舵机
CN101398687A (zh) * 2008-10-10 2009-04-01 北京科技大学 一种小型双足机器人的信息处理平台
CN102857482B (zh) * 2011-06-30 2015-11-18 北京新媒传信科技有限公司 基于多服务端的数据传输方法及***
CN102915010A (zh) * 2012-09-19 2013-02-06 山东神戎电子股份有限公司 基于fpga的串行通信分配装置及通信方法
CN103268691A (zh) * 2013-04-28 2013-08-28 大连海事大学 一种远洋船舶安全监测预警***及其工作方法
CN103538069A (zh) * 2013-10-21 2014-01-29 深圳先进技术研究院 一种机器人的控制方法以及装置与***
CN203753267U (zh) * 2014-01-28 2014-08-06 防灾科技学院 分布式控制智能机器蛇
CN103823442A (zh) * 2014-02-25 2014-05-28 山河智能装备股份有限公司 一种基于can总线的智能舵机驱动器及其控制方法
CN104199463A (zh) * 2014-09-15 2014-12-10 南京林业大学 一种六足仿生机器人控制***
CN105487890A (zh) * 2015-11-25 2016-04-13 天津航空机电有限公司 一种基于c51系列单片机内核的固件下载方法
CN105515978A (zh) * 2016-01-08 2016-04-20 盛科网络（苏州）有限公司 实现分布式路由、物理主机接入的方法及装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
"仿人机器人分布式控制***主控层的研究与实现";杨斌;《中国优秀硕士学位论文全文数据库信息科技辑》;20111215(第S2期);第I140-467页

Also Published As

Publication number Publication date
CN106292369A (zh) 2017-01-04

Similar Documents

Publication Publication Date Title
CN106292369B (zh) 舵机的分布式控制***及方法
CN103246204B (zh) 多无人机***仿真与验证方法与装置
CN102662377B (zh) 基于无线传感器网络的多移动机器人编队***和编队方法
CN107037816A (zh) 一种多无人船编队***
CN106325298A (zh) 无人机增程控制***和方法
CN109032181A (zh) 一种双遥控器控制的无人机控制***及控制方法
CN108369421B (zh) 用于运行***的方法以及***
CN105182999A (zh) 一种高精度植保机器人无人机
CN203433367U (zh) 一种小型无人飞行器超视距无线遥控***
CN205103661U (zh) 一种基于体感控制技术的无人机操控***
CN108388268A (zh) 一种基于云端的无人机航线规划方法
CN102508447A (zh) 小型无人飞行器用双向切换***
CN104750008B (zh) 一种ZigBee网络中的农业机器人无线遥控***
CN103837125B (zh) 一种用于隧道施工的收敛监测***
CN106444767B (zh) 一种基于apm和i7智能芯片的联动组合自主导航无人船控制***
CN107703520A (zh) 一种利用无人飞行器任务链路传送差分数据的方法和装置
CN105867420A (zh) 一种应用于无人机的快速模式切换***及方法
CN113067624A (zh) 一种基于北斗报文链的无人机控制方法
CN205581576U (zh) 无人机农田土壤信息监测***
CN206833254U (zh) 无人机地面站
CN109270943A (zh) 一种农业无人机作业方法
CN205507550U (zh) 一种无人飞行器的飞行控制***和飞行控制器
CN106502259A (zh) 电力巡检用小型光电吊舱控制装置、吊舱、无人机及方法
CN110333723A (zh) 一种基于双通信设备的无人艇协同编队方法
CN108900240A (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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20181225

Address after: 210046 No. 2, 57 Zidong Road, Maqun Street, Qixia District, Nanjing, Jiangsu Province

Applicant after: JIANGSU XINCHENHAI INTELLIGENT TECHNOLOGY Co.,Ltd.

Address before: 210049 No. 2 Qingma Road, Qixia District, Nanjing City, Jiangsu Province

Applicant before: NANJING MASITENG INTELLIGENT TECHNOLOGY Co.,Ltd.

GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20220415

Address after: Lishui County, Jiangsu Province

Patentee after: Zhang Xiaoli

Address before: 210046 No. 2, 57 Zidong Road, Maqun Street, Qixia District, Nanjing, Jiangsu Province

Patentee before: JIANGSU XINCHENHAI INTELLIGENT TECHNOLOGY Co.,Ltd.

CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20190215