WO2021033625A1 - 制御回路、制御方法および制御プログラム - Google Patents

制御回路、制御方法および制御プログラム Download PDF

Info

Publication number
WO2021033625A1
WO2021033625A1 PCT/JP2020/030817 JP2020030817W WO2021033625A1 WO 2021033625 A1 WO2021033625 A1 WO 2021033625A1 JP 2020030817 W JP2020030817 W JP 2020030817W WO 2021033625 A1 WO2021033625 A1 WO 2021033625A1
Authority
WO
WIPO (PCT)
Prior art keywords
target value
interval
motor
control
control circuit
Prior art date
Application number
PCT/JP2020/030817
Other languages
English (en)
French (fr)
Inventor
瑟基 洪
Original Assignee
株式会社ソニー・インタラクティブエンタテインメント
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 株式会社ソニー・インタラクティブエンタテインメント filed Critical 株式会社ソニー・インタラクティブエンタテインメント
Publication of WO2021033625A1 publication Critical patent/WO2021033625A1/ja

Links

Images

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/41—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 characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path
    • G05B19/4103—Digital interpolation
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback

Definitions

  • the present invention relates to a control circuit, a control method and a control program.
  • the input interval of the target value from the control device is restricted by, for example, the communication interval between the control device and the control circuit of the motor. Therefore, even when the time resolution of the motor control circuit is high and smooth operation is possible, operation noise due to step drive is likely to occur because the update interval of the target value is long.
  • an object of the present invention is to provide a control circuit, a control method, and a control program capable of smoothing the operation of a motor according to the time resolution of the control circuit regardless of the input interval of a target value. ..
  • a receiving unit that receives the target value of the motor operating amount at the first interval, and an interpolation processing unit that interpolates the target value at the second interval shorter than the first interval.
  • a control circuit including an output unit that outputs the interpolated target value to the servo control unit of the motor at a second interval.
  • the step of receiving the target value of the motor operating amount at the first interval, the step of interpolating the target value at the second interval shorter than the first interval, and the interpolation is provided.
  • the present invention there is a function of receiving the target value of the motor operating amount at the first interval, and a function of interpolating the target value at the second interval shorter than the first interval.
  • a program is provided for the processor to realize a function of outputting the interpolated target value to the servo control unit of the motor at a second interval.
  • the operation of the motor can be smoothed according to the time resolution of the control circuit regardless of the input interval of the target value.
  • FIG. 1 It is a figure which shows the hardware configuration example of the robot which concerns on one Embodiment of this invention. It is a block diagram which shows the structure of the control circuit of the motor shown in FIG. It is a figure for demonstrating the interpolation of the target value in one Embodiment of this invention. It is a figure for demonstrating the interpolation of the target value in one Embodiment of this invention. It is a flowchart which shows the example of the control method which concerns on one Embodiment of this invention.
  • FIG. 1 is a diagram showing a hardware configuration example of a robot according to an embodiment of the present invention.
  • the robot 10 has a control device 110 mounted on the main body 102.
  • the control device 110 includes a CPU (Central Processing Unit) 111, a RAM (Random Access Memory) 112, a ROM (Read Only Memory) 113, an external memory 114, and the like that execute arithmetic processing.
  • the control device 110 determines the operation of the robot 10 according to the image data acquired by the camera 121, the voice data acquired by the microphone 122, the command signal received by the communication interface 124, and the like.
  • the camera 121, the microphone 122, and the communication interface 124 are connected to the control device 110 via the bus interface 115.
  • the control device 110 controls each part of the robot 10 so that the determined operation is executed. Specifically, the control device 110 controls a motor 130 that rotationally drives the joints of the arms 103L and 103R, the hands 104L and 104R, and the legs 105L and 105R so that the determined motion is executed. To do. Although not shown, the head 101, the main body 102, and the foot may also be provided with joints driven by the motor 130. At this time, the control device 110 detects the detected values of the distance measurement sensor (not shown), the inertial measurement unit (IMU: Inertial Measurement Unit) 125, the grounding confirmation sensor 126, the load sensor (not shown), and the power supply control device 127. Refer to as necessary. The motor 130, the distance measurement sensor, the IMU 125, the grounding confirmation sensor 126, the load sensor, and the power supply control device 127 are connected to the control device 110 via the bus interface 115.
  • IMU Inertial Measurement Unit
  • the CPU 111 of the control device 110 selects a pattern corresponding to the operation determined from the control pattern stored in the ROM 113 or the external memory 114, and according to the selected pattern, the foot movement, the ZMP (Zero Moment Point) trajectory, and the like.
  • the trunk movement, upper limb movement, lumbar horizontal position and height are set, and the motor 130 is controlled according to these set values.
  • the CPU 111 may adaptively control the motor 130 according to the detection value of the sensor or the like as described above.
  • FIG. 2 is a block diagram showing the configuration of the motor control circuit shown in FIG.
  • the control circuit 140 for driving the motor 130 has a receiving unit 141 that receives the target value of the rotation angle of the motor 130 from the control device 110 at the first interval, and the target value is the first.
  • the servo control unit 144 drives the motor 130 by outputting a control signal to the driver 151, and detects the rotation angle of the motor 130 based on the pulse signal output from the encoder 152 as the motor 130 rotates.
  • the control signal input to the driver 151 is adjusted so that the rotation angle reaches the target value.
  • the control circuit 140 is implemented as a microcontroller including, for example, a memory in which the program is stored and a processor that operates according to the program.
  • the receiving unit 141, the interpolation processing unit 142, the output unit 143, and the servo control unit 144 are software-like functional parts by the processor.
  • FIG. 3A and 3B are diagrams for explaining the interpolation of the target value in one embodiment of the present invention.
  • FIG. 3A is a graph showing the target value input to the servo control unit 144 and the rotation angle of the motor 130 according to the target value in chronological order when the target value is not interpolated in the control circuit 140 shown in FIG. Is.
  • FIG. 3B is a graph showing the target value input to the servo control unit 144 and the rotation angle of the motor 130 according to the target value in chronological order when the interpolation processing unit 142 performs interpolation of the target value in the control circuit 140. Is. In the example shown in FIGS.
  • the first interval at which the receiving unit 141 of the control circuit 140 receives the target value from the control device 110 is 4 msec.
  • the interval at which the servo control unit 144 can update the control signal output to the driver 151 is shorter, which is 1 msec or less.
  • the target value V1 input to the servo control unit 144 is updated at the same 4 msec interval as the interval at which the receiving unit 141 receives the target value from the control device 110. .. Since the servo control unit 144 generates a control signal so that the current value follows the input target value V1 as quickly as possible, the change in the rotation angle of the motor 130 is transmitted to the servo control unit 144 in the above case. Immediately after the target value is entered, it becomes steep. On the other hand, when the rotation angle reaches the target value, the servo control unit 144 generates a control signal so as to maintain the rotation angle, so that the rotation angle of the motor 130 does not change.
  • the rotation angle of the motor 130 changes in a step-like manner in which a steep change and stagnation are repeated each time the target value is received, and the motor 130 and the driving force transmission mechanism connected to the motor 130 move and stop. As a result of repeating the above, operating noise is likely to occur.
  • the interpolation processing unit 142 receives the second interval, specifically the target value V1, whose target value is shorter than the first interval. Linear interpolation is performed at an interval of 1 msec shorter than the interval of 4 msec. That is, in the illustrated example, the interpolation processing unit 142 refers to the current value of the rotation angle of the motor 130, and sets the target value so that the rotation angle gradually increases by 1/4 times the difference between the target value and the current value. Interpolate. In this case, the target value V2 (interpolated target value) input to the servo control unit 144 is updated at 1 msec intervals. Similar to the example of FIG.
  • the servo control unit 144 generates a control signal so that the current value follows the input target value as quickly as possible, but in the example of FIG. 3B, the target value V2 Is interpolated at 1 msec intervals, so that the difference between the target value V2 input to the servo control unit 144 and the current value is small each time (about 1/4 of the example of FIG. 3A). Therefore, in the example of FIG. 3B, the steepness of the change in the rotation angle of the motor 130 after the target value is input to the servo control unit 144 can be suppressed.
  • the rotation angle of the motor 130 is between the time when the rotation angle approaches or reaches the target value V2 and the time when the next target value V2 is input because the update interval of the target value is shortened. Stagnation time is shortened.
  • the operation for following the next target value is started before the motor 130 and the driving force transmission mechanism are completely stopped, so that the operation noise can be reduced. ..
  • the operation of the motor 130 is smoothed by increasing the time resolution of the target value input to the servo control unit 144 by interpolation.
  • the control device 110 since the control device 110 communicates with the control circuit of the motor 130 of the joint portion provided in a large number of joints, the control device 110 transmits a target value to the control circuit 140. Since it is not easy to shorten the interval, a configuration in which the operation of the motor 130 is smoothed by the interpolation process on the motor 130 side as described above may be effective.
  • the interval between the interpolated target values is 1/4 times the interval between the received target values (first interval), but any n (n ⁇ 2).
  • the second interval may be 1 / n times the first interval. As long as 1 / n times the first interval does not fall below the interval at which the control signal output to the driver 151 by the servo control unit 144 can be updated, the larger n is, the smoother the operation of the motor 130 can be.
  • the interpolation processing unit 142 linearly interpolates the target value with reference to the difference between the target value and the current value of the rotation angle of the motor 130, but the interpolation processing unit 142 further receives the previous target value.
  • the target value may be interpolated non-linearly with reference to the rotation angle of the motor 130 at that time.
  • the interpolation processing unit 142 interpolates between the time when the previous target value is input and the time when the next target value is input (in the case of the example of FIG. 3B, for example, between time t1 + 4 ms and time t1 + 12 ms).
  • the target value is interpolated so that the amount of change in the gradient of the target value is minimized.
  • FIG. 4 is a flowchart showing an example of a control method according to an embodiment of the present invention.
  • the receiving unit 141 of the control circuit 140 receives the target value from the control device 110 (step S101).
  • the interpolation processing unit 142 interpolates the target value (step S102).
  • the interpolation processing unit 142 refers to, for example, the current value of the rotation angle of the motor 130, and gradually increases the rotation angle by 1 / n times (n ⁇ 2) of the difference between the target value and the current value. Interpolate.
  • the output unit 143 outputs the interpolated target value to the servo control unit 144.
  • the output unit 143 outputs the target value interpolated at an interval of 1 / n times the interval at which the reception unit 141 receives the target value to the servo control unit 144 (step S103).
  • the process returns to step S101 (step S104). The above processing is repeated every interval when the receiving unit 141 receives the target value (step S105).
  • the target value of the rotation angle is set for the motor 130 to be rotationally driven, but in other embodiments, the motor is not necessarily rotationally driven, and may be linearly driven, for example.
  • a target value is set for the amount of operation such as the amount of movement of the motor. Further, even when the motor is rotationally driven, a target value may be set for an operating amount other than the rotation angle.
  • the receiving unit 141, the interpolation processing unit 142, the output unit 143, and the servo control unit 144 are implemented in a single control circuit 140 has been described, but for example, the servo control unit 144 is another. It may be implemented in a circuit or device that is physically different from the part of. Further, the embodiment of the present invention is not limited to the robot as in the above example, and can be applied to various devices or devices in which the control circuit of the motor receives a target value from an external control device by communication.

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computing Systems (AREA)
  • Theoretical Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

モータの動作量の目標値を第１の間隔で受信する受信部と、目標値を、第１の間隔よりも短い第２の間隔で補間する補間処理部と、補間された目標値を第２の間隔でモータのサーボ制御部に出力する出力部とを備える制御回路が提供される。

Description

制御回路、制御方法および制御プログラム
　本発明は、制御回路、制御方法および制御プログラムに関する。
　例えばロボットにおいて、関節部を回転駆動させるモータを制御装置から入力される目標値に従って制御することが行われている。そのような技術の一例が、特許文献１に記載されている。
国際公開第２０１９／００３４０１号
　しかしながら、上記のような場合において、制御装置からの目標値の入力間隔は、例えば制御装置とモータの制御回路との間の通信間隔によって制約される。このため、モータの制御回路の時間分解能が高く滑らかな動作が可能である場合にも、目標値の更新間隔が長いためにステップ駆動による動作ノイズが発生しやすい。
　そこで、本発明は、目標値の入力間隔にかかわらず、制御回路の時間分解能に応じてモータの動作を平滑化することが可能な制御回路、制御方法および制御プログラムを提供することを目的とする。
　本発明のある観点によれば、モータの動作量の目標値を第１の間隔で受信する受信部と、目標値を、第１の間隔よりも短い第２の間隔で補間する補間処理部と、補間された目標値を第２の間隔でモータのサーボ制御部に出力する出力部とを備える制御回路が提供される。
　本発明の別の観点によれば、モータの動作量の目標値を第１の間隔で受信するステップと、目標値を、第１の間隔よりも短い第２の間隔で補間するステップと、補間された目標値を第２の間隔でモータのサーボ制御部に出力するステップとを含む制御方法が提供される。
　本発明のさらに別の観点によれば、モータの動作量の目標値が第１の間隔で受信する機能と、目標値を、第１の間隔よりも短い第２の間隔で補間する機能と、補間された目標値を第２の間隔でモータのサーボ制御部に出力する機能とをプロセッサに実現させるためのプログラムが提供される。
　上記の構成によれば、目標値の入力間隔にかかわらず、制御回路の時間分解能に応じてモータの動作を平滑化することができる。
本発明の一実施形態に係るロボットのハードウェア構成例を示す図である。 図１に示されたモータの制御回路の構成を示すブロック図である。 本発明の一実施形態における目標値の補間について説明するための図である。 本発明の一実施形態における目標値の補間について説明するための図である。 本発明の一実施形態に係る制御方法の例を示すフローチャートである。
　以下、添付図面を参照しながら、本発明のいくつかの実施形態について詳細に説明する。なお、本明細書および図面において、実質的に同一の機能構成を有する構成要素については、同一の符号を付することにより重複説明を省略する。
　図１は、本発明の一実施形態に係るロボットのハードウェア構成例を示す図である。図１に示されるように、ロボット１０は、本体部１０２に搭載される制御装置１１０を有する。制御装置１１０は、演算処理を実行するＣＰＵ（Central　Processing　Unit）１１１、ＲＡＭ（Random　Access　Memory）１１２、ＲＯＭ（Read　Only　Memory）１１３、および外部メモリ１１４などを含む。制御装置１１０は、カメラ１２１が取得した画像データ、マイクロフォン１２２が取得した音声データ、または通信インターフェース１２４が受信したコマンド信号などに応じてロボット１０の動作を決定する。カメラ１２１、マイクロフォン１２２、および通信インターフェース１２４は、バスインターフェース１１５を介して制御装置１１０に接続される。
　制御装置１１０は、決定された動作が実行されるように、ロボット１０の各部を制御する。具体的には、制御装置１１０は、決定された動作が実行されるように、腕部１０３Ｌ，１０３Ｒ、手部１０４Ｌ，１０４Ｒ、および脚部１０５Ｌ，１０５Ｒの関節部を回転駆動するモータ１３０を制御する。図示されていないが、頭部１０１、本体部１０２、および足部にもモータ１３０によって駆動される関節部が設けられてもよい。このとき、制御装置１１０は、距離計測センサ（図示せず）、慣性計測装置（ＩＭＵ：Inertial　Measurement　Unit）１２５、接地確認センサ１２６、荷重センサ（図示せず）、電源制御装置１２７の検出値を必要に応じて参照する。モータ１３０、距離計測センサ、ＩＭＵ１２５、接地確認センサ１２６、荷重センサ、および電源制御装置１２７は、バスインターフェース１１５を介して制御装置１１０に接続される。
　例えば、制御装置１１０のＣＰＵ１１１は、ＲＯＭ１１３または外部メモリ１１４に格納された制御パターンから決定された動作に対応するパターンを選択し、選択されたパターンに従って足部運動、ＺＭＰ（Zero　Moment　Point）軌道、体幹運動、上肢運動、腰部水平位置および高さなどを設定し、これらの設定値に従ってモータ１３０を制御する。このとき、ＣＰＵ１１１は、上記のようなセンサなどの検出値に応じて、モータ１３０を適応的に制御してもよい。
　図２は、図１に示されたモータの制御回路の構成を示すブロック図である。図２に示されるように、モータ１３０を駆動するための制御回路１４０は、制御装置１１０からモータ１３０の回転角度の目標値を第１の間隔で受信する受信部１４１と、目標値を第１の間隔よりも短い第２の間隔で補間する補間処理部１４２と、補完された目標値を第２の間隔でサーボ制御部１４４に出力する出力部１４３と、サーボ制御部１４４とを含む。サーボ制御部１４４は、ドライバ１５１に制御信号を出力することによってモータ１３０を駆動するとともに、モータ１３０の回転に伴ってエンコーダ１５２から出力されるパルス信号に基づいてモータ１３０の回転角度を検出し、回転角度が目標値に到達するようにドライバ１５１に入力する制御信号を調節する。制御回路１４０は、例えばプログラムが格納されたメモリとプログラムに従って動作するプロセッサとを含むマイクロコントローラとして実装される。この場合、受信部１４１、補間処理部１４２、出力部１４３、およびサーボ制御部１４４はプロセッサによるソフトウェア的な機能部分である。
　図３Ａおよび図３Ｂは、本発明の一実施形態における目標値の補間について説明するための図である。図３Ａは、図２に示した制御回路１４０において目標値の補間が実施されない場合にサーボ制御部１４４に入力される目標値と目標値に応じたモータ１３０の回転角度とを時系列で示すグラフである。図３Ｂは、制御回路１４０において補間処理部１４２が目標値の補間を実施する場合にサーボ制御部１４４に入力される目標値と目標値に応じたモータ１３０の回転角度とを時系列で示すグラフである。図３Ａおよび図３Ｂに示された例において、制御回路１４０の受信部１４１が制御装置１１０から目標値を受信する第１の間隔は４ｍｓｅｃである。これに対して、サーボ制御部１４４がドライバ１５１に出力する制御信号を更新できる間隔はより短く、１ｍｓｅｃ以下である。
　図３Ａに示す目標値の補間が実施されない例の場合、サーボ制御部１４４に入力される目標値Ｖ１は、受信部１４１が制御装置１１０から目標値を受信する間隔と同じ４ｍｓｅｃ間隔で更新される。サーボ制御部１４４は入力された目標値Ｖ１に対して現在値が可能な限り速やかに追従するように制御信号を生成するため、上記の場合においてモータ１３０の回転角度の変化はサーボ制御部１４４に目標値が入力された直後において急峻になる。その一方で、回転角度が目標値に到達するとサーボ制御部１４４は回転角度を維持するように制御信号を生成するため、モータ１３０の回転角度は変化しなくなる。この結果、モータ１３０の回転角度は、目標値の受信の度に急峻な変化と停滞とを繰り返すステップ状に推移し、モータ１３０およびモータ１３０に連結された駆動力伝達機構とが移動と停止とを繰り返す結果として動作ノイズが発生しやすい。
　一方、図３Ｂに示す本実施形態の例の場合、制御回路１４０において、補間処理部１４２が目標値を第１の間隔よりも短い第２の間隔、具体的には目標値Ｖ１が受信される間隔４ｍｓｅｃよりも短い間隔１ｍｓｅｃで線形補間する。つまり、図示された例において、補間処理部１４２は、モータ１３０の回転角度の現在値を参照し、回転角度が目標値と現在値との差分の１／４倍ずつ漸増するように目標値を補間する。この場合、サーボ制御部１４４に入力される目標値Ｖ２（補間された目標値）は、１ｍｓｅｃ間隔で更新される。サーボ制御部１４４が入力された目標値に対して現在値が可能な限り速やかに追従するように制御信号を生成するのは図３Ａの例と同様であるが、図３Ｂの例では目標値Ｖ２が１ｍｓｅｃ間隔に補間されている分、各回においてサーボ制御部１４４に入力される目標値Ｖ２と現在値との差分が小さい（図３Ａの例の約１／４になる）。従って、図３Ｂの例では、サーボ制御部１４４に対する目標値入力後のモータ１３０の回転角度の変化の急峻さを抑えることができる。
　また、図３Ｂの例では、目標値の更新間隔が短くなった分、回転角度が目標値Ｖ２に接近または到達してから次の目標値Ｖ２が入力されるまでの間にモータ１３０の回転角度が停滞する時間が短くなる。これによって、前後の目標値の値によっては、モータ１３０および駆動力伝達機構が完全に停止する前に次の目標値に追従するための動作が開始されるため、動作ノイズを低減することができる。このように、本実施形態では、補間によってサーボ制御部１４４に入力される目標値の時間分解能を上げることによって、モータ１３０の動作を平滑化している。
　例えば図１に示したようなロボット１０の場合、制御装置１１０が多数の関節に設けられた関節部のモータ１３０の制御回路と通信するため、制御装置１１０が制御回路１４０に目標値を送信する間隔を短縮することは容易ではないため、上記のようにモータ１３０側での補間処理によってモータ１３０の動作を平滑化する構成が有効でありうる。
　なお、上記の例において、補間された目標値の間隔（第２の間隔）が受信される目標値の間隔（第１の間隔）の１／４倍であるが、任意のｎ（ｎ≧２）について、第２の間隔を第１の間隔の１／ｎ倍としてもよい。第１の間隔の１／ｎ倍がサーボ制御部１４４がドライバ１５１に出力する制御信号を更新できる間隔を下回らない限り、上記のｎが大きいほどモータ１３０の動作を平滑化することができる。
　また、上記の例では、補間処理部１４２がモータ１３０の回転角度の目標値と現在値との差分を参照して目標値を線形補間したが、補間処理部１４２はさらに前回目標値が受信された時のモータ１３０の回転角度を参照して、目標値を非線形補間してもよい。この場合、例えば、補間処理部１４２は、前回目標値が入力されてから次回目標値が入力されるまでの間（図３Ｂの例の場合、例えば時刻ｔ１＋４ｍｓから時刻ｔ１＋１２ｍｓまでの間）で、補間された目標値の勾配変化量が最小化されるように目標値を補間する。
　図４は、本発明の一実施形態に係る制御方法の例を示すフローチャートである。図示された例では、まず、制御回路１４０の受信部１４１が制御装置１１０から目標値を受信する（ステップＳ１０１）。次に、補間処理部１４２が目標値を補間する（ステップＳ１０２）。このとき、補間処理部１４２は、例えばモータ１３０の回転角度の現在値を参照し、回転角度が目標値と現在値との差分の１／ｎ倍（ｎ≧２）ずつ漸増するように目標値を補間する。次に、出力部１４３が補間された目標値をサーボ制御部１４４に出力する。出力部１４３は、受信部１４１が目標値を受信する間隔の１／ｎ倍の間隔で補間された目標値をサーボ制御部１４４に出力する（ステップＳ１０３）。ｎ番目の補間された目標値を出力すると、処理はステップＳ１０１に戻る（ステップＳ１０４）。以上のような処理が、受信部１４１が目標値を受信する間隔ごとに繰り返される（ステップＳ１０５）。
　上記の実施形態では、回転駆動するモータ１３０に対して回転角度の目標値が設定されたが、他の実施形態では、モータは必ずしも回転駆動せず、例えば直線駆動してもよい。この場合、モータの移動量などの動作量について目標値が設定される。また、モータが回転駆動する場合であっても、回転角度以外の動作量について目標値が設定されてもよい。また、上記の実施形態では受信部１４１、補間処理部１４２、出力部１４３およびサーボ制御部１４４が単一の制御回路１４０の中で実装される例について説明したが、例えばサーボ制御部１４４が他の部分とは物理的に異なる回路または装置内で実装されてもよい。また、本発明の実施形態は、上記の例のようなロボットに限らず、モータの制御回路が通信によって外部の制御装置から目標値を受信する各種の装置または機器に適用可能である。
　以上、添付図面を参照しながら本発明のいくつかの実施形態について詳細に説明したが、本発明はかかる例に限定されない。本発明の属する技術の分野における通常の知識を有する者であれば、請求の範囲に記載された技術的思想の範疇内において、各種の変更例または修正例に想到し得ることは明らかであり、これらについても、当然に本発明の技術的範囲に属するものと了解される。
　１０…ロボット、１１０…制御装置、１３０…モータ、１４０…制御回路、１４１…受信部、１４２…補間処理部、１４３…出力部、１４４…サーボ制御部、１５１…ドライバ、１５２…エンコーダ。

Claims (5)

  1. 　モータの動作量の目標値を第１の間隔で受信する受信部と、
    　前記目標値を、前記第１の間隔よりも短い第２の間隔で補間する補間処理部と、
    　前記補間された目標値を前記第２の間隔で前記モータのサーボ制御部に出力する出力部と
    　を備える制御回路。
  2. 　前記第２の間隔は、前記第１の間隔の１／ｎ倍（ｎ≧２）であり、
    　前記補間された目標値は、前記目標値と現在値との差分の１／ｎ倍ずつ漸増する、請求項１に記載の制御回路。
  3. 　前記補間処理部は、前回目標値が入力されてから次回目標値が入力されるまでの間で、前記補間された目標値の勾配変化量が最小化されるように前記目標値を補間する、請求項１に記載の制御回路。
  4. 　モータの動作量の目標値を第１の間隔で受信するステップと、
    　前記目標値を、前記第１の間隔よりも短い第２の間隔で補間するステップと、
    　前記補間された目標値を前記第２の間隔で前記モータのサーボ制御部に出力するステップと
    　を含む制御方法。
  5. 　モータの動作量の目標値が第１の間隔で受信する機能と、
    　前記目標値を、前記第１の間隔よりも短い第２の間隔で補間する機能と、
    　前記補間された目標値を前記第２の間隔で前記モータのサーボ制御部に出力する機能と
    　をプロセッサに実現させるためのプログラム。
PCT/JP2020/030817 2019-08-20 2020-08-13 制御回路、制御方法および制御プログラム WO2021033625A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019150080A JP2021033436A (ja) 2019-08-20 2019-08-20 制御回路、制御方法および制御プログラム
JP2019-150080 2019-08-20

Publications (1)

Publication Number Publication Date
WO2021033625A1 true WO2021033625A1 (ja) 2021-02-25

Family

ID=74660834

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/030817 WO2021033625A1 (ja) 2019-08-20 2020-08-13 制御回路、制御方法および制御プログラム

Country Status (2)

Country Link
JP (1) JP2021033436A (ja)
WO (1) WO2021033625A1 (ja)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000272530A (ja) * 1999-03-29 2000-10-03 Koyo Seiko Co Ltd 自動操舵装置
JP2010170435A (ja) * 2009-01-24 2010-08-05 Tamagawa Seiki Co Ltd モーション制御用指令システム、モーション制御用指令方法およびモーション制御システム

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2599377B2 (ja) * 1987-01-21 1997-04-09 株式会社神戸製鋼所 ロボットの軌跡制御方法
JPH0199102A (ja) * 1987-10-13 1989-04-18 Yamatake Honeywell Co Ltd サーボ制御装置
JP2013184233A (ja) * 2012-03-06 2013-09-19 Toyota Motor Corp ロボットおよびその軌道生成方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000272530A (ja) * 1999-03-29 2000-10-03 Koyo Seiko Co Ltd 自動操舵装置
JP2010170435A (ja) * 2009-01-24 2010-08-05 Tamagawa Seiki Co Ltd モーション制御用指令システム、モーション制御用指令方法およびモーション制御システム

Also Published As

Publication number Publication date
JP2021033436A (ja) 2021-03-01

Similar Documents

Publication Publication Date Title
JP2010170435A (ja) モーション制御用指令システム、モーション制御用指令方法およびモーション制御システム
CN107924198B (zh) 控制装置、控制方法、非暂时记录介质
US20070188116A1 (en) Control system
WO2016199839A1 (ja) 電動パワーステアリング装置
US10656616B2 (en) Control device, control system, and recording medium
JP6790452B2 (ja) ステアリング制御装置
JP6564433B2 (ja) ロボットシステム
US9886025B2 (en) Numerical controller with an I/O control unit that generates control information using a processor of the I/O control unit
JP2019216558A (ja) 駆動装置、駆動方法、及びプログラム
WO2021033625A1 (ja) 制御回路、制御方法および制御プログラム
US20160104265A1 (en) Method for integration of calculations having a variable running time into a time-controlled architecture
JP6469320B1 (ja) サーボ制御装置
US20150212510A1 (en) Apparatus and method for providing feedback force and machine tool system
JP6538787B2 (ja) モータ制御装置及びモータ制御方法
JP7124696B2 (ja) 同期制御装置、同期制御システム、同期制御方法及びシミュレーション装置
JP2006217746A (ja) モータ制御装置
CN111331577A (zh) 机器人的控制装置及控制方法
JP6396389B2 (ja) サーボ制御装置
JP6356709B2 (ja) 高応答制御を行うモーションコントローラ
JP4515408B2 (ja) 位置決め制御装置
WO2020170306A1 (ja) ロボット制御装置
WO2020162202A1 (ja) 制御装置および制御プログラム
JP2005034991A (ja) ロボットの動作範囲制限装置および移動ロボット
JP6627999B2 (ja) 制御装置、制御方法、制御プログラム
JP6011697B2 (ja) 電動機の位置制御装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20853816

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20853816

Country of ref document: EP

Kind code of ref document: A1