CN106113039A - 舵机锁位控制方法及舵机 - Google Patents

舵机锁位控制方法及舵机 Download PDF

Info

Publication number
CN106113039A
CN106113039A CN201610544019.1A CN201610544019A CN106113039A CN 106113039 A CN106113039 A CN 106113039A CN 201610544019 A CN201610544019 A CN 201610544019A CN 106113039 A CN106113039 A CN 106113039A
Authority
CN
China
Prior art keywords
steering wheel
lock
value
deviant
predetermined angle
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
Application number
CN201610544019.1A
Other languages
English (en)
Other versions
CN106113039B (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.)
Shenzhen Ubtech Technology Co ltd
Original Assignee
Shenzhen Ubtech 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 Shenzhen Ubtech Technology Co ltd filed Critical Shenzhen Ubtech Technology Co ltd
Priority to CN201610544019.1A priority Critical patent/CN106113039B/zh
Publication of CN106113039A publication Critical patent/CN106113039A/zh
Priority to US15/373,486 priority patent/US10031514B2/en
Application granted granted Critical
Publication of CN106113039B publication Critical patent/CN106113039B/zh
Active 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/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/414—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
    • 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/1679—Programme controls characterised by the tasks executed
    • B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
    • 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
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/34—Director, elements to supervisory
    • G05B2219/34013—Servocontroller
    • 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
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/41—Servomotor, servo controller till figures
    • G05B2219/41247—Servo lock

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Lock And Its Accessories (AREA)

Abstract

本发明公开舵机锁位控制方法及舵机。该舵机锁位控制方法包括如下步骤：舵机进入强锁位状态；判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；若所述角度偏移值在第一预设时间内均大于预设角度偏移值，舵机进入弱锁位状态；判断当前角度变化值是否在第二预设时间内均小于预设角度变化值；若所述当前角度变化值在第二预设时间内均小于预设角度变化值，舵机进入强锁位状态。该舵机锁位控制方法及舵机可实现舵机在强锁位状态和弱锁位状态下的灵活转换，控制方式简单灵活。

Description

舵机锁位控制方法及舵机
技术领域
本发明涉及机器人舵机领域，尤其涉及一种舵机锁位控制方法及舵机。
背景技术
机器人是根据控制器发送的控制指令执行相应动作的机器设备。舵机是机器人的动力元件，是构建机器人关节部件的关键元件。机器人根据控制器的控制指令执行相关动作后，需使舵机齿轮转动到特定位置并固定，以完成锁位操作。具体地，现有舵机锁位控制过程中，通过舵机内的主控电路和角度传感器配合，以完成将舵机齿轮转动到特定位置并固定的目的。但这种舵机锁位控制方法只能通过主控电路和角度传感器配合以实现控制舵机齿轮锁位，控制方式不灵活。
发明内容
本发明要解决的技术问题在于，针对现有舵机锁位控制方法存在的缺陷，提供一种舵机锁位控制方法及舵机。
本发明解决其技术问题所采用的技术方案是：一种舵机锁位控制方法，包括如下步骤：
舵机进入强锁位状态；
判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；
若所述当前角度偏移值在第一预设时间内均大于所述预设角度偏移值，舵机进入弱锁位状态；
判断当前角度变化值是否在第二预设时间内均小于预设角度变化值；
若所述当前角度变化值在第二预设时间内均小于所述预设角度变化值，舵机进入强锁位状态。
优选地，所述“舵机进入强锁位状态”步骤后还包括：
判断舵机进入强锁位状态是否超过强锁位预设稳定用时；若是，则判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；若否，则继续执行本步骤。
优选地，所述“判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值”包括步骤：
记录舵机的最新锁位目标值；
每隔单位时间采集一次舵机的当前角度值并保存；
根据所述最新锁位目标值和所述当前角度值计算所述当前角度偏移值。
优选地，还包括步骤：
将每一所述当前角度偏移值与所述预设角度偏移值进行比较，并判断所述当前角度偏移值是否大于所述预设角度偏移值；
若所述当前角度偏移值大于所述预设角度偏移值，则使角度偏差计数加1，并判断所述角度偏差计数是否大于第一计数阈值；若所述角度偏差计数大于所述第一计数阈值，则所述当前角度偏移值在第一预设时间内均大于预设角度值。
优选地，所述“判断所述当前角度偏移值是否在第一预设时间内均大于预设角度偏移值”还包括：
若所述当前角度偏移值不大于所述预设角度偏移值，则使所述角度偏差计数清零，并判断下一单位时间的角度偏移值是否大于所述预设角度偏移值；
若所述角度偏差计数不大于所述第一计数阈值，则判断下一单位时间的角度偏移值是否大于所述预设角度偏移值。
判断所述当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；
优选地，所述“舵机进入弱锁位状态”步骤还包括：若所述当前角度偏移值在第一预设时间内均大于预设角度偏移值，则所述舵机进入弱锁位状态，并将所述第一预设时间内最后一个所述当前角度值更新为最新锁位目标值。
优选地，所述步骤“判断当前角度变化值是否在第二预设时间内均小于预设角度变化值”包括：
每隔单位时间采集一次舵机的当前角度值并保存；
根据本次采集的当前角度值与上一次采集的当前角度值计算当前角度变化值。
优选地，还包括步骤：
将每一所述当前角度变化值与所述预设角度变化值进行比较，并判断所述当前角度变化值是否小于预设角度变化值；
若所述当前角度变化值小于所述预设角度变化值，则使角度变化计数加1，并判断所述角度变化计数是否大于第二计数阈值；若所述角度变化计数大于所述第二计数阈值，则所述角度变化值在第二预设时间内均小于预设角度变化值。
优选地，还包括步骤：
若所述当前角度变化值不小于所述预设角度变化值，则使所述角度变化计数清零，并判断下一单位时间的所述当前角度变化值是否小于所述预设角度变化值；
若所述角度变化计数不大于所述第二计数阈值，则判断下一单位时间的所述当前角度变化值是否小于所述预设角度变化值
优选地，所述“舵机进入强锁位状态”步骤还包括：将所述第二预设时间内最后一个所述当前角度值更新为所述最新锁位目标值。
本发明还提供一种采用所述舵机锁位控制方法的舵机，包括主控电路、伺服电机、角度传感器、减速齿轮和输出轴，所述角度传感器采集输出角度信息，所述主控电路执行所述舵机锁位控制方法控制所述伺服电机转动，通过所述减速齿轮和输出轴输出。
本发明与现有技术相比具有如下优点：本发明所提供的舵机锁位控制方法，可通过外力使得舵机的当前角度偏移值在第一预设时间内均大于预设角度偏移值，即可使得舵机在强锁位状态下进入弱锁位状态；若当前角度变化值在第二预设时间内均小于预设角度变化值，则进入强锁位状态。该舵机锁位控制方法可通过外力控制舵机的当前角度值以实现对舵机齿轮的锁位控制，可实现舵机在强锁位状态和弱锁位状态灵活转换，控制方式简单灵活。
本发明所提供的采用舵机锁位控制方法的舵机，该舵机中的主控电路执行舵机锁位控制方法，可对舵机齿轮的强锁位状态和弱锁位状态的转换控制，控制方式简单灵活，使得舵机更容易满足其使用需求。
附图说明
下面将结合附图及实施例对本发明作进一步说明，附图中：
图1是本发明实施例1中的舵机锁位控制方法的一流程图；
图2是本发明实施例2中的舵机锁位控制方法的另一流程图；
图3是本发明实施例2中的舵机锁位控制方法的一局部流程图；
图4是本发明实施例2中的舵机锁位控制方法的另一局部流程图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解，现对照附图详细说明本发明的具体实施方式。
实施例1
图1示出本实施例中的舵机锁位控制方法的流程图。如图1所示，该舵机锁位控制方法包括如下步骤：
S11：舵机进入强锁位状态。具体地，舵机上电后，接收来自控制器的首次锁位指令，并根据该首次锁位指令使舵机进入强锁位状态。其中，强锁位状态是指舵机内主控电路控制齿轮转动到并保持在锁位目标值位置，若检测到齿轮转动的位置偏离锁位目标值位置，则控制舵机齿轮的输出力矩，给舵机齿轮施加与偏离方向相反的力，从而使舵机齿轮在收到新的锁位指令之前一直保持在锁位目标值位置的状态。
S12：判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值。其中，当前角度偏移值为当前角度值与最新锁位目标值的差值的绝对值。预设角度偏移值是预先设置的用于判定舵机齿轮偏离锁位目标值的角度偏移值。若当前角度偏移值大于预设角度偏移值，则说明有较大的外力使得舵机齿轮偏离锁位目标值。
S13：若当前角度偏移值在第一预设时间内均大于预设角度偏移值，舵机进入弱锁位状态。其中，弱锁位状态是指舵机内主控电路控制齿轮转动到锁位目标值位置后，若检测到有一长时间大于预定值(使舵机齿轮偏移锁位目标值位置的当前角度偏移值大于预设角度偏移值)的外力存在，则舵机减弱齿轮的输出力矩，并改变舵机锁位目标值位置，使其随当前角度值的变化而变化的状态。
可以理解地，若当前角度偏移值大于预设角度偏移值，则说明有较大的外力作用在舵机上，以使舵机齿轮偏离锁位目标值；若在第一预设时间内根据采集到的当前角度值计算出的当前角度偏移值均大于预设角度偏移值，将说明在第一预设时间内一直有外力作用在舵机上，使舵机齿轮长时间偏离锁位目标值，退出强锁位状态而进入弱锁位状态。
S14：判断当前角度变化值是否在第二预设时间内均小于预设角度变化值。其中，当前角度变化值为本次采集的当前角度值与上一次采集的当前角度值的差值的绝对值。预设角度变化值是预先设置的用于判定舵机齿轮输出角度变化程度的参考值；若当前角度变化值小于预设角度变化值，则说明舵机本次采集的当前角度值与上一次采集的当前角度值之间差值较小，基本保持静止不动。
S15：若当前角度变化值在第二预设时间内均小于预设角度变化值，舵机进入强锁位状态。可以理解地，若当前角度变化值在第二预设时间内均小于预设角度变化值，则说明舵机轮齿的角度在第二预设时间内处于较稳定的状态，此时恢复舵机的输出力矩，使舵机进入强锁位状态，有利于保证舵机的正常工作。
本实施例所提供的舵机锁位控制方法，可通过外力使得舵机的当前角度偏移值在第一预设时间内均大于预设角度偏移值，即可使得舵机在强锁位状态下进入弱锁位状态；若当前角度变化值在第二预设时间内均小于预设角度变化值，则进入强锁位状态。该舵机锁位控制方法可通过外力控制舵机的当前角度值以实现对舵机齿轮的锁位控制，可实现舵机在强锁位状态和弱锁位状态灵活转换，控制方式简单灵活。
实施例2
图2示出本实施例中的舵机锁位控制方法的流程图。如图2所示，该舵机锁位控制方法包括如下步骤：
S21：舵机进入强锁位状态。具体地，舵机上电后，接收来自控制器的首次锁位指令，并根据该首次锁位指令使舵机进入强锁位状态，记录舵机进入强锁位状态时的最新锁位目标值α0。具体地，强锁位状态是指舵机内主控电路控制齿轮转动到并保持在锁位目标值位置，若检测到齿轮转动的位置偏离锁位目标值位置，则控制舵机齿轮的输出力矩，给舵机齿轮施加与偏离方向相反的力，从而使舵机齿轮在收到新的锁位指令之前一直保持在锁位目标值位置的状态。
S22：在舵机进入强锁位状态时，判断舵机进入强锁位状态是否超过强锁位预设稳定用时。若是，执行步骤S23判断当前角度偏移值ε1是否在第一预设时间Δt1内均大于预设角度偏移值ε0；若否，则保持强锁位状态，继续执行步骤S22。可以理解地，由于舵机上电初始化时，可能出现较大幅度的摆动，使得舵机进入强锁位状态可能锁位不理想，因此要求舵机进入强锁位状态后要先等待一段时间(即强锁位预设稳定用时)使舵机锁位稳定下来，再去检测是否有较大的外力使得当前角度偏移值ε1是否在第一预设时间Δt1内均大于预设角度偏移值ε0。可以理解地，步骤S22的设置，可有效防止因误检测而使舵机在上电初始化时，因舵机进入强锁位状态时锁位不理想，而直接进入弱锁位状态，影响舵机的性能。
S23：判断当前角度偏移值ε1是否在第一预设时间Δt1内均大于预设角度偏移值ε0。其中，预设角度偏移值ε0是预先设置的用于判定舵机齿轮偏离锁位目标值的角度偏移值。若当前角度偏移值ε1大于预设角度偏移值ε0，则说明有较大的外力作用在舵机上，以使舵机齿轮偏离锁位目标值；若在第一预设时间Δt1内根据采集到的当前角度值β1计算出的当前角度偏移值ε1均大于预设角度偏移值ε0，将说明在第一预设时间Δt1内一直有外力作用在舵机上，使舵机齿轮长时间偏离锁位目标值，退出强锁位状态而进入弱锁位状态。可以理解地，舵机进入强锁位状态时会不断执行步骤S23，以确定在第一预设时间Δt1(连续时间)内所检测到的当前角度偏移值ε1是否均大于预设角度偏移值ε0。具体包括如下步骤：
S231：记录舵机的最新锁位目标值α0。可以理解地，在舵机进入强锁位状态时，即记录舵机的最新锁位目标值α0
S232：每隔单位时间t1采集到的当前角度值β1。
S233：根据最新锁位目标值α0和当前角度值β1计算当前角度偏移值ε1。具体地，每隔单位时间t1，通过设置在舵机齿轮上的角度传感器采集一次舵机的当前角度值β1并保存，并计算获取当前角度偏移值ε1。其中，当前角度偏移值ε1为当前角度值β1与最新锁位目标值α0的差值的绝对值，即ε1＝|β1-α0|。
S234：将每一当前角度偏移值ε1与预设角度偏移值ε0进行比较，并判断当前角度偏移值ε1是否大于预设角度偏移值ε0。
S235：若当前角度偏移值ε1大于预设角度偏移值ε0，则使角度偏差计数n1加1，并判断角度偏差计数n1是否大于第一计数阈值N1；若角度偏差计数n1大于第一计数阈值N1，则当前角度偏移值ε1在第一预设时间Δt1内均大于预设角度值ε0。可以理解地，由于每一当前角度偏移值ε1为当前角度值β1与最新锁位目标值α0的差值的绝对值，而当前角度值β1每隔单位时间t1采集一次，若当前角度偏移值ε1大于预设角度偏移值ε0，则使角度偏差计数n1加1，通过计算单位时间t1与角度偏差计数n1的乘积即可获得当前角度偏移值ε1均大于预设角度偏移值ε0的时间，并将其与第一预设时间Δt1进行比较，即可判断当前角度偏移值ε1是否在第一预设时间Δt1内均大于预设角度偏移值ε0。其中，第一计数阈值N1可以为第一预设时间Δt1与单位时间t1的商值，通过比较角度偏差计数n1是否大于第一计数阈值N1，即可确定当前角度偏移值ε1是否在第一预设时间Δt1内均大于预设角度偏移值ε0，计算过程简单方便。
S236：若当前角度偏移值ε1不大于预设角度偏移值ε0，则使角度偏差计数n1清零，并判断下一单位时间的当前角度偏移值ε1是否大于预设角度偏移值ε0。可以理解地，若任一单位时间的当前角度偏移值ε1不大于预设角度偏移值ε0，则其不可能在第一预设时间Δt1内的当前角度偏移值ε1均大于预设角度偏移值ε0，故使角度偏差计数n1清零，并判断下一单位时间的当前角度偏移值ε1是否大于预设角度偏移值ε0。
S237：若角度偏差计数n1不大于第一计数阈值N1，则判断下一单位时间的当前角度偏移值ε1是否大于预设角度偏移值ε0。可以理解地，只需使角度偏差计数n1大于第一计数阈值N1，即可认定第一预设时间Δt1内的当前角度偏移值ε1均大于预设角度偏移值ε0，因此，若角度偏差计数n1不大于第一计数阈值N1，则需计算下一单位时间的当前角度偏移值ε1是否大于预设角度偏移值ε0，直到角度偏差计数n1大于第一计数阈值N1。
S24：若当前角度偏移值ε1在第一预设时间Δt1内均大于预设角度偏移值ε0，则舵机进入弱锁位状态。即在第一预设时间Δt1这一连续时间内所检测到的当前角度偏移值ε1均大于预设角度偏移值ε0。可以理解地，弱锁位状态是指舵机内主控电路控制齿轮转动到锁位目标值位置后，若检测到有一长时间大于预定值(使舵机齿轮偏移锁位目标值位置的当前角度偏移值ε1大于预设角度偏移值ε0)的外力存在，则舵机减弱齿轮的输出力矩，并改变舵机锁位目标值位置，使其随当前角度值β1的变化而变化的状态。可以理解地，若当前角度偏移值ε1在第一预设时间Δt1内没有均大于预设角度偏移值ε0，则舵机不进入弱锁位状态，则继续执行步骤S23。
可以理解地，当舵机处于强锁位状态时，若当前角度偏移值ε1在第一预设时间Δt1内均大于预设角度偏移值ε0，则舵机由强锁位状态进入弱锁位状态，并将第一预设时间Δt1内最后一个当前角度值β1更新为最新锁位目标值α0，以使舵机实现由强锁位状态到弱锁位状态的灵活变换，使舵机的控制方式更简单灵活。
S25：将第一预设时间Δt1内最后一个当前角度值β1更新为最新锁位目标值α0。在下一单位时间t1，以第一预设时间Δt1内最后一个当前角度值β1更新为最新锁位目标值α0。
S26：判断当前角度变化值θ1是否在第二预设时间Δt2内均小于预设角度变化值θ0。其中，当前角度变化值θ1为本次采集的当前角度值与上一次采集的当前角度值的差值的绝对值。预设角度变化值θ0是预先设置的用于判定舵机齿轮输出角度变化程度的参考值。若当前角度变化值θ1小于预设角度变化值θ0，则说明舵机本次采集的当前角度值与上一次采集的当前角度值之间差值较小，基本保持静止不动。
S261：每隔单位时间t1采集一次舵机的当前角度值β1并保存。
S262：根据本次采集的当前角度值与上一次采集的当前角度值计算当前角度变化值。本实施例中，角度传感器采集到的本次舵机的当前角度值可以用β1来表示，上一次采集到的当前角度值可以用来β0表示，下一次采集到的当前角度值可以用β2来表示。其中，当前角度变化值θ1为本次采集的当前角度值β1与上一次采集的当前角度值β0的差值的绝对值，即θ1＝|β1-β0|。
S263：将每一当前角度变化值θ1与预设角度变化值θ0进行比较，并判断当前角度变化值θ1是否小于预设角度变化值θ0。
S264：若当前角度变化值θ1小于预设角度变化值θ0，则使角度变化计数n2加1，并判断角度变化计数n2是否大于第二计数阈值N2；若角度变化计数n2大于第二计数阈值N2，则当前角度变化值θ1在第二预设时间Δt2内均小于预设角度变化值θ0。可以理解地，每一当前角度变化值θ1为本次采集的当前角度值β1与上一次采集的当前角度值β0的差值的绝对值，而当前角度值β1每隔单位时间t1采集一次，若当前角度变化值θ1小于预设角度变化值θ0，则使角度变化计数n2加1，通过计算单位时间t1与角度变化计数n2的乘积即可获得当前角度变化值均小于预设角度变化值θ0的时间，并将其与第二预设时间Δt2进行比较，即可判断当前角度变化值θ1是否在第二预设时间Δt2内均小于预设角度变化值θ0。其中，第二计数阈值N2可以为第二预设时间Δt2与单位时间t1的商值，通过比较角度变化计数n2是否大于第二计数阈值N2，即可确定当前角度变化值θ1是否在第二预设时间Δt2内均小于预设角度变化值θ0。
S265：若当前角度变化值θ1不小于预设角度变化值θ0，则使所述角度变化计数n2清零，并判断下一单位时间的所述当前角度变化值θ1是否小于所述预设角度变化值θ0。可以理解地，若任一单位时间的当前角度变化值θ1不小于所述预设角度变化值θ0，则其不可能在第二预设时间Δt2内的当前角度变化值θ1均小于预设角度变化值θ0，故使所述角度变化计数n2清零，并判断下一单位时间的所述当前角度变化值θ1是否小于所述预设角度变化值θ0。
S266：若角度变化计数n2不大于第二计数阈值N2，则判断下一单位时间的当前角度变化值θ1是否小于预设角度变化值θ0。可以理解地，只需使角度变化计数n2大于第二计数阈值N2，即可认定第二预设时间Δt2内的当前角度变化值θ1均小于预设角度变化值θ0。因此，若角度变化计数n2不大于第二计数阈值N2，则判断下一单位时间的当前角度变化值θ1是否小于预设角度变化值θ0。
S27：若当前角度变化值θ1在第二预设时间Δt2内均小于预设角度变化值θ0，则舵机进入强锁位状态。当前角度变化值θ1在第二预设时间Δt2内均小于预设角度变化值θ0，则说明舵机在第二预设时间Δt2内前后N2个单位时间内的当前角度变化值θ1均小于预设角度变化值θ0，舵机齿轮的角度处于较稳定的状态，此时恢复舵机的输出力矩，使舵机进入强锁位状态，有利于保证舵机的正常工作。可以理解地，若当前角度变化值θ1在第二预设时间Δt2内没有均小于预设角度变化值θ0，则继续执行步骤S26。
S28:将第二预设时间Δt2内最后一个当前角度值更新为最新锁位目标值α0。在下一单位时间t1采集到的当前角度值β1并计算当前角度偏移值ε1时，以当前角度值β1与更新后的最新锁位目标值α0的差值的绝对值作为当前角度偏移值ε1。
可以理解地，当舵机处于弱锁位状态时，若当前角度变化值θ1在第二预设时间Δt2内均小于预设角度变化值θ0，则舵机由弱锁位状态进入强锁位状态，并将第二预设时间Δt2内最后一个当前角度值更新为最新锁位目标值，以使舵机实现由弱锁位状态到强锁位状态的灵活转换，使舵机的控制方式更简单灵活。
本实施例所提供的舵机锁位控制方法，可通过外力使得舵机的当前角度偏移值ε1在第一预设时间Δt1内均大于预设角度偏移值ε0，即可使得舵机在强锁位状态下进入弱锁位状态；若当前角度变化值θ1在第二预设时间Δt2内均小于预设角度变化值θ0，则进入强锁位状态。该舵机锁位控制方法可通过外力控制舵机的当前角度值的变化以实现对舵机齿轮的强锁位状态和弱锁位状态的转换控制，控制方式简单灵活，使得舵机更容易满足其使用需求。
实施例3
本实施例公开一种采用实施例1或实施例2中的舵机锁位控制方法的舵机。该舵机包括主控电路、伺服电机、角度传感器、减速齿轮和输出轴，角度传感器采集输出角度信息，主控电路执行实施例1或2中的舵机锁位控制方法控制伺服电机转动，通过减速齿轮和输出轴输出。该舵机中的主控电路执行舵机锁位控制方法，可对舵机齿轮的强锁位状态和弱锁位状态的转换控制，控制方式简单灵活，使得舵机更容易满足其使用需求。
本发明是通过上述具体实施例进行说明的，本领域技术人员应当明白，在不脱离本发明范围的情况下，还可以对本发明进行各种变换和等同替代。另外，针对特定情形或具体情况，可以对本发明做各种修改，而不脱离本发明的范围。因此，本发明不局限于所公开的具体实施例，而应当包括落入本发明权利要求范围内的全部实施方式。

Claims (11)

1.一种舵机锁位控制方法，其特征在于，包括如下步骤：
舵机进入强锁位状态；
判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；
若所述当前角度偏移值在第一预设时间内均大于所述预设角度偏移值，舵机进入弱锁位状态；
判断当前角度变化值是否在第二预设时间内均小于预设角度变化值；
若所述当前角度变化值在第二预设时间内均小于所述预设角度变化值，舵机进入强锁位状态。
2.根据权利要求1所述的舵机锁位控制方法，其特征在于，所述“舵机进入强锁位状态”步骤后还包括：
判断舵机进入强锁位状态是否超过强锁位预设稳定用时；若是，则判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值；若否，则继续执行本步骤。
3.根据权利要求1所述的舵机锁位控制方法，其特征在于，所述“判断当前角度偏移值是否在第一预设时间内均大于预设角度偏移值”包括步骤：
记录舵机的最新锁位目标值；
每隔单位时间采集一次舵机的当前角度值并保存；
根据所述最新锁位目标值和所述当前角度值计算所述当前角度偏移值。
4.根据权利要求3所述的舵机锁位控制方法，其特征在于，还包括步骤：
将每一所述当前角度偏移值与所述预设角度偏移值进行比较，并判断所述当前角度偏移值是否大于所述预设角度偏移值；
若所述当前角度偏移值大于所述预设角度偏移值，则使角度偏差计数加1，并判断所述角度偏差计数是否大于第一计数阈值；若所述角度偏差计数大于所述第一计数阈值，则所述当前角度偏移值在第一预设时间内均大于预设角度值。
5.根据权利要求4所述的舵机锁位控制方法，其特征在于，所述“判断所述当前角度偏移值是否在第一预设时间内均大于预设角度偏移值”还包括：
若所述当前角度偏移值不大于所述预设角度偏移值，则使所述角度偏差计数清零，并判断下一单位时间的角度偏移值是否大于所述预设角度偏移值；
若所述角度偏差计数不大于所述第一计数阈值，则判断下一单位时间的角度偏移值是否大于所述预设角度偏移值。
6.根据权利要求3所述的舵机锁位控制方法，其特征在于，所述“舵机进入弱锁位状态”步骤还包括：将所述第一预设时间内最后一个所述当前角度值更新为最新锁位目标值。
7.根据权利要求5所述的舵机锁位控制方法，其特征在于，所述步骤“判断当前角度变化值是否在第二预设时间内均小于预设角度变化值”包括：
每隔单位时间采集一次舵机的当前角度值并保存；
根据本次采集的当前角度值与上一次采集的当前角度值计算当前角度变化值。
8.根据权利要求7所述的舵机锁位控制方法，其特征在于，还包括步骤：
将每一所述当前角度变化值与所述预设角度变化值进行比较，并判断所述当前角度变化值是否小于预设角度变化值；
若所述当前角度变化值小于所述预设角度变化值，则使角度变化计数加1，并判断所述角度变化计数是否大于第二计数阈值；若所述角度变化计数大于所述第二计数阈值，则所述角度变化值在第二预设时间内均小于预设角度变化值。
9.根据权利要求8所述的舵机锁位控制方法，其特征在于，还包括步骤：
若所述当前角度变化值不小于所述预设角度变化值，则使所述角度变化计数清零，并判断下一单位时间的所述当前角度变化值是否小于所述预设角度变化值；
若所述角度变化计数不大于所述第二计数阈值，则判断下一单位时间的所述当前角度变化值是否小于所述预设角度变化值。
10.根据权利要求7所述的舵机锁位控制方法，其特征在于，所述“舵机进入强锁位状态”步骤还包括：将所述第二预设时间内最后一个所述当前角度值更新为所述最新锁位目标值。
11.一种采用根据权利要求1-10中任一项所述舵机锁位控制方法的舵机，其特征在于，包括主控电路、伺服电机、角度传感器、减速齿轮和输出轴，所述角度传感器采集输出角度信息，所述主控电路执行所述舵机锁位控制方法控制所述伺服电机转动，通过所述减速齿轮和输出轴输出。
CN201610544019.1A 2016-07-08 2016-07-08 舵机锁位控制方法及舵机 Active CN106113039B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201610544019.1A CN106113039B (zh) 2016-07-08 2016-07-08 舵机锁位控制方法及舵机
US15/373,486 US10031514B2 (en) 2016-07-08 2016-12-09 Method for servo locking control and servo

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610544019.1A CN106113039B (zh) 2016-07-08 2016-07-08 舵机锁位控制方法及舵机

Publications (2)

Publication Number Publication Date
CN106113039A true CN106113039A (zh) 2016-11-16
CN106113039B CN106113039B (zh) 2018-06-15

Family

ID=57283627

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610544019.1A Active CN106113039B (zh) 2016-07-08 2016-07-08 舵机锁位控制方法及舵机

Country Status (2)

Country Link
US (1) US10031514B2 (zh)
CN (1) CN106113039B (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107065820A (zh) * 2016-12-31 2017-08-18 深圳市优必选科技有限公司 一种舵机信息防丢失方法及装置
CN109391191A (zh) * 2018-10-25 2019-02-26 浙江大华技术股份有限公司 一种电机控制系统及方法
CN109834727A (zh) * 2017-11-24 2019-06-04 深圳市优必选科技有限公司 一种机器人舵机抖动抑制控制方法及装置
WO2019140655A1 (zh) * 2018-01-19 2019-07-25 深圳市大疆创新科技有限公司 一种限位角度校准方法及终端设备
WO2020155822A1 (zh) * 2019-02-01 2020-08-06 苏州小工匠机器人有限公司 机械手装置控制方法及控制系统

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110071681A (zh) * 2018-01-22 2019-07-30 金宝电子工业股份有限公司 自动控制设备以及自动控制方法
CN118244800A (zh) * 2024-02-19 2024-06-25 重庆日联科技有限公司 一种动态软限位的程序算法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0771465A (ja) * 1993-09-02 1995-03-17 I S Seiki Kk サーボモーターと小バックラッシュ歯車減速機の連結装置
JPH11179691A (ja) * 1997-12-19 1999-07-06 Mitsubishi Electric Corp ロボットの制御装置
JP2003061377A (ja) * 2001-08-17 2003-02-28 Yaskawa Electric Corp オートチューニング機能を備えたモータ制御装置
JP2003189652A (ja) * 2001-12-11 2003-07-04 Hitachi Ltd サーボモータ制御装置
CN202754140U (zh) * 2012-08-02 2013-02-27 上海未来伙伴机器人有限公司 数字舵机
CN103231798A (zh) * 2013-05-06 2013-08-07 西北工业大学 一种数字电动舵机控制装置和控制方法
CN104536326A (zh) * 2015-01-05 2015-04-22 谷逍驰 一种中心出轴式舵机单元结构及其控制系统
CN105173119A (zh) * 2015-08-21 2015-12-23 湖北三江航天红峰控制有限公司 一种自锁电动舵机
CN105270607A (zh) * 2015-11-09 2016-01-27 湖北航天技术研究院总体设计所 一种舵系统锁定装置

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2667150B2 (ja) * 1986-04-21 1997-10-27 ファナック 株式会社 電源切断前の指令上の機械位置復元方法
JP3200059B2 (ja) * 1990-03-30 2001-08-20 株式会社東芝 ロボットの制御装置
DE69126938T2 (de) * 1990-10-11 1998-02-12 Canon Kk Positionierungsvorrichtung
JP3302235B2 (ja) * 1995-09-29 2002-07-15 三菱電機株式会社 電動機の位置制御装置
US6379042B1 (en) * 2000-05-19 2002-04-30 Ge Medical Systems Global Technology Company, Llc Variable self-compensating detent control system for improved positioning accuracy and repeatability
WO2007013350A1 (ja) * 2005-07-25 2007-02-01 Olympus Medical Systems Corp. 医療用制御装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0771465A (ja) * 1993-09-02 1995-03-17 I S Seiki Kk サーボモーターと小バックラッシュ歯車減速機の連結装置
JPH11179691A (ja) * 1997-12-19 1999-07-06 Mitsubishi Electric Corp ロボットの制御装置
JP2003061377A (ja) * 2001-08-17 2003-02-28 Yaskawa Electric Corp オートチューニング機能を備えたモータ制御装置
JP2003189652A (ja) * 2001-12-11 2003-07-04 Hitachi Ltd サーボモータ制御装置
CN202754140U (zh) * 2012-08-02 2013-02-27 上海未来伙伴机器人有限公司 数字舵机
CN103231798A (zh) * 2013-05-06 2013-08-07 西北工业大学 一种数字电动舵机控制装置和控制方法
CN104536326A (zh) * 2015-01-05 2015-04-22 谷逍驰 一种中心出轴式舵机单元结构及其控制系统
CN105173119A (zh) * 2015-08-21 2015-12-23 湖北三江航天红峰控制有限公司 一种自锁电动舵机
CN105270607A (zh) * 2015-11-09 2016-01-27 湖北航天技术研究院总体设计所 一种舵系统锁定装置

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107065820A (zh) * 2016-12-31 2017-08-18 深圳市优必选科技有限公司 一种舵机信息防丢失方法及装置
CN107065820B (zh) * 2016-12-31 2019-06-21 深圳市优必选科技有限公司 一种舵机信息防丢失方法及装置
CN109834727A (zh) * 2017-11-24 2019-06-04 深圳市优必选科技有限公司 一种机器人舵机抖动抑制控制方法及装置
WO2019140655A1 (zh) * 2018-01-19 2019-07-25 深圳市大疆创新科技有限公司 一种限位角度校准方法及终端设备
CN110268357A (zh) * 2018-01-19 2019-09-20 深圳市大疆创新科技有限公司 一种限位角度校准方法及终端设备
CN109391191A (zh) * 2018-10-25 2019-02-26 浙江大华技术股份有限公司 一种电机控制系统及方法
CN109391191B (zh) * 2018-10-25 2020-06-23 浙江大华技术股份有限公司 一种电机控制系统及方法
WO2020155822A1 (zh) * 2019-02-01 2020-08-06 苏州小工匠机器人有限公司 机械手装置控制方法及控制系统

Also Published As

Publication number Publication date
US10031514B2 (en) 2018-07-24
US20180011478A1 (en) 2018-01-11
CN106113039B (zh) 2018-06-15

Similar Documents

Publication Publication Date Title
CN106113039A (zh) 舵机锁位控制方法及舵机
CN108454626B (zh) 一种车辆的自适应巡航纵向调节控制方法及系统
TWI470151B (zh) 風力發電系統
CN104698845B (zh) 基于自抗扰控制器的雷达天线伺服跟踪方法与系统
CN206610167U (zh) 一种自行走机器人
CN104917436A (zh) 永磁直线同步电机的自适应二阶终端滑模控制系统及方法
CN104314757A (zh) 一种风力发电机组偏航控制方法及系统
KR102637909B1 (ko) 전동식 파워 스티어링 시스템의 리던던시 회로
CN102320325A (zh) 应用于双电机线控转向系统的冗余容错控制方法
CN104615153A (zh) 一种基于tmx320f28335浮点dsp的二轴光电跟踪系统
CN103076752B (zh) 舵机控制器、舵机控制方法以及控制系统
CN102904496B (zh) 双电机同步控制系统及其同步控制的方法
CN111980855B (zh) 风力发电机组的偏航控制方法、装置、设备及存储介质
CN101403848A (zh) 三维自动稳定摄像系统
CN109455219A (zh) 一种线控转向系统方向盘限位装置及限位方法
CN204761356U (zh) 永磁直线同步电机的自适应二阶终端滑模控制系统
CN107037729A (zh) 一种基于rbf神经网络自抗扰控制器的设计方法
CN106406162A (zh) 一种基于迁移神经网络的交流伺服控制系统
CN108923711A (zh) 一种伺服系统零点校对的绝对值编码器调零方法
CN105680734B (zh) 一种双电机同步驱动方法
CN104776214A (zh) 纯电动汽车两挡机械式自动变速器换挡控制系统及其控制方法
CN102478820A (zh) 一种新型数控机床定位误差实时补偿装置
CN201854230U (zh) 多电机同步控制系统
CN105867301A (zh) 一种基于误差适应的数控机床温度补偿方法
CN103744439B (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
GR01 Patent grant
GR01 Patent grant