CN109217750B - 一种步进电机自校准的方法 - Google Patents
一种步进电机自校准的方法 Download PDFInfo
- Publication number
- CN109217750B CN109217750B CN201810962313.3A CN201810962313A CN109217750B CN 109217750 B CN109217750 B CN 109217750B CN 201810962313 A CN201810962313 A CN 201810962313A CN 109217750 B CN109217750 B CN 109217750B
- Authority
- CN
- China
- Prior art keywords
- stepping motor
- hall
- angle
- point
- self
- 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.)
- Active
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P8/00—Arrangements for controlling dynamo-electric motors of the kind having motors rotating step by step
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P8/00—Arrangements for controlling dynamo-electric motors of the kind having motors rotating step by step
- H02P8/36—Protection against faults, e.g. against overheating, step-out; Indicating faults
Abstract
本发明提供了一种步进电机自校准的方法,包括判断角度传感器是否出现失步异常、步进电机寻找所述第一霍尔点和第二霍尔点、分析角度数据判断所述角度传感器是否损坏等步骤。本发明通过判断角度传感器是否出现工作异常,并判断角度传感器引发的异常能否纠正,实现判断达到纠正角度传感器的采集数据偏差,或当角度传感器无法正常工作时,防止步进电机轴损坏,避免导致事故的发生。
Description
技术领域
本发明涉及一种步进电机自校准的方法。
背景技术
为了确保步进电机能定位准确和防止外物的干扰从而达到正常运行,一般会利用霍尔传感器和角度传感器用于电机的纠错作用。当步进电机运行的过程中出现失步的异常时,角度传感器都能准确的将电机指向正确的目标位置。但如果在纠错工作中,角度传感器出现异常时,就会给步进电机指示一些错误的目标位置,导致步进电机运行异常,严重的情况可导致电机轴损坏,导致事故的发生。
发明内容
为解决上述技术问题,本发明的目的在于提供一种步进电机自校准的方法,实现判断达到纠正角度传感器的采集数据偏差,或当角度传感器无法正常工作时,防止步进电机轴损坏,避免导致事故的发生。
基于此,本发明提出了一种步进电机自校准的方法,包括以下步骤:
步骤一:记录步进电机全部行程的起点为第一行程位置,终点为第二行程位置,在步进电机的行程范围内分别使用两个霍尔传感器标记第一霍尔点和第二霍尔点,记录所述第一霍尔点的第三行程位置和第一角度位置,记录所述第二霍尔点的第四行程位置和第二角度位置,记录所述第二行程位置与所述第三行程位置之间的距离为第一距离,记录所述第三行程位置与所述第四行程位置之间的距离为第二距离。记录所述第一行程位置与所述第三行程位置之间的距离为第三距离;
步骤二:判断所述角度传感器是否出现失步异常,若未出现失步异常,则所述步进电机自校准结束,若出现失步异常,则执行步骤三;
步骤三:所述步进电机寻找所述第一霍尔点,若未发现所述第一霍尔点,则判断所述步进电机处于被阻挡的状态,所述步进电机自校准结束,若发现所述第一霍尔点,记录此点的角度数据为第三角度位置,执行步骤四;
步骤四:所述步进电机寻找所述第二霍尔点,若未发现所述第二霍尔点,则判断所述步进电机行走过程出现异常且无法进行修正,所述步进电机自校准结束,若发现所述第二霍尔点,则判断所述步进电机行走过程正常,记录此点的角度数据为第四角度位置,执行步骤五;
步骤五:通过分析角度数据判断所述角度传感器是否损坏,若所述角度传感器已损坏,则所述步进电机自校准结束,若所述角度传感器未损坏,则重新设置所述第一行程位置,执行所述步骤一。
可选的,所述步骤二包括以下步骤:
所述步进电机在所述第一行程位置和所述第二行程位置之间行走至任一点,记录所述任一点与所述第一行程位置之间的距离为第四距离;
所述步进电机的步距角数值与所述第四距离数值相乘并得到乘积数值,判断所述乘积数值与所述第一角度位置数值之和是否相等于所述任意点的角度位置数值,若相等则未出现失步异常,所述步进电机自校准结束,若不相等则出现失步异常,执行所述步骤三。
可选的,所述步骤三包括以下步骤:
所述步进电机向所述第一行程位置的方向行走所述第一距离,此期间为第一行走期间,
若所述第一行走期间未发现任何一个霍尔传感器,则所述步进电机向所述第二行程位置的方向行走所述第三距离,若未发现任何一个霍尔传感器,则判断所述步进电机处于被阻挡的状态,所述步进电机自校准结束,
若所述第一行走期间发现第一个所述霍尔传感器,则步进电机再向所述第一行程位置的方向行走所述第二距离为第二行走期间,
若所述第二行走期间未发现第二个所述霍尔传感器,则判断第一个所述霍尔传感器的位置为所述第一霍尔点,所述步进电机向所述第一霍尔点的方向行走至所述第一霍尔点,并记录此时的所述第一霍尔点对应的角度数据为第三角度位置,执行所述步骤四
若所述第二行走期间发现第二个所述霍尔传感器,则判断第二个所述霍尔传感器的位置为所述第一霍尔点,记录此时的所述第一霍尔点对应的角度数据为第三角度位置,执行所述步骤四。
可选的,所述步骤四包括以下步骤:
所述步进电机从所述第一霍尔点出发向所述第二行程位置的方向行走所述第二距离,
若在行走完所述第二距离之后的到达位置未发现所述霍尔传感器,则判断所述步进电机行走过程出现异常且无法进行修正,所述步进电机自校准结束,
若在行走完所述第二距离之后的到达位置发现所述霍尔传感器,则判断此所述霍尔传感器的位置为所述第二霍尔点,则判断所述步进电机行走过程正常,并记录此时的所述第二霍尔点对应的角度数据为第四角度位置,执行所述步骤五。
可选的,所述步骤五包括以下步骤:
记录所述第一角度位置与所述第二角度位置的角度差为第一角度差,记录所述第三角度位置与所述第四角度位置的角度差为第二角度差,
若所述第一角度差与所述第二角度差不相等,则判断所述角度传感器已损坏,所述步进电机自校准结束,
若所述第一角度差与所述第二角度差相等,则判断所述角度传感器未损坏,则重新设置所述第一行程位置,所述步进电机自校准结束。
可选的,所述步骤五“通过分析角度数据判断角度传感器是否损坏,若所述角度传感器已损坏,则所述步进电机自校准结束”还包括:继续运行所述步进电机。
可选的,在所述步进电机继续运行之后,所述步进电机经过霍尔传感器时,判断所述步进电机的当前位置与所述第三行程位置或者所述步进电机的当前位置与所述第四行程位置是否相同,若不相同则停止运行所述步进电机,若相同则所述步进电机继续运行。
本发明的一种步进电机自校准的方法,通过判断角度传感器是否出现工作异常,并判断角度传感器引发的异常能否纠正,实现判断达到纠正角度传感器的采集数据偏差,或当角度传感器无法正常工作时,防止步进电机轴损坏,避免导致事故的发生。
附图说明
图1为本发明实施例的示意图。
附图标记说明:S1、步骤二;S2、步骤三;S3、步骤四;S4、步骤五。
具体实施方式
在本发明的描述中,需要说明的是,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
此外,在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明,但不用来限制本发明的范围。
请参照图1,本实施例提供一种步进电机自校准的方法,包括以下步骤:
步骤一:记录步进电机全部行程的起点为第一行程位置,终点为第二行程位置,在步进电机的行程范围内分别使用两个霍尔传感器标记第一霍尔点和第二霍尔点,记录第一霍尔点的第三行程位置和第一角度位置,记录第二霍尔点的第四行程位置和第二角度位置,记录第二行程位置与第三行程位置之间的距离为第一距离,记录第三行程位置与第四行程位置之间的距离为第二距离。记录第一行程位置与第三行程位置之间的距离为第三距离。
步骤二S1:判断角度传感器是否出现失步异常,若未出现失步异常,则步进电机自校准结束,若出现失步异常,则执行步骤三S2。
其中,步骤二S1包括以下步骤:步进电机在第一行程位置和第二行程位置之间行走至任一点,记录任一点与第一行程位置之间的距离为第四距离;步进电机的步距角数值与第四距离数值相乘并得到乘积数值,判断乘积数值与第一角度位置数值之和是否相当于任意点的角度位置数值,若相等则未出现失步异常,步进电机自校准结束,若不相等则出现失步异常,执行步骤三S2。
在此需要说明的是,乘积数值与第一角度位置数值之和若不相等于任意点的角度位置数值,通常出现的情况为以下三种:角度传感器损坏、角度传感器采集数据出现异常、步进电机处于被阻挡的状态。后续的步骤均为分析确认这三种情况,并进行相应的处理。
步骤三S2:步进电机寻找第一霍尔点,若未发现第一霍尔点,则判断步进电机处于被阻挡的状态,步进电机自校准结束,若发现第一霍尔点,记录此点的角度数据为第三角度位置,执行步骤四S3。
具体来说,步骤三S2包括以下步骤:
步进电机向第一行程位置的方向行走第一距离,此期间为第一行走期间。若第一行走期间未发现任何一个霍尔传感器,则步进电机向第二行程位置的方向行走第三距离,若未发现任何一个霍尔传感器,则判断步进电机处于被阻挡的状态,步进电机自校准结束。此时,步进电机应以及停止运行。
若第一行走期间发现第一个霍尔传感器,则步进电机再向第一行程位置的方向行走第二距离为第二行走期间。若第二行走期间未发现第二个霍尔传感器,则判断第一个霍尔传感器的位置为第一霍尔点,步进电机向第一霍尔点的方向行走至第一霍尔点,并记录此时的第一霍尔点对应的角度数据为第三角度位置,执行步骤四S3。若第二行走期间发现第二个霍尔传感器,则判断第二个霍尔传感器的位置为第一霍尔点,记录此时的第一霍尔点对应的角度数据为第三角度位置,执行步骤四S3。
步骤四S3:步进电机寻找第二霍尔点,若未发现第二霍尔点,则判断步进电机行走过程出现异常且无法进行修正,步进电机自校准结束,若发现第二霍尔点,则判断步进电机行走过程正常,记录此点的角度数据为第四角度位置,执行步骤五S4。
其中,步骤四S3包括以下步骤:步进电机从第一霍尔点出发向第二行程位置的方向行走第二距离,若在行走完第二距离之后的到达位置未发现霍尔传感器,则判断步进电机行走过程出现异常且无法进行修正,步进电机自校准结束;若在行走完第二距离之后的到达位置发现霍尔传感器,则判断此霍尔传感器的位置为第二霍尔点,则判断步进电机行走过程正常,并记录此时的第二霍尔点对应的角度数据为第四角度位置,执行步骤五S4。
步骤五S4:通过分析角度数据判断角度传感器是否损坏,若角度传感器已损坏,则步进电机自校准结束,若角度传感器未损坏,则重新设置第一行程位置,执行步骤一。由此实现了一个循环,不断判断步进电机、角度传感器是否正常工作,避免事故。
具体来说,步骤五S4包括以下步骤:记录第一角度位置与第二角度位置的角度差为第一角度差,记录第三角度位置与第四角度位置的角度差为第二角度差。若第一角度差与第二角度差不相等,则判断角度传感器已损坏,步进电机自校准结束,若第一角度差与第二角度差相等,则判断角度传感器未损坏,则重新设置第一行程位置,步进电机自校准结束。
在本实施例中,步骤五S4“通过分析角度数据判断角度传感器是否损坏,若角度传感器已损坏,则步进电机自校准结束”还包括:继续运行步进电机。在运行步进电机之前,应关闭角度传感器的纠正功能。在其他实施例中,也可选择直接停止运行步进电机。
在步进电机继续运行之后,步进电机经过霍尔传感器时,判断步进电机的当前位置与第三行程位置或者步进电机的当前位置与第四行程位置是否相同,若不相同则停止运行步进电机,若相同则步进电机继续运行至再次经过霍尔传感器,继续循环这一过程。在其他实施例中,也可选择停止步进电机的运行。
本实施例提供了一种步进电机自校准的方法,通过判断角度传感器是否出现工作异常,并判断角度传感器引发的异常能否纠正,实现判断达到纠正角度传感器的采集数据偏差,或当角度传感器无法正常工作时,防止步进电机轴损坏,避免导致事故的发生。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和替换,这些改进和替换也应视为本发明的保护范围。
Claims (6)
1.一种步进电机自校准的方法,其特征在于,包括以下步骤:
步骤一:记录步进电机全部行程的起点为第一行程位置,终点为第二行程位置,在步进电机的行程范围内分别使用两个霍尔传感器标记第一霍尔点和第二霍尔点,记录所述第一霍尔点的第三行程位置和第一角度位置,记录所述第二霍尔点的第四行程位置和第二角度位置,记录所述第二行程位置与所述第三行程位置之间的距离为第一距离,记录所述第三行程位置与所述第四行程位置之间的距离为第二距离, 记录所述第一行程位置与所述第三行程位置之间的距离为第三距离;
步骤二:判断角度传感器是否出现失步异常,若未出现失步异常,则所述步进电机自校准结束,若出现失步异常,则执行步骤三;
步骤三:所述步进电机寻找所述第一霍尔点,若未发现所述第一霍尔点,则判断所述步进电机处于被阻挡的状态,所述步进电机自校准结束,若发现所述第一霍尔点,记录此点的角度数据为第三角度位置,执行步骤四;
步骤四:所述步进电机寻找所述第二霍尔点,若未发现所述第二霍尔点,则判断所述步进电机行走过程出现异常且无法进行修正,所述步进电机自校准结束,若发现所述第二霍尔点,则判断所述步进电机行走过程正常,记录此点的角度数据为第四角度位置,执行步骤五;
步骤五:通过分析角度数据判断所述角度传感器是否损坏,若所述角度传感器已损坏,则所述步进电机自校准结束,若所述角度传感器未损坏,则重新设置所述第一行程位置,执行所述步骤一。
2.根据权利要求1所述的步进电机自校准的方法,其特征在于,所述步骤三包括以下步骤:
所述步进电机向所述第一行程位置的方向行走所述第一距离,此期间为第一行走期间,
若所述第一行走期间未发现任何一个霍尔传感器,则所述步进电机向所述第二行程位置的方向行走所述第三距离,若未发现任何一个霍尔传感器,则判断所述步进电机处于被阻挡的状态,所述步进电机自校准结束,
若所述第一行走期间发现第一个所述霍尔传感器,则步进电机再向所述第一行程位置的方向行走所述第二距离为第二行走期间,
若所述第二行走期间未发现第二个所述霍尔传感器,则判断第一个所述霍尔传感器的位置为所述第一霍尔点,所述步进电机向所述第一霍尔点的方向行走至所述第一霍尔点,并记录此时的所述第一霍尔点对应的角度数据为第三角度位置,执行所述步骤四,
若所述第二行走期间发现第二个所述霍尔传感器,则判断第二个所述霍尔传感器的位置为所述第一霍尔点,记录此时的所述第一霍尔点对应的角度数据为第三角度位置,执行所述步骤四。
3.根据权利要求1所述的步进电机自校准的方法,其特征在于,所述步骤四包括以下步骤:
所述步进电机从所述第一霍尔点出发向所述第二行程位置的方向行走所述第二距离,
若在行走完所述第二距离之后的到达位置未发现所述霍尔传感器,则判断所述步进电机行走过程出现异常且无法进行修正,所述步进电机自校准结束,
若在行走完所述第二距离之后的到达位置发现所述霍尔传感器,则判断此所述霍尔传感器的位置为所述第二霍尔点,则判断所述步进电机行走过程正常,并记录此时的所述第二霍尔点对应的角度数据为第四角度位置,执行所述步骤五。
4.根据权利要求1所述的步进电机自校准的方法,其特征在于,所述步骤五包括以下步骤:
记录所述第一角度位置与所述第二角度位置的角度差为第一角度差,记录所述第三角度位置与所述第四角度位置的角度差为第二角度差,
若所述第一角度差与所述第二角度差不相等,则判断所述角度传感器已损坏,所述步进电机自校准结束,
若所述第一角度差与所述第二角度差相等,则判断所述角度传感器未损坏,则重新设置所述第一行程位置,所述步进电机自校准结束。
5.根据权利要求1所述的步进电机自校准的方法,其特征在于,所述步骤五“通过分析角度数据判断角度传感器是否损坏,若所述角度传感器已损坏,则所述步进电机自校准结束”还包括:继续运行所述步进电机。
6.根据权利要求5所述的步进电机自校准的方法,其特征在于,在所述步进电机继续运行之后,所述步进电机经过霍尔传感器时,判断所述步进电机的当前位置与所述第三行程位置或者所述步进电机的当前位置与所述第四行程位置是否相同,若不相同则停止运行所述步进电机,若相同则所述步进电机继续运行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810962313.3A CN109217750B (zh) | 2018-08-22 | 2018-08-22 | 一种步进电机自校准的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810962313.3A CN109217750B (zh) | 2018-08-22 | 2018-08-22 | 一种步进电机自校准的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109217750A CN109217750A (zh) | 2019-01-15 |
CN109217750B true CN109217750B (zh) | 2020-06-16 |
Family
ID=64989025
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810962313.3A Active CN109217750B (zh) | 2018-08-22 | 2018-08-22 | 一种步进电机自校准的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109217750B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7234737B2 (ja) * | 2019-03-28 | 2023-03-08 | 株式会社デンソー | 検出ユニット |
CN110811827B (zh) * | 2019-09-25 | 2021-04-06 | 中奕智创医疗科技有限公司 | 一种手术机器人电机复位标定设备、标定方法及机器人 |
CN111625025B (zh) * | 2020-04-24 | 2023-04-28 | Oppo(重庆)智能科技有限公司 | 参数校准方法、装置、存储介质及电子设备 |
CN113098340B (zh) * | 2021-04-02 | 2023-04-25 | 吉林省科英医疗激光有限责任公司 | 修正步进电机转角偏移的精准定位控制系统及控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01231694A (ja) * | 1988-03-10 | 1989-09-14 | Nec Corp | ステッピングモータの励磁電流プロファイル較正方法 |
CN102826116A (zh) * | 2011-06-15 | 2012-12-19 | 现代摩比斯株式会社 | 电动式动力转向装置的控制方法 |
CN105577048A (zh) * | 2014-11-08 | 2016-05-11 | 陕西亚泰电器科技有限公司 | 基于单片机的无刷直流电机转子位置检测保护器 |
CN106571758A (zh) * | 2016-11-03 | 2017-04-19 | 深圳开立生物医疗科技股份有限公司 | 步进电机失步补偿方法及装置 |
-
2018
- 2018-08-22 CN CN201810962313.3A patent/CN109217750B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01231694A (ja) * | 1988-03-10 | 1989-09-14 | Nec Corp | ステッピングモータの励磁電流プロファイル較正方法 |
CN102826116A (zh) * | 2011-06-15 | 2012-12-19 | 现代摩比斯株式会社 | 电动式动力转向装置的控制方法 |
CN105577048A (zh) * | 2014-11-08 | 2016-05-11 | 陕西亚泰电器科技有限公司 | 基于单片机的无刷直流电机转子位置检测保护器 |
CN106571758A (zh) * | 2016-11-03 | 2017-04-19 | 深圳开立生物医疗科技股份有限公司 | 步进电机失步补偿方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN109217750A (zh) | 2019-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109217750B (zh) | 一种步进电机自校准的方法 | |
US10802497B2 (en) | Automated fault diagnosis and recovery of machines | |
AU2020203481B2 (en) | Systems and methods for materials handling vehicle odometry calibration | |
EP3304491B1 (en) | Systems and methods for image capture device calibration for a materials handling vehicle | |
US7696894B2 (en) | Method for determining a relative position of a mobile unit by comparing scans of an environment and mobile unit | |
US20130053064A1 (en) | Method and apparatus for determining heading angle in wireless lan | |
US7418361B2 (en) | Method of correcting speed of encoder and apparatus therefor | |
JP5976027B2 (ja) | センサ軸ずれ検出装置およびセンサ軸ずれ検出方法 | |
CN106681273B (zh) | 数控设备探针测量值自动补偿方法 | |
US7443118B2 (en) | Method and device for triggering an electric motor | |
JP2014215232A (ja) | ヨーレート検出装置 | |
US11920961B2 (en) | Method for calibrating a crankshaft sensor based on a camshaft sensor | |
CN112594374B (zh) | 车辆的p挡角度学习方法、车辆及计算机可读存储介质 | |
CN110139217B (zh) | 一种农田机器人的定位方法、装置及存储介质 | |
CN114834300A (zh) | 托盘伸出定位方法和系统 | |
CN112008712B (zh) | 实现任意位置控制气爪行程方法、装置及可读存储介质 | |
CN110154085B (zh) | 机器人空转识别方法及装置 | |
TWI639816B (zh) | Electromagnetically induced position detector | |
CN111915638A (zh) | 追踪装置及信息处理方法、可读存储介质、电子设备 | |
CN111774915B (zh) | 机床的定位方法及装置、机床设备 | |
CN112720485B (zh) | 机械臂关节回零方法、装置及计算机可读存储介质 | |
US20220292713A1 (en) | Information processing apparatus, information processing method, and storage medium | |
EP2930463A1 (en) | System for measuring orthogonality of y-cross beam and x-guides of a stage and method for positioning stage home using same | |
CN116224226A (zh) | 一种挂轨式机器人定位方法、装置及计算机设备 | |
CN114913165A (zh) | 一种步进电机的校准方法、装置、电子设备及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |