[发明专利]舵机及其控制方法、可读存储介质有效
申请号: | 202010522319.6 | 申请日: | 2020-06-10 |
公开(公告)号: | CN111638731B | 公开(公告)日: | 2022-10-25 |
发明(设计)人: | 王绍芳;陈乔誉;王黎韬;蒋汶峰 | 申请(专利权)人: | 深圳全智能机器人科技有限公司 |
主分类号: | G05D3/12 | 分类号: | G05D3/12 |
代理公司: | 深圳市国高专利代理事务所(普通合伙) 44731 | 代理人: | 陈冠豪 |
地址: | 518000 广东省深圳市宝安区福永*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 舵机 及其 控制 方法 可读 存储 介质 | ||
本申请公开了舵机及其控制方法、可读存储介质,该方法包括:在舵机上电后,获取控制器发送的控制信号,并基于控制信号计算目标角度;获取舵机的当前角度,并判断舵机的当前角度和目标角度是否相等;若否,控制舵机的电机转动至目标角度,并在电机转动时,获取电机的电流值,若电流值超过预设电流,控制电机停止转动。通过上述方式,解决了现有技术中舵机上电复位易损坏的问题。
技术领域
本申请涉及舵机控制技术领域,特别是涉及一种舵机及其控制方法、可读存储介质。
背景技术
随着近几年自动化设备应用的拓展,舵机的需求越来越广泛,各种应用场合对舵机的控制方式都提出了更高的要求。目前的舵机,在控制转动的时候,仅仅根据控制器发送的信号驱动舵机的电机运行,实现舵机转动,当舵机转动的角度出现偏差时,无法获取舵机实际偏转角度与期望角度的角度差,因此在角度出现偏差时无法进行准确的控制。且大部分舵机在未运行状态时被外力所控制发生偏转后,易使得舵机实际偏转角度发生变化,这种情况下,当舵机上电后进行复位操作时,容易出现舵机损坏的情况。
发明内容
为了解决上述问题,本申请提供一种舵机及其控制方法、可读存储介质,解决现有技术中舵机上电复位易损坏的问题。
本申请采用的一种技术方案是提供一种舵机的控制方法,该方法包括:在舵机上电后,获取控制器发送的控制信号,并基于控制信号计算目标角度;获取舵机的当前角度,并判断舵机的当前角度和目标角度是否相等;若否,控制舵机的电机转动至目标角度,并在电机转动时,获取电机的电流值,若电流值超过预设电流,控制电机停止转动。
其中,控制舵机的电机转动至目标角度,包括:判断舵机的当前角度是否大于目标角度;若是,则控制舵机的电机正转,以转动至目标角度;若否,则控制舵机的电机反转,以转动至目标角度。
其中,控制舵机的电机转动至目标角度,包括:计算当前角度和目标角度的差值,基于差值计算出电机的转动速度;控制电机按照转动速度转动至目标角度。
其中,该方法还包括:若舵机的当前角度和目标角度相等,则控制舵机停止转动。
其中,控制舵机的电机转动至目标角度,并在电机转动时,获取电机的电流值,若电流值超过预设电流,控制电机停止转动,包括:获取舵机转动至目标角度时的实际角度,根据目标角度与实际角度计算得出角度差;根据角度差,控制舵机转动至目标角度,并在电机转动时,获取电机的电流值,若电流值超过预设电流,控制电机停止转动。
本申请采用的另一种技术方案是提供一种舵机,该舵机包括:电机;控制电路,与电机连接,用于在舵机上电后,获取控制器发送的控制信号,并基于控制信号计算目标角度,并获取舵机的当前角度,并判断舵机的当前角度和目标角度是否相等;若否,控制舵机的电机转动至目标角度,并在电机转动时,获取电机的电流值,若电流值超过预设电流,控制电机停止转动。
其中,控制电路还用于判断舵机的当前角度是否大于目标角度;若是,则控制舵机的电机正转,以转动至目标角度;若否,则控制舵机的电机反转,以转动至目标角度。
其中,控制电路还用于计算当前角度和目标角度的差值,基于差值计算出电机的转动速度;控制电机按照转动速度转动至目标角度。
其中,该舵机还包括电位器,与控制电路和电机连接,用于在电机转动时,向控制电路反馈电阻值;控制电路还用于在接收到反馈电阻值时,基于反馈电阻值计算电机的当前角度。
本申请采用的另一种技术方案是提供一种可读存储介质,其特征在于,可读存储介质用于存储程序数据,程序数据在被处理器执行时,用于实现上述技术方案提供的方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳全智能机器人科技有限公司,未经深圳全智能机器人科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010522319.6/2.html,转载请声明来源钻瓜专利网。