JP7153584B2 - Tilt correction system, component insertion system, tilt correction method, and component insertion method - Google Patents

Tilt correction system, component insertion system, tilt correction method, and component insertion method Download PDF

Info

Publication number
JP7153584B2
JP7153584B2 JP2019029869A JP2019029869A JP7153584B2 JP 7153584 B2 JP7153584 B2 JP 7153584B2 JP 2019029869 A JP2019029869 A JP 2019029869A JP 2019029869 A JP2019029869 A JP 2019029869A JP 7153584 B2 JP7153584 B2 JP 7153584B2
Authority
JP
Japan
Prior art keywords
holding
component
holding member
stress
tilt correction
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
Application number
JP2019029869A
Other languages
Japanese (ja)
Other versions
JP2020131386A (en
Inventor
隆博 西田
洋 河本
恵多 河野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Heavy Industries Ltd
Original Assignee
Mitsubishi Heavy Industries Ltd
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 Mitsubishi Heavy Industries Ltd filed Critical Mitsubishi Heavy Industries Ltd
Priority to JP2019029869A priority Critical patent/JP7153584B2/en
Priority to PCT/JP2019/047601 priority patent/WO2020170549A1/en
Publication of JP2020131386A publication Critical patent/JP2020131386A/en
Application granted granted Critical
Publication of JP7153584B2 publication Critical patent/JP7153584B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/08Gripping heads and other end effectors having finger members

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)

Description

本発明は、傾斜補正システム、部品挿入システム、傾斜補正方法及び部品挿入方法に関する。 The present invention relates to a tilt correction system, a component insertion system, a tilt correction method, and a component insertion method.

部品をハウジングの被挿入部に挿入する方法として、部品を被挿入部に向けて載置してから、部品の姿勢を変更させるという方法が知られている(特許文献1参照)。 As a method of inserting a component into the inserted portion of the housing, there is known a method of placing the component facing the inserted portion and then changing the orientation of the component (see Patent Document 1).

特開2011-194499号公報JP 2011-194499 A

特許文献1に記載の方法では、部品が傾斜された状態で被挿入部に向けて載置してから、部品の傾斜状態を変更させる場合があるので、部品が正しい姿勢で被挿入部に挿入されなかったり、部品の載置の仕方次第では被挿入部に挿入することが困難な状態に至ったりする可能性が高いという問題があった。 In the method described in Patent Literature 1, there are cases where the tilted state of the component is changed after the component is placed in an inclined state toward the insertion target, so that the component must be inserted into the insertion target in the correct posture. Otherwise, there is a high possibility that it will be difficult to insert the part into the insertion part depending on how the part is placed.

本発明は、上記に鑑みてなされたものであって、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる傾斜補正システム、部品挿入システム、傾斜補正方法及び部品挿入方法を提供することを目的とする。 The present invention has been made in view of the above, and is a tilt correction system, a component insertion system, a tilt correction method, and a component insertion method that can improve the possibility of inserting a component into an inserted portion in a correct posture. intended to provide

上述した課題を解決し、目的を達成するために、傾斜補正システムは、部品を保持し、前記部品の保持によって生じる応力を検出する保持部を少なくとも3つ有する保持部材と、前記保持部材において前記保持部を駆動して前記部品を保持させる保持部駆動装置と、前記保持部材の傾斜角を変更する保持部材傾斜装置と、前記保持部材、前記保持部駆動装置及び前記保持部材傾斜装置を制御する制御装置と、を備え、前記制御装置は、前記保持部が検出した前記応力を取得し、取得した前記応力に基づいて、前記保持部で保持されている前記部品の傾斜状態を算出し、算出した前記傾斜状態に基づいて、前記保持部材傾斜装置に前記傾斜状態を解消させることを特徴とする。 In order to solve the above-described problems and achieve the object, a tilt correction system includes: a holding member that holds a part and has at least three holding portions that detect stress generated by holding the part; A holding portion driving device for driving a holding portion to hold the component, a holding member tilting device for changing an inclination angle of the holding member, the holding member, the holding portion driving device, and the holding member tilting device are controlled. a control device, wherein the control device acquires the stress detected by the holding unit, calculates the tilt state of the part held by the holding unit based on the acquired stress, and calculates The holding member tilting device cancels the tilted state based on the tilted state.

この構成によれば、保持部で保持されている部品の傾斜状態を、部品を保持したまま、解消させることができるので、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる。 According to this configuration, the tilted state of the component held by the holding portion can be eliminated while the component is held, so that the possibility of inserting the component into the inserted portion in the correct posture is improved. can be done.

この構成において、制御装置は、一定時間ごとに、前記応力の取得、前記傾斜状態の算出及び前記傾斜状態の解消を実行することが好ましい。この構成によれば、保持部で保持されている部品が搬送中に再び傾斜状態となった場合でも、再び傾斜状態を解消することができるので、部品を正しい姿勢で被挿入部に挿入される可能性をより向上させることができる。 In this configuration, the control device preferably acquires the stress, calculates the tilted state, and cancels the tilted state at regular intervals. According to this configuration, even if the component held by the holding portion is again tilted during transportation, the tilted state can be canceled again, so that the component can be inserted into the inserted portion in the correct posture. Possibilities can be improved.

これらの構成において、前記保持部は、前記保持部材において相対的に径方向に移動可能に設けられており、相対的に径方向の内側に移動することで前記部品の外周部で外側から挟み込むように保持可能であり、相対的に径方向の外側に移動することで前記部品の内側で内側から保持可能であることが好ましい。この構成によれば、部品の形状等に応じて、適宜保持の仕方を変更することができるので、部品の形状等に依らず、部品を正しい姿勢で被挿入部に挿入される可能性をより向上させることができる。さらに、前記保持部は、前記部品に設けられた開口の内側で、前記部品を保持することがより好ましい。この構成によれば、部品の保持によって生じる応力をより正確に検出することができるので、より高い精度で傾斜状態を解消することができ、部品を正しい姿勢で被挿入部に挿入される可能性をより向上させることができる。 In these configurations, the holding portion is provided so as to be relatively movable in the radial direction in the holding member, and moves relatively inward in the radial direction so that the outer peripheral portion of the component sandwiches the holding portion from the outside. It is preferably holdable from the inside on the inside of said component by moving relatively radially outwardly. According to this configuration, the holding method can be appropriately changed according to the shape of the part, etc., so that the possibility of inserting the part into the inserted portion in the correct posture is increased regardless of the shape of the part. can be improved. Furthermore, it is more preferable that the holding portion holds the component inside an opening provided in the component. According to this configuration, the stress generated by holding the part can be detected more accurately, so the tilted state can be eliminated with higher accuracy, and the part can be inserted into the insertion part in the correct posture. can be further improved.

これらの構成において、制御装置は、隣接して設けられた前記保持部が検出した前記応力に基づいて、隣接して設けられた前記保持部の間の状態を見積もることが好ましい。この構成によれば、保持部で保持されている部品の傾斜状態をより高い精度で算出することができるので、より高い精度で傾斜状態を解消することができ、部品を正しい姿勢で被挿入部に挿入される可能性をより向上させることができる。 In these configurations, it is preferable that the control device estimates the state between the adjacent holding portions based on the stress detected by the adjacent holding portions. According to this configuration, the tilted state of the component held by the holding portion can be calculated with higher accuracy, so that the tilted state can be canceled with higher accuracy, and the component can be placed in the inserted portion in the correct posture. can be more likely to be inserted into

上述した課題を解決し、目的を達成するために、部品挿入システムは、部品をハウジングの被挿入部に挿入する部品挿入システムであって、上記したいずれかの傾斜補正システムと、前記ハウジングの前記被挿入部を検出する被挿入部検出装置と、前記保持部材を移動させる保持部材移動装置と、を備え、前記制御装置は、さらに、前記被挿入部検出装置及び前記保持部材移動装置を制御し、前記被挿入部検出装置に前記被挿入部を検出させて、検出した前記被挿入部に基づいて前記保持部に保持させる前記部品を決定し、前記保持部材移動装置に前記保持部材を移動させて、先に決定した前記部品を前記保持部に保持させ、前記保持部に保持させた前記部品を前記被挿入部まで搬送して前記被挿入部に挿入する、ことを特徴とする。この構成によれば、本発明に係る傾斜補正システムと同様に、保持部で保持されている部品の傾斜状態を、部品を保持したまま、解消させることができるので、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる。 In order to solve the above-described problems and achieve the object, a component insertion system is a component insertion system for inserting a component into an inserted portion of a housing, comprising any one of the tilt correction systems described above and the An inserted portion detecting device that detects the inserted portion and a holding member moving device that moves the holding member are provided, and the control device further controls the inserted portion detecting device and the holding member moving device. causing the inserted portion detecting device to detect the inserted portion, determining the component to be held by the holding portion based on the detected inserted portion, and causing the holding member moving device to move the holding member; and holding the previously determined component in the holding portion, conveying the component held by the holding portion to the insertion target portion, and inserting the component into the insertion target portion. According to this configuration, as in the tilt correction system according to the present invention, the tilted state of the part held by the holding portion can be eliminated while the part is held, so that the part can be inserted in the correct posture. The possibility of being inserted into the part can be improved.

上述した課題を解決し、目的を達成するために、傾斜補正方法は、部品の保持によって保持部材が有する保持部に生じる応力を検出して取得する応力取得ステップと、取得した前記応力に基づいて、前記保持部で保持されている前記部品の傾斜状態を算出する傾斜算出ステップと、算出した前記傾斜状態に基づいて、前記保持部材の傾斜角を変更して前記傾斜状態を解消させる傾斜状態解消ステップと、を有することを特徴とする。この構成によれば、本発明に係る傾斜補正システムと同様に、保持部で保持されている部品の傾斜状態を、部品を保持したまま、解消させることができるので、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる。 In order to solve the above-described problems and achieve the object, the tilt correction method includes a stress acquisition step of detecting and acquiring the stress generated in the holding portion of the holding member by holding the component, and based on the acquired stress, a tilt calculation step of calculating a tilt state of the part held by the holding portion; and a tilt state cancellation step of changing the tilt angle of the holding member based on the calculated tilt state to eliminate the tilt state. and a step. According to this configuration, as in the tilt correction system according to the present invention, the tilted state of the part held by the holding portion can be eliminated while the part is held, so that the part can be inserted in the correct posture. The possibility of being inserted into the part can be improved.

上述した課題を解決し、目的を達成するために、部品挿入方法は、部品をハウジングの被挿入部に挿入する部品挿入方法であって、前記ハウジングの前記被挿入部を検出する被挿入部検出ステップと、検出した前記被挿入部に基づいて決定した前記部品を前記保持部で保持する保持ステップと、上記した傾斜補正方法に基づく傾斜補正ステップと、前記傾斜補正ステップによって傾斜状態を解消した状態で、前記保持部に保持させた前記部品を前記被挿入部まで搬送して前記被挿入部に挿入する挿入ステップと、を有することを特徴とする。この構成によれば、本発明に係る傾斜補正システムと同様に、保持部で保持されている部品の傾斜状態を、部品を保持したまま、解消させることができるので、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる。 In order to solve the above-described problems and achieve the object, a component insertion method is a component insertion method for inserting a component into an insertion target portion of a housing, wherein insertion target detection detects the insertion target portion of the housing. a holding step of holding the component determined based on the detected inserted portion with the holding portion; a tilt correction step based on the tilt correction method; and a state in which the tilt state is eliminated by the tilt correction step. and an inserting step of conveying the component held by the holding portion to the insertion target portion and inserting the component into the insertion target portion. According to this configuration, as in the tilt correction system according to the present invention, the tilted state of the part held by the holding portion can be eliminated while the part is held, so that the part can be inserted in the correct posture. The possibility of being inserted into the part can be improved.

本発明によれば、部品を正しい姿勢で被挿入部に挿入される可能性を向上させることができる傾斜補正システム、部品挿入システム、傾斜補正方法及び部品挿入方法を提供することができる。 According to the present invention, it is possible to provide a tilt correction system, a component insertion system, a tilt correction method, and a component insertion method that can improve the possibility of inserting a component into an inserted portion in a correct posture.

図1は、本発明の実施形態に係る傾斜補正システムを含む部品挿入システムの構成図である。FIG. 1 is a configuration diagram of a component insertion system including a tilt correction system according to an embodiment of the present invention. 図2は、図1の保持部材の一例を示す概略図である。2 is a schematic diagram showing an example of the holding member of FIG. 1. FIG. 図3は、図1の保持部が検出した応力の一例を示すグラフである。FIG. 3 is a graph showing an example of stress detected by the holding unit of FIG. 1; 図4は、本発明の実施形態に係る傾斜補正方法を含む部品挿入方法を示すフローチャートである。FIG. 4 is a flow chart illustrating a component insertion method including a tilt correction method according to an embodiment of the present invention. 図5は、図4の応力取得ステップを説明する説明図である。FIG. 5 is an explanatory diagram for explaining the stress acquisition step in FIG. 図6は、図4の傾斜算出ステップを説明する説明図である。FIG. 6 is an explanatory diagram for explaining the tilt calculation step in FIG. 図7は、図4の傾斜算出ステップを説明する説明図である。FIG. 7 is an explanatory diagram for explaining the tilt calculation step in FIG. 図8は、図4の傾斜状態解消ステップを説明する説明図である。FIG. 8 is an explanatory diagram for explaining the tilted state elimination step in FIG.

以下に、本発明に係る実施形態を図面に基づいて詳細に説明する。なお、この実施形態によりこの発明が限定されるものではない。また、実施形態における構成要素には、当業者が置換可能かつ容易なもの、あるいは実質的に同一のものが含まれる。さらに、以下に記載した構成要素は適宜組み合わせることが可能である。 EMBODIMENT OF THE INVENTION Below, embodiment which concerns on this invention is described in detail based on drawing. In addition, this invention is not limited by this embodiment. In addition, components in the embodiments include those that can be easily replaced by those skilled in the art, or those that are substantially the same. Furthermore, the components described below can be combined as appropriate.

[実施形態]
図1は、本発明の実施形態に係る傾斜補正システム100を含む部品挿入システム1000の構成図である。傾斜補正システム100は、図1に示すように、保持部材10と、保持部駆動装置20と、保持部材傾斜装置30と、制御装置60と、を備える。傾斜補正システム100は、保持部材10の保持部11で保持されている部品1の傾斜状態を、部品1を保持したまま、解消させるシステムである。ここで、傾斜状態とは、部品1が、要求された姿勢状態に対して所定の閾値より大きな角度で傾斜している状態であることを言い、傾斜状態を解消するとは、傾斜状態にある部品1が、要求された姿勢状態に補正されることを言う。なお、傾斜状態等に関する具体的な例については、後述する。
[Embodiment]
FIG. 1 is a configuration diagram of a component insertion system 1000 including a tilt correction system 100 according to an embodiment of the invention. The tilt correction system 100 includes a holding member 10, a holding portion driving device 20, a holding member tilting device 30, and a control device 60, as shown in FIG. The tilt correction system 100 is a system that eliminates the tilted state of the part 1 held by the holding portion 11 of the holding member 10 while holding the part 1 . Here, the tilted state refers to a state in which the part 1 is tilted at an angle larger than a predetermined threshold with respect to the required attitude state, and canceling the tilted state means that the part in the tilted state 1 is said to be corrected to the requested attitude state. A specific example regarding the tilted state and the like will be described later.

また、部品挿入システム1000は、図1に示すように、傾斜補正システム100と、保持部材移動装置40と、被挿入部検出装置50と、を備える。部品挿入システム1000は、部品1をハウジング2の被挿入部2aに挿入するシステムである。 Further, the component insertion system 1000 includes a tilt correction system 100, a holding member moving device 40, and an inserted portion detection device 50, as shown in FIG. A component insertion system 1000 is a system for inserting a component 1 into an inserted portion 2 a of a housing 2 .

なお、本実施形態では、ハウジング2を水平方向であるXY平面に沿って、被挿入部2aを鉛直方向上方である+Z方向に向けて載置し、部品1を鉛直方向下方である-Z方向に向けて被挿入部2aに挿入する形態について説明する。これに鑑み、本実施形態では、保持部材10の保持部11で保持されている部品1の重心軸が鉛直方向であるZ軸方向と一致するまたは所定の閾値以下の角度でしか傾斜していない場合に、部品1が傾斜していない状態であるとし、保持部材10の保持部11で保持されている部品1の重心軸が鉛直方向に対して所定の閾値より大きな角度で傾斜している場合に、部品1が傾斜している状態である傾斜状態であるとして説明する。また、保持部材10の保持部11で保持されている部品1の重心軸と鉛直方向とが形成する角度を、部品1の傾斜状態を客観的に表示するパラメータである傾斜角とする。 In this embodiment, the housing 2 is placed along the XY plane, which is the horizontal direction, with the inserted portion 2a directed upward in the +Z direction, and the component 1 is placed in the −Z direction, which is downward in the vertical direction. A mode of inserting into the inserted portion 2a toward the will be described. In view of this, in the present embodiment, the center of gravity of the component 1 held by the holding portion 11 of the holding member 10 coincides with the vertical Z-axis direction, or is inclined only at an angle equal to or less than a predetermined threshold. , the part 1 is not tilted, and the center of gravity of the part 1 held by the holding portion 11 of the holding member 10 is tilted at an angle larger than a predetermined threshold with respect to the vertical direction. 1, it is assumed that the component 1 is in a tilted state. The angle formed by the center of gravity of the component 1 held by the holding portion 11 of the holding member 10 and the vertical direction is defined as the tilt angle, which is a parameter that objectively indicates the tilted state of the component 1 .

部品1及びハウジング2は、部品1の外側形状がハウジング2に穴状に形成された被挿入部2aの内側形状に嵌め合わせされるという条件を満たせば、どのような大きさ及び形状のものであってもよい。本実施形態では、部品1とハウジング2の被挿入部2aとの嵌め合わせにかかる余裕代が小さければ小さいほど、より顕著に本発明の効果を奏する形態となり、例えば、部品1としてハウジング2の被挿入部2aにインストールされるブッシュが採用されるような形態であることが、より顕著に本発明の効果を奏するという点で好ましい。また、部品1は、開口が設けられていることが好ましく、この場合、開口の内側1aで保持して、搬送及び挿入することが可能となる。 The component 1 and the housing 2 may be of any size and shape as long as the outer shape of the component 1 is fitted to the inner shape of the inserted portion 2a formed in the housing 2 in the shape of a hole. There may be. In this embodiment, the smaller the allowance for fitting the component 1 and the inserted portion 2a of the housing 2, the more remarkable the effect of the present invention. A configuration in which a bush installed in the insertion portion 2a is employed is preferable in that the effects of the present invention are more remarkably achieved. Moreover, it is preferable that the component 1 is provided with an opening. In this case, the component 1 can be held on the inside 1a of the opening to be transported and inserted.

図2は、図1の保持部材10の一例を示す概略図である。図2は、図1の保持部材を+Z方向から見た上面図であり、保持部材10の鉛直方向下側に向けて設けられている保持部11の位置を点線で示している。保持部材10は、部品1を保持するための保持部11を円周方向に等間隔に3つ有する。以下において、3つの保持部11を区別する必要がある場合には、それぞれ、保持部11-1、保持部11-2、保持部11-3と称する。 FIG. 2 is a schematic diagram showing an example of the holding member 10 of FIG. FIG. 2 is a top view of the holding member in FIG. 1 as seen from the +Z direction, and the position of the holding portion 11 provided downward in the vertical direction of the holding member 10 is indicated by a dotted line. The holding member 10 has three holding portions 11 for holding the component 1 at equal intervals in the circumferential direction. Hereinafter, when it is necessary to distinguish between the three holding portions 11, they are referred to as holding portion 11-1, holding portion 11-2, and holding portion 11-3, respectively.

保持部材10は、本実施形態では3つの保持部11を有しているが、本発明ではこれに限定されず、保持部材10において同一直線状に配されていない保持部11を少なくとも3つ有していればよく、例えば、4つ以上の保持部11を有していてもよい。また、保持部材10は、3つの保持部11を円周方向に等間隔に有しているが、本発明はこれに限定されない。なお、保持部材10は、複数の保持部11を円周方向に等間隔に有していることが好ましく、この場合、部品1が傾斜していない状態となるように、保持部11でより好適に保持することができるとともに、後述する応力のバランスをより好適に取得することができる。 Although the holding member 10 has three holding portions 11 in this embodiment, the present invention is not limited to this, and the holding member 10 may have at least three holding portions 11 that are not arranged in the same straight line. For example, four or more holding portions 11 may be provided. Moreover, although the holding member 10 has the three holding portions 11 at equal intervals in the circumferential direction, the present invention is not limited to this. In addition, it is preferable that the holding member 10 has a plurality of holding portions 11 at equal intervals in the circumferential direction. can be maintained, and the stress balance, which will be described later, can be obtained more favorably.

保持部11は、保持部駆動装置20により、保持部材10において相対的に径方向に移動可能に設けられている。保持部11は、部品1の外周部で外側から保持する場合、相対的に径方向の内側に移動して挟み込むように保持する。一方、保持部11は、部品1の開口の内側1aで内側から保持する場合、相対的に径方向の外側に移動して保持する。このように、保持部11は、部品1の形状等に応じて、適宜保持の仕方を変更することができる。なお、保持部11は、本実施形態では、部品1の開口の内側1aで内側から保持する場合として説明する。 The holding portion 11 is provided so as to be relatively movable in the radial direction in the holding member 10 by the holding portion driving device 20 . When the component 1 is held from the outside by the outer peripheral portion, the holding portion 11 holds the component 1 so as to move relatively inward in the radial direction and sandwich the component 1 . On the other hand, when the holding portion 11 holds the component 1 from the inner side 1a of the opening of the component 1, the holding portion 11 moves relatively outward in the radial direction to hold the component. In this manner, the holding portion 11 can appropriately change the holding method according to the shape of the component 1 or the like. In this embodiment, the holding portion 11 will be described as a case of holding the component 1 from the inner side 1a of the opening of the component 1 .

保持部11は、部品1の保持によって保持部11自身に生じる応力を検出する応力センサとしても機能する。保持部材10は、少なくとも同一直線状にない3つの保持部11を有するので、少なくとも同一直線状にない3つの応力センサを有している。このため、保持部材10は、保持部11により、部品1の保持によって生じる応力のXY平面における偏りを検出することができる。 The holding portion 11 also functions as a stress sensor that detects stress generated in the holding portion 11 itself by holding the component 1 . Since the holding member 10 has at least three non-collinear holding portions 11, it has at least three non-collinear stress sensors. Therefore, the holding member 10 can detect the bias in the XY plane of the stress generated by holding the component 1 by the holding portion 11 .

保持部材10は、保持部11が部品1の開口の内側1aで内側から保持する場合、具体的には、図2に示すように、保持部11-1が、径方向の外側へ向かって部品1に対して印加している応力P1を検出し、保持部11-2が、径方向の外側へ向かって部品1に対して印加している応力P2を検出し、保持部11-3が、径方向の外側へ向かって部品1に対して印加している応力P3を検出する。 When the holding member 10 holds the component 1 from the inner side 1a of the opening of the component 1, specifically, as shown in FIG. The stress P1 applied to the part 1 is detected, the holding part 11-2 detects the stress P2 applied to the part 1 toward the outside in the radial direction, and the holding part 11-3 A stress P3 applied to the component 1 toward the outside in the radial direction is detected.

図3は、図1の保持部11が検出した応力の一例を示すグラフである。図3の上段のグラフは、保持部11-1による応力P1の検出例であり、図3の中段のグラフは、保持部11-2による応力P2の検出例であり、図3の下段のグラフは、保持部11-3による応力P3の検出例である。図3の上段、中段、下段のいずれのグラフも、横軸は、保持部11の鉛直方向上側の基端部からの距離となっており、縦軸は、保持部11の鉛直方向下側の先端部からの応力の積算量となっている。 FIG. 3 is a graph showing an example of stress detected by the holding portion 11 of FIG. The upper graph in FIG. 3 is an example of the stress P1 detected by the holding portion 11-1, the middle graph in FIG. 3 is an example of the stress P2 detected by the holding portion 11-2, and the lower graph in FIG. is an example of detection of the stress P3 by the holding portion 11-3. In each of the upper, middle, and lower graphs of FIG. 3 , the horizontal axis represents the distance from the base end of the holding portion 11 on the upper side in the vertical direction, and the vertical axis represents the distance from the lower side of the holding portion 11 in the vertical direction. It is the integrated amount of stress from the tip.

保持部駆動装置20は、保持部材10と電気的に接続されて保持部材10の付近に設けられており、保持部材10において保持部11を駆動して、保持部11に部品1を保持させる装置である。保持部駆動装置20は、保持部材10において保持部11を相対的に径方向に移動させることで、保持部11が部品1を保持する保持状態と、保持部11が部品1の保持を解消した保持解消状態とを、切り替えることができる。保持部駆動装置20は、また、保持状態下にある場合、部品1の保持によって保持部11自身に生じる応力を保持部11に検出させて、検出した応力の情報を取得することができる。 The holding portion driving device 20 is electrically connected to the holding member 10 and provided near the holding member 10, and drives the holding portion 11 in the holding member 10 to cause the holding portion 11 to hold the component 1. is. The holding portion driving device 20 moves the holding portion 11 relative to the holding member 10 in the radial direction, thereby canceling the holding state in which the holding portion 11 holds the component 1 and the holding state in which the holding portion 11 holds the component 1. It is possible to switch between the holding cancellation state and the holding cancellation state. Further, when in the holding state, the holding section drive device 20 can cause the holding section 11 to detect the stress generated in the holding section 11 itself by holding the component 1, and acquire information on the detected stress.

保持部材傾斜装置30は、保持部材10の鉛直方向上側に取り付けられており、保持部材10の傾斜角を変更する装置である。保持部材傾斜装置30は、保持部材10の傾斜角を変更することに伴って、保持部11及び保持部11に保持された部品1の傾斜角を同時に変更することができる。保持部材傾斜装置30は、自動ゴニオステージが好適なものとして例示される。 The holding member tilting device 30 is attached to the upper side of the holding member 10 in the vertical direction, and is a device for changing the tilt angle of the holding member 10 . The holding member tilting device 30 can simultaneously change the tilt angles of the holding portion 11 and the component 1 held by the holding portion 11 as the tilt angle of the holding member 10 is changed. The holding member tilting device 30 is exemplified as a suitable automatic goniometer stage.

保持部材移動装置40は、保持部材傾斜装置30に取り付けられており、保持部材傾斜装置30とともに保持部材10を、3次元的に移動させる装置である。保持部材移動装置40は、保持部材傾斜装置30によって制御された保持部材10の立体角を維持した状態で、保持部材10を、水平方向であるX軸方向またはY軸方向に沿って移動させたり、鉛直方向であるZ軸方向に沿って移動させたりすることができる。また、保持部材移動装置40は、常に、保持部材10の3次元的な位置の情報を取得することができる。保持部材移動装置40は、ロボットアーム及びクレーンのアーム等が好適なものとして例示される。 The holding member moving device 40 is attached to the holding member tilting device 30 and is a device that three-dimensionally moves the holding member 10 together with the holding member tilting device 30 . The holding member moving device 40 moves the holding member 10 along the horizontal direction of the X-axis or the Y-axis while maintaining the solid angle of the holding member 10 controlled by the holding member tilting device 30. , along the Z-axis direction, which is the vertical direction. Further, the holding member moving device 40 can always acquire information on the three-dimensional position of the holding member 10 . The holding member moving device 40 is preferably exemplified by a robot arm, a crane arm, and the like.

被挿入部検出装置50は、保持部材10に対して水平方向に隣接した位置に、鉛直方向下方に向けて取り付けられており、ハウジング2の被挿入部2aを検出する装置である。被挿入部検出装置50は、保持部材移動装置40により、保持部材10、保持部駆動装置20及び保持部材傾斜装置30と共に移動する。被挿入部検出装置50は、光学カメラ及びレーザーカメラ等の撮像装置が好適なものとして例示され、このような撮像装置である場合、ハウジング2を鉛直方向上側から撮像し、撮像した画像を解析することで、被挿入部2aの位置、大きさ及び形状等を検出することができる。 The inserted portion detection device 50 is mounted vertically downward at a position adjacent to the holding member 10 in the horizontal direction, and detects the inserted portion 2 a of the housing 2 . The inserted portion detecting device 50 is moved together with the holding member 10 , the holding portion driving device 20 and the holding member tilting device 30 by the holding member moving device 40 . The inserted portion detection device 50 is preferably exemplified by an imaging device such as an optical camera or a laser camera. In the case of such an imaging device, the housing 2 is imaged from above in the vertical direction, and the imaged image is analyzed. Thus, the position, size, shape, etc. of the inserted portion 2a can be detected.

傾斜補正システム100及び部品挿入システム1000は、傾斜補正及び部品挿入に関する情報の入力を受け付ける入力装置70をさらに備えていてもよい。また、傾斜補正システム100及び部品挿入システム1000は、傾斜補正及び部品挿入に関する情報を出力する出力装置80をさらに備えていてもよい。 The tilt correction system 100 and component insertion system 1000 may further include an input device 70 that receives input of information regarding tilt correction and component insertion. Further, the tilt correction system 100 and component insertion system 1000 may further include an output device 80 that outputs information regarding tilt correction and component insertion.

入力装置70は、高機能携帯電話(いわゆる、スマートフォン)を含む携帯電話機、タブレット端末、ノート型またはデスクトップ型のPC(Personal Computer)、携帯情報端末であるPDA(Personal Digital Assistant)、及び、眼鏡型や時計型のウェアラブルデバイス(Wearable Device)等に例示される情報処理端末である。 The input device 70 includes a mobile phone including a high-performance mobile phone (so-called smart phone), a tablet terminal, a notebook or desktop PC (Personal Computer), a PDA (Personal Digital Assistant) which is a mobile information terminal, and a glasses type. and a watch-type wearable device.

入力装置70は、制御装置60が実施形態に係る傾斜補正方法及び部品挿入方法に関する各種電算処理を実行する際に必要となる各種情報を入力するための機能、例えば、制御装置60から送信される各種情報の入力を受け付けるための入力画面等を入力装置70の表示部に表示する機能、及び、入力を受け付けた各種情報を制御装置60に送信する機能を有する。入力装置70は、これらの様々な機能を、制御装置60を利用するためのソフトウェアまたはアプリケーションを実行したり、制御装置60を利用するためのインターネットブラウザ機能を実行したりすることで、実現する。 The input device 70 has a function of inputting various information necessary when the control device 60 executes various kinds of computational processing related to the tilt correction method and the component insertion method according to the embodiment. It has a function of displaying an input screen or the like for receiving input of various information on the display section of the input device 70 and a function of transmitting the received various information to the control device 60 . The input device 70 implements these various functions by executing software or applications for using the control device 60 or by executing an Internet browser function for using the control device 60.

出力装置80は、受信した情報に基づいて、文字、画像、動画等により表示する。出力装置80は、制御装置60が実行する実施形態に係る傾斜補正方法及び部品挿入方法に関する各種電算処理の結果として得られる出力情報を出力するための機能、例えば、制御装置60から出力された出力情報を受信する機能、及び、出力情報に基づく出力画面等を出力装置80の表示部に表示する機能を有する。出力装置80は、これらの様々な機能を、制御装置60を利用するためのソフトウェアまたはアプリケーションを実行したり、制御装置60を利用するためのインターネットブラウザ機能を実行したりすることで、実現する。 The output device 80 displays characters, images, moving images, etc. based on the received information. The output device 80 has a function for outputting output information obtained as a result of various computational processing relating to the tilt correction method and the component insertion method according to the embodiment executed by the control device 60, for example, the output output from the control device 60. It has a function of receiving information and a function of displaying an output screen or the like based on the output information on the display section of the output device 80 . The output device 80 implements these various functions by executing software or applications for using the control device 60 or by executing an Internet browser function for using the control device 60.

なお、傾斜補正システム100及び部品挿入システム1000は、本実施形態では、入力装置70と出力装置80とを別々に設けたが、本発明はこれに限定されず、入力装置70と出力装置80とが一体化された形態であってもよい。この場合、例えば、入力装置70の表示部が出力装置80として機能する。 In addition, although the tilt correction system 100 and the component insertion system 1000 are separately provided with the input device 70 and the output device 80 in the present embodiment, the present invention is not limited to this. may be integrated. In this case, for example, the display section of the input device 70 functions as the output device 80 .

制御装置60は、各装置、すなわち、保持部駆動装置20、保持部材傾斜装置30、保持部材移動装置40、被挿入部検出装置50、入力装置70及び出力装置80と電気的に接続されており、これらの各装置の動作を制御する。また、制御装置60は、保持部駆動装置20を介して、保持部材10を制御する。 The control device 60 is electrically connected to each device, that is, the holding portion driving device 20, the holding member tilting device 30, the holding member moving device 40, the inserted portion detection device 50, the input device 70, and the output device 80. , which controls the operation of each of these devices. The control device 60 also controls the holding member 10 via the holding portion drive device 20 .

制御装置60は、傾斜補正システム100及び部品挿入システム1000を制御するコンピュータシステムを含む情報処理装置である。制御装置60は、図1に示すように、処理部61と、記憶部62と、情報通信インターフェイス63と、を有する。 The control device 60 is an information processing device including a computer system that controls the tilt correction system 100 and the component insertion system 1000 . The control device 60 has a processing unit 61, a storage unit 62, and an information communication interface 63, as shown in FIG.

処理部61は、コントローラ(controller)であり、例えば、CPU(Central Processing Unit)やMPU(Micro Processing Unit)等によって、制御装置60内部の記憶装置である記憶部62に記憶されている各種プログラム(傾斜補正プログラムまたは部品挿入プログラムの一例に相当)がRAM(Random Access Memory)を作業領域として実行されることにより実現される。また、処理部61は、例えば、コントローラであり、ASIC(Application Specific Integrated Circuit)やFPGA(Field Programmable Gate Array)等の集積回路により実現される。処理部61は、各装置からの情報の入力を受け付けたり、制御装置60と電気的に接続されている出力装置80に傾斜補正システム100及び部品挿入システム1000に関する各種パラメータ、計測結果、及び算出結果等の情報の出力を行ったりする情報通信インターフェイス63が接続されている。 The processing unit 61 is a controller, and for example, various programs ( (corresponding to an example of a tilt correction program or a component insertion program) is executed using a RAM (Random Access Memory) as a work area. Also, the processing unit 61 is, for example, a controller, and is implemented by an integrated circuit such as an ASIC (Application Specific Integrated Circuit) or an FPGA (Field Programmable Gate Array). The processing unit 61 receives input of information from each device, and outputs various parameters, measurement results, and calculation results related to the tilt correction system 100 and the component insertion system 1000 to the output device 80 electrically connected to the control device 60. An information communication interface 63 for outputting information such as is connected.

処理部61は、図1に示すように、記憶部62及び情報通信インターフェイス63と、互いに情報通信可能に電気的に接続されており、これらの各構成要素をそれぞれ制御する制御部として機能する。すなわち、処理部61は、記憶部62とともに、制御部として機能して、本発明の実施形態に係る傾斜補正方法を傾斜補正システム100に実行させ、部品挿入方法を部品挿入システム1000に実行させるものである。 As shown in FIG. 1, the processing unit 61 is electrically connected to the storage unit 62 and the information communication interface 63 so as to be able to communicate information with each other, and functions as a control unit that controls these components. That is, the processing unit 61 functions as a control unit together with the storage unit 62 to cause the tilt correction system 100 to execute the tilt correction method according to the embodiment of the present invention and to cause the component insertion system 1000 to execute the component insertion method. is.

処理部61は、図1に示すように、保持動作制御部65と、応力取得部66と、傾斜算出部67と、傾斜状態解消部68と、挿入動作制御部69と、を有する。処理部61に含まれる各部、すなわち、保持動作制御部65、応力取得部66、傾斜算出部67、傾斜状態解消部68及び挿入動作制御部69は、いずれも、処理部61が傾斜補正プログラムまたは部品挿入プログラムを実行することにより、実現される機能部である。なお、処理部61に含まれる各部の具体的な機能は、実施形態に係る傾斜補正方法及び部品挿入方法の詳細な説明と併せて、説明する。 The processing unit 61 includes a holding operation control unit 65, a stress acquisition unit 66, an inclination calculation unit 67, an inclination state elimination unit 68, and an insertion operation control unit 69, as shown in FIG. Each unit included in the processing unit 61, that is, the holding operation control unit 65, the stress acquisition unit 66, the tilt calculation unit 67, the tilt state elimination unit 68, and the insertion operation control unit 69, is configured by the processing unit 61 as the tilt correction program or the It is a functional unit realized by executing a component insertion program. The specific functions of each unit included in the processing unit 61 will be described together with detailed descriptions of the tilt correction method and the component insertion method according to the embodiment.

記憶部62は、例えば、ROM(Read Only Memory)、RAM(Random Access Memory)、フラッシュメモリ(Flash Memory)等の半導体メモリ素子、または、ハードディスク、光ディスク等の記憶装置によって実現される。記憶部62は、傾斜補正システム100及び部品挿入システム1000の各装置を制御するための制御信号の生成処理に必要な各種出力処理情報、及び、傾斜補正システム100及び部品挿入システム1000の各装置から得られる受信信号の解析処理に必要な各種入力処理情報を記憶する。また、記憶部62は、傾斜補正システム100及び部品挿入システム1000の各装置から得られる受信信号を解析して得られる各種入力情報を、随時記憶する。 The storage unit 62 is realized by, for example, a semiconductor memory device such as a ROM (Read Only Memory), a RAM (Random Access Memory), a flash memory, or a storage device such as a hard disk or an optical disk. The storage unit 62 stores various output processing information necessary for generating control signals for controlling each device of the tilt correction system 100 and the component insertion system 1000, and information from each device of the tilt correction system 100 and the component insertion system 1000. It stores various input processing information required for analysis processing of the received signal obtained. Further, the storage unit 62 stores various input information obtained by analyzing received signals obtained from each device of the tilt correction system 100 and the component insertion system 1000 at any time.

情報通信インターフェイス63は、処理部61と、制御装置60と電気的に接続されている各装置とを、互いに情報通信可能に接続している。情報通信インターフェイス63は、保持部駆動装置20が取得した、部品1の保持によって保持部11自身に生じる応力の情報を、保持部駆動装置20から受信して処理部61に送信する。また、情報通信インターフェイス63は、保持部材傾斜装置30が取得した保持部材10の傾斜角の情報を保持部材傾斜装置30から受信して処理部61に送信する。また、情報通信インターフェイス63は、保持部材移動装置40が取得した保持部材10の3次元的な位置の情報を保持部材移動装置40から受信して処理部61に送信する。また、情報通信インターフェイス63は、被挿入部検出装置50が取得したハウジング2の被挿入部2aの位置、大きさ及び形状等の情報を被挿入部検出装置50から受信して処理部61に送信する。また、情報通信インターフェイス63は、入力装置70から入力を受け付けた各種情報を入力装置70から受信して処理部61に送信する。 The information communication interface 63 connects the processing unit 61 and each device electrically connected to the control device 60 so that they can communicate information with each other. The information communication interface 63 receives, from the holding portion driving device 20 , information on the stress generated in the holding portion 11 itself by holding the component 1 , which is acquired by the holding portion driving device 20 , and transmits the information to the processing portion 61 . The information communication interface 63 also receives information about the tilt angle of the holding member 10 acquired by the holding member tilting device 30 from the holding member tilting device 30 and transmits the information to the processing unit 61 . The information communication interface 63 also receives information on the three-dimensional position of the holding member 10 acquired by the holding member moving device 40 from the holding member moving device 40 and transmits the information to the processing unit 61 . Further, the information communication interface 63 receives information such as the position, size and shape of the inserted portion 2a of the housing 2 acquired by the inserted portion detecting device 50 from the inserted portion detecting device 50 and transmits the information to the processing unit 61. do. Further, the information communication interface 63 receives various types of information input from the input device 70 and transmits the received information to the processing unit 61 .

情報通信インターフェイス63は、処理部61で生成される各情報、例えば、各装置を制御するための制御信号を処理部61から受信し、それぞれ、各装置に向けて送信する。また、情報通信インターフェイス63は、処理部61で生成される実施形態に係る傾斜補正方法及び部品挿入方法に関する各種電算処理の結果として得られる出力情報を処理部61から受信し、出力装置80に向けて送信する。 The information communication interface 63 receives each information generated by the processing unit 61, for example, a control signal for controlling each device from the processing unit 61, and transmits the information to each device. Further, the information communication interface 63 receives from the processing unit 61 output information obtained as a result of various computational processing related to the tilt correction method and the component insertion method according to the embodiment generated by the processing unit 61, and sends the output information to the output device 80. to send.

実施形態に係る傾斜補正システム100及び部品挿入システム1000の作用について以下に説明する。図4は、本発明の実施形態に係る傾斜補正方法を含む部品挿入方法を示すフローチャートである。傾斜補正システム100によって実行される傾斜補正方法と、部品挿入システム1000によって実行される部品挿入方法とについて、傾斜補正システム100及び部品挿入システム1000の制御装置60の処理部61における各部の詳細な機能と併せて、以下に説明する。 The operation of the tilt correction system 100 and the component insertion system 1000 according to the embodiment will be described below. FIG. 4 is a flow chart illustrating a component insertion method including a tilt correction method according to an embodiment of the present invention. Regarding the tilt correction method executed by the tilt correction system 100 and the component insertion method executed by the component insertion system 1000, detailed functions of each unit in the processing unit 61 of the controller 60 of the tilt correction system 100 and the component insertion system 1000. together with the following description.

本発明の実施形態に係る部品挿入方法は、部品1をハウジング2の被挿入部2aに挿入する方法であり、図4に示すように、被挿入部検出ステップS11と、保持ステップS12と、本発明の実施形態に係る傾斜補正方法に基づく傾斜補正ステップS13と、挿入ステップS14と、を有する。 A component inserting method according to an embodiment of the present invention is a method for inserting a component 1 into an inserted portion 2a of a housing 2. As shown in FIG. It has a tilt correction step S13 based on the tilt correction method according to the embodiment of the invention, and an insertion step S14.

被挿入部検出ステップS11は、保持動作制御部65が、ハウジング2の被挿入部2aを検出するステップである。被挿入部検出ステップS11では、具体的には、保持動作制御部65が、被挿入部検出装置50を制御して、被挿入部検出装置50にハウジング2の被挿入部2aを検出させて、部品1を挿入する被挿入部2aの位置、大きさ及び形状等の情報を取得する。 The insertion portion detection step S<b>11 is a step in which the holding operation control portion 65 detects the insertion portion 2 a of the housing 2 . Specifically, in the inserted portion detecting step S11, the holding operation control unit 65 controls the inserted portion detecting device 50 to detect the inserted portion 2a of the housing 2, Information such as the position, size and shape of the inserted portion 2a into which the component 1 is inserted is acquired.

保持ステップS12は、保持動作制御部65が、被挿入部検出ステップS11で検出した被挿入部2aに基づいて決定した部品1を保持部11で保持するステップである。保持ステップS12では、具体的には、保持動作制御部65が、被挿入部検出装置50により検出した被挿入部2aの位置、大きさ及び形状等の情報に基づいて、被挿入部2aに嵌め合わせされる部品1の大きさ及び形状等の仕様を決定する。保持ステップS12では、保持動作制御部65が、次に、保持部材移動装置40を制御して、先に決定した大きさ及び形状等の仕様の部品1の供給部へ保持部材10を移動させる。保持ステップS12では、保持動作制御部65が、その次に、保持部駆動装置20を制御して、当該仕様の部品1を保持部11に保持させる。 The holding step S12 is a step in which the holding operation control section 65 holds the part 1 determined based on the inserted portion 2a detected in the inserted portion detection step S11 by the holding portion 11. FIG. Specifically, in the holding step S12, the holding operation control unit 65 fits the inserted portion 2a based on information such as the position, size and shape of the inserted portion 2a detected by the inserted portion detecting device 50. Specifications such as the size and shape of the parts 1 to be combined are determined. In the holding step S12, the holding operation control section 65 next controls the holding member moving device 40 to move the holding member 10 to the supply section for the component 1 having the previously determined specifications such as size and shape. In the holding step S<b>12 , the holding operation control section 65 then controls the holding section driving device 20 to cause the holding section 11 to hold the component 1 having the specification.

本発明の実施形態に係る傾斜補正方法は、保持部材10の保持部11で保持されている部品1の傾斜状態を、部品1を保持したまま、解消させる方法である。傾斜補正ステップS13は、保持部材10の保持部11で保持されている部品1の傾斜状態を、部品1を保持したまま、解消させるステップであり、図4に示すように、応力取得ステップS21と、傾斜算出ステップS22と、傾斜有無判定ステップS23と、傾斜状態解消ステップS24と、を有する。 The tilt correction method according to the embodiment of the present invention is a method for eliminating the tilted state of the part 1 held by the holding portion 11 of the holding member 10 while the part 1 is held. The tilt correcting step S13 is a step of resolving the tilted state of the part 1 held by the holding portion 11 of the holding member 10 while holding the part 1. As shown in FIG. , a tilt calculation step S22, a tilt presence/absence determination step S23, and a tilt state elimination step S24.

応力取得ステップS21は、応力取得部66が、部品1の保持によって保持部材10が有する保持部11に生じる応力を検出して取得するステップである。応力取得ステップS21では、具体的には、応力取得部66が、保持部駆動装置20を制御して、保持部駆動装置20を介して、部品1の保持によって保持部11自身に生じる応力を保持部11に検出させて、検出した応力の情報を取得する。応力取得ステップS21では、例えば、応力取得部66が、図3に示す応力P1,P2,P3のグラフを取得することができる。 The stress acquisition step S<b>21 is a step in which the stress acquisition unit 66 detects and acquires the stress generated in the holding part 11 of the holding member 10 due to the holding of the component 1 . Specifically, in the stress acquisition step S21, the stress acquisition unit 66 controls the holding unit driving device 20 to hold the stress generated in the holding unit 11 itself by holding the component 1 via the holding unit driving unit 20. The part 11 is made to detect and information on the detected stress is obtained. In the stress acquisition step S21, for example, the stress acquisition unit 66 can acquire the graphs of stresses P1, P2, and P3 shown in FIG.

図5は、図4の応力取得ステップS21を説明する説明図である。図5において、箇所1-1は、保持部11-1によって支持されている部品1における箇所であり、箇所1-2は、保持部11-2によって支持されている部品1における箇所であり、箇所1-3は、保持部11-3によって支持されている部品1における箇所である。図5において、グラフ1p及びグラフ1qは、いずれも、応力P1,P2,P3を合わせて示すことで、応力P1,P2,P3のバランスを示すグラフであり、応力P1の相対的な大きさは、各グラフにおいて原点から箇所1-1に向かう方向の長さで示され、応力P2の相対的な大きさは、各グラフにおいて原点から箇所1-2に向かう方向の長さで示され、応力P3の相対的な大きさは、各グラフにおいて原点から箇所1-3に向かう方向の長さで示されている。 FIG. 5 is an explanatory diagram for explaining the stress acquisition step S21 of FIG. In FIG. 5, a point 1-1 is a point on the part 1 supported by the holding part 11-1, a point 1-2 is a part on the part 1 supported by the holding part 11-2, A point 1-3 is a point on the component 1 supported by the holding portion 11-3. In FIG. 5, graphs 1p and 1q are graphs showing the balance of the stresses P1, P2, and P3 by showing the stresses P1, P2, and P3 together, and the relative magnitude of the stress P1 is , is indicated by the length in the direction from the origin to the point 1-1 in each graph, and the relative magnitude of the stress P2 is indicated by the length in the direction from the origin to the point 1-2 in each graph, and the stress The relative size of P3 is indicated by the length in the direction from the origin to points 1-3 in each graph.

図5において実線で示されたグラフ1pは、応力P1,P2,P3が均衡を保持しており、保持部11で保持された部品1が傾斜していない状態であることを示している。一方、図5において破線で示されたグラフ1qは、応力P1,P2,P3が均衡を保持しておらず、保持部11で保持された部品1が傾斜状態であることを示している。より詳細には、グラフ1qは、応力P3が応力P1及び応力P2に比して大きくなっていることを示しており、保持部11で保持された部品1が、箇所1-3が箇所1-1及び箇所1-2に比して鉛直方向上側にずれた傾斜状態であることを示している。 A graph 1p indicated by a solid line in FIG. 5 indicates that the stresses P1, P2, and P3 are balanced and the part 1 held by the holding portion 11 is not tilted. On the other hand, a graph 1q indicated by a dashed line in FIG. 5 indicates that the stresses P1, P2, and P3 are not balanced and the part 1 held by the holding portion 11 is tilted. More specifically, graph 1q shows that stress P3 is greater than stress P1 and stress P2, and part 1 held by holding part 11 is placed at point 1-3 at point 1- 1 and the point 1-2, it is in an inclined state shifted upward in the vertical direction.

応力取得ステップS21では、例えば、応力取得部66が、図3に示す応力P1,P2,P3のグラフに基づいて、図5に示すグラフ1qを取得する。応力取得ステップS21では、具体的には、応力取得部66が、まず、図3に示す応力P1,P2,P3のグラフにおける応力分布が、部品1が傾斜していない状態と比較して、保持部11の鉛直方向上側の基端部側に偏っているか、保持部11の鉛直方向下側の先端部側に偏っているかを判定する。応力取得ステップS21では、本実施形態では、応力取得部66が、図3に示す応力P1及び応力P2のそれぞれのグラフでは、部品1が傾斜していない状態と比較してわずかではあるが保持部11の鉛直方向下側の先端部側に偏っていると判定し、図3に示す応力P3のグラフでは、部品1が傾斜していない状態と比較して有意に保持部11の鉛直方向上側の基端部側に偏っていると判定する。 In the stress acquisition step S21, for example, the stress acquisition unit 66 acquires the graph 1q shown in FIG. 5 based on the graphs of the stresses P1, P2, and P3 shown in FIG. Specifically, in the stress acquisition step S21, the stress acquisition unit 66 first compares the stress distribution in the graph of the stresses P1, P2, and P3 shown in FIG. It is determined whether it is biased to the base end side of the upper side in the vertical direction of the portion 11 or to the side of the distal end side of the lower side in the vertical direction of the holding portion 11 . In the stress acquisition step S21, in the present embodiment, the stress acquisition unit 66 acquires the stress P1 and the stress P2 shown in FIG. 11, and in the graph of stress P3 shown in FIG. It is determined that it is biased toward the proximal end.

応力取得ステップS21では、応力取得部66が、次に、応力のグラフが保持部11の鉛直方向下側の先端部側に偏っていると判定した場合、部品1が傾斜していない状態と比較して応力が相対的に小さいと認識し、応力のグラフが保持部11の鉛直方向上側の基端部側に偏っていると判定した場合、部品1が傾斜していない状態と比較して応力が相対的に大きいと認識する。応力取得ステップS21では、本実施形態では、応力取得部66が、図3に示す応力P1及び応力P2のそれぞれのグラフに基づいて、部品1が傾斜していない状態と比較して応力P1及び応力P2が相対的にわずかに小さいと認識し、図3に示す応力P3のグラフに基づいて、部品1が傾斜していない状態と比較して応力P3が相対的に有意に大きいと認識する。応力取得ステップS21では、応力取得部66が、これらの図3に示す応力P1,P2,P3のグラフにおける判定結果及び認識結果に基づいて、図5に示すグラフ1qを取得する。 In the stress acquisition step S21, when the stress acquisition unit 66 next determines that the stress graph is biased toward the lower tip end portion side of the holding unit 11 in the vertical direction, the stress acquisition unit 66 compares the graph with the state where the part 1 is not tilted. When it is determined that the stress is relatively small, and the stress graph is biased toward the base end side of the upper side of the holding portion 11 in the vertical direction, the stress is compared with the state where the part 1 is not tilted. is relatively large. In the stress acquisition step S21, in this embodiment, the stress acquisition unit 66 compares the stress P1 and the stress P2 in the state where the part 1 is not tilted based on the respective graphs of the stress P1 and the stress P2 shown in FIG. Recognize that P2 is relatively slightly smaller, and based on the graph of stress P3 shown in FIG. In the stress acquisition step S21, the stress acquisition unit 66 acquires the graph 1q shown in FIG. 5 based on the determination results and recognition results in the graphs of the stresses P1, P2, and P3 shown in FIG.

また、応力取得ステップS21では、応力取得部66が、隣接して設けられた保持部11が検出した応力に基づいて、隣接して設けられた保持部11の間の状態を見積もることが好ましい。応力取得ステップS21では、具体的には、応力取得部66が、隣接して設けられた保持部11-1及び保持部11-2がそれぞれ検出した応力P1及び応力P2の各グラフに基づいて、保持部11-1と保持部11-2との間に保持部11が設けられていた場合、どの程度の応力が検出されていた可能性があるかを見積もることができる。応力取得ステップS21では、応力取得部66が、本実施形態では、3つの保持部11-1,11-2,11-3に基づいて三角形状の応力のバランスのグラフを取得することについて説明しているが、保持部11間の応力を見積もることで、六角形状の応力のバランスのグラフを取得することもできる。また、応力取得ステップS21で応力取得部66が隣接して設けられた保持部11の間の状態を見積もる場合、追って説明する傾斜算出ステップS22において、傾斜状態をより精度よく算出することを可能にする。 Moreover, in the stress obtaining step S21, the stress obtaining unit 66 preferably estimates the state between the holding portions 11 provided adjacently based on the stress detected by the holding portions 11 provided adjacently. Specifically, in the stress acquisition step S21, the stress acquisition unit 66 detects stress P1 and stress P2 respectively detected by the holding unit 11-1 and the holding unit 11-2 provided adjacent to each other, based on each graph, If the holding portion 11 is provided between the holding portion 11-1 and the holding portion 11-2, it is possible to estimate how much stress may have been detected. In the stress acquisition step S21, the stress acquisition unit 66 acquires a triangular stress balance graph based on the three holding units 11-1, 11-2, and 11-3 in this embodiment. However, by estimating the stress between the holding portions 11, it is also possible to obtain a graph of the hexagonal stress balance. Further, when estimating the state between the holding portions 11 provided adjacent to each other by the stress obtaining portion 66 in the stress obtaining step S21, the tilt state can be calculated more accurately in the tilt calculating step S22, which will be described later. do.

傾斜算出ステップS22は、傾斜算出部67が、応力取得ステップS21で応力取得部66が取得した応力P1,P2,P3に基づいて、保持部11で保持されている部品1の傾斜状態を算出するステップである。 In the tilt calculation step S22, the tilt calculation unit 67 calculates the tilt state of the component 1 held by the holding unit 11 based on the stresses P1, P2, and P3 acquired by the stress acquisition unit 66 in the stress acquisition step S21. is a step.

図6及び図7は、図4の傾斜算出ステップS22を説明する説明図である。図6は、保持部11で保持されている部品1において+Z軸方向に最も傾斜している部分を含むX´Z平面における断面図である。図7は、図6におけるX´軸方向及びY´軸方向と、図1、図2及び図5におけるX軸方向及びY軸方向との相関関係を、+Z方向から見た図である。 6 and 7 are explanatory diagrams for explaining the tilt calculation step S22 in FIG. FIG. 6 is a cross-sectional view of the component 1 held by the holding portion 11 on the X'Z plane including the most inclined portion in the +Z-axis direction. FIG. 7 is a view of the correlation between the X'-axis direction and Y'-axis direction in FIG. 6 and the X-axis direction and Y-axis direction in FIGS.

傾斜算出ステップS22において傾斜算出部67が算出する傾斜状態は、図6に示す傾斜角θと、傾斜している方向を示す図7に示す傾斜方向φと、の2つのパラメータで表現される。傾斜方向φは、図6に示す例では、図7に示すように、保持部11で保持されている部品1において+Z軸方向に最も傾斜している部分を含む断面である図6のX´Z平面の、XZ平面を基準として+Z方向から見て反時計回りに設定された相対角度座標で示される。 The tilt state calculated by the tilt calculation unit 67 in the tilt calculation step S22 is expressed by two parameters, the tilt angle θ shown in FIG. 6 and the tilt direction φ shown in FIG. 7 indicating the tilt direction. In the example shown in FIG. 6, the direction of inclination φ is X′ in FIG. The Z plane is indicated by relative angular coordinates set counterclockwise when viewed from the +Z direction with the XZ plane as a reference.

傾斜算出ステップS22では、傾斜算出部67が、具体的には、応力P3が応力P1及び応力P2に比して相対的に優位に大きいことに基づいて、傾斜方向φが、保持部11-3の方向、すなわち部品1における箇所1-3を指し示す方向、すなわち約330度(-30度)であると算出する。傾斜算出ステップS22では、傾斜算出部67が、また、応力P3と応力P1及び応力P2との差分に基づいて、所定の計算式に応力P1,P2,P3の値を代入することにより、傾斜角θを算出する。 In the tilt calculation step S22, the tilt calculator 67 specifically determines that the tilt direction φ , ie, the direction pointing to the point 1-3 on the part 1, ie, about 330 degrees (-30 degrees). In the tilt calculation step S22, the tilt calculator 67 substitutes the values of the stresses P1, P2, and P3 into a predetermined formula based on the difference between the stress P3 and the stresses P1 and P2 to obtain the tilt angle Calculate θ.

傾斜有無判定ステップS23は、傾斜状態解消部68が、傾斜算出ステップS22で傾斜算出部67が算出した傾斜状態に基づいて、保持部11で保持されている部品1が傾斜していない状態に該当するか傾斜状態に該当するかを判定するステップである。傾斜有無判定ステップS23では、具体的には、傾斜状態解消部68が、傾斜算出部67が算出した傾斜角θが予め定めた閾値以下である場合、保持部11で保持されている部品1が傾斜していない状態に該当すると判定して一連の傾斜補正ステップS13を終了させて処理を挿入ステップS14に進める。一方、傾斜有無判定ステップS23では、傾斜状態解消部68が、傾斜算出部67が算出した傾斜角θが予め定めた閾値より大きい場合、保持部11で保持されている部品1が傾斜状態に該当すると判定して、処理を傾斜状態解消ステップS24に進める。 The tilt presence/absence determination step S23 corresponds to a state in which the component 1 held by the holding unit 11 is not tilted based on the tilt state calculated by the tilt calculation unit 67 in the tilt calculation step S22. This is the step of determining whether the vehicle is in a tilted state. Specifically, in the tilt presence/absence determination step S23, when the tilt angle ? It is determined that the state is not tilted, the series of tilt correction steps S13 is terminated, and the process proceeds to insertion step S14. On the other hand, in the tilt presence/absence determination step S23, if the tilt angle ? It is determined that it is, and the process proceeds to tilted state cancellation step S24.

傾斜状態解消ステップS24は、傾斜状態解消部68が、傾斜算出ステップS22で傾斜算出部67が算出した傾斜状態に基づいて、保持部材10の傾斜角を変更して、保持部11で保持されている部品1の傾斜状態を解消させるステップである。 In the tilted state canceling step S24, the tilted state canceling unit 68 changes the tilt angle of the holding member 10 based on the tilted state calculated by the tilt calculating unit 67 in the tilt calculating step S22. In this step, the tilted state of the component 1 is eliminated.

図8は、図4の傾斜状態解消ステップS24を説明する説明図である。図8の左側では、傾斜方向φで示されるX´Z平面において、保持部11で保持されている部品1が傾斜角θだけ傾斜している状態を示している。図8の右側では、図8の左側の保持部材10、保持部11及び部品1の全体を、傾斜方向φで示されるX´Z平面において、傾斜角-θだけ傾斜させた状態を示している。 FIG. 8 is an explanatory diagram for explaining the tilted state elimination step S24 in FIG. The left side of FIG. 8 shows a state in which the component 1 held by the holding portion 11 is tilted by the tilt angle θ on the X'Z plane indicated by the tilt direction φ. The right side of FIG. 8 shows a state in which the holding member 10, the holding portion 11 and the component 1 on the left side of FIG. .

傾斜状態解消ステップS24では、具体的には、図8に示すように、傾斜状態解消部68が、保持部材傾斜装置30を制御して、傾斜算出ステップS22で傾斜算出部67が算出した傾斜方向φにおいて、傾斜算出ステップS22で傾斜算出部67が算出した傾斜角θを解消するように、すなわち傾斜角-θだけ、保持部材傾斜装置30に保持部材10の傾斜角を変更させることで、保持部材10及び保持部11は傾斜角-θ及び傾斜方向φの傾斜状態として、部品1の傾斜状態を解消する。 Specifically, in the tilted state elimination step S24, as shown in FIG. 8, the tilted state elimination unit 68 controls the holding member tilting device 30 to determine the tilt direction calculated by the tilt calculation unit 67 in the tilt calculation step S22. At φ, the holding member tilting device 30 is caused to change the tilt angle of the holding member 10 so as to cancel the tilt angle θ calculated by the tilt calculating unit 67 in the tilt calculating step S22, that is, by the tilt angle −θ. The member 10 and the holding portion 11 are inclined at the inclination angle −θ and the inclination direction φ, thereby canceling the inclination state of the component 1 .

なお、実施形態に係る傾斜補正システム100及び部品挿入システム1000は、本発明の実施形態に係る傾斜補正方法を、一定時間ごとに繰り返し実行することが好ましい。具体的には、実施形態に係る傾斜補正システム100及び部品挿入システム1000の制御装置60は、一定時間ごとに、応力取得ステップS21での応力の取得、傾斜算出ステップS22での傾斜状態の算出、傾斜有無判定ステップS23での傾斜状態の判定、及び、傾斜状態解消ステップS24での傾斜状態の解消、を繰り返し実行することが好ましい。これにより、実施形態に係る傾斜補正システム100及び部品挿入システム1000は、比較的長い時間をかけて部品1をハウジング2の被挿入部2aに搬送する必要がある場合でも、一定時間ごとに部品1の傾斜状態を検出及び補正することで、保持部11で保持されている部品1を傾斜していない状態にして、正しい姿勢とすることができる。 It is preferable that the tilt correction system 100 and the component insertion system 1000 according to the embodiment repeatedly execute the tilt correction method according to the embodiment of the present invention at regular time intervals. Specifically, the control device 60 of the tilt correction system 100 and the component insertion system 1000 according to the embodiment acquires the stress in the stress acquisition step S21, calculates the tilt state in the tilt calculation step S22, It is preferable to repeat the determination of the tilted state in the tilt presence/absence determination step S23 and the elimination of the tilted state in the tilted state elimination step S24. As a result, the tilt correction system 100 and the component insertion system 1000 according to the embodiment can perform the component 1 at regular time intervals even when the component 1 needs to be transported to the insertion portion 2a of the housing 2 over a relatively long period of time. By detecting and correcting the tilted state of , the component 1 held by the holding portion 11 can be brought into a non-tilted state and can be in the correct posture.

挿入ステップS14は、挿入動作制御部69が、一連の傾斜補正ステップS13によって部品1の傾斜状態を解消した状態で、保持部11に保持させた部品1をハウジング2の被挿入部2aまで搬送して被挿入部2aに挿入するステップである。 In the insertion step S14, the insertion operation control section 69 conveys the component 1 held by the holding section 11 to the inserted section 2a of the housing 2 in a state where the tilted state of the component 1 is eliminated by the series of tilt correction steps S13. This is a step of inserting into the inserted portion 2a.

挿入ステップS14では、具体的には、挿入動作制御部69が、まず、保持部材移動装置40を制御して、傾斜状態を解消した状態で部品1を保持している保持部材10を、ハウジング2の被挿入部2aの鉛直方向上側の位置まで搬送する。挿入ステップS14では、挿入動作制御部69が、次に、保持部材移動装置40を制御して、傾斜状態を解消した状態で部品1を保持している保持部材10を、ハウジング2の被挿入部2aへ鉛直方向下側に向けて接近させることで、傾斜状態を解消した状態で保持している部品1をハウジング2の被挿入部2aへ向けて挿入する。挿入ステップS14では、挿入動作制御部69が、最後に、保持部駆動装置20を制御して、保持部材10に、傾斜状態を解消した状態で保持している部品1の保持状態を解消させることで、部品1が正しい姿勢でハウジング2の被挿入部2aに挿入される。 Specifically, in the inserting step S14, the inserting operation control unit 69 first controls the holding member moving device 40 to move the holding member 10 holding the component 1 in a state in which the inclined state is canceled to the housing 2. is conveyed to a position above the inserted portion 2a in the vertical direction. In the insertion step S14, the insertion operation control section 69 next controls the holding member moving device 40 to move the holding member 10 holding the component 1 in a state in which the inclined state is canceled to the inserted portion of the housing 2. The component 1 held in a state in which the tilted state is canceled is inserted toward the inserted portion 2a of the housing 2 by approaching the component 2a downward in the vertical direction. In the insertion step S14, the insertion operation control section 69 finally controls the holding section driving device 20 to cause the holding member 10 to cancel the holding state of the component 1 held in the state of canceling the inclined state. Then, the component 1 is inserted into the inserted portion 2a of the housing 2 in the correct posture.

本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、以上のような構成を有するので、保持部11で保持されている部品1の傾斜状態を、部品1を保持したまま、解消させることができるため、部品1を正しい姿勢で被挿入部2aに挿入される可能性を向上させることができる。 Since the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention are configured as described above, the tilted state of the component 1 held by the holding section 11 can be Since the part 1 can be released while being held, the possibility of inserting the part 1 into the inserted portion 2a in a correct posture can be improved.

また、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、制御装置60が、一定時間ごとに、応力の取得、傾斜状態の算出及び傾斜状態の解消を実行する。このため、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、保持部11で保持されている部品1が搬送中に再び傾斜状態となった場合でも、再び傾斜状態を解消することができるので、部品1を正しい姿勢で被挿入部2aに挿入される可能性をより向上させることができる。 Further, in the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention, the control device 60 acquires the stress, calculates the tilt state, and calculates the tilt state at regular time intervals. Execute resolving. For this reason, the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention can be used when the component 1 held by the holding unit 11 is again inclined during transportation. However, since the inclined state can be canceled again, the possibility of inserting the component 1 into the inserted portion 2a in the correct posture can be further improved.

また、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、保持部11が、保持部材10において相対的に径方向に移動可能に設けられており、相対的に径方向の内側に移動することで部品1の外周部で外側から挟み込むように保持可能であり、相対的に径方向の外側に移動することで部品1の内側1aで内側から保持可能である。このため、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、部品1の形状等に応じて、適宜保持の仕方を変更することができるので、部品1の形状等に依らず、部品1を正しい姿勢で被挿入部2aに挿入される可能性をより向上させることができる。さらに、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、保持部11が、部品1に設けられた開口の内側1aで、部品1を保持する。このため、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、部品1の保持によって生じる応力をより正確に検出することができるので、より高い精度で傾斜状態を解消することができ、部品1を正しい姿勢で被挿入部2aに挿入される可能性をより向上させることができる。 Further, in the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention, the holding part 11 is provided so as to be relatively movable in the radial direction in the holding member 10. By moving relatively radially inward, it can be held by the outer peripheral portion of the component 1 so as to be sandwiched from the outside, and by moving relatively radially outward, it can be held by the inner side 1a of the component 1 from the inside. It is possible. Therefore, in the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention, the method of holding the component 1 can be appropriately changed according to the shape of the component 1. It is possible to further improve the possibility that the component 1 is inserted into the inserted portion 2a in the correct posture, regardless of the shape of the component 1 or the like. Furthermore, in the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention, the holding section 11 holds the component 1 inside 1a of the opening provided in the component 1. . Therefore, the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention can more accurately detect the stress caused by holding the component 1, and thus can achieve higher accuracy. can be eliminated, and the possibility of inserting the component 1 into the inserted portion 2a in a correct posture can be further improved.

また、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、制御装置60が、隣接して設けられた保持部11が検出した応力に基づいて、隣接して設けられた保持部11の間の状態を見積もることが好ましい。この場合、本発明の実施形態に係る傾斜補正システム100、部品挿入システム1000、傾斜補正方法及び部品挿入方法は、保持部11で保持されている部品1の傾斜状態をより高い精度で算出することができるので、より高い精度で傾斜状態を解消することができ、部品1を正しい姿勢で被挿入部2aに挿入される可能性をより向上させることができる。 Further, in the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention, the control device 60, based on the stress detected by the holding section 11 provided adjacently, It is preferable to estimate the state between the holding portions 11 provided adjacently. In this case, the tilt correction system 100, the component insertion system 1000, the tilt correction method, and the component insertion method according to the embodiments of the present invention can calculate the tilt state of the component 1 held by the holding section 11 with higher accuracy. Therefore, the inclined state can be eliminated with higher accuracy, and the possibility of inserting the component 1 into the inserted portion 2a in the correct posture can be further improved.

1 部品
1-1,1-2,1-3 箇所
1a 内側
1p,1q グラフ
2 ハウジング
2a 被挿入部
10 保持部材
11,11-1,11-2,11-3 保持部
20 保持部駆動装置
30 保持部材傾斜装置
40 保持部材移動装置
50 被挿入部検出装置
60 制御装置
61 処理部
62 記憶部
63 情報通信インターフェイス
65 保持動作制御部
66 応力取得部
67 傾斜算出部
68 傾斜状態解消部
69 挿入動作制御部
70 入力装置
80 出力装置
100 傾斜補正システム
1000 部品挿入システム
P1,P2,P3 応力
1 Part 1-1, 1-2, 1-3 Location 1a Inside 1p, 1q Graph 2 Housing 2a Inserted Portion 10 Holding Member 11, 11-1, 11-2, 11-3 Holding Part 20 Holding Part Driving Device 30 Holding member tilting device 40 Holding member moving device 50 Inserted portion detection device 60 Control device 61 Processing unit 62 Storage unit 63 Information communication interface 65 Holding operation control unit 66 Stress acquisition unit 67 Inclination calculation unit 68 Inclination state elimination unit 69 Insertion operation control Section 70 Input Device 80 Output Device 100 Tilt Correction System 1000 Part Insertion System P1, P2, P3 Stress

Claims (8)

部品を保持し、前記部品の保持によって生じる応力を検出し、同一直線状に配置されていない保持部を少なくとも3つ有する保持部材と、
前記保持部材において前記保持部を駆動して前記部品を保持させる保持部駆動装置と、
前記保持部材の傾斜角を変更する保持部材傾斜装置と、
前記保持部材、前記保持部駆動装置及び前記保持部材傾斜装置を制御する制御装置と、を備え、
前記制御装置は、前記保持部が検出した前記応力を取得し、取得した前記保持部についての鉛直方向における前記応力の偏りと前記部品の大きさ及び形状を少なくとも含んだ仕様の情報に基づいて、前記保持部で保持されている前記部品の傾斜状態を算出し、算出した前記傾斜状態に基づいて、前記保持部材傾斜装置に前記傾斜状態を解消させることを特徴とする傾斜補正システム。
a retaining member that retains a component, detects stresses caused by retaining the component, and has at least three non-collinear retaining portions;
a holding portion driving device that drives the holding portion in the holding member to hold the component;
a holding member tilting device that changes the tilt angle of the holding member;
a control device that controls the holding member, the holding portion driving device, and the holding member tilting device;
The control device acquires the stress detected by the holding unit, and based on specification information including at least the deviation of the stress in the vertical direction of the acquired holding unit and the size and shape of the part, A tilt correction system, wherein a tilted state of the part held by the holding portion is calculated, and the tilted state is canceled by the holding member tilting device based on the calculated tilted state.
前記制御装置は、一定時間ごとに、前記応力の取得、前記傾斜状態の算出及び前記傾斜状態の解消を実行することを特徴とする請求項1に記載の傾斜補正システム。 2. The tilt correction system according to claim 1, wherein the control device acquires the stress, calculates the tilt state, and cancels the tilt state at regular time intervals. 前記保持部は、前記保持部材において相対的に径方向に移動可能に設けられており、
相対的に径方向の内側に移動することで前記部品の外周部で外側から挟み込むように保持可能であり、
相対的に径方向の外側に移動することで前記部品の内側で内側から保持可能であることを特徴とする請求項1または請求項2に記載の傾斜補正システム。
The holding portion is provided so as to be relatively radially movable in the holding member,
It can be held so as to be sandwiched from the outside by the outer peripheral portion of the component by moving relatively inward in the radial direction,
3. A tilt correction system according to claim 1 or claim 2, characterized in that it can be held from the inside inside the part by moving relatively radially outwardly.
前記保持部は、前記部品に設けられた開口の内側で、前記部品を保持することを特徴とする請求項3に記載の傾斜補正システム。 4. The tilt correction system according to claim 3, wherein the holding part holds the component inside an opening provided in the component. 前記制御装置は、隣接して設けられた前記保持部が検出した前記応力に基づいて、隣接して設けられた前記保持部の間に保持部が設けられた場合、当該保持部に生じる応力を見積もることを特徴とする請求項1から請求項4のいずれか1項に記載の傾斜補正システム。 Based on the stress detected by the holding portions provided adjacent to each other, the control device adjusts the stress generated in the holding portions when the holding portions are provided between the holding portions provided adjacent to each other. A tilt correction system according to any one of claims 1 to 4, characterized in that it estimates. 部品をハウジングの被挿入部に挿入する部品挿入システムであって、
請求項1から請求項5のいずれか1項に記載の傾斜補正システムと、
前記ハウジングの前記被挿入部を検出する被挿入部検出装置と、
前記保持部材を移動させる保持部材移動装置と、を備え、
前記制御装置は、さらに、
前記被挿入部検出装置及び前記保持部材移動装置を制御し、
前記被挿入部検出装置に前記被挿入部を検出させて、検出した前記被挿入部に基づいて前記保持部に保持させる前記部品を決定し、
前記保持部材移動装置に前記保持部材を移動させて、先に決定した前記部品を前記保持部に保持させ、前記保持部に保持させた前記部品を前記被挿入部まで搬送して前記被挿入部に挿入する、
ことを特徴とする部品挿入システム。
A component insertion system for inserting a component into an inserted portion of a housing,
A tilt correction system according to any one of claims 1 to 5;
an inserted portion detecting device for detecting the inserted portion of the housing;
a holding member moving device that moves the holding member,
The control device further
controlling the inserted portion detecting device and the holding member moving device;
causing the inserted portion detecting device to detect the inserted portion, and determining the part to be held by the holding portion based on the detected inserted portion;
The holding member moving device is caused to move the holding member to hold the previously determined part in the holding part, and the part held in the holding part is conveyed to the insertion part to the insertion part. insert into
A component insertion system characterized by:
部品の保持によって保持部材が有し、同一直線状に配置されていない少なくとも3つの保持部に生じる応力を検出して取得する応力取得ステップと、
取得した前記保持部についての鉛直方向における前記応力の各偏りと前記部品の大きさ及び形状を少なくとも含んだ仕様の情報に基づいて、前記保持部で保持されている前記部品の傾斜状態を算出する傾斜算出ステップと、
算出した前記傾斜状態に基づいて、前記保持部材の傾斜角を変更して前記傾斜状態を解消させる傾斜状態解消ステップと、
を有することを特徴とする傾斜補正方法。
a stress obtaining step of detecting and obtaining the stress generated in at least three holding portions of the holding member that are not arranged on the same straight line due to the holding of the component;
A tilted state of the part held by the holding part is calculated based on the obtained specification information including at least the deviation of the stress in the vertical direction and the size and shape of the part with respect to the holding part. a slope calculation step;
a tilted state canceling step of changing the tilt angle of the holding member based on the calculated tilted state to cancel the tilted state;
A tilt correction method, comprising:
部品をハウジングの被挿入部に挿入する部品挿入方法であって、
前記ハウジングの前記被挿入部を検出する被挿入部検出ステップと、
検出した前記被挿入部に基づいて決定した前記部品を前記保持部で保持する保持ステップと、
請求項7に記載の傾斜補正方法に基づく傾斜補正ステップと、
前記傾斜補正ステップによって傾斜状態を解消した状態で、前記保持部に保持させた前記部品を前記被挿入部まで搬送して前記被挿入部に挿入する挿入ステップと、
を有することを特徴とする部品挿入方法。
A component insertion method for inserting a component into an inserted portion of a housing,
an inserted portion detection step of detecting the inserted portion of the housing;
a holding step of holding the component determined based on the detected inserted portion with the holding portion;
a tilt correction step based on the tilt correction method of claim 7;
an insertion step of conveying the component held by the holding portion to the insertion target portion and inserting the component into the insertion target portion in a state where the tilted state is eliminated by the tilt correction step;
A component insertion method, comprising:
JP2019029869A 2019-02-21 2019-02-21 Tilt correction system, component insertion system, tilt correction method, and component insertion method Active JP7153584B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2019029869A JP7153584B2 (en) 2019-02-21 2019-02-21 Tilt correction system, component insertion system, tilt correction method, and component insertion method
PCT/JP2019/047601 WO2020170549A1 (en) 2019-02-21 2019-12-05 Inclination correction system, component insertion system, inclination correction method, and component insertion method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019029869A JP7153584B2 (en) 2019-02-21 2019-02-21 Tilt correction system, component insertion system, tilt correction method, and component insertion method

Publications (2)

Publication Number Publication Date
JP2020131386A JP2020131386A (en) 2020-08-31
JP7153584B2 true JP7153584B2 (en) 2022-10-14

Family

ID=72143786

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019029869A Active JP7153584B2 (en) 2019-02-21 2019-02-21 Tilt correction system, component insertion system, tilt correction method, and component insertion method

Country Status (2)

Country Link
JP (1) JP7153584B2 (en)
WO (1) WO2020170549A1 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011121169A (en) 2009-12-09 2011-06-23 Gm Global Technology Operations Inc System and method associated with handling object with robot gripper
JP2014210311A (en) 2013-04-18 2014-11-13 ファナック株式会社 Control device of robot carrying work
JP2015155126A (en) 2014-02-20 2015-08-27 キヤノン株式会社 Tool coordinate system correction method of robot system and robot system
JP2017039184A (en) 2015-08-19 2017-02-23 富士通株式会社 robot

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04289087A (en) * 1991-02-21 1992-10-14 Mitsubishi Electric Corp Robot device
JP3187191B2 (en) * 1993-02-23 2001-07-11 富士通株式会社 Robot finger grip force detection device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011121169A (en) 2009-12-09 2011-06-23 Gm Global Technology Operations Inc System and method associated with handling object with robot gripper
JP2014210311A (en) 2013-04-18 2014-11-13 ファナック株式会社 Control device of robot carrying work
JP2015155126A (en) 2014-02-20 2015-08-27 キヤノン株式会社 Tool coordinate system correction method of robot system and robot system
JP2017039184A (en) 2015-08-19 2017-02-23 富士通株式会社 robot

Also Published As

Publication number Publication date
WO2020170549A1 (en) 2020-08-27
JP2020131386A (en) 2020-08-31

Similar Documents

Publication Publication Date Title
US11254008B2 (en) Method and device of controlling robot system
EP3527335B1 (en) Conveyor tracking system and calibration method
US11911914B2 (en) System and method for automatic hand-eye calibration of vision system for robot motion
US10035268B2 (en) Measurement system used for calibrating mechanical parameters of robot
JP5927212B2 (en) Welding torch detection device and welding robot system
US8306660B2 (en) Device and a method for restoring positional information of robot
EP1555508A1 (en) Measuring system
US10189161B2 (en) Calibration system and calibration method calibrating mechanical parameters of wrist part of robot
US20220410375A1 (en) Coordinate system alignment method, alignment system, and alignment device for robot
JP2020078859A (en) Robot device
US9081026B2 (en) Opening/closing body inspection apparatus and opening/closing body inspection method
KR20080088165A (en) Robot calibration method
CN111152243A (en) Control system
CN111002304A (en) Device for determining the position and position of an end effector of a robot
JP5787646B2 (en) Robot system and component manufacturing method
JP6335237B2 (en) Stereo distance measuring device, stereo distance measuring method, and stereo distance measuring program
JP7153584B2 (en) Tilt correction system, component insertion system, tilt correction method, and component insertion method
KR102121287B1 (en) Camera system and controlling method of Camera system
KR102130617B1 (en) Apparatus and method for controling position of robot
CN109313811A (en) Auto-correction method, the apparatus and system of view-based access control model system vibration displacement
US20230032421A1 (en) Robot system
JP2010091540A (en) System and method for three-dimensional measurement
CN111352090B (en) Laser radar integrated with attitude system and control method
JPH08292019A (en) Calibration method for article detecting device
WO2023053395A1 (en) Position and posture measurement system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210624

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220222

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220421

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220705

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220825

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: 20220906

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221003

R150 Certificate of patent or registration of utility model

Ref document number: 7153584

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150