CN109842350B - 一种基于分析电流变化率的机械定位方法 - Google Patents
一种基于分析电流变化率的机械定位方法 Download PDFInfo
- Publication number
- CN109842350B CN109842350B CN201811620108.5A CN201811620108A CN109842350B CN 109842350 B CN109842350 B CN 109842350B CN 201811620108 A CN201811620108 A CN 201811620108A CN 109842350 B CN109842350 B CN 109842350B
- Authority
- CN
- China
- Prior art keywords
- current
- judging
- positioning method
- analysis
- method based
- 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
Landscapes
- Control Of Position Or Direction (AREA)
- Manipulator (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开了一种基于分析电流变化率的机械定位方法，包括：S1，设定采样周期t及电流变化阈值ΔIs；S2，获取T时刻的电流值IT；S3，获取T+t时刻的电流值IT+t；S4，判断|IT+t‑IT|<ΔIs？；是，则执行步骤S5，否则设T+t＝T，跳回步骤S3；S5，判断IT+t‑IT<0？；是，则执行步骤S6；否则执行步骤S7；S6，判定当前位置为最小负载点；执行步骤S8；S7，判定当前位置为最大负载点；执行步骤S8；S8，结束。由此，本发明的定位方法仅需在控制电路中增加一个采样电阻，对电流值进行定期采集即可根据ΔI的变化量判断出当前的位置，简单经济，无需增加以往需要的各种辅助设施，可降低系统成本，并减少传感器损坏带来的设备故障风险。
Description
技术领域
本发明涉及位置检测领域，尤其涉及一种基于分析电流变化率的机械定位方法。
背景技术
现代社会自动化程度越来越高，很多工作都已经被自动化的设备所代替，在自动化设备里，获取某个部件当前的位置对于下一步要进行的操作至关重要，随即发展出了精确的定位方法，包括绝对值编码器，光栅等.但有很多地方不需要这么高的精度，比如检测机器人的手臂是否抬起到最高点或者落到最低点，这类使用场景要求不需要那么高精度，可以采用粗略的定位方法，如通过位置开关，干簧管，光电开关等来实现粗略的定位，但这些方法都需要额外增加配套的传感器器件，结构复杂，安装费事；大部分还需要针对负载情况进行预先的校准，在负载变化较大的情况下，每次都需要人工重新校准，若负载频繁变化，甚至完全失去实用价值。
发明内容
综上，本发明提出一种基于分析电流变化率的机械定位方法，特别适合周期应力的电动机拖动场景，无需增加任何附件，只需要在控制电路增加一枚电流采样电阻，即可实现位置的粗略定位。
在周期性负荷的应用场景下，电机旋转后，随着力臂的周期性变化，就会在产生周期性应力，从而使电机驱动电流周期性变化，经采样电阻后，转变为周期性变化的电压信号，处理器处理周期性变化信号后，得出当前机械装置的位置。
从最小电流点向最大电流点运动过程中，ΔI值先增大，当其值接近0的时候，说明装置运动到电流最大点，即负载最大位置，继续运动，直到ΔI再次接近0的时候，说明装置运动到电流最小点，即负载最小位置。这样通过对ΔI的分析，即可对运动位置实现判断。
为解决上述技术问题，本发明所采用的技术方案是：
一种基于分析电流变化率的机械定位方法，包括如下步骤：
S1，设定采样周期t及电流变化阈值ΔIs；
S2，获取T时刻的电流值IT；
S3，获取T+t时刻的电流值IT+t；
S4，判断|IT+t-IT|<ΔIs？是，则执行步骤S5，否则设T+t＝T，跳回步骤S3；
S5，判断IT+t-IT<0？是，则执行步骤S6；否则执行步骤S7；
S6，判定当前位置为最小负载点；执行步骤S8；
S7，判定当前位置为最大负载点；执行步骤S8；
S8，结束。
在上述基础上，本发明还可以做如下改进：
在上述步骤S6或者S7之后还可以增加以下步骤：
S01，记录经过最近一次|IT+t-IT|<ΔIs时刻的时间Tg；
S02，根据电机转速结合步骤S01中获得的时间Tg，计算获得当前的实时位置，从而可以获得任意时刻的实时位置。
与现有技术相比，本发明具有如下技术效果：
1、仅需要在控制电路中增加一个采样电阻或者电流传感器，利用控制器处理器的AD转化功能对电流值进行定期采集即可根据ΔI的变化量，判断出当前的位置，简单经济，无需增加以往需要的各种限位开关，位置传感器，编码器等辅助设施，可降低系统成本，并减少传感器损坏带来的设备故障风险。
2、在电机正常的工作电流范围内，即便更换不同规格的负载，也无需对系统进行校准，本方法基于分析电流变化率来获取最大负载点和最小负载点，故即便更换负载，也无需进行校准工作，仍然可以准确的检测出最大负载点和最小负载点，方便快捷。
附图说明
图1为本发明的基于分析电流变化率的机械定位方法的流程图；
图2为本发明实施例中的场景示意图；
图3为本发明实施例中的电流变化图；
在附图中，各标号所表示的部件名称列表如下：
1、电机；2、机器人手臂；
S1，设定采样周期t及电流变化阈值ΔIs；
S2，获取T时刻的电流值IT；
S3，获取T+t时刻的电流值IT+t；
S4，判断|IT+t-IT|<ΔIs？是，则执行步骤S5，否则设T+t＝T，跳回步骤S3；
S5，判断IT+t-IT<0？是，则执行步骤S6；否则执行步骤S7；
S6，判定当前位置为最小负载点；执行步骤S8；
S7，判定当前位置为最大负载点；执行步骤S8；
S8，结束。
具体实施方式
以下结合附图对本发明的原理和特征进行描述，所举实例只用于解释本发明，并非用于限定本发明的范围。
请参照图1所示，其为本发明的基于分析电流变化率的机械定位方法的流程图。所述基于分析电流变化率的机械定位方法包括以下步骤：
S1，设定采样周期t及电流变化阈值ΔIs；
S2，获取T时刻的电流值IT；
S3，获取T+t时刻的电流值IT+t；
S4，判断|IT+t-IT|<ΔIs？是，则执行步骤S5，否则设T+t＝T，跳回步骤S3；
S5，判断IT+t-IT<0？是，则执行步骤S6；否则执行步骤S7；
S6，判定当前位置为最小负载点；执行步骤S8；
S7，判定当前位置为最大负载点；执行步骤S8；
S8，结束。
具体到机器人场景，如图2所示，为电机1带动机器人胳膊2旋转的示意图，图中I，II，III，IV四个位置为旋转的四个极值点，在机器人胳膊2旋转的过程中，电机1对应的电流变化趋势如图3所示，当机器人的胳膊2从I点匀速运动到II点的过程中，ΔI由大于0到趋于0，胳膊旋转到位置II时,ΔI＝0(ΔI<ΔIs时即可认为等于零)；机器人的胳膊继续从II点向III点匀速运动过程中，ΔI由小于0到趋于0，胳膊旋转到位置IV，ΔI＝0；由此可获知机器人胳膊2当前是处于I，II，III，IV四个位置的哪个位置，若要获取其他位置，只需根据机器人胳膊2经过最近的一个极值点，即经过I、II、III或者IV后的时间Tg，结合电机的转速信息，便可计算获得当前的实时位置，进行粗略的位置控制。
本发明的基于分析电流变化率的机械定位方法仅需要在控制电路中增加一个采样电阻或者电流传感器，利用控制器处理器的AD转化功能对电流值进行定期采集即可根据电流变化量ΔI的变化情况，判断出当前的位置，简单经济，无需增加以往需要的各种限位开关，位置传感器，编码器等辅助设施，可降低系统成本，并减少传感器损坏带来的设备故障风险。
以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (2)
1.一种基于分析电流变化率的机械定位方法，其特征在于，包括：
S1，设定采样周期t及电流变化阈值ΔIs；
S2，获取T时刻的电流值IT；
S3，获取T+t时刻的电流值IT+t；
S4，判断|IT+t-IT|<ΔIs？是，则执行步骤S5，否则设T+t＝T，跳回步骤S3；
S5，判断IT+t-IT<0？是，则执行步骤S6；否则执行步骤S7；
S6，判定当前位置为最小负载点；执行步骤S8；
S7，判定当前位置为最大负载点；执行步骤S8；
S8，结束。
2.如权利要求1所述的基于分析电流变化率的机械定位方法，其特征在于，在步骤S6之后、S7之前，或S7之后、S8之前还有步骤：
S01，记录经过最近一次|IT+t-IT|<ΔIs时刻的时间Tg；
S02，根据电机转速结合步骤S01中获得的时间Tg，计算获得当前的实时位置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811620108.5A CN109842350B (zh) | 2018-12-28 | 2018-12-28 | 一种基于分析电流变化率的机械定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811620108.5A CN109842350B (zh) | 2018-12-28 | 2018-12-28 | 一种基于分析电流变化率的机械定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN109842350A CN109842350A (zh) | 2019-06-04 |
| CN109842350B true CN109842350B (zh) | 2020-09-08 |
Family
ID=66883533
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201811620108.5A Active CN109842350B (zh) | 2018-12-28 | 2018-12-28 | 一种基于分析电流变化率的机械定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109842350B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112486080A (zh) * | 2019-09-12 | 2021-03-12 | 苏州宝时得电动工具有限公司 | 一种户外机器人及其控制方法 |
| CN113884878A (zh) * | 2021-09-27 | 2022-01-04 | 中汽创智科技有限公司 | 一种故障确定方法、装置、电子设备及存储介质 |
Family Cites Families (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5841274A (en) * | 1997-01-29 | 1998-11-24 | Mitutoyo Corporation | Induced current absolute position transducer using a code-track-type scale and read head |
| US8447469B2 (en) * | 2008-09-08 | 2013-05-21 | Steering Solutions Ip Holding Corporation | Electric power steering system control methods |
| CN101499753B (zh) * | 2009-03-10 | 2011-08-10 | 常州合泰微特电机有限公司 | 基于永磁无刷直流电机的无刷伺服控制系统和驱动装置 |
| CN103532397B (zh) * | 2013-09-11 | 2016-02-10 | 上海交通大学 | 交交变频器预测无环流控制方法 |
| US10439538B2 (en) * | 2016-04-29 | 2019-10-08 | Deere & Company | Method and system for estimating a rotor position with a notch filter |
| CN106864181B (zh) * | 2017-04-28 | 2018-11-27 | 吉林大学 | 一种基于导电膜的汽车防爆胎预警装置及其控制方法 |
| CN106992733B (zh) * | 2017-05-17 | 2020-04-07 | 武汉科技大学 | 车载内置式永磁同步电机控制方法 |
-
2018
- 2018-12-28 CN CN201811620108.5A patent/CN109842350B/zh active Active
Also Published As
| Publication number | Publication date |
|---|---|
| CN109842350A (zh) | 2019-06-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109842350B (zh) | 一种基于分析电流变化率的机械定位方法 | |
| CN110955274B (zh) | 位移控制方法、系统、伺服电机及存储介质 | |
| US7643946B2 (en) | Method and system for appraising the wear of axles of a robot arm | |
| US6222362B1 (en) | Method for detecting the position and direction of motion of a moving part mounted on an electric motor | |
| WO2021088235A1 (zh) | 零点定位方法、系统、伺服电机及存储介质 | |
| WO1996033550A1 (en) | Method and apparatus for hybrid direct-indirect control of a switched reluctance motor | |
| CN108508784B (zh) | 伺服电动机控制装置、伺服电动机控制方法以及记录介质 | |
| US11125837B2 (en) | Magnetic field sensor offset and gain adjustment | |
| Kubo et al. | Disturbance torque compensated speed observer for digital servo drives | |
| CN112104294B (zh) | 一种大转矩永磁同步电机电流精确检测方法 | |
| Khalid et al. | Sensor less control of DC motor using Kalman filter for low cost CNC machine | |
| US20020050756A1 (en) | Absolute position detecting device for a linear actuator | |
| JP6766751B2 (ja) | モータ制御システム及びレゾルバ／デジタル変換器の異常検出方法 | |
| CN113162509B (zh) | 动力设备控制方法、装置、机器人及计算机可读存储介质 | |
| CN114029954B (zh) | 一种异构伺服的力反馈估计方法 | |
| KR100850971B1 (ko) | 지능형 로봇용 움직임 제어 장치 | |
| CN103080754B (zh) | 电流传感器 | |
| JP2010518366A (ja) | パルス識別のための方法及び装置 | |
| CN107370446A (zh) | 农业作业机驱动装置 | |
| TWI733951B (zh) | 馬達編碼器的動態取樣方法 | |
| JP4453618B2 (ja) | アブソリュートエンコーダ | |
| KR101408566B1 (ko) | 토크 검출 장치 | |
| CN113852313B (zh) | 电梯曳引机控制电路、方法、装置、系统及存储介质 | |
| CN118137921B (zh) | 一种永磁电机电流预测控制方法 | |
| WO2021056344A1 (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 | ||
| CB02 | Change of applicant information | ||
| CB02 | Change of applicant information |
Address after: 276800 No. 71 Taiyuan Road, Rizhao Economic Development Zone, Shandong Province Applicant after: Chuangze intelligent robot Group Co.,Ltd. Address before: 276800 No. 71 Taiyuan Road, Rizhao Economic Development Zone, Shandong Province Applicant before: CHUANGZE INTELLIGENT ROBOT Co.,Ltd. |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant |