CN102468802B - Feedback switching device and method driven by servo motor - Google Patents
Feedback switching device and method driven by servo motor Download PDFInfo
- Publication number
- CN102468802B CN102468802B CN201010537977.9A CN201010537977A CN102468802B CN 102468802 B CN102468802 B CN 102468802B CN 201010537977 A CN201010537977 A CN 201010537977A CN 102468802 B CN102468802 B CN 102468802B
- Authority
- CN
- China
- Prior art keywords
- signal
- servo motor
- feedback
- speed
- switching condition
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 230000000052 comparative effect Effects 0.000 claims 2
- 238000005516 engineering process Methods 0.000 abstract description 17
- 238000010586 diagram Methods 0.000 description 6
- 238000001514 detection method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000008713 feedback mechanism Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Landscapes
- Control Of Electric Motors In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
技术领域 technical field
本发明涉及伺服马达驱动,更具体而言,涉及能够主动地随着伺服马达运转速度进行反馈模式切换的伺服马达驱动反馈切换装置及方法。The present invention relates to servo motor drive, and more specifically, to a servo motor drive feedback switching device and method capable of actively switching feedback modes along with the running speed of the servo motor.
背景技术 Background technique
伺服马达驱动器为现代化工业中所广泛使用的一种重要技术,其现阶段的发展方向皆以提升性能与降低成本为主,而在因应成本考虑的同时,对于性能的提升与功能的增加也产生了相应的需求。在各种应用中,部分伺服马达必须操作在非常宽的运转速度范围内,而伺服马达驱动器如何能有效地提升性能与降低成本的关键因素,即在于所谓的速度控制架构的建置。Servo motor drive is an important technology widely used in modern industry. Its current development direction is mainly to improve performance and reduce cost. In response to cost considerations, the improvement of performance and the increase of functions are also produced. corresponding needs. In various applications, some servo motors must operate in a very wide range of operating speeds, and the key factor in how the servo motor driver can effectively improve performance and reduce costs lies in the construction of the so-called speed control architecture.
举例而言,倘若设计者使用编码器或解角器等位置感测元件来建置速度控制架构,亦即利用位置感测反馈技术来建置速度控制架构,在伺服马达处于低速运转状态下,只要位置信号的频宽低于位置感测器的频宽,伺服马达驱动器就可正确地接收到位置信号。但倘若马达转速过高,以致于位置信号的频率高于位置信号接收器的频宽时,位置信号将会发生扭曲。因此,在伺服马达高速运转下,势必使用其他技术来进行处理。为了解决此种问题,业界已研发出将无感测位置估计反馈技术应用在高速运转的马达上,以估计出马达角度,进而建置速度控制架构的方法。For example, if the designer uses position sensing components such as encoders or resolvers to build a speed control structure, that is, uses position sensing feedback technology to build a speed control structure, when the servo motor is running at a low speed, As long as the bandwidth of the position signal is lower than that of the position sensor, the servo motor driver can receive the position signal correctly. However, if the motor speed is too high, so that the frequency of the position signal is higher than the bandwidth of the position signal receiver, the position signal will be distorted. Therefore, under the high-speed operation of the servo motor, other technologies must be used for processing. In order to solve this problem, the industry has developed a method of applying sensorless position estimation feedback technology to a high-speed motor to estimate the angle of the motor and then build a speed control framework.
尽管这两种反馈技术的发展已日趋成熟,但现行伺服马达驱动器的设定方法是使用者必须在伺服马达运行前,先决定是使用位置感测元件来建置速度控制架构,或是先决定使用无感测位置估计反馈技术来建置速度控制架构,但于伺服马达的运行过程中,使用者所设定的速度控制架构并无法随着马达转速做出相对应的弹性改变,以伺服马达驱动器仍然会有无法对伺服马达进行精确控制的问题。具体来说,如果使用者一开始设定以位置感测反馈技术来建置速度控制架构,当伺服马达的转速提高至超出一定的标准时,位置感测反馈技术所得到的位置信号将发生扭曲,以致伺服马达驱动器无法获得正确的位置信息。如果使用者一开始设定以无感测位置估计反馈技术来建置速度控制架构,当伺服马达的转速降低至低于一定的标准时,无感测位置估计反馈技术所得到的位置信号的精确度会开始失去精确度,以致伺服马达驱动器也将无法获得正确的位置信息。由此可知,如果可解决此问题,则伺服马达驱动器的速度控制性能将可得到大幅度的改善。Although the development of these two feedback technologies has become more and more mature, the current setting method of the servo motor driver is that the user must first decide whether to use the position sensing element to build the speed control structure before the servo motor runs, or to decide first Use sensorless position estimation feedback technology to build a speed control structure, but during the operation of the servo motor, the speed control structure set by the user cannot make corresponding elastic changes with the motor speed. The drive still has the problem of not being able to precisely control the servo motor. Specifically, if the user sets the speed control structure with position sensing feedback technology at the beginning, when the speed of the servo motor increases beyond a certain standard, the position signal obtained by the position sensing feedback technology will be distorted. As a result, the servo motor driver cannot obtain correct position information. If the user sets the speed control structure with sensorless position estimation feedback technology at the beginning, when the speed of the servo motor decreases below a certain standard, the accuracy of the position signal obtained by the sensorless position estimation feedback technology will start to lose accuracy, so that the servo motor driver will not be able to obtain correct position information. It can be seen that if this problem can be solved, the speed control performance of the servo motor driver will be greatly improved.
因此,如果有一种能够根据伺服马达运转速度自动设定或切换反馈机制的伺服马达驱动反馈切换装置及方法,将能够有效地提供制造商所需的成本效益,但一直以来,未有相关文献能够提供有助于改善此一问题的建议与教示。Therefore, if there is a servo motor drive feedback switching device and method that can automatically set or switch the feedback mechanism according to the operating speed of the servo motor, it will be able to effectively provide the cost-effectiveness required by the manufacturer. Suggestions and teachings are provided to help improve this problem.
因此,如何提出一种可解决已知技术种种缺失的伺服马达驱动反馈切换装置及方法,实为目前各界亟欲解决的技术问题。Therefore, how to propose a servo motor drive feedback switching device and method that can solve various deficiencies in the known technology is a technical problem that all circles are eager to solve.
发明内容 Contents of the invention
鉴于上述已知技术的缺点,本发明的主要目的在于提供得以令伺服马达驱动控制回路主动地随着伺服马达运转速度进行反馈模式切换的反馈切换装置及方法。In view of the shortcomings of the above-mentioned known technologies, the main purpose of the present invention is to provide a feedback switching device and method for enabling the servo motor drive control loop to actively switch the feedback mode according to the running speed of the servo motor.
为实现上述目的及其他目的,本发明提供一种伺服马达驱动的反馈切换装置,应用于具有伺服马达的控制回路中,该伺服马达驱动的反馈切换装置包括:电流感测器,用以感测供应至该伺服马达的电流,并根据感测到的电流输出对应的电流反馈信号;位置感测器,用以感测该伺服马达的位置,并根据感测到的位置输出对应的位置感测信号;位置估计器,用以接收该电流感测器的电流反馈信号,并根据该电流反馈信号输出对应的位置估计信号;以及反馈切换比较器,具有预定的切换条件,用以接收该位置感测信号及该位置估计信号,并且基于该预定的切换条件选择将该位置感测信号与该位置估计信号的其中一个输出作为位置反馈信号。To achieve the above and other objectives, the present invention provides a servo motor-driven feedback switching device, which is applied in a control loop with a servo motor. The servo motor-driven feedback switching device includes: a current sensor for sensing The current supplied to the servo motor, and output a corresponding current feedback signal according to the sensed current; the position sensor is used to sense the position of the servo motor, and output a corresponding position sensor according to the sensed position signal; a position estimator, used to receive the current feedback signal of the current sensor, and output a corresponding position estimation signal according to the current feedback signal; and a feedback switching comparator, with predetermined switching conditions, used to receive the position sensor The detection signal and the position estimation signal, and select one of the position detection signal and the position estimation signal as the position feedback signal based on the predetermined switching condition.
此外,本发明又提供一种伺服马达驱动的反馈切换方法,应用于具有伺服马达的控制回路中,且该伺服马达的起始运转速度处于低速状态,该伺服马达驱动的反馈切换方法包括以下步骤:(1)以电流感测器对供应至该伺服马达的电流进行感测,以根据所感测的电流输出对应的电流反馈信号,并令位置感测器对该伺服马达的位置进行感测,以输出对应的位置感测信号,且令位置估计器接收该电流反馈信号,以根据该电流反馈信号输出对应的位置估计信号;(2)令速度计算模块接收该位置感测器输出的位置感测信号与该位置估计器输出的位置估计信号,以分别产生对应的第一速度信号与第二速度信号,并令比较模块接收该第一速度信号与该第二速度信号;(3)令该比较模块将该第一速度信号与预定的切换条件进行比较,以判断该第一速度信号是否高于该切换条件,如果是,则进至步骤(4),如果否,则进至步骤(6);(4)令切换模块选择将该位置估计信号输出作为位置反馈信号;(5)令该比较模块将该第二速度信号与该预定的切换条件进行比较,以判断该第二速度信号是否低于该预定的切换条件,如果是,则进至步骤(6),如果否,则回到步骤(4);以及(6)令切换模块选择将该位置感测信号输出作为位置反馈信号。In addition, the present invention further provides a feedback switching method driven by a servo motor, which is applied in a control loop with a servo motor, and the initial operating speed of the servo motor is in a low speed state. The feedback switching method driven by a servo motor includes the following steps : (1) using a current sensor to sense the current supplied to the servo motor, so as to output a corresponding current feedback signal according to the sensed current, and make the position sensor sense the position of the servo motor, To output the corresponding position sensing signal, and make the position estimator receive the current feedback signal, so as to output the corresponding position estimation signal according to the current feedback signal; (2) make the speed calculation module receive the position sensor output by the position sensor The measured signal and the position estimation signal output by the position estimator to generate corresponding first speed signal and second speed signal respectively, and make the comparison module receive the first speed signal and the second speed signal; (3) make the The comparison module compares the first speed signal with a predetermined switching condition to determine whether the first speed signal is higher than the switching condition, if yes, then proceed to step (4), if not, then proceed to step (6 ); (4) make the switching module select the output of the position estimation signal as a position feedback signal; (5) make the comparison module compare the second speed signal with the predetermined switching condition to determine whether the second speed signal If it is lower than the predetermined switching condition, then go to step (6), if not, go back to step (4); and (6) let the switching module choose to output the position sensing signal as a position feedback signal.
再者,本发明复提供一种伺服马达驱动的反馈切换方法,应用于具有伺服马达的控制回路中,且该伺服马达的起始运转速度处于高速状态,该伺服马达驱动的反馈切换方法包括以下步骤:(1)令设置于该伺服马达的供电路径上的电流感测器对供应至该伺服马达的电流进行感测,以根据所感测的电流输出对应的电流反馈信号,并令位置感测器对该伺服马达的位置进行感测,以输出对应的位置感测信号,且令位置估计器接收该电流反馈信号,以根据该电流反馈信号输出对应的位置估计信号;(2)令速度计算模块接收该位置感测器输出的位置感测信号与该位置估计器输出的位置估计信号,以分别产生对应的第一速度信号与第二速度信号,并令比较模块接收该第一速度信号与该第二速度信号;(3)令该比较模块将该第二速度信号与预定的切换条件进行比较,以判断该第二速度信号是否低于该切换条件,如果是,则进至步骤(4),如果否,则进至步骤(6);(4)令切换模块选择将该位置感测信号输出作为位置反馈信号;(5)令该比较模块将该第一速度信号与该切换条件进行比较,以判断该第一速度信号是否高于该预定的切换条件,如果是,则进至步骤(6),如果否,则回到步骤(4);以及(6)令切换模块选择将该位置估计信号输出作为位置反馈信号。Furthermore, the present invention further provides a feedback switching method driven by a servo motor, which is applied in a control loop with a servo motor, and the initial operating speed of the servo motor is in a high-speed state. The feedback switching method driven by the servo motor includes the following Steps: (1) Make the current sensor arranged on the power supply path of the servo motor sense the current supplied to the servo motor, so as to output a corresponding current feedback signal according to the sensed current, and make the position sensing The device senses the position of the servo motor to output a corresponding position sensing signal, and makes the position estimator receive the current feedback signal to output a corresponding position estimation signal according to the current feedback signal; (2) makes the speed calculation The module receives the position sensing signal output by the position sensor and the position estimation signal output by the position estimator to generate corresponding first speed signal and second speed signal respectively, and makes the comparison module receive the first speed signal and the second speed signal The second speed signal; (3) make the comparison module compare the second speed signal with a predetermined switching condition to judge whether the second speed signal is lower than the switching condition, if so, proceed to step (4 ), if not, proceed to step (6); (4) make the switching module select the output of the position sensing signal as the position feedback signal; (5) make the comparison module compare the first speed signal with the switching condition Compare to determine whether the first speed signal is higher than the predetermined switching condition, if yes, then proceed to step (6), if not, then return to step (4); and (6) make the switching module select the The position estimate signal is output as a position feedback signal.
相较于已知技术,本发明不但能够有效地降低制造商成本、提升产品功能性,并能有效提升伺服马达驱动器应用于宽速度范围伺服驱动系统上的弹性,提高伺服马达整体的运转效率。Compared with the known technology, the present invention can not only effectively reduce the cost of the manufacturer, improve product functionality, but also effectively improve the flexibility of the servo motor driver applied to the servo drive system with a wide speed range, and improve the overall operating efficiency of the servo motor.
附图说明 Description of drawings
图1是描绘本发明实施例的伺服马达驱动的反馈切换装置的架构图;FIG. 1 is a structural diagram depicting a feedback switching device driven by a servo motor according to an embodiment of the present invention;
图2是图1中的反馈切换比较器的概略电路图;Fig. 2 is a schematic circuit diagram of the feedback switching comparator in Fig. 1;
图3是描绘本发明实施例的伺服马达驱动的反馈切换装置的运作示意图;3 is a schematic diagram illustrating the operation of a feedback switching device driven by a servo motor according to an embodiment of the present invention;
图4是描绘本发明实施例的一伺服马达驱动的反馈切换方法的步骤流程图;以及FIG. 4 is a flow chart depicting the steps of a feedback switching method driven by a servo motor according to an embodiment of the present invention; and
图5是描绘本发明实施例的另一伺服马达驱动的反馈切换方法的步骤流程图。FIG. 5 is a flowchart depicting the steps of another servo motor-driven feedback switching method according to an embodiment of the present invention.
【主要元件符号说明】[Description of main component symbols]
100伺服马达驱动的反馈切换装置Feedback switching device driven by 100 servo motors
102位置命令 103PID控制器102
104速度命令 105PID控制器104
106电流命令 107PID控制器106
108电流反馈信号 109功率模块108
110位置反馈信号 111电流感测器110 position feedback signal 111 current sensor
112速度反馈信号 113伺服马达112 Speed
115位置感测器 115a位置感测信号115
117位置估计器 117a位置估计信号117
119反馈切换比较器 121速度反馈产生器119
201速度计算模块 201a第一速度信号201
201b 第二速度信号 202切换条件201b
203比较模块 203a速度比较结果203
205切换模块 302时点205
304时点304 points
400伺服马达驱动的反馈切换方法Feedback switching method for 400 servo motor drive
S402-S412步骤Steps S402-S412
500伺服马达驱动的反馈切换方法Feedback switching method driven by 500 servo motor
S502-S512步骤Steps S502-S512
具体实施方式Detailed ways
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭示的内容轻易地了解本发明的其他优点与功效。本发明也可通过其他不同的具体实例加以施行或应用,本说明书中的各项细节也可基于不同观点与应用,在未悖离本发明的精神下进行各种修饰与变更。Embodiments of the present invention are described below through specific examples, and those skilled in the art can easily understand other advantages and effects of the present invention from the content disclosed in this specification. The present invention can also be implemented or applied through other different specific examples, and various modifications and changes can be made to the details in this specification based on different viewpoints and applications without departing from the spirit of the present invention.
本发明所提出的伺服马达驱动的反馈切换装置及方法,应用于伺服马达驱动控制回路中,以期于克服位置感测反馈技术在马达高速运转时,位置数据会出现扭曲现象的问题外,一并克服使用无感测位置估计反馈在马达低速运转时,位置数据无法达到使用者所要求的速度精确度等种种问题。The feedback switching device and method for servo motor drive proposed by the present invention are applied in the control loop of servo motor drive, in order to overcome the problem that the position data will be distorted when the motor is running at high speed in the position sensing feedback technology. To overcome various problems such as the position data cannot meet the speed accuracy required by the user when the motor is running at low speed using sensorless position estimation feedback.
请参照图1,显示本发明实施例的伺服马达驱动的反馈切换装置100的架构示意图。在本实施例中,伺服马达驱动的反馈切换装置100,应用于具有伺服马达113的伺服马达驱动控制回路中,且至少包含位置感测器115、位置估计器117、及反馈切换比较器119,且选择性地具备有例如为微分器的速度反馈产生器121。Please refer to FIG. 1 , which shows a schematic structural diagram of a
而该伺服马达驱动控制回路还可具备比例-积分-微分(proportional-integral-derivative)控制器103、105、107,以下简称PID控制器103、105、107,及功率模块109。其中,PID控制器103可接收位置命令102,PID控制器105可接收速度命令104,而PID控制器107可接收电流命令106,并连接至功率模块109。The servo motor drive control loop can also include proportional-integral-derivative (proportional-integral-derivative)
这些电流感测器111设置于该伺服马达113的供电路径上,用以感测供应至该伺服马达113的电流,并根据感测到的电流输出对应的电流反馈信号108。The current sensors 111 are disposed on the power supply path of the
该位置感测器115可设置于伺服马达113上,用以感测该伺服马达113的位置,并根据感测到的位置输出对应的位置感测信号115a,在本实施例中,位置感测器115可为用以将伺服马达113的位置进行编码的编码器或解角器。The
该位置估计器117连接至这些电流感测器111,用以接收该电流感测器111输出的电流反馈信号108,并根据该电流感测器111输出的电流反馈信号108输出对应的位置估计信号117a。The
该反馈切换比较器119用以接收该位置感测信号115a、该位置估计信号117a、及使用者预先定义的切换条件(以下简称切换条件),并且基于所述的切换条件,选择将该位置感测信号115a与该位置估计信号117a的其中一个输出,以作为位置反馈信号110。The
因此,当伺服马达驱动控制回路运作于较低转速的情况下,反馈切换比较器119可自动选择将该位置感测信号115a输出作为位置反馈信号110,藉此满足高效率的需求。而当伺服马达驱动控制回路运作于较高转速的情况时,反馈切换比较器119可自动选择将该位置估计信号117a输出作为位置反馈信号110,藉此满足宽速度运转需求。Therefore, when the servo motor drive control loop operates at a lower speed, the
进一步而言,反馈切换比较器119输出的位置反馈信号110,可与位置命令102相结合,以供PID控制器103接收而产生速度命令104,同时,反馈切换比较器119输出的位置反馈信号110也可传输至速度反馈产生器121,以供其产生速度反馈信号112,而速度反馈信号112与速度命令104相结合后,即可供PID控制器105接收以产生电流命令106,而电流命令106在与电流反馈信号108相结合后,即可提供予PID控制器107接收,而PID控制器107还可连接至功率模块109,以令功率模块109对伺服马达113进行相关的速度控制。Further, the position feedback signal 110 output by the
实际实施时,首先,设置于该伺服马达113的供电路径上的电流感测器111可对该伺服马达113的电流进行感测,并根据感测得到的电流产生对应的电流反馈信号108。该电流反馈信号108传送至该位置估计器117,并与该电流命令106相结合,而该位置估计器117在接收该电流反馈信号108之后,即根据该电流反馈信号108产生/输出对应的位置估计信号117a。同时,该位置感测器115对该伺服马达113的位置进行感测,并根据该位置产生/输出对应的位置感测信号115a。In actual implementation, firstly, the current sensor 111 disposed on the power supply path of the
接下来,该反馈切换比较器119接收该位置感测信号115a与该位置估计信号117a,并基于使用者所预先定义的切换条件,选择将该位置感测信号115a与该位置估计信号117a的其中一个输出作为该位置反馈信号110。而关于该反馈切换比较器119的运作细节,将详述于下文中。Next, the
然后,该速度反馈产生器121基于该位置反馈信号110产生速度反馈信号112,且该速度反馈信号112与该速度命令104相结合。Then, the
请搭配图1来参照图2,其中,图2是显示图1中的反馈切换比较器119的概略电路图。如图所示,该反馈切换比较器119包含二个速度计算模块201、比较模块203、及切换模块205。Please refer to FIG. 2 in conjunction with FIG. 1 , wherein FIG. 2 is a schematic circuit diagram showing the
这些速度计算模块201可为微分器,用以分别接收该位置感测器115输出的位置感测信号115a与该位置估计器117输出的位置估计信号117a,以分别产生对应的第一速度信号201a与第二速度信号201b。实际实施时,可将图中所示的二个速度计算模块201整合为单一个。The
该比较模块203用以接收使用者预先定义的切换条件202、该第一速度信号201a、与该第二速度信号201b,并将该第一速度信号201a与该第二速度信号201b的其中一个与该切换条件202进行比较,以输出速度比较结果203a。在此须说明的是,在本实施例中,可利用额外的控制器或逻辑电路或软件(未显示)对该比较模块203进行控制,而该比较模块203也可具有磁滞特性,且设定有特定的磁滞范围,以通过该磁滞范围及该切换条件202作为比较标准,避免该比较模块203所输出的速度比较结果203a于临限值(threshold value)附近发生振荡。而切换条件202可设定在伺服马达113特性曲线的任意点上,只要满足位置反馈正确即可。The
该切换模块205则用以接收该位置感测器115输出的位置感测信号115a与该位置估计器117输出的位置估计信号117a,并基于该速度比较结果203a选择将接收到的该位置感测信号115a与该位置估计信号117a的其中一个输出作为该位置反馈信号110。The
为了更清楚了解本发明的伺服马达驱动的反馈切换装置,请搭配图2来参照图3,其中,图3是显示本发明实施例的伺服马达驱动的反馈切换装置100的一运作示意图。如图所示,磁滞范围可搭配切换条件202以形成一种较为弹性的比较标准,而图3中纵轴所的速度代表伺服马达113的运转速度。In order to understand the feedback switching device driven by a servo motor of the present invention more clearly, please refer to FIG. 3 in conjunction with FIG. 2 , wherein FIG. 3 is a schematic diagram showing the operation of the
在时点302前,使用者可设定直接以位置感测信号115a作为位置反馈信号110,利用位置感测信号115a作为对伺服马达113的速度控制基础。但由在此时比较模块203也可比较出该第二速度信号201b低于该使用者定义切换条件202,亦即判断出伺服马达113的速度处于低速状态,所以比较模块203也会据以输出速度比较结果203a至切换模块205,以令切换模块205选择将该位置感测信号115a输出作为该位置反馈信号110,进而利用位置感测信号115a作为对伺服马达113的速度控制基础。Before the
当时间进行至时点302(磁滞范围高点)时,比较模块203会比较出该第一速度信号201a高于切换条件202,亦即伺服马达113的速度已运转至高速状态,此时,比较模块203会据以输出速度比较结果203a至切换模块205,以令切换模块205进行切换作动,俾选择将该位置估计信号117a输出作为该位置反馈信号110,进而开始利用位置估计信号117a作为对伺服马达113的速度控制基础。When the time goes to the time point 302 (the high point of the hysteresis range), the
而当时间进行至时点304(磁滞范围低点)时,比较模块203会比较出该第二速度信号201b低于该使用者定义切换条件202,亦即伺服马达113的速度运转至低速状态,此时,该比较模块203会据以输出速度比较结果203a至切换模块205,以令切换模块205再度进行切换,俾选择将该位置感测信号115a输出作为该位置反馈信号110,进而又开始利用位置感测信号115a作为对伺服马达113的速度控制基础。And when the time goes to the time point 304 (the low point of the hysteresis range), the
请搭配前述图1及图2参照图4,以清楚了解本发明实施例的一伺服马达驱动的反馈切换方法400的一步骤流程,而伺服马达驱动的反馈切换方法400应用于具有伺服马达的伺服马达驱动控制回路中。而需先说明的是,伺服马达驱动的反馈切换方法400应用于伺服马达的起始运转速度为低速的运转状态下。Please refer to FIG. 4 in conjunction with FIG. 1 and FIG. 2 to clearly understand a step-by-step process of a servo motor-driven
首先,在步骤S402中,以设置于该伺服马达的供电路径上的电流感测器对供应至该伺服马达的电流进行感测,以根据感测到的电流输出对应的电流反馈信号,并以位置感测器对该伺服马达的位置进行感测,以输出对应的位置感测信号,且以位置估计器接收该电流反馈信号,以根据该电流反馈信号输出对应的位置估计信号,同时以位置感测信号作为位置反馈信号,接着进至步骤S404。First, in step S402, the current sensor provided on the power supply path of the servo motor is used to sense the current supplied to the servo motor, so as to output a corresponding current feedback signal according to the sensed current, and use The position sensor senses the position of the servo motor to output a corresponding position sensing signal, and the position estimator receives the current feedback signal to output a corresponding position estimation signal according to the current feedback signal, and simultaneously uses the position The sensing signal is used as a position feedback signal, and then proceed to step S404.
在步骤S404中,以速度计算模块接收该位置感测器输出的位置感测信号与该位置估计器输出的位置估计信号,并分别产生对应的第一速度信号与第二速度信号,同时,以比较模块接收预定的切换条件、该第一速度信号、与该第二速度信号,接着进至步骤S406。In step S404, the speed calculation module receives the position sensing signal output by the position sensor and the position estimation signal output by the position estimator, and generates a corresponding first speed signal and a second speed signal respectively. The comparison module receives a predetermined switching condition, the first speed signal, and the second speed signal, and then proceeds to step S406.
在步骤S406中,以该比较模块对该第一速度信号与该预定的切换条件进行比较,以判断该第一速度信号是否高于预定的切换条件,如果是,则进入步骤S408,如果否,则进至步骤S412。In step S406, use the comparison module to compare the first speed signal with the predetermined switching condition to determine whether the first speed signal is higher than the predetermined switching condition, if yes, go to step S408, if not, Then go to step S412.
在步骤S408中,以切换模块选择将该位置估计信号输出作为位置反馈信号,接着进至步骤S410。In step S408, the switching module selects to output the position estimation signal as a position feedback signal, and then proceeds to step S410.
在步骤S410中,以该比较模块对该第二速度信号与该预定的切换条件进行比较,以判断该第二速度信号是否低于该预定的切换条件,如果是,则进入步骤S412,如果否,则回到步骤S408。In step S410, use the comparison module to compare the second speed signal with the predetermined switching condition to determine whether the second speed signal is lower than the predetermined switching condition, if yes, go to step S412, if not , return to step S408.
在步骤S412中,以切换模块选择将该位置感测信号输出作为位置反馈信号,并接着回到步骤S406。In step S412, the switching module selects to output the position sensing signal as a position feedback signal, and then returns to step S406.
在伺服马达驱动的反馈切换方法400中,该位置感测器为用以将伺服马达的位置进行编码的编码器或解角器。而该比较模块可具有磁滞特性,且设定有特定的磁滞范围,因此,在步骤S406中,该比较模块以该磁滞范围及该预定的切换条件作为该第一速度信号是否高于该切换条件的判断标准,而在步骤S410中,该比较模块也可以该磁滞范围及该预定的切换条件作为该第二速度信号是否低于该切换条件的判断标准。In the
请搭配前述图1及图2来参照图5,以清楚了解本发明实施例的另一伺服马达驱动的反馈切换方法500的步骤流程。当然,伺服马达驱动的反馈切换方法500亦被应用于具有伺服马达的伺服马达驱动控制回路中。而需先说明的是,伺服马达驱动的反馈切换方法500应用于伺服马达的起始运转速度已为高速的运转状态下。Please refer to FIG. 5 together with FIG. 1 and FIG. 2 to clearly understand the flow of steps of another
首先,在步骤S502中,以设置于该伺服马达的供电路径上的电流感测器对供应至该伺服马达的电流进行感测,以根据感测到的电流输出对应的电流反馈信号,并以位置感测器对该伺服马达的位置进行感测,以输出对应的位置感测信号,且以位置估计器接收该电流反馈信号,以根据该电流反馈信号输出对应的位置估计信号,同时设定以位置估计信号作为位置反馈信号,接着进至步骤S504。First, in step S502, the current supplied to the servo motor is sensed by a current sensor provided on the power supply path of the servo motor, so as to output a corresponding current feedback signal according to the sensed current, and use The position sensor senses the position of the servo motor to output a corresponding position sensing signal, and the position estimator receives the current feedback signal to output a corresponding position estimation signal according to the current feedback signal, and simultaneously sets Using the position estimation signal as the position feedback signal, then proceed to step S504.
在步骤S504中,以速度计算模块接收该位置感测器输出的位置感测信号与该位置估计器输出的位置估计信号,以分别产生对应的第一速度信号与第二速度信号,并以比较模块接收预定的切换条件、该第一速度信号、与该第二速度信号,接着进至步骤S506。In step S504, the speed calculation module receives the position sensing signal output by the position sensor and the position estimation signal output by the position estimator to generate corresponding first speed signals and second speed signals respectively, and compare the The module receives a predetermined switching condition, the first speed signal, and the second speed signal, and then proceeds to step S506.
在步骤S506中,以该比较模块对该第二速度信号与该预定的切换条件进行比较,以判断该第二速度信号是否低于使用者所设定的切换条件,如果是,则进入步骤S508,如果否,则进至步骤S512。In step S506, use the comparison module to compare the second speed signal with the predetermined switching condition to determine whether the second speed signal is lower than the switching condition set by the user, if yes, go to step S508 , if not, go to step S512.
在步骤S508中,以切换模块选择将该位置感测信号输出作为位置反馈信号,接着进至步骤S510。In step S508, the switching module selects to output the position sensing signal as a position feedback signal, and then proceeds to step S510.
在步骤S510中,以该比较模块对该第一速度信号与该切换条件进行比较,以判断该第一速度信号是否高于该预定的切换条件,如果是,则进入步骤S512,如果否,则回到步骤S508。In step S510, use the comparison module to compare the first speed signal with the switching condition to determine whether the first speed signal is higher than the predetermined switching condition, if yes, go to step S512, if not, then Go back to step S508.
在步骤S512中,以切换模块选择将该位置估计信号输出作为位置反馈信号,并接着回到步骤S506。In step S512, the switching module selects to output the position estimation signal as a position feedback signal, and then returns to step S506.
在伺服马达驱动的反馈切换方法500中,该位置感测器为用以将伺服马达的位置进行编码的编码器或解角器。而该比较模块可具有磁滞特性,且设定有特定的磁滞范围,因此,而在步骤S506中,该比较模块以该磁滞范围及该预定的切换条件作为该第二速度信号是否低于该切换条件的判断标准,而在步骤S510中,该比较模块以该磁滞范围及该预定的切换条件作为该第一速度信号是否高于该切换条件的判断标准。In the
综上所述,本发明的伺服马达驱动的反馈切换装置及方法,除了能够提供自动化的反馈切换机制以外,更能够进一步提升伺服马达驱动控制回路的功能性,对于宽速度范围应用下的伺服马达驱动控制,实可避免如已知技术中操作弹性不足的问题,进而提高伺服马达整体的运转效率。In summary, the feedback switching device and method for servo motor drive of the present invention, in addition to providing an automated feedback switching mechanism, can further improve the functionality of the servo motor drive control loop. For servo motors with wide speed range applications The driving control can actually avoid the problem of insufficient operational flexibility in the known technology, thereby improving the overall operating efficiency of the servo motor.
上述实施例仅例示性说明本发明的原理及其功效,而非用于限制本发明。本领域技术人员均可在不违背本发明的精神及范围下,对上述实施例进行修饰与改变。因此,本发明的权利保护范围,应如权利要求书要求保护的范围所列。The above-mentioned embodiments only illustrate the principles and effects of the present invention, but are not intended to limit the present invention. Those skilled in the art can modify and change the above embodiments without departing from the spirit and scope of the present invention. Therefore, the protection scope of the present invention should be listed in the protection scope of the claims.
Claims (13)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010537977.9A CN102468802B (en) | 2010-11-10 | 2010-11-10 | Feedback switching device and method driven by servo motor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010537977.9A CN102468802B (en) | 2010-11-10 | 2010-11-10 | Feedback switching device and method driven by servo motor |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102468802A CN102468802A (en) | 2012-05-23 |
CN102468802B true CN102468802B (en) | 2014-05-07 |
Family
ID=46072063
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010537977.9A Active CN102468802B (en) | 2010-11-10 | 2010-11-10 | Feedback switching device and method driven by servo motor |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102468802B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI570533B (en) * | 2015-09-25 | 2017-02-11 | Chen Peng-Ren | CNC servo control drive system |
CN107017813B (en) * | 2017-05-17 | 2024-04-09 | 合肥环信科技发展有限公司 | Control device and system for driving motor for vehicle |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4528486A (en) * | 1983-12-29 | 1985-07-09 | The Boeing Company | Controller for a brushless DC motor |
US4713596A (en) * | 1985-07-10 | 1987-12-15 | General Electric Company | Induction motor drive system |
US5038090A (en) * | 1988-10-05 | 1991-08-06 | Toyota Jidosha Kabushiki Kaisha | Servo motor control apparatus |
US5600221A (en) * | 1994-05-09 | 1997-02-04 | Mitsubishi Denki Kabushiki Kaisha | Control apparatus for servo system |
US7002318B1 (en) * | 2004-09-23 | 2006-02-21 | General Motors Corporation | Position sensor fault tolerant control for automotive propulsion system |
-
2010
- 2010-11-10 CN CN201010537977.9A patent/CN102468802B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4528486A (en) * | 1983-12-29 | 1985-07-09 | The Boeing Company | Controller for a brushless DC motor |
US4713596A (en) * | 1985-07-10 | 1987-12-15 | General Electric Company | Induction motor drive system |
US5038090A (en) * | 1988-10-05 | 1991-08-06 | Toyota Jidosha Kabushiki Kaisha | Servo motor control apparatus |
US5600221A (en) * | 1994-05-09 | 1997-02-04 | Mitsubishi Denki Kabushiki Kaisha | Control apparatus for servo system |
US7002318B1 (en) * | 2004-09-23 | 2006-02-21 | General Motors Corporation | Position sensor fault tolerant control for automotive propulsion system |
Also Published As
Publication number | Publication date |
---|---|
CN102468802A (en) | 2012-05-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI403871B (en) | Feedback switching device and method for servo motor driving | |
CN101984553B (en) | Voltage vector selection method and multi-motor synchronous control system established by same | |
CN203434899U (en) | High-precision servo controller used for multiple motors | |
TW201713029A (en) | Method for setting identification code of smart motor and multi-axis control apparatus using the same | |
CN102468802B (en) | Feedback switching device and method driven by servo motor | |
JP5540753B2 (en) | Robot system | |
CN103765760A (en) | Integrated servo system, motor system, and motor control method | |
CN103607149B (en) | A kind of ultrasonic motor rudder servo system and control method thereof | |
CN104779875A (en) | Closed-loop control system for direct current servo motor | |
CN103713572A (en) | Numerical control system control method based on position giving | |
TW201119205A (en) | Method for motor startup control, motor driving system and motor system | |
CN110096077B (en) | Nonsingular rapid terminal sliding mode rotating speed control method and system for switched reluctance motor | |
CN201854230U (en) | Multi-motor synchronous control system | |
US8051653B2 (en) | Velocity-pressure control apparatus of hydraulic machine | |
CN103238123B (en) | Locating device and use the PLC system of this locating device | |
CN103762915B (en) | A kind of method for controlling stepping motor | |
CN105553357A (en) | Constant current driving system and constant current driving method for stepping motor with fixed duty ratio | |
CN104335478B (en) | Method for controlling synchronous reluctance motor | |
CN113067524A (en) | Position information processing method of hub servo motor | |
CN201467053U (en) | Step synchronous drive system | |
JP2008067562A (en) | Servo amplifier, multi-axis servo system, and control method of the same | |
CN101174807A (en) | DC motor control system and switching method capable of switching between speed and position online | |
CN106257820B (en) | Motor multi-mode control method and system | |
CN112398368B (en) | Method for changing the position of the angular position of the rotor of an EC motor and EC motor | |
CN212012504U (en) | Multi-control servo control system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |