JP6973504B2 - Device ID setting device and setting method - Google Patents
Device ID setting device and setting method Download PDFInfo
- Publication number
- JP6973504B2 JP6973504B2 JP2019558067A JP2019558067A JP6973504B2 JP 6973504 B2 JP6973504 B2 JP 6973504B2 JP 2019558067 A JP2019558067 A JP 2019558067A JP 2019558067 A JP2019558067 A JP 2019558067A JP 6973504 B2 JP6973504 B2 JP 6973504B2
- Authority
- JP
- Japan
- Prior art keywords
- setting
- torque value
- motor
- unit
- module
- 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
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L12/00—Data switching networks
- H04L12/28—Data switching networks characterised by path configuration, e.g. LAN [Local Area Networks] or WAN [Wide Area Networks]
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Manipulator (AREA)
- Small-Scale Networks (AREA)
Description
本発明は、モータモジュール等のデバイスにID(識別情報、識別番号)を設定する装置及び方法に関する。 The present invention relates to an apparatus and a method for setting an ID (identification information, identification number) in a device such as a motor module.
ロボットなどの可動装置は、複数のモータモジュールを有している場合が多い。ロボットの場合、ロボットの複数の関節等に、それぞれモータモジュールが設けられる。各モータモジュールを個別に制御するために、各モータモジュールには個別のデバイスIDが設定される。デバイスIDは、例えば、各モータモジュールに指示(制御信号)を送信する場合の通信用アドレスとなる。従って、ロボットに使用されるモータモジュールには、ロボットの部位の目的に合ったデバイスID(識別情報、識別番号)を付与する必要がある。
デバイスにIDを設定する場合、1つのマスタ装置(以上、単に「マスタ」と称する)から複数のスレーブ装置(以下、単に「スレーブ」と称する)にIDを設定することがある。このような場合のデバイスID設定技術の一例が、特許文献1に開示されている。特許文献1では、各スレーブにID設定用信号線を取り付け、ID設定用信号線には、各スレーブに応じた分圧抵抗が設けられている。そして、当該分圧抵抗により付与される分圧電圧に応じたIDが各スレーブに設定されるようになっている。Movable devices such as robots often have a plurality of motor modules. In the case of a robot, motor modules are provided at each of a plurality of joints of the robot. In order to control each motor module individually, an individual device ID is set for each motor module. The device ID is, for example, a communication address when an instruction (control signal) is transmitted to each motor module. Therefore, it is necessary to assign a device ID (identification information, identification number) suitable for the purpose of the part of the robot to the motor module used for the robot.
When setting an ID in a device, an ID may be set from one master device (hereinafter, simply referred to as "master") to a plurality of slave devices (hereinafter, simply referred to as "slave"). An example of the device ID setting technique in such a case is disclosed in
特許文献1の技術では、各スレーブにID設定用信号線を取り付ける必要がある。つまり、特許文献1の技術では、各スレーブにIDを設定するために、ID設定用ハードウエアを追加する必要がある。よって、最終製品にID設定専用の部品や配線が必要となる。
本発明は、上記した課題を解決するものであり、その目的は、ID設定用ハードウエアを追加することなく、各デバイスにIDを設定することができるデバイスID設定装置を提供することである。In the technique of
The present invention solves the above-mentioned problems, and an object of the present invention is to provide a device ID setting device capable of setting an ID in each device without adding ID setting hardware.
本発明の1つの態様によるデバイスID設定装置は、可動部に設けられたデバイスの動作時のトルク値を取得する取得部と、取得した前記トルク値に基づいて、前記デバイスにデバイスIDを設定する設定部と、を備える。 The device ID setting device according to one aspect of the present invention sets the device ID in the device based on the acquisition unit for acquiring the torque value of the device provided in the movable portion during operation and the acquired torque value. It is equipped with a setting unit.
本発明によれば、デバイスの動作トルク値に基づいて、デバイスIDを設定する。よって、ハードウエアを追加することなく、デバイスIDを設定することができる。 According to the present invention, the device ID is set based on the operating torque value of the device. Therefore, the device ID can be set without adding hardware.
以下、添付図面を参照して、本発明を実施するための実施形態を詳細に説明する。以下に説明する実施形態は、本発明の実現手段としての一例であり、本発明が適用される装置やシステムの構成や各種条件によって適宜修正または変更されるべきものであり、本発明は以下の実施形態に限定されない。 Hereinafter, embodiments for carrying out the present invention will be described in detail with reference to the accompanying drawings. The embodiment described below is an example as a means for realizing the present invention, and should be appropriately modified or modified depending on the configuration and various conditions of the apparatus or system to which the present invention is applied. It is not limited to the embodiment.
実施形態1
図1(a)は実施形態1に係るロボット10の正面図である。本実施形態では、ロボット10の下肢に設けられた6つのモータモジュール(図2(a)の符号60)にIDを設定する場合を説明する。モータモジュールはデバイスの一種であるので、モータモジュールに設定されるIDは、以下の説明においてデバイスIDと称する場合もある。
FIG. 1A is a front view of the
(ロボットの構成)
図1(a)に示すように、ロボット10は、頭部12、胴部14、左上腕16、左前腕18、左手20、右上腕22、右前腕24、右手26、鼠径部28、左大腿30、左下腿32、左足34、右大腿36、右下腿38及び右足40を有している。また、ロボット10は、上記した各部の間に可動部を有している。具体的には、例えば、ロボット10の下肢においては、鼠径部28と右大腿36の間に第1可動部42を有し、鼠径部28と左大腿30の間に第2可動部44を有し、右大腿36と右下腿38の間に第3可動部46を有し、左大腿30と左下腿32の間に第4可動部48を有し、右下腿38と右足40の間に第5可動部50を有し、左下腿32と左足34の間に第6可動部52を有している。第1可動部42は右腰、第2可動部44は左腰、第3可動部46は右膝、第4可動部48は左膝、第5可動部50は右足首、第6可動部52は左足首と称することもできる。本実施形態では、第1可動部42〜第6可動部52に、それぞれ、1つのモータモジュール60が設けられているとする。第1可動部42〜第6可動部52に設けられる6つのモータモジュール60は同一の構成を有するとする。なお、ロボット10の上肢の可動部にもモータモジュールが設けられているが、以下の記載では、ロボット10の上肢の可動部に設けられたモータモジュールにIDを設定する場合の説明は省略する。(Robot configuration)
As shown in FIG. 1A, the
ロボット10の胴部14には、システムモジュール54が設けられている。システムモジュール54は、ロボット10の全体の動作を制御する。また、システムモジュール54は、第1可動部42〜第6可動部52に設けられた6つのモータモジュールにデバイスIDを設定する。システムモジュール54はマスタと称することができ、6つのモータモジュールはスレーブと称することができる。システムモジュール54と6つのモータモジュールは有線または無線で通信可能に接続されている。デバイスIDは、システムモジュール54が6つのモータモジュールを制御する際の、各モータモジュールの通信アドレスの役割を果たす。
本実施形態において、各可動部は、2つの要素が接続する接続部(関節)である。例えば、第2可動部44は、鼠径部28と左大腿30の接続部(関節)である。当該接続部に設けられたモータモジュールが回転駆動される(具体的には、モータモジュール内のモータが回転する)と、ロボット10が動く。モータモジュールが回転駆動されると、ロボット10は、例えば、図1(b)に示すような姿勢を取ることができる。A
In the present embodiment, each movable portion is a connecting portion (joint) in which two elements are connected. For example, the second
(モータモジュールの構成)
図2(a)はモータモジュール60の外観斜視図であり、図2(b)はモータモジュール60のブロック図である。図2(a)に示すように、モータモジュール60は、本体61と出力軸62を有する。モータモジュール60は、サーボモータモジュールである。
上記したように、本実施形態では6つのモータモジュールが同一の構成を有している。
また、6つのモータモジュールには、モータモジュールの製造当初、同一のデバイスID(初期デバイスID)が付与されているとする。そして、システムモジュール54によるデバイスID設定が行われる前にあっては、同一のデバイスIDが付与されている6つのモータモジュールがロボット10に組み込まれているとする。
図2(b)に示すように、モータモジュール60は、モータ制御MCU(Micro Control Unit)65、モータ66、ギヤ67及びセンサ68を備える。本明細書において、モータモジュール60が回転駆動するというのは、モータ66が回転することを意味する。(Motor module configuration)
FIG. 2A is an external perspective view of the
As described above, in this embodiment, the six motor modules have the same configuration.
Further, it is assumed that the same device ID (initial device ID) is assigned to the six motor modules at the beginning of manufacturing the motor module. Before the device ID is set by the
As shown in FIG. 2B, the
モータ制御MCU65は、センサ68からの検知信号に基づいてモータ66を回転させる。また、モータ制御MCU65は、システムモジュール54からの指示に応じて、仮IDを自ら決める。本実施形態において、仮IDは2桁の数字であるとする。モータ制御MCU65は、仮ID生成のための乱数発生機能を有している。また、モータ制御MCU65は、システムモジュール54との通信を行うための通信機能も有している。
ギヤ67は、モータ66の回転出力を受け取り、モータ制御MCU65の制御の下で、モータ66の出力トルクや回転速度を変える。
センサ68は、例えば、モータ66の温度、電流及び軸位置(出力軸62の角度位置)を検知する。センサ68は、図2(b)において1つのブロックで描かれているが、温度センサ、電流センタ及び軸位置センサに分かれていてもよい。モータ制御MCU65は、例えば、センサ68が検知した電流と軸位置に基づいて、モータのトルク(負荷)を算出(推定)することができる。The
The
The
(デバイスIDの設定)
次に、図3を参照して、6つのモータモジュール60にデバイスIDを設定するフローを説明する。以下の説明において、第1可動部42に設けられたモータモジュール60は、第1モータモジュール60aと称し、第2可動部44に設けられたモータモジュール60は、第2モータモジュール60bと称し、第3可動部46に設けられたモータモジュール60は、第3モータモジュール60cと称し、第4可動部48に設けられたモータモジュール60は、第4モータモジュール60dと称し、第5可動部50に設けられたモータモジュール60は、第5モータモジュール60eと称し、第6可動部52に設けられたモータモジュール60は、第6モータモジュール60fと称する。
第1モータモジュール60a〜第6モータモジュール60fの製造時において、第1モータモジュール60a〜第6モータモジュール60fには、同一のデバイスIDが設定されている。そして、同一のデバイスIDが設定されている第1モータモジュール60a〜第6モータモジュール60fが、ロボット10に組み込まれているとする。図3のフローはこの状態においてスタートする。(Device ID setting)
Next, with reference to FIG. 3, a flow for setting device IDs in the six
At the time of manufacturing the
まず、S10において、システムモジュール(マスタ)54が第1モータモジュール60a〜第6モータモジュール60fに、ブロードキャスト通信で、「仮IDを決めて返送せよ」という指示と、「少し動きトルク値を返送せよ」という指示を送る。システムモジュール54からの指示に応じて各モータモジュールが回転駆動するので、システムモジュール54はモータモジュール60を動作させる動作機能を有すると言える。また、システムモジュール54からの指示に基づいて各モータモジュールが仮IDを設定するので、システムモジュール54は仮IDを設定させる仮ID設定機能を備えると言える。
First, in S10, the system module (master) 54 gives an instruction to "determine a temporary ID and return it" to the
S11において、システムモジュール54からの指示を受けた第1モータモジュール60aは、疑似乱数で、第1モータモジュール60aの仮IDを決める。
また、S12において、第1モータモジュール60aは、システムモジュール54からの指示に応じて、少しモータ66を回転させ、その時のトルク値を算出(測定)する。
そして、S13において、第1モータモジュール60aは、仮IDと測定したトルク値をシステムモジュール54に送信する。この送信により、システムモジュール54は、第1モータモジュール60aの仮IDと動作時のトルク値を取得する。S13の「Source=仮ID」は、信号の発信元を示す情報として、第1モータモジュール60aの仮IDを使用していることを示している。S13の「Destination=Master」は、S13の信号送信における送信先がシステムモジュール54であることを示している。In S11, the
Further, in S12, the
Then, in S13, the
S14において、システムモジュール54からの指示を受けた第2モータモジュール60bは、疑似乱数で、第2モータモジュール60bの仮IDを決める。
また、S15において、第2モータモジュール60bは、システムモジュール54からの指示に応じて、少しモータ66を回転させ、その時のトルク値を測定する。
そして、S16において、第2モータモジュール60bは、仮IDと測定したトルク値をシステムモジュール54に送信する。この送信により、システムモジュール54は、第2モータモジュール60bの仮IDと動作時のトルク値を取得する。
同様に、第3モータモジュール60c〜第6モータモジュール60fは、疑似乱数で、それぞれ、仮IDを決める。また、第3モータモジュール60c〜第6モータモジュール60fは、少しモータ66を回転させ、その時のトルク値を測定する。そして、第3モータモジュール60c〜第6モータモジュール60fは、ぞれぞれ、仮IDと測定したトルク値をシステムモジュール54に送信する。この送信により、システムモジュール54は、第3モータモジュール60c〜第6モータモジュール60fの仮IDと動作時のトルク値を取得する。In S14, the
Further, in S15, the
Then, in S16, the
Similarly, the third motor module 60c to the
S17において、システムモジュール54は、第1モータモジュール60a〜第6モータモジュール60fから受信した6つの仮IDが全て異なっているかを判定する。同じ仮IDがあった場合、システムモジュール54は、全ての仮IDが異なるようになるまで、「仮IDを決めて返送せよ」という指示を第1モータモジュール60a〜第6モータモジュール60fに送信する。6つの仮IDが全て異なるIDになったならば、S18に進む。
S18において、システムモジュール54は、各モータモジュールについて、受信したトルク値に基づいて、トルク−デバイスID表(図4)を用いて、本IDを特定(決定)する。In S17, the
In S18, the
図4は、本実施形態で使用するトルク−デバイスID表70を示している。トルク−デバイスID表70は、測定したトルク値と、デバイスIDと、デバイス(モータモジュール)設置位置との関係を示す表である。測定したトルク値は、システムモジュール54からの「少し動きトルク値を返送せよ」という指示に基づいた値であるので、モータ66の動き出しのトルク値である。このトルク値は、表70では「初期トルク値」と記載されている。表70のトルク値の単位はNmである。なお、以下の記載において、トルク値を説明する際に単位(Nm)は省略する。例えば、トルク値「3」は3Nmを意味する。
FIG. 4 shows the torque-device ID table 70 used in this embodiment. The torque-device ID table 70 is a table showing the relationship between the measured torque value, the device ID, and the device (motor module) installation position. Since the measured torque value is a value based on the instruction from the
ロボット10を動かす場合、モータモジュールの設置位置により、必要なトルク値が異なる。よって、トクル値が分かれば、ロボット10のどの部位(どの可動部)に設置されたモータモジュールのトルク値であるかが分かる。本実施形態では、予め、右腰に設置されるモータモジュールにはデバイスID「1」が設定され、左腰に設置されるモータモジュールにはデバイスID「2」が設定され、右膝に設置されるモータモジュールにはデバイスID「3」が設定され、左膝に設置されるモータモジュールにはデバイスID「4」が設定され、右足首に設置されるモータモジュールにはデバイスID「5」が設定され、左足首に設置されるモータモジュールにはデバイスID「6」が設定されることが決められているとする。
トルク−デバイスID表70は、ロボット10を製造する際に、予め用意し、システムモジュール54に記憶させておく。When moving the
The torque-device ID table 70 is prepared in advance when the
本実施形態では、システムモジュール54がS10で「時計回りに少し回転した際のトルク値と、反時計回りに少し回転した際のトルク値を返送せよ」という指示を出すとする。この場合、システムモジュール54が、時計回りに回転した際のトルク値として「3」を受信し、反時計回りに回転した際のトルク値として「1」を受信したならば、当該トルク値は右膝に設けられたモータモジュール60cから受信したものであることが分かる。よって、システムモジュール54は、当該モータモジュール60cに、本IDとして「3」を設定すべきであることを特定(決定)する。
システムモジュール54が、時計回りに回転した際のトルク値として「4」を受信し、反時計回りに回転した際のトルク値として「1」を受信したならば、当該トルク値は右足首に設けられたモータモジュール60eから受信したものであることが分かる。よって、システムモジュール54は、当該モータモジュール60eに、本IDとして「5」を設定すべきであることを特定する。In the present embodiment, it is assumed that the
If the
トルク−デバイスID表70において、例えば、時計回りの初期トルク値が右膝は「3〜4」と記載され、右足首は「4〜5」と記載されている。これは、時計回りに回転した際のトルク値は、右足首の方が右膝より大きい値となることを示している。例えば、時計回りに回転した際の右膝のトルク値が「3」であれば、右足首のトルク値は「3」より大きな値(例えば「4」)になり、時計回りに回転した際の右膝のトルク値が「4」であれば、右足首のトルク値は「4」より大きな値(例えば「5」)になる。 In the torque-device ID table 70, for example, the initial clockwise torque value is described as "3 to 4" for the right knee and "4 to 5" for the right ankle. This indicates that the torque value when rotating clockwise is larger for the right ankle than for the right knee. For example, if the torque value of the right knee when rotating clockwise is "3", the torque value of the right ankle becomes a value larger than "3" (for example, "4"), and when rotating clockwise. If the torque value of the right knee is "4", the torque value of the right ankle is larger than "4" (for example, "5").
また、時計回りの初期トルク値については、右腰は「0.2〜0.6」と記載され、左腰は「0.1〜0.5」と記載されている。これは、時計回りに回転した際のトルク値は、右腰の方が左腰より大きい値となることを示している。例えば、時計回りに回転した際の右腰のトルク値が「0.2」であれば、左腰のトルク値は「0.2」より小さい値(例えば「0.1」)になり、時計回りに回転した際の右腰のトルク値が「0.3」であれば、左腰のトルク値は「0.3」より小さい値(例えば「0.2」)になる。
このように、本実施形態では、受信したトルク値に基づいて、トルク−デバイスID表70を用いて、当該モータモジュールの設置位置(どの可動部に設けられたか)を特定し、その後、当該可動部の位置に基づいて、設定すべきデバイスIDを決定することができる。Further, regarding the initial clockwise torque value, the right hip is described as "0.2 to 0.6" and the left hip is described as "0.1 to 0.5". This indicates that the torque value when rotating clockwise is larger on the right hip than on the left hip. For example, if the torque value of the right waist when rotating clockwise is "0.2", the torque value of the left waist is smaller than "0.2" (for example, "0.1"), and the clock. If the torque value of the right waist when rotating around is "0.3", the torque value of the left waist is smaller than "0.3" (for example, "0.2").
As described above, in the present embodiment, the installation position (which movable part of the motor module is provided) of the motor module is specified by using the torque-device ID table 70 based on the received torque value, and then the movable part is specified. The device ID to be set can be determined based on the position of the unit.
S18において、システムモジュール54が、各モータモジュールの本IDを特定したならば、S19に進む。
S19において、システムモジュール54は、第1モータモジュール60aに「本IDをデバイスIDとして設定せよ」という指示を送る。本実施形態のロボット10では、6つのモータモジュール60a〜60fにデバイスID「1」〜「6」を設定することが求められている(予め決められている)。S19以前の状態では、6つのモータモジュール60a〜60fには6つの異なる仮IDが設定されているが、ロボット10を適切に制御するためには、仮IDに代えて本IDを各モータモジュールに設定する必要がある。仮IDは乱数で決められた値なので、どのような値が各モータモジュールに設定されているか不明である。システムモジュール54は、右腰に設けられた第1モータモジュール60aにはデバイスID「1」が設定され、左腰に設けられた第2モータモジュール60bにはデバイスID「2」が設定され、右膝に設けられた第3モータモジュール60cにはデバイスID「3」が設定され、左膝に設けられた第4モータモジュール60dにはデバイスID「4」が設定され、右足首に設けられた第5モータモジュール60eにはデバイスID「5」が設定され、左足首に設けられた第6モータモジュール60fにはデバイスID「6」が設定されることを前提として構成されている。If the
In S19, the
S19でシステムモジュール54が第1モータモジュール60aに指示を送る際、システムモジュール54は、例えば、図5に示すような通信プロトコルを使用する。通信プロトコルについては、後述する。
S20において、第1モータモジュール60aは、システムモジュール54から指定された本IDを、第1モータモジュール60aのデバイスIDとして設定する。
S21において、システムモジュール54は、第2モータモジュール60bに「本IDをデバイスIDとして設定せよ」という指示を送る。
S22において、第2モータモジュール60bは、システムモジュール54から指定された本IDを、第2モータモジュール60bのデバイスIDとして設定する。
同様に、システムモジュール54は、第3モータモジュール60c〜第6モータモジュール60fに「本IDをデバイスIDとして設定せよ」という指示を送る。そして、第3モータモジュール60c〜第6モータモジュール60fは、システムモジュール54から指定された本IDを、第3モータモジュール60c〜第6モータモジュール60fのデバイスIDとして設定する。When the
In S20, the
In S21, the
In S22, the
Similarly, the
図5は、システムモジュール54と各モータモジュールとの間の通信に用いられる通信パケット(プロトコル)を示している。
Headerは、通信パケットの始まりを示す定形の情報である。
DeviceIDは、システムモジュール54が各モータモジュールに送るデバイスIDである。DeviceIDは、デバイスIDの通信先を特定する情報(Destination)と、デバイスIDの発信元を特定する情報(Source)を含む。全デバイスをDestinationとして指定することも可能である。
Lengthは、通信で有効なバイト長さである。FIG. 5 shows a communication packet (protocol) used for communication between the
Header is standard information indicating the beginning of a communication packet.
The Device ID is a device ID sent by the
Length is a valid byte length for communication.
CommonDataStructure(共通データ構造)は、目的のデバイスに指示する情報であり、OperationとAttirbuteを含む。Operationは、目的のデバイスへの動作系コマンドであり、例えば、ブロードキャスト、ライト、リード、ストップ、リセット、イニシャライズ等の操作情報である。Attributeは、目的のデバイスへの属性系コマンドであり、例えば、時計回りに30度回転せよ、反時計回りに30度回転せよ等の情報である。
Checksumは、通信したデータが正常か否かを確認するために使用する情報である。
図5の通信パケットは、システムモジュール54が各モータモジュール60へ指示を送る場合に用いられるパケットである。なお、図5の通信パケットは、各モータモジュール60がシステムモジュール54へ信号を送る際に用いられてもよい。CommonDataStructure (common data structure) is information that directs the device of interest and includes Operation and Attilbute. Operation is an operation command to a target device, and is, for example, operation information such as broadcast, write, read, stop, reset, and initialize. Attribute is an attribute-based command to a target device, and is information such as, for example, rotate 30 degrees clockwise, rotate 30 degrees counterclockwise, and the like.
Checksum is information used to confirm whether or not the communicated data is normal.
The communication packet of FIG. 5 is a packet used when the
(実施形態1の効果)
本実施形態によれば、システムモジュール54は、各モータモジュール60から取得したトルク値に基づいて、各モータモジュール60にデバイスIDを設定している。つまり、本実施形態によれば、デバイスの動作トルク値に基づいて、デバイスIDを設定することができる。よって、モータモジュール60にデバイスID設定用信号線などのハードウエアを追加することなく、モータモジュール60にデバイスIDを設定することができる。本実施形態では、既存のロボットに設けるシステムモジュール54のソフトウエアを変更するだけで、複数のモータモジュール60に異なるデバイスIDを設定することができる。(Effect of Embodiment 1)
According to the present embodiment, the
ロボット10は複数のモータモジュール60を備え、各モータモジュール60が個別に持つデバイスIDは、各モータモジュール60とシステムモジュール54とが通信する際のアドレスとなる。よって、当該アドレスを使用することにより、各モータモジュール60とシステムモジュール54は、適切な通信を行うことができる。
The
従来は、ロボットにモータモジュールを組み込む前に、モータモジュールに個別のデバイスIDを付与(設定)して、当該デバイスIDに従った目的の部位に各モータモジュールを組み込むという手法も採用されていた。このような手法では、例えば、6つのデバイスIDを設定する場合には、モータモジュールをロボットに組み込む前に、6つの異なるモータモジュールを管理する必要があった。本実施形態によれば、複数のモータモジュールをロボットに組み込む際には、複数のモータモジュールには同一のデバイスIDが設定されている。よって、最終的に6つのモータモジュールに6つの異なるデバイスIDを設定する場合でも、モータモジュールをロボットに組み込む前にあっては、6つの異なるモータモジュールを管理するという必要はなくなる。本実施形態によれば、複数のモータモジュール60をロボット10に組み込んだ後に、自動でデバイスIDを設定することができる。本実施形態では、ロボット10に複数の同じモータモジュール60を組み込んだ後に、異なるデバイスIDをモータモジュール60に設定する。よって、ロボット10を組み立てるときには、どのモータモジュールをどの部位に設けるかについて、管理する必要がなくなる。
ロボット10を組み立てた直後の状態では、6つのモータモジュールに重複したデバイスIDが設定されている。本実施形態によれば、重複したデバイスID(初期デバイスID)を、ロボット10の組み立て後に、重複しないデバイスIDに書き換えることができる。Conventionally, before incorporating a motor module into a robot, a method of assigning (setting) an individual device ID to the motor module and incorporating each motor module into a target portion according to the device ID has also been adopted. In such a method, for example, when setting six device IDs, it is necessary to manage six different motor modules before incorporating the motor modules into the robot. According to the present embodiment, when a plurality of motor modules are incorporated into a robot, the same device ID is set for the plurality of motor modules. Therefore, even when six different device IDs are finally set in the six motor modules, it is not necessary to manage the six different motor modules before incorporating the motor modules into the robot. According to this embodiment, the device ID can be automatically set after the plurality of
Immediately after assembling the
(変形例)
上記した本実施形態では6つのモータモジュールが同一の構成を有するとしたが、全てのモータモジュールが同じ構成を有さなくてもよい。例えば、第5可動部50と第6可動部52に設けられるモータモジュール60eと60fには大きな負荷が作用すると考えられるので、第5可動部50と第6可動部52に設けられるモータモジュール60eと60fは、他の可動部に設けられるモータモジュールより大きな負荷に耐えられる構造のものを採用してもよい。(Modification example)
In the present embodiment described above, it is assumed that the six motor modules have the same configuration, but all the motor modules do not have to have the same configuration. For example, since it is considered that a large load acts on the
図3のフローでは、S10においてシステムモジュール54が第1モータモジュール60a〜第6モータモジュール60fに、「仮IDを決めて返送せよ」という指示と、「少し動きトルク値を返送せよ」という指示を送った。本実施形態は、このようなフローに限定されない。例えば、S10において、システムモジュール54は第1モータモジュール60a〜第6モータモジュール60fに、「仮IDを決めて返送せよ」という指示のみを送ってもよい。この場合、システムモジュール54は、S17の後に、「少し動きトルク値を返送せよ」という指示を第1モータモジュール60a〜第6モータモジュール60fに送る。
In the flow of FIG. 3, in S10, the
上記した実施形態では、センサ68は、検知した電流と軸位置に基づいて、モータのトルク(負荷)を算出するとしたが、トルク値を計測するトルクセンサを設けてもよい。
上記した実施形態では、システムモジュール54は、ロボット10の胴部14の中に設けられるとしたが、システムモジュール54の設置位置は胴部14の中に限定されない。例えば、ロボット10の外部に設置してもよい。
上記した実施形態では、デバイスIDは「1」〜「6」であったが、本発明のデバイスIDは「1」〜「6」以外の識別番号あるいは識別情報であってもよい。
トルク−デバイスID表70は図4に示したものに限定されない。本実施形態で使用するトルク−デバイスID表は、複数のトルク値と、当該複数のトルク値に対応付けられた接続部及びデバイスIDとを含むものであればよい。In the above embodiment, the
In the above embodiment, the
In the above-described embodiment, the device ID is "1" to "6", but the device ID of the present invention may be an identification number or identification information other than "1" to "6".
The torque-device ID table 70 is not limited to that shown in FIG. The torque-device ID table used in the present embodiment may include a plurality of torque values and a connection portion and a device ID associated with the plurality of torque values.
上記した実施形態では、本発明を複数のモータデバイスを備えるロボットに適用したが、本発明の適用はこれに限定されない。本発明は1つまたは複数のモータ等のデバイスに識別情報や識別番号を付与する場合に適用することができる。例えば、本発明は、モータを備える制御装置やシステムに適用することができる。 In the above-described embodiment, the present invention has been applied to a robot provided with a plurality of motor devices, but the application of the present invention is not limited to this. The present invention can be applied when giving identification information or an identification number to a device such as one or a plurality of motors. For example, the present invention can be applied to a control device or system including a motor.
10…ロボット、42…第1可動部、44…第2可動部、46…第3可動部、48…第4可動部、50…第5可動部、52…第6可動部、54…システムモジュール、60…モータモジュール 10 ... Robot, 42 ... 1st movable part, 44 ... 2nd movable part, 46 ... 3rd movable part, 48 ... 4th movable part, 50 ... 5th movable part, 52 ... 6th movable part, 54 ... System module , 60 ... Motor module
Claims (15)
取得した前記トルク値に基づいて、前記デバイスにデバイスIDを設定する設定部と、
を備えるデバイスID設定装置。An acquisition unit that acquires the torque value during operation of the device provided in the movable unit, and an acquisition unit.
A setting unit that sets a device ID for the device based on the acquired torque value, and
A device ID setting device comprising.
前記デバイスは、前記可動部のうち2つ以上の要素が接続する接続部に配置され、
前記取得部は、前記動作部により動作させられた前記デバイスの動作時のトルク値を取得し、
前記設定部は、取得した前記トルク値に基づいて前記接続部を特定し、特定した前記接続部に基づいて、前記デバイスにデバイスIDを設定する請求項1に記載のデバイスID設定装置。Further provided with an operating unit for operating the device,
The device is placed at a connection where two or more elements of the movable part are connected.
The acquisition unit acquires the torque value of the device operated by the operation unit during operation, and obtains the torque value during operation.
The device ID setting device according to claim 1, wherein the setting unit identifies the connection unit based on the acquired torque value, and sets a device ID to the device based on the identified connection unit.
前記設定部は、前記デバイスの時計回りの動作時のトルク値または反時計回りの動作時のトルク値に基づいて、前記接続部を特定し、特定した前記接続部に基づいて、前記デバイスにデバイスIDを設定する請求項2に記載のデバイスID設定装置。The moving unit causes the device to operate clockwise or counterclockwise.
The setting unit identifies the connection portion based on the torque value during clockwise operation or the torque value during counterclockwise operation of the device, and the device is attached to the device based on the identified connection portion. The device ID setting device according to claim 2, wherein the ID is set.
当該複数のトルク値に一対一で対応付けられた前記接続部及びデバイスIDと、
を含むテーブルをさらに備える請求項2または3に記載のデバイスID設定装置。With multiple torque values,
The connection unit and device ID associated with the plurality of torque values on a one-to-one basis,
The device ID setting device according to claim 2 or 3, further comprising a table including.
前記設定部は、前記複数のデバイスに異なるデバイスIDを設定する請求項1〜5のいずれか1項に記載のデバイスID設定装置。There are a plurality of the movable parts, and each of the plurality of movable parts is provided with a device.
The device ID setting device according to any one of claims 1 to 5, wherein the setting unit sets different device IDs for the plurality of devices.
前記設定部は、前記初期デバイスIDを書き換えて前記複数のデバイスに異なるデバイスIDを設定する請求項6に記載のデバイスID設定装置。The same initial device ID is set for the devices provided in the plurality of movable parts, respectively.
The device ID setting device according to claim 6, wherein the setting unit rewrites the initial device ID to set different device IDs for the plurality of devices.
前記設定部は、前記仮デバイスIDに代えて、前記トルク値に基づいて前記デバイスに前記デバイスIDを設定する請求項1〜10のいずれか1項に記載のデバイスID設定装置。The acquisition unit acquires the temporary device ID set by the device together with the torque value, and obtains the temporary device ID.
The device ID setting device according to any one of claims 1 to 10, wherein the setting unit sets the device ID in the device based on the torque value instead of the temporary device ID.
前記デバイスID設定装置は、前記複数のデバイスにそれぞれ仮IDを設定させる仮ID設定部をさらに備え、
前記仮ID設定部は、前記複数のデバイスのそれぞれに異なる仮IDが設定されるまで、前記複数のデバイスに前記仮IDを設定させ続ける請求項1〜11のいずれか1項に記載のデバイスID設定装置。There are a plurality of the movable parts, and each of the plurality of movable parts is provided with a device.
The device ID setting device further includes a temporary ID setting unit that causes the plurality of devices to set temporary IDs.
The device ID according to any one of claims 1 to 11, wherein the temporary ID setting unit keeps the plurality of devices setting the temporary ID until a different temporary ID is set for each of the plurality of devices. Setting device.
当該デバイスID設定装置によりデバイスIDが設定されるデバイスと、
からなるシステム。The device ID setting device according to any one of claims 1 to 12, and the device ID setting device.
A device whose device ID is set by the device ID setting device, and
A system consisting of.
取得した前記トルク値に基づいて、前記デバイスにデバイスIDを設定する設定ステップと、を有するデバイスID設定方法。The acquisition step to acquire the torque value during operation of the device provided in the moving part, and
A device ID setting method comprising a setting step for setting a device ID in the device based on the acquired torque value.
前記デバイスID設定方法は、前記接続部で前記デバイスを動作させるステップをさらに有し、
前記設定ステップは、取得した前記トルク値に基づいて前記接続部を特定し、特定した前記接続部に基づいて、前記デバイスにデバイスIDを設定する請求項14に記載のデバイスID設定方法。The device is arranged at a connection portion to which two or more elements of the movable portion are connected.
The device ID setting method further includes a step of operating the device at the connection portion.
The device ID setting method according to claim 14, wherein the setting step identifies the connection portion based on the acquired torque value, and sets a device ID to the device based on the identified connection portion.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021179769A JP2022020739A (en) | 2017-12-06 | 2021-11-02 | Device ID setting device and setting method |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017234126 | 2017-12-06 | ||
JP2017234126 | 2017-12-06 | ||
PCT/JP2018/039925 WO2019111582A1 (en) | 2017-12-06 | 2018-10-26 | Device id setting device and setting method |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021179769A Division JP2022020739A (en) | 2017-12-06 | 2021-11-02 | Device ID setting device and setting method |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2019111582A1 JPWO2019111582A1 (en) | 2020-12-10 |
JP6973504B2 true JP6973504B2 (en) | 2021-12-01 |
Family
ID=66751359
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019558067A Active JP6973504B2 (en) | 2017-12-06 | 2018-10-26 | Device ID setting device and setting method |
JP2021179769A Pending JP2022020739A (en) | 2017-12-06 | 2021-11-02 | Device ID setting device and setting method |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021179769A Pending JP2022020739A (en) | 2017-12-06 | 2021-11-02 | Device ID setting device and setting method |
Country Status (3)
Country | Link |
---|---|
JP (2) | JP6973504B2 (en) |
CN (1) | CN111434075A (en) |
WO (1) | WO2019111582A1 (en) |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000061858A (en) * | 1998-08-18 | 2000-02-29 | Nippon Denki Denpa Kiki Engineering Kk | Torque driver |
US7215253B2 (en) * | 2002-04-10 | 2007-05-08 | Lg Electronics Inc. | Method for recognizing electronic appliance in multiple control system |
JP4306512B2 (en) * | 2004-01-13 | 2009-08-05 | 株式会社デンソー | Communication network system and communication network system ID setting method |
JP2006162410A (en) * | 2004-12-07 | 2006-06-22 | Ntn Corp | Rotation detection device and its connection system |
JP2008062802A (en) * | 2006-09-07 | 2008-03-21 | Denso Corp | Communication system, and method of assigning address |
CN101417425A (en) * | 2007-10-26 | 2009-04-29 | 应广科技股份有限公司 | Multiple servo-motor control system and method |
US20090128080A1 (en) * | 2007-11-16 | 2009-05-21 | Padauk Technology Co. | System and method for controlling multiple servo motors |
JP2009189075A (en) * | 2008-02-01 | 2009-08-20 | Denso Corp | Communication system |
CN102147782B (en) * | 2010-02-08 | 2013-08-21 | 鸿富锦精密工业(深圳)有限公司 | Communication circuit between master equipment and slave equipment and ID (Identity) address allocating method thereof |
SE536708C2 (en) * | 2012-10-23 | 2014-06-10 | Cognibotics Ab | Method and system for determining at least one property of a manipulator |
KR102088526B1 (en) * | 2013-11-04 | 2020-04-14 | 삼성전자주식회사 | Method and its apparatus for controlling the smart home system |
KR102352870B1 (en) * | 2015-03-09 | 2022-01-18 | 삼성전자 주식회사 | Method and apparatus for controlling a electronic device in a communication system |
TWI554022B (en) * | 2015-09-23 | 2016-10-11 | 金寶電子工業股份有限公司 | Method for setting identification code of smart motor and multi-axis control apparatus using the same |
WO2017073052A1 (en) * | 2015-10-30 | 2017-05-04 | 川崎重工業株式会社 | Monitoring device for robot system |
JP2017135979A (en) * | 2017-03-06 | 2017-08-03 | 貴司 徳田 | Motor Module System |
-
2018
- 2018-10-26 CN CN201880078349.3A patent/CN111434075A/en active Pending
- 2018-10-26 WO PCT/JP2018/039925 patent/WO2019111582A1/en active Application Filing
- 2018-10-26 JP JP2019558067A patent/JP6973504B2/en active Active
-
2021
- 2021-11-02 JP JP2021179769A patent/JP2022020739A/en active Pending
Also Published As
Publication number | Publication date |
---|---|
WO2019111582A1 (en) | 2019-06-13 |
CN111434075A (en) | 2020-07-17 |
JPWO2019111582A1 (en) | 2020-12-10 |
JP2022020739A (en) | 2022-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101818570B1 (en) | Method of controlling an automated work cell | |
KR101839772B1 (en) | Method of controlling an automated work cell | |
TWI554022B (en) | Method for setting identification code of smart motor and multi-axis control apparatus using the same | |
JP6720958B2 (en) | Driving device, driving method, and program | |
US10274175B1 (en) | Systems and methods for controlling the position of a moving light fixture | |
US20220266449A1 (en) | Control device, control system, robot system and controlling method | |
CN105818160A (en) | Universal robot joints and robot arm | |
JP2003025269A (en) | Offset rotational joint unit with rotation correction mechanism | |
JP6973504B2 (en) | Device ID setting device and setting method | |
CN106020240A (en) | Holder control system of autonomous homing calibration | |
JP2013142699A (en) | Sensor device | |
JP2016194831A (en) | Controller | |
US20010006334A1 (en) | Control apparatus for legged mobile robot | |
JP5488549B2 (en) | Robot control system and robot control method | |
JP2004088208A (en) | Data transmission system and method therefor | |
JP2022526550A (en) | Expandable safety system for robot systems | |
JP4472165B2 (en) | Mobile robot controller | |
CN110831725A (en) | Robot control device, control method, and control program | |
JP2008525870A (en) | Module for simulating detector signals | |
US11787068B2 (en) | Robot joint structure | |
CN111098319A (en) | Industrial grade arm allies oneself with control system more | |
CN211615626U (en) | Industrial grade arm allies oneself with control system more | |
JP2001287181A (en) | Actuator driving control system, and driving controller for actuator | |
KR20090002398A (en) | Device of pulse command generation for position reference and sensor data acquistion of human riding robot's joint actuator and its control device and method thereof | |
JP6605638B2 (en) | Control processor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20201222 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20211005 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211018 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6973504 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |