JP2018120306A - エンコーダー、ロボットおよびプリンター - Google Patents

エンコーダー、ロボットおよびプリンター Download PDF

Info

Publication number
JP2018120306A
JP2018120306A JP2017009720A JP2017009720A JP2018120306A JP 2018120306 A JP2018120306 A JP 2018120306A JP 2017009720 A JP2017009720 A JP 2017009720A JP 2017009720 A JP2017009720 A JP 2017009720A JP 2018120306 A JP2018120306 A JP 2018120306A
Authority
JP
Japan
Prior art keywords
mark
image
rotation
encoder
base
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.)
Granted
Application number
JP2017009720A
Other languages
English (en)
Other versions
JP6878908B2 (ja
Inventor
近藤 貴幸
Takayuki Kondo
貴幸 近藤
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.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
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 Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2017009720A priority Critical patent/JP6878908B2/ja
Priority to CN201711465715.4A priority patent/CN108340368B/zh
Priority to US15/873,386 priority patent/US10845218B2/en
Publication of JP2018120306A publication Critical patent/JP2018120306A/ja
Application granted granted Critical
Publication of JP6878908B2 publication Critical patent/JP6878908B2/ja
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
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/161Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/26Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
    • G01D5/32Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
    • G01D5/34Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
    • G01D5/347Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells using displacement encoding scales
    • G01D5/34776Absolute encoders with analogue or digital scales
    • G01D5/34792Absolute encoders with analogue or digital scales with only digital scales or both digital and incremental scales
    • 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
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • 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
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • B25J13/089Determining the position of the robot with reference to its environment
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/021Optical sensing devices
    • B25J19/022Optical sensing devices using lasers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0009Constructional details, e.g. manipulator supports, bases
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • B25J9/044Cylindrical coordinate type comprising an articulated arm with forearm providing vertical linear movement
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B41PRINTING; LINING MACHINES; TYPEWRITERS; STAMPS
    • B41JTYPEWRITERS; SELECTIVE PRINTING MECHANISMS, i.e. MECHANISMS PRINTING OTHERWISE THAN FROM A FORME; CORRECTION OF TYPOGRAPHICAL ERRORS
    • B41J11/00Devices or arrangements  of selective printing mechanisms, e.g. ink-jet printers or thermal printers, for supporting or handling copy material in sheet or web form
    • B41J11/66Applications of cutting devices
    • B41J11/663Controlling cutting, cutting resulting in special shapes of the cutting line, e.g. controlling cutting positions, e.g. for cutting in the immediate vicinity of a printed image
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B41PRINTING; LINING MACHINES; TYPEWRITERS; STAMPS
    • B41JTYPEWRITERS; SELECTIVE PRINTING MECHANISMS, i.e. MECHANISMS PRINTING OTHERWISE THAN FROM A FORME; CORRECTION OF TYPOGRAPHICAL ERRORS
    • B41J2/00Typewriters or selective printing mechanisms characterised by the printing or marking process for which they are designed
    • B41J2/005Typewriters or selective printing mechanisms characterised by the printing or marking process for which they are designed characterised by bringing liquid or particles selectively into contact with a printing material
    • B41J2/01Ink jet
    • B41J2/21Ink jet for multi-colour printing
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D18/00Testing or calibrating apparatus or arrangements provided for in groups G01D1/00 - G01D15/00
    • G01D18/001Calibrating encoders
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/26Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
    • G01D5/32Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
    • G01D5/34Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
    • G01D5/347Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells using displacement encoding scales
    • G01D5/34707Scales; Discs, e.g. fixation, fabrication, compensation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/26Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
    • G01D5/32Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
    • G01D5/34Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
    • G01D5/347Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells using displacement encoding scales
    • G01D5/3473Circular or rotary encoders
    • GPHYSICS
    • G02OPTICS
    • G02BOPTICAL ELEMENTS, SYSTEMS OR APPARATUS
    • G02B27/00Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00
    • G02B27/28Optical systems or apparatus not provided for by any of the groups G02B1/00 - G02B26/00, G02B30/00 for polarising
    • GPHYSICS
    • G02OPTICS
    • G02BOPTICAL ELEMENTS, SYSTEMS OR APPARATUS
    • G02B5/00Optical elements other than lenses
    • G02B5/30Polarising elements
    • G02B5/3083Birefringent or phase retarding elements
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras
    • G06T7/73Determining position or orientation of objects or cameras using feature-based methods
    • G06T7/74Determining position or orientation of objects or cameras using feature-based methods involving reference images or patches
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/12Programme control other than numerical control, i.e. in sequence controllers or logic controllers using record carriers
    • G05B19/124Programme control other than numerical control, i.e. in sequence controllers or logic controllers using record carriers using tapes, cards or discs with optically sensed marks or codes
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00Indexing scheme for image analysis or image enhancement
    • G06T2207/30Subject of image; Context of image processing
    • G06T2207/30204Marker

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Optics & Photonics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Theoretical Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Evolutionary Computation (AREA)
  • Artificial Intelligence (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Manipulator (AREA)
  • Image Analysis (AREA)

Abstract

【課題】低コスト化を図りつつ検出精度を高めることができるエンコーダーを提供すること、また、このエンコーダーを備えるロボットおよびプリンターを提供すること。
【解決手段】基部と、前記基部に対して回動軸まわりに回動可能に設けられている回動部と、前記回動部に前記回動軸まわりに沿って配置されているマークと、前記基部に配置され、前記マークを撮像する撮像素子と、前記撮像素子の撮像画像に対して基準画像を用いてテンプレートマッチングを行うことにより前記マークを検出し、その検出結果に基づいて、前記基部に対する前記回動部の回動状態を判断する判断部と、を備えることを特徴とするエンコーダー。
【選択図】図2

Description

本発明は、エンコーダー、ロボットおよびプリンターに関するものである。
エンコーダーの一種として光学式のロータリーエンコーダーが一般に知られている(例えば特許文献1参照)。ロータリーエンコーダーは、例えば、回動可能な関節部を有するロボットアームを備えるロボットにおいて、関節部の回転角度、回転位置、回転数、回転速度等の回転状態を検出する。その検出結果は、例えば、関節部の駆動制御に用いられる。
例えば、特許文献1に記載のエンコーダーは、グレイ符号等の数値パターンおよびストライプ状のパターンが形成されているコード板を撮像素子で読み取り、読み取った数値パターンおよびストライプ状のパターンから位置を検出する。
特開昭63−187118号公報
しかし、特許文献1に記載のエンコーダーでは、高い検出精度を実現するためには、高精細なパターンをコード板に形成しなければならず、その結果、高コスト化を招いてしまうという問題があった。また、特許文献1に記載のエンコーダーでは、たとえ、高精細なパターンをコード板に形成したとしても、パターンが汚れ等によりかすれた場合、検出精度が極端に低下してしまうという問題もあった。
本発明の目的は、低コスト化を図りつつ検出精度を高めることができるエンコーダーを提供すること、また、このエンコーダーを備えるロボットおよびプリンターを提供することにある。
上記目的は、下記の本発明により達成される。
本発明のエンコーダーは、基部と、
前記基部に対して回動軸まわりに回動可能に設けられている回動部と、
前記回動部に前記回動軸まわりに沿って配置されているマークと、
前記基部に配置され、前記マークを撮像する撮像素子と、
前記撮像素子の撮像画像に対して基準画像を用いてテンプレートマッチングを行うことにより前記マークを検出し、その検出結果に基づいて、前記基部に対する前記回動部の回動状態を判断する判断部と、を備えることを特徴とする。
このような特徴を有するエンコーダーによれば、テンプレートマッチングを用いてマークを認識して基部に対する回動部の回動状態を判断するため、高精細なマークを用いなくても、撮像素子の撮像画像内でのマークの画像の位置に基づいて、基部に対する回動部の回動状態を高精度に判断することができる。また、マークが汚れ等によりかすれたとしても、撮像素子の撮像画像内でのマークの画像の位置をテンプレートマッチングにより高精度に検出することができる。そのため、低コスト化を図りつつ検出精度を高めることができる。
本発明のエンコーダーでは、前記回動部には、複数の前記マークが配置されており、
前記撮像素子は、前記回動軸まわりの周方向に互いに隣り合う2つの前記マーク全体を包含させて撮像することが好ましい。
これにより、撮像素子が撮像した2つのマークのうちの一方のマークが汚れ等により正確に読み取ることができなくなっても、他方のマークを読み取って検出を行うことができる。
本発明のエンコーダーでは、前記判断部は、前記撮像画像の一部の領域に探索領域を設定し、前記探索領域内で前記テンプレートマッチングを行うことが好ましい。
これにより、テンプレートマッチングに用いる探索領域の画素数を少なくし、テンプレートマッチングに関する演算時間を短縮することができる。そのため、回動部の角速度が速い場合においても、高精度な検出を行うことができる。また、撮像素子とマークとの間に配置されているレンズの収差によって、撮像素子の撮像画像の外周部分の歪やボケが大きくなっても、そのような歪やボケの少ない領域を探索領域として用いることで、検出精度の低下を低減することができる。
本発明のエンコーダーでは、前記判断部は、前記回動部の前記回動軸まわりの角速度に関する情報に基づいて、前記撮像画像内における前記探索領域の第1方向での位置および長さのうちの少なくとも一方を変更可能であることが好ましい。
これにより、回動部の回動状態(角速度)に応じた無駄の少ない探索領域を設定し、テンプレートマッチングに用いる探索領域の画素数をより少なくすることができる。
本発明のエンコーダーでは、前記判断部は、過去2回以上の前記回動状態の判断結果に基づいて、前記角速度に関する情報を算出することが好ましい。
これにより、回動部の回動状態(角速度)に応じた探索領域を比較的簡単に設定することができる。
本発明のエンコーダーでは、前記判断部は、前記回動部の前記回動軸まわりの角加速度に関する情報に基づいて、前記撮像画像内における前記探索領域の第1方向での位置および長さのうちの少なくとも一方を変更可能であることが好ましい。
これにより、回動部の回動状態(角速度)の変化(角加速度)に応じたより無駄の少ない探索領域を設定することができる。
本発明のエンコーダーでは、前記判断部は、過去3回以上の前記回動状態の判断結果に基づいて、前記角加速度に関する情報を算出することが好ましい。
これにより、回動部の回動状態(角速度)の変化(角加速度)に応じた探索領域を比較的簡単に設定することができる。
本発明のエンコーダーでは、前記判断部は、前記撮像画像内における前記探索領域の前記第1方向での位置に基づいて、前記撮像画像内における前記探索領域の前記第1方向に対して垂直な第2方向での位置および長さのうちの少なくとも一方を変更可能であることが好ましい。
これにより、回動部の回動状態(回動角度)に応じた無駄の少ない探索領域を設定し、テンプレートマッチングに用いる探索領域の画素数をより少なくすることができる。
本発明のエンコーダーでは、前記判断部は、前記基部に対する前記回動部の回動角度に関する情報に基づいて、前記撮像画像内における前記基準画像の姿勢を変更可能であることが好ましい。
これにより、探索領域内でマークの画像の姿勢の変化が大きい場合においても、テンプレートマッチングの演算量を低減しつつ、テンプレートマッチングの精度を高めることができる。
本発明のエンコーダーでは、前記判断部は、前記基部に対する前記回動部の回動角度が設定角度よりも大きいか否かを判断し、その判断結果に基づいて、前記撮像画像内における前記基準画像の姿勢を変更することが好ましい。
これにより、テンプレートマッチングの高精度化を図りつつ、テンプレートマッチングの演算量をより低減することができる。
本発明のロボットは、本発明のエンコーダーを備えることを特徴とする。
このような特徴を有するロボットによれば、エンコーダーの検出精度が高いため、エンコーダーの検出結果を用いて、ロボットの高精度な動作制御を行うことができる。また、エンコーダーが安価であるため、ロボットの低コスト化を図ることもできる。
本発明のプリンターは、本発明のエンコーダーを備えることを特徴とする。
このような特徴を有するプリンターによれば、エンコーダーの検出精度が高いため、エンコーダーの検出結果を用いて、プリンターの高精度な動作制御を行うことができる。また、エンコーダーが安価であるため、プリンターの低コスト化を図ることもできる。
本発明の実施形態に係るロボットを示す側面図である。 本発明の第1実施形態に係るエンコーダーを説明するための断面図である。 図2に示すエンコーダーが備えるマークを説明するための図である。 図2に示すエンコーダーが備える撮像素子の撮像画像を説明するための図である。 図4に示す撮像画像内に設定される探索領域でのテンプレートマッチングを説明するための図である。 テンプレートマッチングの際に相関値が最大または最小となる状態から1画素分ずれた状態である。 テンプレートマッチングの際に相関値が最大または最小となる状態を示す図である。 テンプレートマッチングの際に相関値が最大または最小となる状態から図6に示す状態とは反対側に1画素分ずれた状態を示す図である。 本発明の第2実施形態に係るエンコーダーにおける探索領域(回動部の角速度を考慮して設定した領域)を説明するための図である。 図9に示す探索領域(マークの移動軌跡を考慮して設定した領域)を説明するための図である。 本発明の第3実施形態に係るエンコーダーにおける探索領域(回動部の角速度および角加速度を考慮して設定した領域)を説明するための図である。 本発明の第4実施形態に係るエンコーダーにおける探索領域(回動部の回動角度を考慮して設定した領域)を説明するための図である。 本発明の第5実施形態に係るエンコーダーにおける探索領域内での基準画像(テンプレート)を説明するための図である。 図13に示す基準画像の姿勢を変化させた状態を示す図である。 本発明の第6実施形態に係るエンコーダーを説明するための断面図である。 本発明のプリンターの実施形態の概略構成を示す図である。
以下、本発明のエンコーダー、ロボットおよびプリンターを添付図面に示す好適な実施形態に基づいて詳細に説明する。
(ロボット)
図1は、本発明の実施形態に係るロボットを示す側面図である。なお、以下では、説明の便宜上、図1中の上側を「上」、下側を「下」と言う。また、図1中の基台側を「基端」、その反対側(エンドエフェクター側)を「先端側」と言う。また、図1の上下方向を「鉛直方向」とし、左右方向を「水平方向」とする。
図1に示すロボット100は、いわゆる水平多関節ロボット(スカラロボット)であり、例えば、精密機器等を製造する製造工程等で用いられ、精密機器や部品等の把持や搬送等を行うことができる。
図1に示すように、ロボット100は、基台110と、第1アーム120と、第2アーム130と、作業ヘッド140と、エンドエフェクター150と、配線引き回し部160と、を有している。以下、ロボット100の各部を順次簡単に説明する。
基台110は、例えば、図示しない床面にボルト等によって固定されている。基台110の上端部には、第1アーム120が連結されている。第1アーム120は、基台110に対して鉛直方向に沿う第1軸J1まわりに回動可能となっている。
基台110内には、第1アーム120を回動させる駆動力を発生させる第1モーター111と、第1モーター111の駆動力を減速する第1減速機112とが設置されている。第1減速機112の入力軸は、第1モーター111の回転軸に連結され、第1減速機112の出力軸は、第1アーム120に連結されている。そのため、第1モーター111が駆動し、その駆動力が第1減速機112を介して第1アーム120に伝達されると、第1アーム120が基台110に対して第1軸J1まわりに水平面内で回動する。
また、基台110および第1アーム120には、基台110に対する第1アーム120の回動状態を検出する第1エンコーダーであるエンコーダー1が設けられている。
第1アーム120の先端部には、第2アーム130が連結している。第2アーム130は、第1アーム120に対して鉛直方向に沿う第2軸J2まわりに回動可能となっている。図示しないが、第2アーム130内には、第2アーム130を回動させる駆動力を発生させる第2モーターと、第2モーターの駆動力を減速する第2減速機とが設置されている。そして、第2モーターの駆動力が第2減速機を介して第1アーム120に伝達されることにより、第2アーム130が第1アーム120に対して第2軸J2まわりに水平面内で回動する。また、図示しないが、第2モーターには、第1アーム120に対する第2アーム130の回動状態を検出する第2エンコーダーが設けられている。
第2アーム130の先端部には、作業ヘッド140が配置されている。作業ヘッド140は、第2アーム130の先端部に同軸的に配置されたスプラインナットおよびボールネジナット(ともに図示せず)に挿通されたスプラインシャフト141を有している。スプラインシャフト141は、第2アーム130に対して、その軸まわりに回転可能であり、かつ、上下方向に移動(昇降)可能となっている。
図示しないが、第2アーム130内には、回転モーターおよび昇降モーターが配置されている。回転モーターの駆動力は、図示しない駆動力伝達機構によってスプラインナットに伝達され、スプラインナットが正逆回転すると、スプラインシャフト141が鉛直方向に沿う軸J3まわりに正逆回転する。また、図示しないが、回転モーターには、第2アーム130に対するスプラインシャフト141の回動状態を検出する第3エンコーダーが設けられている。
一方、昇降モーターの駆動力は、図示しない駆動力伝達機構によってボールネジナットに伝達され、ボールネジナットが正逆回転すると、スプラインシャフト141が上下に移動する。昇降モーターには、第2アーム130に対するスプラインシャフト141の移動量を検出する第4エンコーダーが設けられている。
スプラインシャフト141の先端部(下端部)には、エンドエフェクター150が連結されている。エンドエフェクター150としては、特に限定されず、例えば、被搬送物を把持するもの、被加工物を加工するもの等が挙げられる。
第2アーム130内に配置された各電子部品(例えば、第2モーター、回転モーター、昇降モーター、第1〜第4エンコーダー等)に接続される複数の配線は、第2アーム130と基台110とを連結する管状の配線引き回し部160内を通って基台110内まで引き回されている。さらに、かかる複数の配線は、基台110内でまとめられることによって、第1モーター111およびエンコーダー1に接続される配線とともに、基台110の外部に設置され、ロボット100を統括制御する図示しない制御装置まで引き回される。
以上、ロボット100の構成について簡単に説明した。このロボット100は、後述する第1ないし第5実施形態のいずれかのエンコーダー1を備える。このエンコーダー1は、後述するように低コスト化を図りつつ検出精度を高めることができる。そのため、エンコーダー1の検出結果を用いて、ロボット100の高精度な動作制御を行うことができる。また、ロボット100の低コスト化を図ることもできる。
(エンコーダー)
以下、エンコーダー1について詳述する。なお、以下では、エンコーダー1をロボット100に組み込む場合の一例について説明する。
<第1実施形態>
図2は、本発明の第1実施形態に係るエンコーダーを説明するための断面図である。図3は、図2に示すエンコーダーが備えるマークを説明するための図である。
図2に示すように、前述したロボット100の基台110は、第1モーター111と第1減速機112を支持する支持部材114を有し、第1モーター111および第1減速機112を収納している。このような基台110には、第1アーム120が第1軸J1まわりに回動可能に設けられている。
第1アーム120は、水平方向に沿って延びているアーム本体部121と、アーム本体部121から下方に向けて突出している軸部122と、を有し、これらが互いに接続されている。そして、軸部122は、軸受115を介して基台110に第1軸J1まわりに回動可能に支持されているとともに、第1減速機112の出力軸に接続されている。また、第1減速機112の入力軸は、第1モーター111の回転軸1111に接続されている。
ここで、基台110は、基台110の自重や基台110が支える他の質量による荷重が加わる構造体である。同様に、第1アーム120も、第1アーム120の自重や第1アーム120が支える他の質量による荷重が加わる構造体である。このような基台110および第1アーム120の構成材料としては、それぞれ、特に限定されないが、例えば、金属材料が挙げられる。
本実施形態では、基台110および第1アーム120の外表面は、ロボット100の外表面の一部を構成している。なお、基台110および第1アーム120の外表面上には、カバー、衝撃吸収材等の外装部材が装着されていてもよい。
このような相対的に回動する基台110および第1アーム120には、これらの回動状態を検出するエンコーダー1が設けられている。
エンコーダー1は、第1アーム120に設けられているマーク部2と、基台110に設けられ、マーク部2を検出するマーク検出部3と、マーク検出部3の検出結果に基づいて基台110および第1アーム120の相対的な回動状態を判断する判断部5と、判断部5に電気的に接続されている記憶部6と、を有する。
マーク部2は、アーム本体部121の基台110と対向する部分、すなわち、アーム本体部121の下面の軸部122を囲む部分に設けられている。このマーク部2は、図3に示すように、第1軸J1とは異なる位置で第1軸J1まわりに沿って配置されている複数のマーク21を有する。ここで、マーク21は、第1アーム120の表面に設けられている。これにより、マーク21を設けるための部材を基台110および第1アーム120とは別途設ける必要がない。そのため、部品点数を少なくすることができる。なお、マーク21は、第1アーム120の表面に直接設けられている場合に限定されず、例えば、第1アーム120の表面に貼着されたシート状の部材に設けられていてもよいし、第1アーム120とともに回動するように設けられた板状の部材に設けられていてもよい。すなわち、マーク21が設けられる部材(回動部)は、第1アーム120とともに基台110に対して第1軸J1まわりに回動する部材であればよい。
本実施形態では、図3に示すように、複数のマーク21は、第1軸J1まわりに等間隔に並んで配置されている互いに異なる複数の位置識別マークである。図3に示す複数のマーク21は、互いに異なるアルファベット(ローマ字)であり、図示では、AからXまでの24文字がアルファベット順に周方向に等間隔に並んで配置されている。このような各マーク21の形成方法としては、例えば、レーザーマーキング、印刷、切削、エッチング等が挙げられる。
なお、マーク21の数および大きさは、必要な分解能、後述する撮像素子31の解像度等に応じて決められるものであり、図示の例に限定されず、任意である。また、複数のマーク21同士の周方向での間隔は、等間隔でなくてもよい。また、各マーク21は、図示のローマ字に限定されず、例えば、数字を用いてもよいし、アラビア文字、漢字等の他の文字を用いてもよいし、文字以外の記号、符号、しるし、標章、図案、文字等を用いてもよい。また、各マーク21は、判断部5で識別可能なものであればよく、必ずしも人間が識別可能なものである必要はない。例えば、各マーク21に代えて、1次元バーコードやQRコード(登録商標)のようなものを用いてもよい。あるいは周期性がなければ全くランダムな模様でもかまわない。
図2に示すマーク検出部3は、基台110内に設けられている撮像素子31と、基台110が有する開口に設けられているレンズ32と、を有し、撮像素子31がレンズ32を介してマーク部2の周方向での一部(図3に示す撮像領域RI)にあるマーク21を撮像する。なお、必要に応じて、撮像素子31の撮像領域RIを照明する光源を設けてもよい。
撮像素子31としては、例えば、CCD(Charge Coupled Devices)、CMOS(Complementary Metal Oxide Semiconductor)等が挙げられる。このような撮像素子31は、撮影された画像を画素ごとの電気信号に変換して出力する。撮像素子31は、2次元撮像素子(エリアイメージセンサ)、あるいは1次元撮像素子(ラインイメージセンサ)のどちらでも適用可能である。1次元撮像素子は、画素の並びがアームの旋回円に接する方向に配置することが望ましい。2次元撮像素子を用いた場合は、情報量の多い2次元画像を取得でき、後述のテンプレートマッチングによるマーク21の検出精度を高めやすい。その結果、第1アーム120の回動状態を高精度に検出することができる。1次元撮像素子を用いた場合は、画像取得周期いわゆるフレームレートが高いため、検出頻度を高めることが可能になり、高速動作時に有利である。
レンズ32は、結像光学系を構成する。結像光学系としては、等倍光学系、拡大光学系、縮小光学系のいずれも用いることができる。ここで、図3に示すように、撮像素子31の撮像領域RIは、第1アーム120の下面に、マーク部2の周方向での一部に重なるように設定されている。これにより、撮像素子31は、撮像領域RI内にあるマーク21を撮像することができる。したがって、撮像領域RIに位置するマーク21を読み取ることにより、第1アーム120の回動状態を知ることができる。
図2に示す判断部5は、マーク検出部3の検出結果に基づいて、基台110および第1アーム120の相対的な回動状態を判断する。この回動状態としては、例えば、回動角度、回動速度、回動方向等が挙げられる。
特に、判断部5は、撮像素子31の撮像画像(撮像画像データ)に対して基準画像(基準画像データ)を用いてテンプレートマッチングすることでマーク21を画像認識する画像認識回路51を有し、この画像認識回路51の認識結果を用いて、基台110および第1アーム120の相対的な回動状態を判断する。ここで、判断部5は、撮像素子31の撮像画像内でのマーク21の画像の位置に基づいて、基台110および第1アーム120の相対的な回動角度(以下、単に「第1アーム120の回動角度」ともいう)をより細かく判断することが可能に構成されている。また、判断部5は、マーク21が検出される時間間隔に基づいて回動速度を求めたり、検出されるマーク21の種類の順序に基づいて回動方向を判断したりすることも可能に構成されている。そして、判断部5は、前述した判断結果に応じた信号、すなわち、基台110および第1アーム120の回動状態に応じた信号を出力する。この信号は、例えば、図示しない制御装置に入力され、ロボット100の動作の制御に用いられる。なお、前述した判断部5の少なくとも一部は、当該制御装置にハードウエアまたはソフトウエアとして組み込まれていてもよい。
また、判断部5は、撮像素子31の撮像画像の一部(マーク21の画像を含む部分)を切り取って基準画像(テンプレート)を生成する機能をも有する。この基準画像の生成は、基台110および第1アーム120の相対的な回動状態を判断するのに先立って、あるいは、必要に応じて適時、各マーク21ごとに行われる。そして、生成した基準画像は、各マーク21に対応して記憶部6に記憶される。そして、判断部5は、記憶部6に記憶されている基準画像(テンプレート)を用いて、テンプレートマッチングを行う。なお、テンプレートマッチングおよびそれを用いた回動状態の判断については、後に詳述する。
ここで、記憶部6には、各マーク21に対応して、前述した基準画像(基準画像データ)がそれに対応するマーク21の種類に関する情報(識別情報)、撮像画像内での座標(後述する基準画素の座標)に関する情報、および、第1アーム120の回動角度に関する情報(角度情報)とともに記憶されている。このような記憶部6としては、不揮発性メモリ、揮発性メモリのいずれも用いることができるが、電力を供給しなくても情報を記憶した状態を保持することができ、省電力化を図ることができるという観点から、不揮発性メモリを用いるのが好ましい。
以上のようなエンコーダー1は、前述したように、「基部」である基台110と、基台110に対して「回動軸」である第1軸J1まわりに回動可能に設けられている「回動部」である第1アーム120と、第1アーム120に第1軸J1まわりに沿って配置されているマーク21と、基台110に配置され、マーク21を撮像する撮像素子31と、撮像素子31の撮像画像Gに対して基準画像を用いてテンプレートマッチングを行うことによりマーク21を検出し、その検出結果に基づいて、基台110に対する第1アーム120の回動状態を判断する判断部5と、を備える。
このようなエンコーダー1によれば、テンプレートマッチングを用いてマーク21を認識して基台110に対する第1アーム120の回動状態を判断するため、高精細なマーク21を用いなくても、撮像素子31の撮像画像内でのマーク21の画像の位置に基づいて、基台110に対する第1アーム120の回動状態を高精度に判断することができる。また、マーク21が汚れ等によりかすれたとしても、撮像素子31の撮像画像内でのマーク21の画像の位置をテンプレートマッチングにより高精度に検出することができる。そのため、低コスト化を図りつつ検出精度を高めることができる。なお、「基部」は、基台110のマーク検出部3を含む部分であると言えるし、また、「回動部」は、第1アーム120のマーク21を含む部分であると言える。
(テンプレートマッチングおよびそれを用いた回動状態の判断)
以下、判断部5におけるテンプレートマッチングおよびそれを用いた回動状態の判断について詳述する。なお、以下では、回動状態として回動角度を判断する場合を代表的に説明する。
−基準画像の取得−
エンコーダー1では、テンプレートマッチングを用いて基台110に対する第1アーム120の回動状態を判断するのに先立って、当該テンプレートマッチングに用いる基準画像を取得する。この基準画像の取得は、最初のテンプレートマッチングの前に1回行うだけでよいが、その後必要に応じて適時行ってもよい。その場合、テンプレートマッチングに用いる基準画像を、新たに取得した基準画像に更新することができる。
基準画像を取得する際には、第1アーム120を基台110に対して第1軸J1まわりに適宜回動させ、撮像素子31で複数のマーク21を各マーク21ごとに撮像する。そして、得られた各撮像画像をトリミングすることにより、各マーク21ごとの基準画像を生成する。生成された基準画像は、その識別情報、画素座標情報および角度情報とともにこれらに対応付けられて記憶部6に記憶される。以下、図4に基づいて、この点を詳述する。
図4は、図2に示すエンコーダーが備える撮像素子の撮像画像を説明するための図である。
第1アーム120が基台110に対して第1軸まわりに回動すると、例えば、図4に示すように、撮像素子31の撮像画像G内に映っている文字「A」を示すマーク21の画像であるマーク画像21Aは、撮像画像G内を円弧C1、C2に沿って移動する。ここで、円弧C1は、基台110に対する第1アーム120の回動に伴ってマーク画像21Aの図4中下端が描く軌跡であり、円弧C2は、基台110に対する第1アーム120の回動に伴ってマーク画像21Aの図4中上端が描く軌跡である。また、図4では、マーク画像21Aの他に、文字「B」を示すマーク21の画像であるマーク画像21B、および、文字「X」を示すマーク21の画像であるマーク画像21Xが撮像画像G内に映っている場合を図示している。
ここで、撮像素子31が撮像することにより得られる撮像画像Gは、撮像領域RIに対応した形状であって、X軸方向に沿って延びている2つの辺とY軸方向に沿って延びている2つの辺とを有する矩形をなしている。また、撮像画像GのX軸方向に沿って延びている2つの辺は、円弧C1、C2にできるだけ沿うように配置されている。また、撮像画像Gは、X軸方向およびY軸方向に行列状に並んでいる複数の画素を有する。ここで、画素の位置は、X軸方向での画素の位置を示す「X」、および、Y軸方向での画素の位置を示す「Y」で表される画素座標系(X,Y)で表される。また、撮像画像Gの外周部を除いた中央領域を有効視野領域RUとし、有効視野領域RUの図中左上端の画素が画像座標系(X,Y)の原点画素(0,0)に設定されている。
例えば、文字「A」を示すマーク21を検出するための基準画像TAを生成する場合、第1アーム120を基台110に対して適宜回動させ、マーク画像21Aを有効視野領域RU内の所定位置(図示ではX軸方向での中央に設定された中心線LY上)に位置させる。ここで、マーク画像21Aが当該所定位置に位置するときの、基台110に対する第1アーム120の回動角度θA0は、測定等により事前に取得されている。
このような撮像画像Gを、マーク画像21Aを包含する必要最小限の範囲となるような矩形の画素範囲でトリミングすることにより、基準画像TA(文字「A」を示すマーク21の検出用のテンプレート)を得る。得られた基準画像TAは、記憶部6に記憶される。このとき、基準画像TAは、その画像の種類(図示の場合、文字「A」)に関する識別情報、前述した回動角度θA0に関する角度情報、および、基準画像TAの画素範囲における基準画素(図示では左上端の画素)の画素座標である基準画素座標(XA0,YA0)に関する画素情報とともに、これらに対応付けられて記憶される。すなわち、基準画像TAおよびそれに対応する識別情報、角度情報および画素座標情報がテンプレートマッチングに用いる1つのテンプレートセットとなる。
−テンプレートマッチングを用いた回動状態の判断−
次に、図5ないし図8に基づいて、前述したように生成した基準画像TAを用いたテンプレートマッチングおよびについて説明する。
図5は、図4に示す撮像画像内に設定される探索領域でのテンプレートマッチングを説明するための図である。図6は、テンプレートマッチングの際に相関値が最大または最小となる状態から1画素分ずれた状態である。図7は、テンプレートマッチングの際に相関値が最大または最小となる状態を示す図である。図8は、テンプレートマッチングの際に相関値が最大または最小となる状態から図6に示す状態とは反対側に1画素分ずれた状態を示す図である。
図5に示すように、有効視野領域RU内にマーク画像21Aが存在しているとき、基準画像TAを用いて有効視野領域RUの画像に対してテンプレートマッチングを行う。本実施形態では、有効視野領域RU全域を探索領域RSとし、探索領域RSに基準画像TAを重ね、探索領域RSに対して基準画像TAを一画素ずつずらしながら、探索領域RSと基準画像TAとの重なり部分の相関値を算出する。ここで、基準画像TAは、その基準画素の画素座標を開始座標PS(原点画素P0)から終了画素PEまで1画素ずつ移動され、探索領域RS全域の画素について、探索領域RSと基準画像TAとの重なり部分の相関値が基準画像TAの基準画素の画素座標ごとに算出される。そして、相関値は、撮像画像データと基準画像データとの相関値データとして、基準画像TAの基準画素の画素座標に対応付けされて記憶部6に記憶される。
次に、記憶部6に記憶されている画素座標ごとの複数の相関値のうち、最大値となる相関値を選択し、その選択された相関値となる基準画像TAの画素座標(XA1,YA1)をマーク画像21Aの画素座標として決定する。このようにして、撮像画像G内でのマーク画像21Aの位置を検出することができる。
特に、サブピクセル推定法を用いて、マーク画像21Aの画素座標を求める。相関値が最大となる近傍では、図6ないし図8に示すように、マーク21に対して基準画像TAが重なる。図7に示す状態は、図6、8に示す状態(図7に示す状態から1画素ずれた状態)よりも相関値が大きく、相関値が最も大きくなる。しかし、図7に示す状態のように、マーク21に対して基準画像TAが完全に一致せずにずれて重なる場合、図7に示す状態をマーク画像21Aの画素位置と判断すると、そのずれが誤差となる。このずれは、最大で視野サイズBとなる。すなわち、サブピクセル推定法を用いない場合、視野サイズBが最小の分解能(精度)となる。これに対し、サブピクセル推定法を用いると、視野サイズBごとの相関値を放物線等(等角直線でもよい)でフィッティングし、これらの相関値間(画素ピッチ間)を補完(近似)することができる。そのため、より高精度にマーク画像21Aの画素座標を求めることができる。なお、前述した説明では、相関値が最大となる画素座標がマーク画像21Aの画素位置となる場合を例に説明したが、相関値が最小となる画素座標がマーク画像21Aの画素位置となるようにテンプレートマッチングを行うことも可能である。
このように、判断部5は、撮像画像Gの一部の領域である有効視野領域RUに探索領域RSを設定し、探索領域RS内でテンプレートマッチングを行う。これにより、テンプレートマッチングに用いる探索領域RSの画素数を少なくし、テンプレートマッチングに関する演算時間を短縮することができる。そのため、第1アーム120の第1軸J1まわりの角速度が速い場合においても、高精度な検出を行うことができる。また、撮像素子31とマーク21との間に配置されているレンズ32の収差によって、撮像画像Gの外周部分の歪やボケが大きくなっても、そのような歪やボケの少ない領域を探索領域RSとして用いることで、検出精度の低下を低減することができる。なお、撮像画像G全域を用いて基準画像TAの生成およびテンプレートマッチングを行ってもよく、この場合、必要に応じて、収差を考慮した補正を行うことが好ましい。
本実施形態では、撮像領域RIと第1軸J1との間の距離が十分に長いため、撮像画像G内において、円弧C1、C2は、それぞれ、ほぼ直線に近似することができる。したがって、撮像画像G内において、マーク画像21Aの移動方向は、X軸方向に一致していると考えることができる。
そうすると、マーク画像21Aは、基準画素座標(XA0,YA0)にある基準画像TAに対してX軸方向に画素数(XA1−XA0)分ずれた位置にあることとなる。したがって、撮像領域RIの中心と第1軸J1との間の距離をrとし、撮像素子31の1画素に対応する撮像領域RI上の領域のX軸方向での幅(撮像素子31の1画素あたりの視野サイズ)をWとしたとき、基台110に対する第1アーム120の回動角度θは、下記式(1)を用いて求めることができる。
Figure 2018120306
この式(1)において、(XA1−XA0)×Wは、基準画像TAの基準画素座標(XA0,YA0)に対応する実位置と、前述した相関値が最大値となる基準画像TAの画素座標(XA1,YA1)に対応する実位置との間の距離に相当する。また、2rπは、基台110に対して第1アーム120が360°回転したときのマーク21の軌跡の長さ(円周の長さ)に相当する。なお、θA0は、前述したように、マーク画像21Aが所定位置に位置するときの、基台110に対する第1アーム120の回動角度である。また、回動角度θは、第1アーム120が基台110に対して基準状態(0°)から回動した角度である。
このように回動角度θを求めるに際しては、画素座標(XA1,YA1)に隣接する画素の相関値を放物線あるいは放物曲面でフィッティングして最大となる相関値の座標を決定する、いわゆるサブピクセル推定法を用いることもできる。これにより、画素単位よりも細かい分解能で撮像画像G内でのマーク画像21Aの位置を求めることができ、その結果、回動角度θの検出精度を高めることができる。
以上のようなテンプレートマッチングおよびそれを用いた回動角度θの算出を他(文字[A]を示すマーク21以外)のマーク21についても同様に行う。ここで、任意の回動角度θにおいて、有効視野領域RU内に少なくとも1つのマーク21が欠けなく写り、かつ、テンプレートマッチング可能なように各マーク21に対応した基準画像が登録されている。これにより、テンプレートマッチングが不可能な角度範囲が生じることを防止することができる。
前述した図4では、任意の回動角度θにおいて、有効視野領域RU内に1つのマーク21が欠けなく写るように、マーク21および有効視野領域RUが構成されているが、任意の回動角度θにおいて、有効視野領域RU内に複数のマーク21が欠けなく写るように、マーク21および有効視野領域RUが構成されていることが好ましい。この場合、任意の回動角度θにおいて、有効視野領域RU内に写っている複数のマーク21に対してテンプレートマッチングが可能となるように、互いに隣り合う2つ以上のマーク21に対応する2つ以上の基準画像を用いてテンプレートマッチングを行う。このとき、当該2つ以上の基準画像が互いに部分的に重なっていてもよい。
すなわち、第1アーム120(回動部)には、複数のマーク21が配置されており、撮像素子31は、第1軸J1(回動軸)まわりの周方向に互いに隣り合う2つのマーク21全体を包含させて撮像することが好ましい。これにより、撮像素子31が撮像した2つのマーク21のうちの一方のマーク21が汚れ等により正確に読み取ることができなくなっても、他方のマーク21を読み取って検出を行うことができる。そのため、高精度な検出精度を担保しやすいという利点がある。
<第2実施形態>
図9は、本発明の第2実施形態に係るエンコーダーにおける探索領域(回動部の角速度を考慮して設定した領域)を説明するための図である。図10は、図9に示す探索領域(マークの移動軌跡を考慮して設定した領域)を説明するための図である。
以下、第2実施形態について説明するが、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。
本実施形態は、探索領域の設定範囲が異なる以外は、前述した第1実施形態と同様である。
前述した第1実施形態では、有効視野領域RUの全域を探索領域RSとして設定した。すなわち、前述した第1実施形態では、有効視野領域RUの全域の画素についてテンプレートマッチングを行って相関値を算出した。ここで、テンプレートマッチングを用いた回動角度θの判断に要する演算時間は、探索領域RSの画素数に比例する。また、回動角度θを求めるのに必要な画素座標は、相関値が最大となる画素座標(サブピクセル推定を用いる場合には、それに隣接する画素座標も必要となる)だけである。したがって、第1実施形態では、場合によっては、演算時間の大部分を無駄な演算に費やしていることとなる。
そこで、本実施形態では、過去の回動角度θの経時変化を利用して、次の撮像においてマーク21が写る位置を予測し、その位置近傍の限られた画素領域だけを探索領域RSに設定する。このように探索領域RSを設定することにより、テンプレートマッチングに関する演算量を大幅に低減し、演算時間も大幅に短縮することができる。
具体的に説明すると、判断部5は、回動角度θに関する判断結果の情報を各マーク21ごとに対応させて記憶部6に記憶させる。そして、判断部5は、記憶部6に記憶されている過去の判断結果(回動角度θ)に関する情報を用いて、探索領域RSの位置および範囲を設定(更新)する。
詳述すると、撮像素子31の撮像タイミングの時間間隔が一定である場合、前回にマーク21(図示では、文字「A」を示すマーク21)を撮像して判断した回動角度θをθ11とし、前々回に当該マーク21を撮像して判断した回動角度θをθ12とし、当該マーク21を今回撮像して判断される回動角度θの予測回動角度をθ14としたとき、基台110に対する第1アーム120の回転速度(角速度)が一定であれば、θ11、θ12およびθ14は、下記式(2)で表される。
Figure 2018120306
ここで、式(2)は、図9に示すように、前回の撮像によるマーク画像21Aであるマーク画像21An−1と今回の撮像によるマーク画像21Aであるマーク画像21Anとの間の中心間距離が、前々回の撮像によるマーク画像21Aであるマーク画像21An−2と前回の撮像によるマーク画像21Aであるマーク画像21An−1との中心間距離ΔXに等しくなることを意味する。しかし、実際は、基台110に対する第1アーム120の回転速度(角速度)が変動することが一般的であるため、その変動分をΔθとし、今回の実際の回動角度θをθ13としたとき、下記式(3)で表される。
Figure 2018120306
ここで、Δθの最大値が既知であれば、その最大値をΔθとすることで、θ13の範囲を一義的に決定することができる。また、θ14が決定すれば、有効視野領域RU内に存在する基準画像TAの角度情報である回動角度θA0からのズレ(θ14−θA0)を決定することもできる。そして、回動角度θA0は既知であるため、ズレ(θ14−θA0)に基づいて、有効視野領域RU内のどの画素範囲に基準画像TAに合致するマーク画像21Aがあるかを予測することができる。
θ13は変動分Δθの幅を有するため、探索領域RSのX軸方向での画素範囲L1は、θ14を基準として基準画像TAに対応する画素範囲に、少なくとも変動分Δθの幅に相当する画素分を加えた範囲となる。
また、探索領域RSのY軸方向での画素範囲は、前述した第1実施形態のように有効視野領域RUのY軸方向での全域であってもよいが、第1実施形態のようにマーク画像21Aが有効視野領域RU内を移動する軌跡(円弧C1、C2)を直線とみなせる場合、基準画像TAのY軸方向での画素範囲またはそれよりも若干大きい範囲とする。また、有効視野領域RU内での円弧C1、C2を直線とみなさない場合、図10に示すように、有効視野領域RU内における円弧C1、C2のY軸方向での画素範囲L0(最大範囲)に、探索領域RSのY軸方向での画素範囲L2を設定する。
このように探索領域RSを設定することで、有効視野領域RU内のマーク画像21AのY軸方向での位置変化が大きくなっても、適切な探索領域RSを設定することができる。また、探索領域RSのY軸方向での画素範囲を有効視野領域RUのY軸方向での一部とすることで、テンプレートマッチングの演算量を大幅に減らすことができる。ここで、比較的広範囲に二次元的に画像の探索を行う通常のテンプレートマッチングと異なり、探索領域RS内でのテンプレートマッチングを主にX軸方向に一次元的に行えばよいため、通常のテンプレートマッチングに比べて半分以下の演算量で済む。
以上のようなことから、本実施形態では、判断部5は、第1アーム120(回動部)の第1軸J1(回動軸)まわりの角速度に関する情報に基づいて、撮像画像G内における探索領域RSの「第1方向」であるX軸方向での位置および長さのうちの少なくとも一方を変更可能である。これにより、第1アーム120の回動状態(角速度)に応じた無駄の少ない探索領域RSを設定し、テンプレートマッチングに用いる探索領域RSの画素数をより少なくすることができる。
ここで、判断部5は、過去2回以上の回動角度θ(回動状態)の判断結果に基づいて、基台110(基部)に対する第1アーム120(回動部)の第1軸J1まわりの角速度に関する情報を算出する。これにより第1アーム120の回動状態(角速度)に応じた探索領域RSを比較的簡単に設定することができる。
以上説明したような第2実施形態によっても、低コスト化を図りつつ検出精度を高めることができる。
<第3実施形態>
図11は、本発明の第3実施形態に係るエンコーダーにおける探索領域(回動部の角速度および角加速度を考慮して設定した領域)を説明するための図である。
以下、第3実施形態について説明するが、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。
本実施形態は、探索領域の設定範囲が異なる以外は、前述した第1実施形態と同様である。
前述した第2実施形態では、探索領域RSを設定する際、過去2回の回動角度θ(θ11、12)に関する情報から予測した直前の第1アーム120の角速度のみを用いるため、角速度の変動分Δθの最大値を考慮した大きさの探索領域RSを設定する必要がある。
本実施形態では、探索領域RSを設定する際、過去3回以上の回動角度θに関する情報を用いる。これにより、第1アーム120の角速度に加えて角加速度も簡単な計算で予測することができる。このように角加速度を用いれば、前述した式(3)のΔθが一義的に決まるため、θ13も一つの値に決定することができる。なお、この決定したθ13は、あくまで予測値であるため、テンプレートマッチングを行って実際の高精度な回動角度θを求める必要はある。
例えば、図11に示すように、前回(n−1回目)の撮像によるマーク画像21Aであるマーク画像21An−1と前々回(n−2回目)の撮像によるマーク画像21Aであるマーク画像21An−2との中心間距離ΔXが、前々回(n−2回目)の撮像によるマーク画像21Aであるマーク画像21An−2と3回前(n−3回目)の撮像によるマーク画像21Aであるマーク画像21An−3との中心間距離ΔX1よりも大きい場合、前回の撮像によるマーク画像21An−1と今回の撮像によるマーク画像21Aであるマーク画像21Anとの中心間距離ΔX2は、中心間距離ΔXよりも大きくなる。
以上のようなことから、本実施形態では、判断部5は、第1アーム120(回動部)の第1軸J1(回動軸)まわりの角加速度に関する情報に基づいて、撮像画像内における探索領域RSの「第1方向」であるX軸方向での位置および長さのうちの少なくとも一方を変更可能である。これにより、第1アーム120の回動状態(角速度)の変化(角加速度)に応じたより無駄の少ない探索領域RSを設定することができる。
ここで、判断部5は、過去3回以上の回動角度θ(回動状態)の判断結果に基づいて、基台110(基部)に対する第1アーム120(回動部)の第1軸J1まわりの角加速度に関する情報を算出する。これにより、第1アーム120の回動状態(角速度)の変化(角加速度)に応じた探索領域RSを比較的簡単に設定することができる。
以上説明したような第3実施形態によっても、低コスト化を図りつつ検出精度を高めることができる。
<第4実施形態>
図12は、本発明の第4実施形態に係るエンコーダーにおける探索領域(回動部の回動角度を考慮して設定した領域)を説明するための図である。
以下、第4実施形態について説明するが、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。
本実施形態は、探索領域の設定範囲が異なる以外は、前述した第1実施形態と同様である。
前述した円弧C1、C2は、撮像領域RIの中心と第1軸J1との間の距離rを基に計算で求めることが可能であるし、また、距離rが正確にわからなくても、第1アーム120を回動させながら撮像素子31での撮像を行うことで予め知ることが可能である。事前に円弧C1またはC2がわかっていれば、前述した回動角度θ13を求めた後、円弧C1またはC2上の回動角度θ13に相当する画素座標をマーク画像21Aの予測画素座標(予測位置)として、基準画像TAの画素サイズよりも所定範囲だけ大きい画素範囲を探索領域RSとして設定することができる。この場合、探索領域RSのY軸方向での画素範囲L2を最小限(例えば、基準画像TAの画素サイズに対して上下1画素拡張する程度)にすることができる。これにより、探索領域RSの画素数をさらに少なくして、演算量を削減することができる。
以上のようなことから、本実施形態では、判断部5は、撮像画像G内における探索領域RSのX軸(第1方向)での位置に基づいて、撮像画像G内における探索領域RSのX軸方向に対して垂直なY軸方向(第2方向)での位置および長さのうちの少なくとも一方を変更可能である。これにより、第1アーム120の回動状態(回動角度)に応じた無駄の少ない探索領域RSを設定し、テンプレートマッチングに用いる探索領域RSの画素数をより少なくすることができる。
以上説明したような第4実施形態によっても、低コスト化を図りつつ検出精度を高めることができる。
<第5実施形態>
図13は、本発明の第5実施形態に係るエンコーダーにおける探索領域内での基準画像(テンプレート)を説明するための図である。図14は、図13に示す基準画像の姿勢を変化させた状態を示す図である。
以下、第5実施形態について説明するが、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。
本実施形態は、テンプレートマッチングにおける基準画像に角度補正を適宜行う以外は、前述した第1ないし第4実施形態と同様である。
前述したように、有効視野領域RU内のマーク21の画像は、円弧C1、C2に沿って移動するため、当該画像の位置によっては、当該画像の姿勢がX軸またはY軸に対して傾く。また、基準画像TAに対してマーク21の画像の傾きが大きくなると、テンプレートマッチングの誤差が大きくなり(例えば、位置が一致していたとしても相関値が小さくなり)、回動角度の判断精度の低下を招く。このような回動角度の判断精度の低下を防止する方法として、前述したように探索領域RS内で1画素ずつ基準画像TAをずらしながら基準画像TAの画素位置ごとに相関値を求めた後、相関値が所定値以上となるいくつかの画素位置について、例えば基準画像TAの姿勢(角度)を少しずつ変更しながら相関値を計算し直し、相関値が最大となる画素位置および角度を決定することが考えられる。しかし、この方法では、演算量が激増してしまう。
そこで、本実施形態では、有効視野領域RU内でのマーク21の画像の傾きは、回動角度θに応じて変化することに着目し、例えば前述した第2実施形態または第3実施形態と同様にして求めた回動角度θ13に基づいて、基準画像TAの姿勢を変更(以下、「傾き補正」ともいう)する。回動角度θ13がわかれば、基準画像TAの補正すべき傾斜角度βが一義的に決まり、基準画像TAを一回傾き補正する演算を追加するだけで済む。この追加する演算による演算量のわずかな増加はあるが、回動角度θの判断精度を高めることができる。
ところで、前述した実施形態では、基準画像TAの基準画素を左上端画素に設定した場合を説明したが、本実施形態のように基準画像TAの傾き補正を行う場合においては、図13に示すように、基準画像TAのできるだけ中心CPに近い画素を基準画素に設定し、その基準画素を基準(中心)として基準画像TAを傾斜角度β回転させて傾き補正を行うことが好ましい。これにより、基準画像TAの傾き補正に起因する基準画像TAの位置ずれを低減することができる。なお、中心CPを基準として基準画像TAの拡大または縮小する補正を行ってもよい。
また、基準画像TAの傾き補正を行うに際しては、基準画像TAの外周に所定幅分の画素を追加して基準画像TAの画素範囲を拡張した上で、その画素範囲を傾き補正に応じた角度(傾斜角度β)回転させ、その回転後の画素範囲を元の基準画像TAの画素範囲の大きさでトリミングすることが好ましい。これにより、図14に示すように、傾き補正後の基準画像TAに画素欠陥が生じるのを低減することができる。なお、基準画像TAに画素欠陥が生じたとしても、検出精度が低下するが、テンプレートマッチングが不可能となるわけではない。また、基準画像TAを傾き補正しなくても、探索領域RSを傾き補正することで、演算量の増加が大きくなるが、同様に判断精度を高めることができる。
また、このような基準画像TAの傾き補正は、基準画像TAの画素位置ごとに行ってもよいが、マーク21の傾きが小さい場合、基準画像TAの傾き補正を行わなくても、回動角度θの判断精度にほとんど影響がない。そこで、例えば、前述したようにθ13を予測したとき、その予測したθ13が所定角度以下か否かを判断し、所定角度よりも大きい場合に基準画像TAの傾き補正を行い、一方、所定角度以下である場合に基準画像TAの傾き補正を省略して演算時間を短縮する。
以上のようなことから、本実施形態では、判断部5は、基台110(基部)に対する第1アーム120(回動部)の回動角度θ13に関する情報に基づいて、撮像画像G内における基準画像TAの姿勢を変更可能である。これにより、探索領域RS内でマーク21の画像の姿勢の変化が大きい場合においても、テンプレートマッチングの演算量を低減しつつ、テンプレートマッチングの精度を高めることができる。
また、判断部5は、基台110(基部)に対する第1アーム120(回動部)の回動角度θ13が設定角度よりも大きいか否かを判断し、その判断結果に基づいて、撮像画像G内における基準画像TAの姿勢を変更する。これにより、テンプレートマッチングの高精度化を図りつつ、テンプレートマッチングの演算量をより低減することができる。
<第6実施形態>
図15は、本発明の第6実施形態に係るエンコーダーを説明するための断面図である。
以下、第6実施形態について説明するが、前述した実施形態との相違点を中心に説明し、同様の事項については、その説明を省略する。
本実施形態は、エンコーダーが有するマークの設置位置およびそれに関する構成が異なる以外は、前述した第1実施形態と同様である。
図15に示すロボット10Dは、基台110に対する第1アーム120の回動状態を検出するエンコーダー1Dを備える。このエンコーダー1Dは、第1アーム120の軸部122の周面に設けられているマーク部2Dと、基台110に設けられ、マーク部2Dが有するマーク(図示せず)を検出するマーク検出部3と、マーク検出部3の検出結果に基づいて基台110および第1アーム120の相対的な回動状態を判断する判断部5と、判断部5に電気的に接続されている記憶部6と、を有する。
マーク部2Dは、図示しないが、軸部122の外周面に周方向に沿って配置されている複数のマークを有する。この複数のマークは、例えば、前述した第1実施形態のマーク21と同様のマークを用いることができる。すなわち、軸部122の周面(円筒面)には、文字、数字、記号等の識別し得る複数のマークが周方向に沿って並んで配置されている。なお、マーク部2Dが有するマークは、軸部122の表面に直接設けられていてもよいし、軸部122に取り付けられた円筒状の部材に設けられていてもよい。
本実施形態では、マーク検出部3が有する撮像素子31およびレンズ32は、マーク部2Dのマークを検出し得るように配置されている。すなわち、マーク部2Dのマークとマーク検出部3とが並ぶ方向が第1軸J1に交差する方向(本実施形態では直交する方向)である。これにより、マーク部2Dのマークおよびマーク検出部3を第1軸J1に近づけることができる。その結果、基台110の小型化や軽量化を図ることができる。
また、このようなエンコーダー1Dでは、軸部122の外周面に撮像素子31の撮像領域が設定される。そして、前述した第1実施形態と同様にテンプレートマッチングを行う。その際、マーク部2Dのマークは、軸部122の外周面に設けられているため、軸部122の回動に伴って当該撮像領域内を一定の姿勢のまま直線的に移動する。そのため、テンプレートマッチングを行う際に、当該撮像領域内での当該マークの姿勢に応じて基準画像(テンプレート)の向きを変化させる必要がなく、基準画像を一方向に移動させるだけで済むため、テンプレートテンプレートマッチングの演算量を少なくすることができるという利点がある。
ただし、軸部122の外周面は湾曲しているため、レンズ32が拡大光学系や縮小光学系である場合、レンズとの距離が変化することにより撮像素子31の撮像領域内におけるマーク部2Dのマークの大きさが当該撮像領域内の位置に応じて変化してしまう。したがって、テンプレートマッチングに際しては、その精度を高める観点から、基準画像の拡大または縮小を行うことが好ましい。また、そのような基準画像の拡大または縮小を行わなくても、そのようなマーク部2Dのマークの大きさの変化がないとみなせる小さい範囲に探索領域を設定するか、または、撮像素子31の探索領域内におけるマーク部2Dのマークの大きさが変化しないようにレンズ32を設計することで、高精度なテンプレートマッチングを行うことが可能である。
以上説明したような第7実施形態によっても、低コスト化を図りつつ検出精度を高めることができる。
(プリンター)
図16は、本発明のプリンターの実施形態の概略構成を示す図である。
図16に示すプリンター1000は、ドラム状のプラテンを備えたラベル印刷装置である。このプリンター1000では、その両端が繰出軸1120および巻取軸1140に記録媒体としてのロール状に巻き付けられた紙系やフィルム系等の1枚のシートS(ウェブ)が、繰出軸1120と巻取軸1140の間に張架されており、シートSはこうして張架された搬送経路Scに沿って、繰出軸1120から巻取軸1140へと搬送される。そして、プリンター1000は、この搬送経路Scに沿って搬送されるシートSに対して機能液を吐出してシートS上に画像を記録(形成)するように構成されている。
プリンター1000は、概略的な構成として、繰出軸1120からシートSを繰り出す繰出部1102と、繰出部1102から繰り出されたシートSに画像を記録するプロセス部1103と、プロセス部1103で画像の記録されたシートSを切り抜くレーザースキャナー装置1007と、シートSを巻取軸1140に巻き取る巻取部1104とを含み構成されている。
繰出部1102は、シートSの端を巻き付けた繰出軸1120と、繰出軸1120から引き出されたシートSを巻き掛ける従動ローラー1121と、を有する。
プロセス部1103は、繰出部1102から繰り出されたシートSを支持部としてのプラテンドラム1130で支持しつつ、プラテンドラム1130の外周面に沿って配置されたヘッドユニット1115に配置された記録ヘッド1151等により適宜処理を行わせ、シートSに画像を記録するものである。
プラテンドラム1130は、図示しない支持機構によりドラム軸1130sを中心にして回転自在に支持された円筒形状のドラムであり、繰出部1102から巻取部1104へと搬送されるシートSを裏面(記録面とは反対側の面)側から巻き掛けられる。このプラテンドラム1130は、シートSとの間の摩擦力を受けてシートSの搬送方向Dsに従動回転しつつ、周方向での範囲Raにわたって、シートSを裏面側から支持するものである。ここで、プロセス部1103では、プラテンドラム1130への巻き掛け部の両側でシートSを折り返す従動ローラー1133、1134が設けられている。また、繰出軸1120と従動ローラー1133との間には、従動ローラー1121、1131およびセンサーSeが設けられ、巻取軸1140と従動ローラー1134との間には、従動ローラー1132、1141が設けられている。
プロセス部1103は、ヘッドユニット1115を備え、ヘッドユニット1115には、イエロー、シアン、マゼンタおよびブラックに対応する4個の記録ヘッド1151が設けられている。各記録ヘッド1151は、プラテンドラム1130に巻き掛けられたシートSの表面に対して若干のクリアランス(プラテンギャップ)を空けて対向しており、対応する色の機能液をノズルからインクジェット方式で吐出する。そして、搬送方向Dsへ搬送されるシートSに対して各記録ヘッド1151が機能液を吐出することにより、シートSの表面にカラー画像が形成される。
ここで、機能液として、紫外線(光)を照射することで硬化するUV(ultraviolet)インク(光硬化性インク)を用いる。そのため、プロセス部1103のヘッドユニット1115には、UVインクを仮硬化させてシートSに定着させるために、複数の記録ヘッド1151の各間に第1UV光源1161(光照射部)が設けられている。また、複数の記録ヘッド1151(ヘッドユニット1115)に対して搬送方向Dsの下流側には、本硬化用の硬化部としての第2UV光源1162が設けられている。
レーザースキャナー装置1007は、画像の記録されたシートSを部分的に切り抜く、もしくは分断するように設けられている。レーザースキャナー装置1007のレーザー発振器1401によって発振されたレーザー光は、エンコーダー1を含む駆動装置1402、1406、1408によって位置または回転位置(角度)を制御された第1レンズ1403および第1ミラー1407や第2ミラー1409などを経由し、被加工物であるシートSに照射される。このように、シートSに照射されるレーザー光LAは、各駆動装置1402、1406、1408によって照射位置が制御され、シートS上の所望の位置に照射することができる。シートSは、レーザー光LAの照射された部分が溶断され、部分的に切り抜かれるか、もしくは分断される。
以上のようなプリンター1000は、エンコーダー1を備える。このエンコーダー1は、前述したように、低コスト化を図りつつ検出精度を高めることができる。そのため、エンコーダー1の検出結果を用いて、プリンター1000の高精度な動作制御を行うことができる。また、プリンター1000の低コスト化を図ることもできる。
以上、本発明のエンコーダー、ロボットおよびプリンターを図示の好適な実施形態に基づいて説明したが、本発明はこれに限定されるものではなく、各部の構成は、同様の機能を有する任意の構成のものに置換することができる。また、他の任意の構成物が付加されていてもよい。また、前述した2つ以上の実施形態の構成を組み合わせてもよい。
また、前述した実施形態では、ロボットの基台を「第1部材」または「基部」、第1アームを「第2部材」または「回動部」とした場合を例に説明したが、これに限定されず、相対的に回動する任意の2つの部材の一方を「第1部材」または「基部」、他方を「第2部材」または「回動部」とすることができる。すなわち、エンコーダーの設置箇所は、基台と第1アームとの関節部に限定されず、相対的に回動する任意の2つのアームの関節部であってもよい。また、エンコーダーの設置箇所は、ロボットが有する関節部に限定されない。
また、前述した実施形態では、ロボットアームの数は、1つであったが、ロボットアームの数は、これに限定されず、例えば、2つ以上でもよい。すなわち、本発明のロボットは、例えば、双腕ロボット等の複数腕ロボットであってもよい。
また、前述した実施形態では、ロボットアームが有するアームの数は、2つであったが、アームの数は、これに限定されず、例えば、1つまたは3つ以上でもよい。
また、前述した実施形態では、本発明のロボットの設置箇所は、床面に限定されず、例えば、天井面や側壁面等でもよい。また、本発明のロボットは、建物等の構造物に固定設置されるものに限定されず、例えば、脚部を有する脚式歩行(走行)ロボットであってもよい。
また、前述した実施形態では、本発明のロボットの一例として、水平多関節ロボットを例に説明したが、本発明のロボットは、相対的に回動する2つの部材を有すれば、垂直多関節ロボット等の他の形式のロボットであってもよい。
また、本発明のエンコーダーは、前述したプリンターに限定されず、回転部を有する産業用プリンター、民生用プリンター等の各種プリンターに用いることができる。また、本発明のエンコーダーをプリンターに用いる場合、エンコーダーの設置箇所は、前述したものに限定されず、例えば、紙送り機構、インクジェットプリンターのインクヘッドを搭載したキャリッジの移動機構等に用いてもよい。
1…エンコーダー、2…マーク部、3…マーク検出部、5…判断部、6…記憶部、21…マーク、21A…マーク画像、21An…マーク画像、21An−1…マーク画像、21An−2…マーク画像、21An−3…マーク画像、21B…マーク画像、21X…マーク画像、31…撮像素子、32…レンズ、51…画像認識回路、100…ロボット、110…基台(基部)、111…第1モーター、112…第1減速機、114…支持部材、115…軸受、120…第1アーム(回動部)、121…アーム本体部、122…軸部、130…第2アーム、140…作業ヘッド、141…スプラインシャフト、150…エンドエフェクター、160…部、1000…プリンター、1007…レーザースキャナー装置、1102…繰出部、1103…プロセス部、1104…巻取部、1111…回転軸、1115…ヘッドユニット、1120…繰出軸、1121…従動ローラー、1130…プラテンドラム、1130s…ドラム軸、1131…従動ローラー、1132…従動ローラー、1133…従動ローラー、1134…従動ローラー、1140…巻取軸、1141…従動ローラー、1151…記録ヘッド、1161…第1UV光源、1162…第2UV光源、1401…レーザー発振器、1402…駆動装置、1403…第1レンズ、1406…駆動装置、1407…第1ミラー、1408…駆動装置、1409…第2ミラー、A…マーク21画像、C1…円弧、C2…円弧、CP…中心、Ds…搬送方向、G…撮像画像、J1…第1軸(回動軸)、J2…第2軸、J3…軸、L0…画素範囲、L1…画素範囲、L2…画素範囲、LA…レーザー光、LY…中心線、P0…原点画素、PE…終了画素、PS…開始座標、RI…撮像領域、RS…探索領域、RU…有効視野領域、Ra…範囲、S…シート、Sc…搬送経路、Se…センサー、TA…基準画像、ΔX…中心間距離、ΔX1…中心間距離、ΔX2…中心間距離、β…傾斜角度

Claims (12)

  1. 基部と、
    前記基部に対して回動軸まわりに回動可能に設けられている回動部と、
    前記回動部に前記回動軸まわりに沿って配置されているマークと、
    前記基部に配置され、前記マークを撮像する撮像素子と、
    前記撮像素子の撮像画像に対して基準画像を用いてテンプレートマッチングを行うことにより前記マークを検出し、その検出結果に基づいて、前記基部に対する前記回動部の回動状態を判断する判断部と、を備えることを特徴とするエンコーダー。
  2. 前記回動部には、複数の前記マークが配置されており、
    前記撮像素子は、前記回動軸まわりの周方向に互いに隣り合う2つの前記マーク全体を包含させて撮像する請求項1に記載のエンコーダー。
  3. 前記判断部は、前記撮像画像の一部の領域に探索領域を設定し、前記探索領域内で前記テンプレートマッチングを行う請求項1または2に記載のエンコーダー。
  4. 前記判断部は、前記回動部の前記回動軸まわりの角速度に関する情報に基づいて、前記撮像画像内における前記探索領域の第1方向での位置および長さのうちの少なくとも一方を変更可能である請求項3に記載のエンコーダー。
  5. 前記判断部は、過去2回以上の前記回動状態の判断結果に基づいて、前記角速度に関する情報を算出する請求項4に記載のエンコーダー。
  6. 前記判断部は、前記回動部の前記回動軸まわりの角加速度に関する情報に基づいて、前記撮像画像内における前記探索領域の第1方向での位置および長さのうちの少なくとも一方を変更可能である請求項4または5に記載のエンコーダー。
  7. 前記判断部は、過去3回以上の前記回動状態の判断結果に基づいて、前記角加速度に関する情報を算出する請求項6に記載のエンコーダー。
  8. 前記判断部は、前記撮像画像内における前記探索領域の前記第1方向での位置に基づいて、前記撮像画像内における前記探索領域の前記第1方向に対して垂直な第2方向での位置および長さのうちの少なくとも一方を変更可能である請求項4ないし7のいずれか1項に記載のエンコーダー。
  9. 前記判断部は、前記基部に対する前記回動部の回動角度に関する情報に基づいて、前記撮像画像内における前記基準画像の姿勢を変更可能である請求項1ないし8のいずれか1項に記載のエンコーダー。
  10. 前記判断部は、前記基部に対する前記回動部の回動角度が設定角度よりも大きいか否かを判断し、その判断結果に基づいて、前記撮像画像内における前記基準画像の姿勢を変更する請求項9に記載のエンコーダー。
  11. 請求項1ないし10のいずれか1項に記載のエンコーダーを備えることを特徴とするロボット。
  12. 請求項1ないし10のいずれか1項に記載のエンコーダーを備えることを特徴とするプリンター。
JP2017009720A 2017-01-23 2017-01-23 エンコーダー、ロボットおよびプリンター Active JP6878908B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2017009720A JP6878908B2 (ja) 2017-01-23 2017-01-23 エンコーダー、ロボットおよびプリンター
CN201711465715.4A CN108340368B (zh) 2017-01-23 2017-12-28 编码器、机器人以及打印机
US15/873,386 US10845218B2 (en) 2017-01-23 2018-01-17 Encoder, robot, and printer

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017009720A JP6878908B2 (ja) 2017-01-23 2017-01-23 エンコーダー、ロボットおよびプリンター

Publications (2)

Publication Number Publication Date
JP2018120306A true JP2018120306A (ja) 2018-08-02
JP6878908B2 JP6878908B2 (ja) 2021-06-02

Family

ID=62906037

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017009720A Active JP6878908B2 (ja) 2017-01-23 2017-01-23 エンコーダー、ロボットおよびプリンター

Country Status (3)

Country Link
US (1) US10845218B2 (ja)
JP (1) JP6878908B2 (ja)
CN (1) CN108340368B (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020004112A1 (ja) 2018-06-25 2020-01-02 株式会社ブリヂストン ランフラットタイヤ
US10775204B2 (en) 2018-02-15 2020-09-15 Seiko Epson Corporation Encoder unit, angle measuring method, and robot
JP2021003783A (ja) * 2019-06-27 2021-01-14 セイコーエプソン株式会社 ロボット
WO2021059341A1 (ja) * 2019-09-24 2021-04-01 株式会社Fuji 角度伝達誤差測定装置

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6632487B2 (ja) * 2016-07-13 2020-01-22 キヤノン株式会社 連続体ロボット、その運動学の補正方法、および連続体ロボットの制御方法
CN109531555B (zh) * 2018-12-05 2024-02-23 诺伯特智能装置(山东)有限公司 一种四轴水平关节机器人
US10703099B1 (en) * 2018-12-14 2020-07-07 Markem-Imaje Corporation Method and device for enabling a pattern to be marked on a substrate

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000136944A (ja) * 1998-10-30 2000-05-16 Sony Corp 回転角度測定装置

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2712163B2 (ja) 1987-01-30 1998-02-10 ソニー株式会社 位置読み取りエンコーダ
JPH05120436A (ja) 1991-10-25 1993-05-18 Yaskawa Electric Corp テンプレートマツチング方法
US6937349B2 (en) 2003-05-02 2005-08-30 Mitutoyo Corporation Systems and methods for absolute positioning using repeated quasi-random pattern
JP4661445B2 (ja) * 2005-08-12 2011-03-30 セイコーエプソン株式会社 エンコーダ
JP5034852B2 (ja) 2007-10-09 2012-09-26 富士通株式会社 画像計測方法及び画像計測装置
JP4181210B1 (ja) 2008-06-11 2008-11-12 株式会社ファースト サブピクセルテンプレートマッチング方法、当該方法を実現するコンピュータプログラムおよび当該プログラム格納媒体
JP2010030281A (ja) * 2008-06-27 2010-02-12 Canon Inc 搬送装置及び記録装置
JP5971028B2 (ja) 2011-10-04 2016-08-17 株式会社明電舎 回転角度計測装置及び方法
US10119842B1 (en) * 2014-08-05 2018-11-06 X Development Llc Encoder design and use
WO2016136086A1 (ja) * 2015-02-27 2016-09-01 ソニー株式会社 撮像装置と画像処理装置と画像処理方法
JP2016187846A (ja) * 2015-03-30 2016-11-04 セイコーエプソン株式会社 ロボット、ロボット制御装置およびロボットシステム
JP6838278B2 (ja) 2016-03-28 2021-03-03 セイコーエプソン株式会社 ロボット
CN106323474B (zh) * 2016-08-22 2017-12-01 沈阳建筑大学 石材表面色差检测装置及控制系统

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000136944A (ja) * 1998-10-30 2000-05-16 Sony Corp 回転角度測定装置

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10775204B2 (en) 2018-02-15 2020-09-15 Seiko Epson Corporation Encoder unit, angle measuring method, and robot
WO2020004112A1 (ja) 2018-06-25 2020-01-02 株式会社ブリヂストン ランフラットタイヤ
JP2021003783A (ja) * 2019-06-27 2021-01-14 セイコーエプソン株式会社 ロボット
JP7375345B2 (ja) 2019-06-27 2023-11-08 セイコーエプソン株式会社 ロボット
WO2021059341A1 (ja) * 2019-09-24 2021-04-01 株式会社Fuji 角度伝達誤差測定装置

Also Published As

Publication number Publication date
CN108340368A (zh) 2018-07-31
JP6878908B2 (ja) 2021-06-02
CN108340368B (zh) 2022-09-27
US10845218B2 (en) 2020-11-24
US20180209822A1 (en) 2018-07-26

Similar Documents

Publication Publication Date Title
JP6878908B2 (ja) エンコーダー、ロボットおよびプリンター
CN109571463B (zh) 编码器、机器人和打印机
US20110080476A1 (en) High Performance Vision System for Part Registration
US10788814B2 (en) Encoder, robot, and printer
JP6809245B2 (ja) ロボット
JP2019143979A (ja) エンコーダーユニット、角度検出方法およびロボット
WO2018198832A1 (ja) 立体物印刷システムおよび立体物印刷方法
KR20190133223A (ko) 입체물 인쇄 시스템 및 입체물 인쇄 방법
US10252414B2 (en) Robot and printer including a telecentric optical system between an imaging element and a mark of an encoder
JP4286677B2 (ja) レーザマーキング装置及びレーザマーキング方法
JP2019035700A (ja) エンコーダー、ロボットおよびプリンター
JP5171486B2 (ja) 物体の移動検出方法およびプリンタ
JP6761590B2 (ja) 光加工装置
JP2019143980A (ja) エンコーダー、角度検出方法、ロボットおよびプリンター
JP7285658B2 (ja) 印字装置および印字方法
JP2011167724A (ja) レーザ加工装置
JP4603838B2 (ja) レーザ印字装置、そのプログラム
JP2020051940A (ja) エンコーダー、エンコーダーの製造方法、ロボットおよびプリンター
JP2012101311A (ja) トンボ検出プログラム、トンボ検出装置及びトンボ検出方法
JP2012526300A (ja) 記録装置の校正
JP4511974B2 (ja) 製版方法、版胴、印刷機およびその制御方法
JP2018140419A (ja) 光加工装置及び光加工物の生産方法
KR100465684B1 (ko) 이미지 센서의 위치조정 장치와 그 방법
JP2016150398A (ja) 駆動装置、ステージ装置、及び産業機械
JP2008030234A (ja) 媒体上のパターンの印刷位置の算出方法

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20191119

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20201207

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20201215

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210210

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210412

R150 Certificate of patent or registration of utility model

Ref document number: 6878908

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150