JP6990231B2 - 位置検出装置およびその組立方法 - Google Patents

位置検出装置およびその組立方法 Download PDF

Info

Publication number
JP6990231B2
JP6990231B2 JP2019503253A JP2019503253A JP6990231B2 JP 6990231 B2 JP6990231 B2 JP 6990231B2 JP 2019503253 A JP2019503253 A JP 2019503253A JP 2019503253 A JP2019503253 A JP 2019503253A JP 6990231 B2 JP6990231 B2 JP 6990231B2
Authority
JP
Japan
Prior art keywords
magnetic
magnetic ring
pairs
ring
disc
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
JP2019503253A
Other languages
English (en)
Other versions
JP2019521362A (ja
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.)
CMR Surgical Ltd
Original Assignee
CMR Surgical 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 CMR Surgical Ltd filed Critical CMR Surgical Ltd
Publication of JP2019521362A publication Critical patent/JP2019521362A/ja
Application granted granted Critical
Publication of JP6990231B2 publication Critical patent/JP6990231B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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/12Mechanical 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 using electric or magnetic means
    • G01D5/14Mechanical 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 using electric or magnetic means influencing the magnitude of a current or voltage
    • G01D5/142Mechanical 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 using electric or magnetic means influencing the magnitude of a current or voltage using Hall-effect devices
    • G01D5/145Mechanical 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 using electric or magnetic means influencing the magnitude of a current or voltage using Hall-effect devices influenced by the relative movement between the Hall device and magnetic fields
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/003Measuring arrangements characterised by the use of electric or magnetic techniques for measuring position, not involving coordinate determination
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q17/00Arrangements for observing, indicating or measuring on machine tools
    • B23Q17/007Arrangements for observing, indicating or measuring on machine tools for managing machine functions not concerning the tool
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q17/00Arrangements for observing, indicating or measuring on machine tools
    • B23Q17/22Arrangements for observing, indicating or measuring on machine tools for indicating or measuring existing or desired position of tool or work
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q7/00Arrangements for handling work specially combined with or arranged in, or specially adapted for use in connection with, machine tools, e.g. for conveying, loading, positioning, discharging, sorting
    • B23Q7/003Cyclically moving conveyors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B7/00Measuring arrangements characterised by the use of electric or magnetic techniques
    • G01B7/30Measuring arrangements characterised by the use of electric or magnetic techniques for measuring angles or tapers; for testing the alignment of axes
    • 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/12Mechanical 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 using electric or magnetic means
    • 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/12Mechanical 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 using electric or magnetic means
    • G01D5/244Mechanical 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 using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
    • G01D5/245Mechanical 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 using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using a variable number of pulses in a train
    • G01D5/2451Incremental encoders
    • G01D5/2452Incremental encoders incorporating two or more tracks having an (n, n+1, ...) relationship
    • 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/12Mechanical 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 using electric or magnetic means
    • G01D5/244Mechanical 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 using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
    • G01D5/249Mechanical 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 using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains using pulse code
    • G01D5/2497Absolute encoders
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B34/00Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
    • A61B34/30Surgical robots
    • A61B2034/305Details of wrist mechanisms at distal ends of robotic arms
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B23MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
    • B23QDETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
    • B23Q17/00Arrangements for observing, indicating or measuring on machine tools
    • B23Q2017/001Measurement or correction of run-out or eccentricity

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Robotics (AREA)
  • Surgery (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Medical Informatics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Biomedical Technology (AREA)
  • Molecular Biology (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
  • Transmission And Conversion Of Sensor Element Output (AREA)
  • Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
  • Manipulator (AREA)

Description

関節構造を含む用途では、多くの場合、関節構造の最も遠位のリンクの遠位端の位置を決定することが望ましい。これは、関節構造に沿った最後の部分に対する各リンクの位置をその基部から最も遠位のリンクまで検知することによって達成することができる。この一連の測定は、基部に対する最も遠位のリンクの遠位端の位置を決定するために、関節構造の既知のレイアウトと組み合わせて用いられてもよい。回転位置センサはリンク間の相対的な回転を感知するために使用される。リニア位置センサは、リンク間の相対的な長さ方向の動きを感知するために使用される。
ホール効果磁気センサは、リンク間の相対的な動きを感知するために一般的に使用されている。代表的な回転位置センサでは、リングの周囲に一組の磁極が交互に配列されている。センサはリングと相互に作用しており、感知されることが望まれる回転が生じた際に磁極がセンサを通過するように配置されている。例えば、リングがシャフトの周りに取り付けられていてもよいし、センサが、シャフトがその中で回転するハウジングに取り付けられていてもよい。磁極がセンサを通過すると、センサは極性の変化を検出する。極性の変化の数を数えることによって、基準位置からの回転量を感知することができる。回転方向を感知するために、2つのそのようなリングおよびセンサの対が設けられ、一方のセンサが、他方のセンサがそのリングの磁気変化を検出する位置からオフセットした回転位置で、そのリングの磁気変化を検出するように配置されていてもよい。各センサによって検出された磁気変化の相対的なタイミングを考慮することによって、回転方向が検知されていてもよい。
ロボット工学の分野では、ロボットアームとして関節構造を利用している。ロボットアームにとって、正確な位置検知は、それらのエンドエフェクタが意図したとおりに正確に操作されることを保証するために重要である。位置センサの磁気リングが大きいほど、ロボットアームの2つのリンクの相対的な回転がより正確に感知される。しかしながら、いくつかのロボット工学の用途、例えば外科用ロボット工学の分野では、位置センサが利用可能な空間内に収まりかつそれらがアームに加わる重量を最小にするために非常にコンパクトであることが望ましい。
したがって、正確さとコンパクトさの競合する要求をバランスさせる改良された位置センサが必要とされている。
本発明によれば、関節構造の回転ジョイントの位置を検出するための位置検出装置の組立方法が提供されており、この位置検出装置は、磁気センサアセンブリと、j個の磁極対を含む第1の磁気リングおよびk個の磁極対を含む第2の磁気リングを有するディスクを含み、ディスクの境界が関節構造によって拘束されており、この方法は、第1の磁気リングが少なくとも磁気センサアセンブリによって拘束された境界から離されるように、第1の磁気リングの磁極対の数を整数pとなるように決定し、第2の磁気リングが第1の磁気リングから所定の距離だけ離されるように、第2の磁気リングの磁極対の数を整数qとなるように決定し、pとqが互いに素である場合、jをpとなるように、かつkをqとなるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含む。
pとqが互いに素でない場合、この方法は、pとqとの間の差が各反復毎に1ずつ増加するように、第2の磁気リングの磁極対の数に対してさらなる値qを反復して決定し、各反復に対して、pとqが互いに素である場合、第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、p'が第1の磁気リングの磁極対の数の範囲内にあり、q'が第2の磁気リングの極対の数の範囲内にあり、そのp'、q'対に対して第2の磁気リングが第1の磁気リングから少なくとも所定の距離だけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、p'の最大値を有する識別されたp'、q'対を選択し、jを選択されたp'となるように、かつkを前記選択されたq'となるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含んでいてもよい。
pとqが互いに素でない場合、この方法は、pとqとの間の差が各反復毎に1ずつ増加するように、第2の磁気リングの磁極対の数に対してさらなる値qを反復して決定し、各反復に対して、pとqが互いに素である場合、第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、p'が第1の磁気リングの磁極対の数の範囲内にあり、q'が第2の磁気リングの極対の数の範囲内にあり、そのp'、q'対に対して第2の磁気リングが第1の磁気リングから少なくとも所定の距離だけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、q'の最大値を有する識別されたp'、q'対を選択し、jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含んでいてもよい。
pとqが互いに素でない場合、この方法は、pとqとの間の差が各反復毎に1ずつ増加するように、第2の磁気リングの磁極対の数に対してさらなる値qを反復して決定し、各反復に対して、pとqが互いに素である場合、第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、p'が第1の磁気リングの磁極対の数の範囲内にあり、q'が第2の磁気リングの極対の数の範囲内にあり、そのp'、q'対に対して第2の磁気リングが第1の磁気リングから少なくとも所定の距離だけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、q'の最小値を有する識別されたp'、q'対を選択し、jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含んでいてもよい。
pとqが互いに素でない場合、この方法は、pとqとの間の差が各反復毎に1ずつ増加するように、第2の磁気リングの磁極対の数に対してさらなる値qを反復して決定し、各反復に対して、pとqが互いに素である場合、第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、p'が第1の磁気リングの磁極対の数の範囲内にあり、q'が第2の磁気リングの極対の数の範囲内にあり、そのp'、q'対に対して第2の磁気リングが第1の磁気リングから少なくとも所定の距離だけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、|p'-q'|の最小値を有する識別されたp'、q'対を選択し、jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含んでいてもよい。
第1の磁気リングと第2の磁気リングは同心であり、第1の磁気リングは第2の磁気リングの内側にあり、拘束された境界はディスクの内側の半径方向の境界であってもよい。
この方法は、p'>pおよびq'<qの場合、各反復毎にqを1だけ増加することによってさらなる値qを反復して決定することを含んでいてもよく、また、この方法は、各反復に対して、pとqが互いに素である場合、pを第1の磁気リングの磁極対の数の範囲の下限とし、qを第2の磁気リングの磁極対の数の範囲の上限とすることを含んでいる。
第1の磁気リングと第2の磁気リングは同心であり、第1の磁気リングは第2の磁気リングの外側にあり、拘束された境界はディスクの外側の半径方向の境界であってもよい。
この方法は、p'<pおよびq'>qの場合、各反復毎にqを1だけ減少することによってさらなる値qを反復して決定することを含んでいてもよく、また、この方法は、各反復に対して、pとqが互いに素である場合、pを第1の磁気リングの磁極対の数の範囲の上限とし、qを第2の磁気リングの磁極対の数の範囲の下限とすることを含んでいる。
pとqが互いに素でない場合、この方法は、pとqとの間の差が各反復毎に1ずつ増加するように、第2の磁気リングの磁極対の数に対してさらなる値qを反復して決定し、各反復に対して、pとqが互いに素である場合、第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、p'が第1の磁気リングの磁極対の数の範囲内にあり、q'が第2の磁気リングの極対の数の範囲内にあり、そのp'、q'対に対して第2の磁気リングが第1の磁気リングから少なくとも所定の距離だけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、位置検出装置により検出された回転ジョイントの最大回転角によって識別されたp'、q'対を選択し、jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、を含んでいてもよい。
ディスクが、l個の磁極対を有する第3の磁気リングをさらに含んでいてもよく、この方法が、第3の磁気リングが第2の磁気リングからさらなる所定の距離だけ離されるように、第3の磁気リングの磁極対の数を整数sに決定し、p、qおよびsが互いに素である場合、jをpとなるように、kをqとなるように、かつlをsとなるように選択し、ディスクと回転ジョイントの両方が同じ軸周りに回転できるようにディスクを関節構造に取り付けることにより位置検出装置を組み立てること、をさらに含んでいてもよい。
本発明のさらなる態様によれば、位置検出装置は、j個の磁極対を有する第1の磁気アレイと、k個の磁極対を有する第2の磁気アレイと、第1の磁気アレイに対して固定された第2の磁気アレイと、磁気センサアセンブリと第1の磁気アレイと第2の磁気アレイの相対的な位置を検出する磁気センサアセンブリと、を含んでいる。ここで、jとkは互いに素であり、|j-k|>1である。
好ましくは、|j-k|>7であることが望ましい。
位置検出装置は、関節構造に取り付けられていてもよく、そこで第1の磁気アレイは第1の磁気リングであり第2の磁気アレイは第2の磁気リングであり、位置検出装置は、関節構造の回転ジョイントの位置を検知するためのものであり、第1の磁気リング、第2の磁気リング、および回転ジョイントはすべて同じ軸周りに回転することができるように、第1の磁気リングおよび第2の磁気リングは関節構造に取り付けられている。
第1および第2の磁気リングは両方ともディスク上に配置されていてもよい。第1および第2の磁気リングは、ディスクの同じ面または対向する面に配置されていてもよい。第1および第2の磁気リングは軸に沿って分離されていてもよい。第2の磁気リングは、所定の距離だけ第1の磁気リングから半径方向に分離されていてもよい。
所定の距離は、少なくとも磁極対の長さがあればよい。
磁気センサアセンブリは、第1の磁気アレイ上に配置された第1の磁気センサアレイと、第2の磁気アレイ上に配置された第2の磁気センサアレイを含み、第1および第2の磁気センサアレイの各々の隣接するセンサが磁極対の長さの4分の1だけ離されていてもよい。
第1の磁気センサアレイは、第1の磁気リングの半径方向の広がりよりも小さい半径方向の広がりを有していてもよく、第2の磁気センサアレイは、第2の磁気リングの半径方向の広がりよりも小さい半径方向の広がりを有していてもよい。
第1および第2の磁気センサアレイの各々は直線的であってもよい。第1および第2の磁気センサアレイの各々は、4つのセンサを含んでいてもよい。第1および第2の磁気センサアレイのいずれかまたは両方は、環状に配置されていてもよい。
位置検出装置はさらに、l個の磁極対を有する第3の磁気リングを含んでおり、第3の磁気リングは、第1および第2の磁気リングに対して固定され、第1および第2の磁気リングと同じ軸周りに回転可能となるように関節構造に取り付けられていてもよい。ここで、j、kおよびlは、互いに素であり、|l-k|>1かつ|l-j|>1である。
本発明を、添付図面を参照して説明する。
位置検出装置を備えたシャフトの概略図である。 図1のディスク3の寸法を示す図である。 図1の磁気リングの一部を示す図である。 図1の磁気センサアレイを示す図である。 位置センサ読取値の理論値および実測値を示すグラフである。 内側の半径方向の境界が制限されている時に2つの磁気リングに対して磁極対の数を決定する方法を示すフローチャートである。 外側の半径方向の境界が制限されている時に2つの磁気リングに対する磁極対の数を決定する方法を示すフローチャートである。 位置センサ読取値の理論値および実測値を示すグラフである。 ディスクを取り付けるための装置を示す図である。 磁気センサアレイによって検出された磁場を示す図である。 単一の磁極対が磁気センサアセンブリを通過する間に取得された位置センサ読取値の理論値および実測値を示す図である。 磁極対に対する補正関数を示す図である。 磁気リング全体が磁気センサアセンブリを通過する間に取得された位置センサ読取値の理論値および実測値を示す図である。
以下は、関節構造用の位置検出装置、および位置検出装置を組み立てる方法に関するものである。関節構造の各ジョイントの位置を感知することによって、関節構造の遠位端の位置が、感知されたジョイント位置と関節構造の既知のレイアウトとの組み合わせから決定され得る。ロボットアームの場合では、ロボットアームの基部は、ジョイントによって互いに結合された一連のリンクを介してロボットアームの遠位端でエンドエフェクタに結合されている。これらのジョイントは、回転ジョイントまたは直進ジョイントであってもよい。回転ジョイントの場合、ジョイントの回転が感知される。言い換えれば、回転ジョイントが取り付けられている2本のシャフトの相対的な回転が検知される。回転角度および回転方向が感知される。直進ジョイントの場合、ジョイントの長手方向の動きが感知される。言い換えれば、直進ジョイントが取り付けられている2本のシャフトの相対的な運動が感知される。移動距離と移動方向が感知される。
図1は、軸2周りのシャフト1の回転を検出するための位置検出装置の一例を示している。位置検出装置は、軸2周りのシャフト1の回転角度および回転方向を検出する。位置検出装置は、磁気センサアセンブリとディスク3とを備えている。ディスク3は図2に詳細に示されている。ディスク3は、外側の半径方向の境界4と内側の半径方向の境界5を有する環状体である。環状体の両方の境界4,5は、ディスク3の中心点を中心としている。外側の半径方向の境界4の半径はroである。内側の半径方向の境界5の半径はriである。ディスク3は、その位置が検知されているエレメントに固定されている。今回の場合、ディスク3はシャフト1に堅固に取り付けられている。シャフト1とディスク3の間の相対的な運動は許容されていない。ディスク3は軸2周りに回転する。言い換えれば、ディスク3とシャフト1は共通の軸2周りに回転する。
2つの磁気リング6、7がディスク3上に配置されている。磁気リング6、7の相対的な運動は許容されていない。2つの磁気リング6、7は同心である。両方の磁気リング6、7はディスク3の中心を中心としている。言い換えれば、磁気リング6、7は、シャフト1の回転軸2を軸とする円周上に配置されている。ディスク3の中心と内側の磁気リング6の中心線9との間の半径方向の距離はrmである。ディスク3の中心と外側の磁気リング7の中心線10との間の半径方向の距離はrnである。磁気リング6、7の中心線9、10は半径方向で距離sだけ離れている。半径方向の距離sの最小値は予め定められている。好ましくは、半径方向の距離sは少なくとも磁極対の長さがあることが望ましい。言い換えれば、s≧2yである。
各磁気リング6、7は磁極8を画定する多数の永久磁石を伴っている。各磁気リング6、7の検知面では、磁石はリング周りのN極とS極の間で極性が交互に切り替わる。内側の磁気リング6は、m個の磁極対を有している。外側の磁気リング7は、n個の磁極対を有している。内側の磁気リング6上の各磁極8は、製造公差内で、同じ形状およびサイズである。外側の磁気リング7上の各磁極8は、製造公差内で、同じ形状および大きさである。好ましくは、内側の磁気リング6上の各磁極8は、製造公差および内側の磁気リング6の半径が外側の磁気リング7の半径と異なるという事実の範囲内で、外側の磁気リング7上の各磁極8と同じ形状およびサイズであることが望ましい。磁気リング6、7の一部が図3に詳細に示されている。各磁極8は、半径方向の長さxおよび円周方向の長さyを有している。一例として、yは2mmである。この例では、磁極対(すなわち、N極と隣接するS極との対)は、4mmの円周方向の長さを有している。
磁気センサアセンブリは、2つのエレメント間の相対的な回転を検出するように関節構造に取り付けられている。磁気センサアセンブリは、磁気センサアセンブリがそのエレメントに対して動くことができないように、それらのエレメントのうちの1つに堅固に取り付けられている。磁気リング6、7が他方のエレメントに対して動くことができないように、ディスク3は他方のエレメントに堅固に取り付けられている。図1の場合、ディスク3はシャフト1に堅固に取り付けられている。磁気センサアセンブリは、シャフト1がそれに対して回転する関節構造の部位に堅固に取り付けられている。
磁気センサアセンブリは、第1および第2の磁気リング6、7と磁気センサアセンブリとの相対的な回転を検出する。磁気センサアセンブリは、2つの磁気センサアレイ11、12を含んでいる。内側の磁気センサアレイ11は、内側の磁気リング6に隣接して整列して配置されている。外側の磁気センサアレイ12は、外側の磁気リング7に隣接して整列して配置されている。シャフト1が回転するときには、磁気センサアセンブリはシャフト1がそれに対して回転する関節構造に取り付けられていることから、磁気リング6および7は磁気センサアレイ11、12を通過して回転する。各センサアレイ11、12は、磁気リング6、7のN極とS極がセンサアレイ11、12を通過して移動するときに、配置されている磁気リング6、7のN極とS極間の変化を検出できる。代表的な実施形態では、第1および第2の磁気リング6、7は少なくとも磁極対の長さだけ半径方向に分離されている。リング6、7間の間隔を広げると、各リングが他のリングのセンサに与える干渉が減少する。それゆえ、少なくとも磁極対の長さだけリング6、7を離すことは、内側の磁気センサアレイ11が内側の磁気リング6の変化を検出することだけを助け、かつ外側の磁気センサアレイ12が外側の磁気リング7の変化を検出することだけを助ける。
各磁気センサアレイ11、12は、一組のセンサを含んでいる。図4は、磁気センサアレイが4つの個々のセンサ13a,13b,13c,13dを含む例を示す。各磁気センサアレイ11、12は直線的である。図4から分かるように、個々のセンサ13は一直線上に配置されている。一組のセンサ13はすべて同じサイズと形状で、等しい間隔だけ離れている。各センサ13は幅tと長さuを有し、次のセンサ13から距離vだけ離れている。隣接するセンサ13の中心が距離zだけ離れている。磁気センサアレイ11、12が4つの個々のセンサ13を有する図4に示す例では、zは磁極対の長さの4分の1と同じ長さである。言い換えれば、z=y/2である。したがって、1および3とマークされた、センサ13の中心は隣接する磁極間の境界上にあるが、2と4とマークされた、センサ13の中心は隣接する磁極の中心上にある。外側のセンサ13の中心(1と4とマークされている)は、磁極対の長さの4分の3離れている。代表的な実施形態では、tは磁気リング6,7の半径方向の広がりxよりも小さい。言い換えれば、t<xである。
個々のセンサ13a,13b,13c,13dは直線上にあるのに対し、磁気リング6,7は円形であるので、シャフト1が回転するにつれて各センサ13の中心は磁極の中心と一貫して位置決めされていない。センサ13の中心と磁極の中心間のオフセットは、シャフト1が回転するにつれて変化する。この可変オフセットはセンサ出力に系統的な誤差を生じさせる。他の実施形態では、磁気センサアレイ11、12はそれぞれ、ディスク3の中心を中心とする円形内にある。この場合、各磁気センサアレイ11、12の中心線の半径は、センサ13が読み取っている磁気リング6,7の中心線9,10の半径と同じである。それゆえ、磁気センサアレイ11、12の中心線は、シャフトが回転している時に読み取りを行うセンサ11、12磁気リング6,7の中心線9,10に対して一貫して位置決めされている。
センサ13は、例えば、ホール効果センサ、リードセンサ、磁気抵抗センサまたは誘導センサであってもよい。
各磁気センサアレイ11、12は、それに隣接する磁極の相対的な位置を表すマルチビット出力を提供するように構成されている。磁気リング6,7上の磁極の数および相対的な配置は、測定されるべき回転角度の範囲内でシャフト1の各位置が2つの磁気センサアレイ11、12からの特有の一組の出力と関連するように配置されている。内側のリング6上の磁極対の数mと外側のリング7上の磁極対の数nは異なっており、互いに素である。それらの選択については、以下でさらに説明される。センサ13からの出力は、プロセッシングユニット14に渡される。
磁気センサアレイ11、12の円周方向の位置および軸2周りのディスク3の回転位置は、磁気センサアレイ11によって検知される内側の磁気リング6上の磁極8間の変化が、磁気センサアレイ12によって検知される外側の磁気リング7上の磁極8間の変化とは異なるシャフト1の回転位置に対して生じるように選択されていてもよい。これにより、各磁気センサアレイ11、12によって検知された変化の相対的な順序からシャフト1の回転方向を推測することが可能になる。
磁気センサアレイ11、12の出力はプロセッシングユニット14に渡される。プロセッシングユニット14は、磁気センサアレイ11、12からの信号を解釈するためにハードコード化されているか、またはメモリ16に非一時的に記憶されたソフトウェアコードを実行するように構成された汎用プロセッサであるプロセッサデバイス15を備えている。プロセッサデバイス15は、センサ13からの信号を結合して、17においてまとめられた出力信号を形成する。
次に、内側の磁気リング6上の磁極対の数mと外側の磁気リング7上の磁極対の数nを選択する方法について説明する。
mおよびnの選択は、以下の制約のうちの任意の1つ、任意の組合せ、またはすべてを条件としてもよい。
1.内側および外側の磁気リング6、7は両方ともディスク3に取り付ける必要がある。好ましくは、内側および外側の磁気センサアレイ11、12もそれぞれディスク3の設置面積内に配置されていることが望ましい。内側の半径方向の境界5は半径riである。内側の半径方向の境界5を超えずに内側の磁気センサアレイ11をディスク3上に取り付けるために、内側の磁気リング6の中心線9は、少なくとも内側の磁気リング6の中心線9と内側の半径方向の境界5との間に配置された磁気センサアレイ11の半径方向の幅の分だけ内側の半径方向の境界5から離されている。これは、磁気センサアセンブリの半径方向の幅の半分、すなわちwm/2であってもよい。言い換えれば、rm>ri+wm/2である。センサアレイ11,12がセンサアセンブリ内で半径方向にオフセットされている場合、それはさらに大きくなってもよい。一例として、rm>ri+(wm+t)/2である。外側の半径方向の境界4は半径roである。外側の半径方向の境界4を超えずに外側の磁気センサアレイ12をディスク3上に取り付けるために、外側の磁気リング7の中心線10は、少なくとも外側の磁気リング7の中心線10と内側の半径方向の境界4との間に配置された磁気センサアレイ12の半径方向の幅の分だけ外側の半径方向の境界4から離されている。これは、磁気センサアセンブリの半径方向の幅、すなわちwn/2であってもよい。言い換えれば、rn<ro-wn/2である。センサアレイ11,12がセンサアセンブリ内で半径方向にオフセットされている場合、それはさらに大きくなってもよい。一例として、rn<ro-(wn+t)/2である。
2.隣接するセンサ13の中心は、磁極対の長さの4分の1だけ離されている。言い換えれば、隣接するセンサ13はy/2だけ離されている。これにより、ディスク3が回転するときに磁気センサアレイ11,12が各磁極8の変化を確実に検出できる。
3.内側の磁気リング6の中心線9と外側の磁気リング7の中心線10との間の半径方向の距離sは所定の距離よりも大きい。この所定の距離は、浮遊磁場に対する所望の鈍感性によって設定されている。好ましくは、s>2yであることが望ましい。この場合、内側の磁気センサアレイ11が検出している内側の磁気リング6上の最も近い磁極8は、常に外側の磁気リング7上の磁極8よりも近い。同様に、外側の磁気センサアレイ12が検出している外側の磁気リング7上の最も近い磁極8は、常に内側の磁気リング6上の磁極8よりも近い。それゆえ、一方の磁気リング上の磁気センサアレイが他方の磁気リングからの磁界を検出することによって生じる干渉を防ぐことができる。
4.各磁気センサアレイ11,12内のセンサ13の最小数bは閾値より大きい。この閾値は、明確な位置読み取りに対して十分な空間サンプリングがあるようになっている。好ましくは、b≧4であることが望ましい。磁気高調波が検出されない場合は、4つのセンサ13a,13b,13c,13dで十分である。
5.各磁気センサ13a,13b,13c,13dの幅tは、磁気リング6,7の半径方向の広がりxよりも小さい。言い換えれば、t<xである。磁気センサアレイ11,12が磁気リング6,7よりも狭い場合、検出された変化の信号対雑音比は減少する。
6.ディスク3の内側の半径方向の境界5は、関節構造によって拘束されていてもよい。例えば、図1では、ディスク3の内側の半径方向の境界5はシャフト1によって制限されている。この場合、内側の半径方向の境界5の半径riは少なくともシャフト1の半径と同じ大きさでなければならない。
7.ディスク3の外側の半径方向の境界4は、関節構造によって拘束されていてもよい。例えば、位置センサは、関節構造のハウジングの内側に備えられていてもよい。この場合、外側の半径方向の境界4の半径roは、少なくともハウジングの広がりと同じくらい小さくなければならない。
8.位置センサは最大回転角を検出するように構成されている。この最大回転角は、回転が検出されるエレメントによって異なる。回転ジョイントの場合、検出される最大回転角は、運動連鎖されたそのジョイントの位置によって異なる。検出される最大回転角は、360°未満であってもよい。検出される最大回転角は、360°より大きくてもよい。位置測定の精度は、検出される回転角に比例する。検出されるべき回転角が大きければ大きいほど、必要とされる位置測定の精度は高くなる。センサの読み取り精度は次の式で与えられる。
Figure 0006990231000001
Σ磁極対は、ディスク3上のすべての磁気リングの磁極対の数の合計である。ディスク3上に2つの磁気リング6,7がある場合、Σ磁極対=m+nである。磁気リング6,7上の磁極対の数が多いほど、磁気リングは大きくなる。したがって、磁気リング6,7が大きいほど、より正確な位置測定につながる。検出されるべき回転角が大きいほど、より大きいmおよび/またはnが、要求される精度を達成するために求められる。それゆえ、あるエレメントの他のエレメントに対する回転を検出するための磁気リング6,7上の磁極対の数は、2つのエレメント間で検出される相対的な回転角によって制約される。回転ジョイントの場合、mおよびnの選択は、検出されるその回転ジョイントの最大回転角に特有のものである。
図5は、図1に示す形態の位置検出装置から得られた位置センサの理論値および実測値を示すグラフである。x軸は外側の磁気センサアレイ12の位置センサの実測値であり、y軸は内側の磁気センサアレイ11の位置センサの実測値である。星形のプロットは、100%の精度を有する理論値を示している。実線のプロットは、実測値の例を示している。これらの代表的な実測値は、ディスク3上の磁気リング6,7の磁化における製造上のばらつき、磁気センサアレイ11,12における製造上のばらつき、および/または磁気リング6,7と磁気センサアレイ11,12間の位置ずれのために、理論値と異なる。図5では、実測値は理論値から一貫したオフセットを有しており、これは実測値における系統的な誤差を示している。このオフセットは、ディスク3を磁化するときのエラーが原因であるかもしれない。例えば、磁気リング6,7の中心はディスク3の回転中心からわずかにずれているかもしれない。図5はまた、系統的な誤差を超える、読取値におけるさらなる誤差を示している。どのセンサ13の読取値が目論見通りかを正確に検出するためには、図5のプロットにおける実測値が、他の理論値よりも正確な理論値に近い必要がある。
続いて、mおよびnの値を決定する方法が、ディスク3の内側の半径方向の境界5が制限されている場合について説明される。例えば、ディスク3がシャフト1に取り付けられていてもよいし、それゆえディスク3の内側の半径方向の境界5の半径riはシャフト1の半径より大きくなければならない。図6はこの方法のステップを示している。
ステップ20で、最小値rm,minが決定される。これは、制限された内側の半径riによって許容される内側の磁気リング6の中心線9の最小半径である。上記の制約1で説明したように、この最小半径において、内側の磁気リング6の中心線9は、内側の磁気リング6の中心線9と内側の半径方向の境界5との間に配置された磁気センサアレイ11の半径方向の幅の分だけ内側の半径方向の境界5から離されている。これは、磁気センサアレイ11が内側の半径方向の境界5内に制限されることを確実にするためである。一例では、最小値rm,minは、次式によって与えられる。
Figure 0006990231000002
ステップ21で、内側の磁気リング6における磁極対の最小数mが決定される。磁気リング6は、多数の磁極対を有している。それゆえ、mは整数である。rm,minは、次式のrmの最小値まで増やされる。
Figure 0006990231000003
ステップ22で、最小値rn,minが決定される。これは、制限された内側の半径riによって許容された外側の磁気リング7の中心線10の最小半径である。上記の制約3で説明したように、この最小半径において、外側の磁気リング7の中心線10は内側の磁気リング6の中心線9から所定の距離だけ半径方向に離されている。この所定の距離は、他の磁気リングによる1つの磁気リングのセンサ読み取りにおける干渉を低減または最小化するために十分に大きいことが望ましい。
Figure 0006990231000004
ステップ23で、外側の磁気リング7に対する磁極対の最小数nが決定される。磁気リング7は、多数の磁極対を有している。それゆえ、nは整数である。rn,minは、次式のrnの最小値まで増やされる。
Figure 0006990231000005
ステップ24で、ステップ21および23で決定されたmおよびnの値が互いに素であるかどうかが判定される。mとnが互いに素であるならば、これらmとnのペアは最もコンパクトなディスク3を提供する。この場合、mは内側の磁気リング6上の磁極対の数となるように選択され、nは外側の磁気リング7上の磁極対の数となるように選択される。次にステップ25に進み、ここで位置検出装置は、m個の磁極対を有する内側の磁気リング6とn個の磁極対を有する外側の磁気リング7とを有するディスク3を関節構造に取り付けることによって構成される。ディスク3は、その位置を感知するように構成されている関節構造のエレメントに堅固に取り付けられている。ディスク3は、その位置を感知するように構成されているエレメントと同じ軸周りに回転するように取り付けられている。
ステップ24で、ステップ21および23で決定されたmおよびnの値が互いに素ではないと判定された場合、ステップ26に進む。ステップ26では、ステップ23で決定されたnの値が1だけ増やされる。ステップ27で、ステップ26で決定されたnの新しい値とステップ21で決定されたmの値が互いに素であるかどうかが判定される。それらが互いに素でない場合、ステップ26に戻り、nの値が1だけ増やされる。次に、ステップ27に戻り、そこでnの新しい値がmと互いに素であるかどうかが判定される。nがmと互いに素である値に達するまで、ステップ26および27が反復され、各反復でnの値が1ずつ増やされる。これにより、各反復は、mとnとの間の差を1ずつ増やす。
mと互いに素であるnの値が見つかると、ステップ28に進む。ステップ28で、ステップ21で決定されたmの値が、内側の磁気リング6の磁極対の数の範囲の下限として設定される。また、ステップ28で、ステップ27においてmと互いに素であると判定されたnの値が、外側の磁気リング7の磁極対の数の範囲の上限として設定される。
ステップ29で、ステップ28で設定された範囲内にある、さらなる互いに素であるm、nの対が識別される。言い換えれば、互いに素であり、mがステップ28で設定された下限より大きく、nがステップ28で設定された上限より小さい、さらなるmとnの値が識別される。これらの互いに素であるm、nの対はまた、外側の磁気リング7が内側の磁気リング6から少なくとも距離sの所定の最小値だけ離されているというような他の制約も満たす。
例示的な実施形態では、ステップ21および23で最初に決定されたmおよびn値は、m=30およびn=35である。これらは互いに素ではない。ステップ26でnを反復すると、m=30およびn=37のm、n対が得られる。ステップ29で、以下のさらなる互いに素である対が識別される。すなわち、m=31,n=36、m=31,n=37、m=32,n=37である。
ステップ30で、一対の互いに素であるm、n対が選択される。このm、n対は、ステップ21で決定されたmの値およびステップ27でそのmの値と互いに素であると判定されたnの値であってもよいし、あるいはm、n対は、ステップ29で決定されてもよい。選択されるm、n対は実施態様に依存する。
一例では、mの最大値を有する互いに素であるm、n対はステップ30で選択される。上記の例では、m=32、n=37が選択される。[数1]から分かるように、mの最大値を有するm、n対を選択することは、結果として得られるセンサ13の精度を最大にする。
別の例では、ステップ30で、nの最小値を有する互いに素であるm、n対が選択される。上記の例では、m=31、n=36が選択される。nの最小値を有するm、n対を選択することは、ディスク3の外側の半径roを最小にし、それゆえセンサ13によって占められる全体の空間を最小にする。
別の例では、ステップ30で、(n-m)の最小値を有する互いに素であるm、n対が選択される。(n-m)の最小値を有するm、n対を選択することはディスク3の半径方向の幅を最小にし、それゆえ最もコンパクトなセンサ13を提供する。上記の例では、2つのm、n対が(n-m)の最小値を有している。すなわち、m=31、n=36と、m=32、n=37である。
ステップ30で選択されたm、n対は、感知される最大回転角に応じて選択されてもよい。上述したように、最大回転角は必要とされる最小精度を特定し、それは次に磁気リング6,7上の磁極対の数の必要とされる最小合計を特定する。これは、コンパクトなセンサ13を提供するための競合する制約である。これらの競合する要求をバランスさせるために、その合計が磁気リング6,7上の磁極対の数の必要とされる最小合計を超える互いに素である最小のm、n対がステップ30で選択されてもよい。
特定の実施形態では、これらの基準のいずれか1つまたは組み合わせが適用されてもよい。例えば、(n-m)の最小値を有する互いに素であるm、n対が選択されてもよい。(n-m)の最小値を有する2つ以上の互いに素であるm、n対がある場合、最大のmを有するもののうちの1つが選択されてもよい。それゆえ、上記の例では、m=32、n=37が選択されるであろう。
ステップ30で互いに素であるm、n対が選択されると、選択されたm、n対のmは内側の磁気リング6上の磁極対の数となるように選択され、選択されたm、n対のnは外側の磁気リング7の磁極対の数となるように選択される。次にステップ25に進み、そこで位置検出装置は、m個の磁極対を有する内側の磁気リング6とn個の磁極対を有する外側の磁気リング7を有するディスク3を前述のように関節構造に取り付けることによって組み立てられる。
mおよびnの値を決定する方法を、ディスク3の外側の半径方向の境界4が制限されている場合についてここで説明する。例えば、ディスク3はハウジング内に取り付けられてもよく、それゆえディスク3の外側の半径方向の境界4の半径roは、ハウジングからディスク3の中心点までの最も近い距離よりも小さくなければならない。図7はこの方法のステップを示す。
ステップ40で、最大値rn,maxが決定される。これは、制限された外径roによって許容された外側の磁気リング7の中心線10の最大半径である。上記の制約1で説明したように、かかる最大値において、外側の磁気リング7の中心線10は、外側の磁気リング7の中心線10と外側の半径方向の境界4の間に配置された磁気センサアレイ12の半径方向の幅の分だけ外側の半径方向の境界4から離されている。これは、磁気センサアレイ12が外側の半径方向の境界4内に制限されることを確実にするためである。一例では、最大値rn,maxは次式で与えられる。
Figure 0006990231000006
ステップ41で、外側の磁気リング7に対する磁極対の最大数nが決定される。磁気リング7は、多数の磁極対を有している。それゆえ、nは整数である。rn,maxは、次式で表されるrnの最大値まで減少する。
Figure 0006990231000007
ステップ42で、最大値rn,maxが決定される。これは、制限された外径roによって許容された内側の磁気リングの中心線9の最大半径である。上記の制約3で説明したように、かかる最値において、内側の磁気リングの中心線9は、外側の磁気リングの中心線10から所定距離だけ半径方向に離されている。この所定距離は、他の磁気リングによる1つの磁気リングのセンサ読み取りにおける干渉を低減または最小化するために十分に大きいことが望ましい。
Figure 0006990231000008
ステップ43で、内側の磁気リング6に対する磁極対の最大数mが決定される。磁気リング6は、多数の磁極対を有している。それゆえ、mは整数である。rm,maxは、次式で表されるrmの最大値まで減少する。
Figure 0006990231000009
ステップ44で、ステップ41および43において決定されたmおよびnの値が互いに素であるかどうかが判定される。mとnが互いに素である場合、これらは最もコンパクトなディスク3を提供するm、n対である。この場合、mは内側の磁気リング6上の磁極対の数となるように選択され、nは外側の磁気リング7上の磁極対の数となるように選択される。次にステップ45に進み、ここで位置検出装置は、m個の磁極対を有する内側の磁気リング6とn個の磁極対を有する外側の磁気リング7とを有するディスク3を関節構造に取り付けることによって構成される。ディスク3は、その位置を感知するように構成されている関節構造のエレメントに堅固に取り付けられている。ディスク3は、その位置を感知するように構成されているエレメントと同じ軸周りに回転するように取り付けられている。
ステップ44で、ステップ41および43において決定されたmおよびnの値が互いに素でないと判定された場合、ステップ46に進む。ステップ46で、ステップ43において決定されたmの値が1だけ減らされる。ステップ47では、ステップ46で決定されたmの新しい値とステップ41で決定されたnの値が互いに素であるかどうかが判定される。それらが互いに素でない場合、ステップ46に戻り、そこでmの値が1だけ減らされる。その後、ステップ47に戻り、ここで、mの新しい値がnと互いに素であるかどうかが判定される。ステップ46および47は、mの値がnと互いに素である値に達するまで、各反復でmの値が1だけ減らされることが反復される。これにより、各反復で、mとnとの間の差は1ずつ増える。
nと互いに素であるmの値が見つかると、ステップ48に進む。ステップ48では、ステップ41で決定されたnの値が、外側の磁気リング7の磁極対の数の範囲の上限として設定される。また、ステップ48において、ステップ47でnと互いに素であると判定されたmの値が、内側の磁気リング6の磁極対の数の範囲の下限として設定される。
ステップ49で、ステップ48で設定された範囲内にある、さらなる互いに素であるm、nの対が識別される。言い換えれば、互いに素であり、mがステップ48で設定された下限より大きく、nがステップ48で設定された上限より小さい、さらなるmとnの値が識別される。これらの互いに素であるm、nの対はまた、外側の磁気リング7が内側の磁気リング6から少なくとも所定の距離だけ離されているというような他の制約も満たす。
ステップ50で、互いに素であるm、n対の1つが選択される。このm、n対は、ステップ41で決定されたnの値とステップ47でそのの値と互いに素であると決定されたmの値であるか、あるいはステップ49で決定されたm、n対、のどちらか一方であってもよい。選択されたm、n対は実施態様に依存する。
一例では、ステップ40で、mの最大値を有する互いに素であるm、n対が選択される。mの最大値を有するm、n対を選択することは、結果として得られるセンサ13の精度を最大にし、そのことは[数1]から分かる。
別の例では、ステップ50で、(n-m)の最小値を有する互いに素であるm、n対が選択される。(n-m)の最小値を有するm、n対を選択することは、ディスク3の半径方向の幅を最小にし、それゆえ最もコンパクトなセンサ13を提供する。
ステップ50で選択されたm、n対は、感知される最大回転角に応じて選択されてもよい。その合計が磁気リング6,7上の磁極対の数の必要とされる最小合計を超える最小の互いに素であるm、n対が、ステップ50で選択されてもよい。
特定の実施形態では、これらの基準のいずれか1つまたは組み合わせが適用されてもよい。例えば、(n-m)の最小値を有する互いに素であるm、n対が選択されてもよい。(n-m)の最小値を有する2つ以上の互いに素であるm、n対がある場合、最大のmを有するもののうちの1つが選択されてもよい。
ステップ50で互いに素であるm、n対が選択されると、選択されたm、n対のmは内側の磁気リング6上の磁極対の数となるように選択され、選択されたm、n対のnは外側の磁気リング7上の磁極対の数になるように選択される。次にステップ45に進み、そこで位置検出装置はm個の磁極対を有する内側の磁気リング6とn個の磁極対を有する外側の磁気リング7を有するディスク3を前述のように関節構造に取り付けることによって組み立てられる。
図6および図7のフローチャートは、ディスク3の内側の半径方向の境界5または外側の半径方向の境界4が制限されている場合に、内側および外側の磁気リング6,7上の磁極の数を決定する代表的方法を表していることが理解されよう。磁極の数を決定するために、記載されたステップのすべてが必ずしも必要とされるわけではない。例えば、図6のステップ21および23で決定された磁極の最小数mおよびnは、最小半径rm,minおよびrn,minを実際に決定することなく決定されてもよい。同様に、図7のステップ41および43で決定された磁極の最大数mおよびnは、最大半径rm,maxおよびrn,maxを実際に決定することなく決定されてもよい。
センサ13によって検出された回転角度は、以下のように内側の磁気リング6および外側の磁気リング7からのセンサ13の読取値から決定され得る。検出された回転角は、外側の磁気リング7の全回転数に外側の磁気リング7に対する現在のセンサ13の読取値を加えたものに等しい。図8は、図1に示す形態の位置検出装置から得られた理論値および実測値を示すグラフである。x軸は、外側の磁気センサアレイ12の位置センサの測定値である。y軸は、((外側のセンサアレイ12の読取値×n)-(内側のセンサアレイ11の読取値×m))で表される組み合わされたセンサ13の読取値である。星形のグラフは、100%の精度を有する理論値を示している。実線のプロットは、実測値を示している。星形のプロットは一連の直線である。各直線は、外側の磁気リング7の特定の回転数および内側の磁気リング6の特定の回転数を表している。それゆえ、センサ13によって検出された回転角を決定する1つの方法は、以下を決定することである。
Figure 0006990231000010
そして、Xを外側のリング7の回転数にマッピングするルックアップテーブルと比較する。回転角は次式のようになる。
Figure 0006990231000011
あるいは回転角は、内側のセンサアレイ11の読取値に関して同様の方法で決定されてもよい。
図1および図2に示す例では、磁気リング6および7の両方がディスク3の同じ面に配置されている。しかしながら、磁気リング6および7はディスク3の対向する面に配置されていてもよい。この場合、磁気センサアレイ11,12はディスク3の対向する面上に取り付けられている。内側の磁気センサアレイ11は、内側の磁気リング6上の磁極の変化を検出するように内側の磁気リング6上に取り付けられている。外側の磁気センサアレイ12は、外側の磁気リング7上の磁極の変化を検出するように外側の磁気センサアレイ7上に取り付けられている。この場合、内側および外側の磁気リング6,7の中心線9と10との間の最小の半径方向の間隔sは、磁気リング6,7がディスク3の同じ表面上にある場合よりも小さい。これは、磁極が磁気センサアレイ11,12に対してディスク3の対向する面に露出している磁気リング6,7によって磁気センサアレイ11,12に引き起こされる干渉が、磁気センサアレイ11,12に対してディスク3の同じ側に同じ距離だけ離れている磁気リング6,7によって引き起こされる干渉よりも小さいためである。それゆえ、内側の磁気リング6と外側の磁気リング7の中心線9,10間の半径方向の距離は、磁極対の長さ2yよりも短くてもよい。
図1および図2に示す例では、内側および外側の磁気リング6、7は同じディスク3上にある。あるいは、内側の磁気リング6と外側の磁気リング7は異なるディスク上に配置されていてもよい。それらの異なるディスクは同じ回転軸を有し、かかる回転軸は回転が検出されるエレメントと同じである。しかしながら、それらの異なるディスクは回転軸に沿って分離されている。例えば、回転ジョイントの回転を測定するとき、ディスクはジョイントの反対側に取り付けられていてもよい。これは包装やコンパクトさの理由で望ましいかもしれない。この例では、内側および外側の磁気リング6,7上の磁極対の数mおよびnは、ここに記載されているように決定されるであろう。しかし、内側および外側の磁気リング6,7は軸方向に分離されているので、一方の磁気リングが他方の磁気リングを感知することによって生じる干渉は無視できるほど小さく、それゆえ磁気リング6,7が半径方向に分離されていることに対する制約はない。
ここに記載されている装置および方法は、一方のエレメントの他方のエレメントに対する1回転未満の回転を検出するために使用することができる。ここに記載の装置および方法はまた、一方のエレメントの他方の対する1回転を超える回転を検出するためにも使用することができる。
代表的な実施形態では、モータが、関節構造のエレメントを駆動するギアボックスを駆動する。一方の磁気リングが、モータからの出力であるモータシャフトに堅固に取り付けられている。他方の磁気リングは、ギアボックスからの出力であるドライブシャフトに堅固に取り付けられている。それゆえ、2つの磁気リングは軸方向に分離されている。モータシャフトとドライブシャフトの回転軸は同じである。磁気リングは両方ともこの回転軸の中心に置かれている。好ましくは、m個の磁極を有する内側の磁気リングはモータシャフトに取り付けられ、n個の磁極を有する外側の磁気リングはドライブシャフトに取り付けられていることが望ましい。n>mである。フラクショナルギア比が使用されている場合、ドライブシャフトの2回転以上を区別することができる。たとえば、13:4のギア比では、最大4回転のドライブシャフトを区別できる。このことは、ドライブシャフトを一方の方向にそして次に他の方向に1回転させる必要なしに、セットアップ中にドライブシャフトの位置を決定することを可能にすることから、ロボットの実施形態において有用である。
mが閾値よりも小さい構成では、内側の磁気リング6用の磁気センサアレイ11は、リニアアレイよりむしろ軸上の円形アレイとして実施される。閾値は、リニア磁気センサアレイが、使用可能な読み取りを提供するに足るだけ内側の磁気リング6の中心線9の円弧と交差しない磁極の最大数mである。
一実施態様では、m=1である。この場合、内側の磁気リング6にはたった1つの磁極対しかない。この磁極対はディスク3の中心に置かれている。この磁極対はディスク3の回転軸上にある。この磁極対は、外側の磁気リング7上のどの磁極対とも位置合わせされていない。これにより回転方向を検出することができる。m=1を用いると、非常にコンパクトなセンサ13を使用できるが、精度は低くなる([数1]参照)。
上述したように、選択されたm、n対は互いに素である。全ての場合において、(n-m)>1である。内側および外側の磁気リング6、7がディスク3の同じ面上にある場合、(n-m)≧7である。これは、干渉を回避するために、内側および外側の磁気リング6、7の中心線9、10間の半径方向の距離sが磁極対の長さ以上であるためである。各磁気リング6、7上の磁極対の数は整数である。それゆえ、2つの磁気リング6、7上の磁極対の数の最小差は2πよりも大きい最初の整数で、7である。一例では、(n-m)≧8である。例えば、n=41、m=33である。他の例では、(n-m)≧10である。例えば、n=47、m=37である。
上記の装置および方法は、2つの磁気リング6、7の回転を感知することに関するものである。同じ方法を3つ以上の磁気リングの回転を感知するように適合させることができる。すべての磁気リングは同軸である。それらは全て同じディスクあるいはいくつかのディスク上に回転軸に沿って軸方向に分離された状態で配置されていてもよい。[数1]は、磁気リング上の磁極対の合計が増加するにつれて感知される位置の精度が増加することを示している。それゆえ、さらなる磁気リングを利用することによって、より正確な位置が測定される。各磁気リング上の磁極対の数は、他のすべての磁気リング上の磁極対の数と互いに素である。したがって、m、n、およびh個の磁極対を有する3つの磁気リングがある場合、m、n、およびhはすべて互いに素である。各磁気リングは、隣接する磁気リングから少なくとも所定の距離だけ半径方向に分離されていることが望ましい。磁気リングがすべてディスクの同じ面上にある場合、各磁気リングは隣接する磁気リングから少なくとも磁極対の長さ2yだけ分離されていることが望ましい。
図6の場合、3つ以上の磁気リングを有する位置センサに対して、最小のmと最小のnは、ステップ21と23で示されているように決定されるであろう。第3の磁気リングがある場合、最小のhはステップ22および23を介して決定されたnと同じ方法で決定されるが、今回は最小の半径方向の間隔はn個の磁極対を有するリングとh個の磁極対を有するリングとの間である。同様に、さらなる磁気リングがある場合、ステップ22および23は、さらなる磁気リングそれぞれに対して対応する方法で繰り返される。ステップ24で全ての磁極対の数が互いに素である場合にのみ、ステップ25に進む。そうでなければ、ステップ26および27が、各リングに対する一組の互いに素である磁極対の数が決定されるまで、さらなる各リングに対して実行される。ステップ28で、最小の磁気リングの磁極対の数がその磁気リングの下限として設定される。ステップ28で、最大の磁気リングの磁極対の数がその磁気リングの上限として設定される。ステップ29で、さらなる互いに素である磁極対の数が全ての磁気リングに対して決定され、隣接するリング間の間隔は少なくとも最小の半径方向の間隔であることを保証する。磁極対の組み合わせは、上述の方法にしたがってステップ30で選択される。位置検出装置は、ステップ30で選択された各リング上の磁極対の数を有する一群の磁気リングを有する関節構造にディスクを取り付けることによって構成されている。
図7の場合、2つ以上の磁気リングを有する位置センサに対して、最大のnと最大のmが、ステップ41と43で示されるように決定されるであろう。第3の磁気リングがある場合、最大のhはステップ42および43を介して決定されたmと同じ方法で決定されるが、今回は最小の半径方向の間隔はm個の磁極対を有するリングとh個の磁極対を有するリングとの間である。同様に、さらなる磁気リングがある場合、ステップ42および43は、さらなる磁気リングそれぞれに対して対応する方法で繰り返される。ステップ44で全ての磁極対の数が互いに素である場合にのみ、ステップ45に進む。そうでなければ、この方法のステップ46および47は、各リングに対する一組の互いに素である磁極対の数が決定されるまで、さらなる各リングに対して実行される。ステップ48で、最小の磁気リングの磁極対の数がその磁気リングの下限として設定される。ステップ48で、最大の磁気リングの磁極対の数がその磁気リングの上限として設定される。ステップ49で、さらなる互いに素である磁極対の数が全ての磁気リングに対して決定され、隣接するリング間の間隔は少なくとも最小の半径方向の間隔sであることを保証する。磁極対の組み合わせは、上述した方法にしたがってステップ50で選択される。位置検出装置は、ステップ50で選択された各リング上の磁極対の数を有する一群の磁気リングを有する関節構造にディスクを取り付けることによって構成される。
ここに記載の位置センサは、2つの物体の相対的な回転位置を絶対的に決定することができる。言い換えれば、位置は、例えば相対的な回転位置が基準構成にあることから運動を数え上げる必要なしに、センサの出力から直接決定することができる。
図1および図2を参照して説明した装置および方法は、2つのエレメントの相対的な回転を測定することに関するものである。しかし、同じ原理が2つのエレメントの相対的な直線運動の測定にも当てはまる。この場合、磁気アレイが磁極対のリングとして配置されるのではなく、それらは磁極対のリニアトラックとして配置される。2つ以上のリニアトラックが使用される。トラックは、互いに素である磁極対の数を有している。各トラックは、その位置が検知されているエレメントの直線運動と平行である。エレメントが動くにつれてリニア磁気センサアレイがそのリニア磁気センサアレイの磁極の変化を検出するように、各リニア磁気センサアレイは各磁気トラック上に取り付けられている。例えば、ハウジング内で直線的に動くエレメントに対して、磁気センサアレイがそのエレメントに取り付けられ、磁気トラックがそのハウジングに固定されていてもよい。
製造時には、ディスク3は、磁気リング6、7が上述のレイアウトを有するように磁化される。ディスク3を磁化するために、図1の磁気センサアレイ11、12と同じ方法で磁化ヘッドがディスク3上に乗せられる。磁気バックプレートが、磁化ヘッドが乗せられている面とは反対側のディスク3の面に配置される。ディスク3が回転し、それによって磁気リング6、7の各磁極対を磁化する。
磁極がディスク3上に位置決めされる精度は製造誤差によって制限される。それらの誤差には、半径方向の位置決め誤差および角度方向の間隔誤差が含まれる。関節構造に取り付けられたときに磁気リング6,7の中心とディスク3の回転軸との間にオフセットがあると、半径方向の位置決め誤差が生じる。取り付け時には、各磁気リング6,7の中心線9,10は回転軸から一定の範囲にない。位置センサに使用されるときには、回転軸2からの各磁気リング6,7の中心線9,10の範囲は、その円周の周りで可変であり、したがって磁気リング6,7の異なる磁極対に対して異なる。磁化ヘッドの意図された半径方向の位置と実際の半径方向の位置との間にオフセットがある場合にも、半径方向の位置決め誤差が生じる。そのような場合、磁化ヘッドによって誘導された磁気リング6,7は、ディスク3の中心から一定の広がりを有しているが、意図された広がりではない。それゆえ、全数の磁極対が磁気リング6,7の円周の周りに収まらず、そのことが磁気リング6,7の1つまたは複数の磁極対の長さを不均一にする。
各磁気リング6,7の磁極対は、2yの一定の円周長を有するようにされている。磁極の円周方向の長さが磁気リング6,7の周りで均等でない場合、角度方向の間隔誤差が発生する。これは、磁化中にディスク3が磁化ヘッドの下で均等に回転しなかった場合に発生するかもしれない。磁極が一様な長さではない場合、検知位置は不正確になる。
半径方向の位置決め誤差および角度方向の間隔誤差は、不規則で回転軸と同心ではない磁極パターンをもたらす。必要な位置測定の精度は、それが何に使用されているかによる。ロボット工学、特に外科用ロボット工学の分野では、位置測定は非常に正確である必要がある。ロボットアームの全てのジョイントの位置測定は、エンドエフェクタの位置を決定するためにロボットアームの既知のレイアウトと組み合わせて使用される。エンドエフェクタの位置は、それを制御して患者内の組織を縫合するなどの細かい制御が必要とされる手術を実行するために高精度で知る必要がある。位置測定は、±25μmの精度を有することが必要とされることがあり、その精度は[数1]によって決定される。前述のように、必要とされる精度は、検出する必要がある回転角によって変わる。検出する必要がある回転角が大きいほど、要求される精度も高くなる。
ディスク3の全ての磁気リングは、同じ磁化治具上で同時に磁化される。磁化治具は、ディスク3上の磁化されるべき磁気リングと同数の磁化ヘッドを有している。各磁化ヘッドは1つの磁気リングの磁極対パターンを誘導する。代表的な実施形態では、2つの磁気リング上の磁極の配置間の差は、(±2y×(1/2)×(1/Σ磁極対))の範囲内で正確である。同じ設定を使用してすべての磁気リングを同時に磁化することによって、あらゆる半径方向の位置決め誤差がすべての磁気リングにわたって一貫して適用される。同様に、ディスク3が一様な速度で回転していないことに起因するいかなる角度方向の間隔誤差も、すべての磁気リングにわたって一貫して適用されることになる。これらの系統的誤差は全ての磁気リングの磁極対に等しく影響を及ぼし、それゆえ、2つの磁気リング上の磁極の配置間の差によってもたらされる誤差は、2つのリングに個別にもたらされる誤差の合計よりも小さくなる。したがって、所望の精度を達成するために両方のリングが一緒に磁化されるときに磁化に要求される許容誤差は、リングが個々に磁化される場合に要求される許容差に対して有意である(ほぼ半分である)。系統的誤差は位置測定において検出可能で、補償されてもよい。例えば、図5を参照すると、実線プロットの実測値における誤差の一部は系統的であり、これは実線が理論値から一貫してオフセットされているという事実から分かる。このオフセットは、おそらく上述したタイプの磁化誤差によるものである。この一定のオフセットは、より正確な結果を生み出すために決定され除去され得る。
磁化治具の磁化ヘッドは、それが磁化治具に取り付けられるときにディスク3の回転中心から同じ半径方向の線上に配置されていてもよい。これにより、磁化中にディスク3の回転が不均一になることによって生じる誤差が、同じ半径方向の線に沿ってすべての磁気リングに確実に適用される。位置検出装置の磁気センサアレイは、ディスク3が関節構造に取り付けられたときにディスク3の回転中心から同じ半径方向の線上に配置される。磁気センサアレイは、磁化ヘッドが磁化中に配置されるのと同じディスク3に対して同じ位置および向きに配置される。
磁気センサアレイ内のセンサはモノリシックであってもよい。同じプロセスでセンサを形成することによって、いかなる誤差もセンサ間で一致し、したがって、いかなる誤差も位置測定値を生成するためにセンサ読取値が評価されているときに系統的誤差としてより容易に識別される。
ディスク3の磁気リング上の磁極対の数の値m、n、hなどは、他の制約内でできるだけ大きくなるように選択されてもよい。これにより、その後の測定の精度が向上し、したがって製造工程によってもたらされる同心度誤差および位置誤差が減少する。
ディスク3は、磁化治具に取り付けられているのと同じ構成で関節構造に取り付けられている。言い換えれば、ディスク3は、磁化治具に取り付けられているのと同じ位置および向きで関節構造に取り付けられている。好ましくは、ディスク3が磁化治具および関節構造に取り付け可能である唯一の単一の向きがあることが望ましい。ディスク3は、磁化治具に取り付けられたのと同じ構成でユーザがディスク3を関節構造に取り付けるのを助ける取付装置を備えている。
図9は、代表的な取付装置を示す図である。取付装置は、一組のスルーホール60a、60b、60c、60dを含んでいる。これらのスルーホール60a、60b、60c、60dはディスク3上に非対称パターンを形成している。スルーホール60a、60b、60c、60dは、ディスク3を磁化治具および関節構造上の相補的形状に取り付けることを可能にしている。これらの相補的形状は、ディスク3上のスルーホール60a、60b、60c、60dの非対称パターンと同じ非対称パターンで配置されている。例えば、ディスク3は、ディスク3上のスルーホール60a、60b、60c、60dのパターンと同じ配置で磁化治具/関節構造から突き出ているピンに取り付けられていてもよい。この例では、ディスク3は、磁化治具/関節構造に対してディスク3を保持する保持機構によって磁化治具/関節構造に固定されている。例えば、ピンはねじ付きピンであってもよく、ねじ付きナットがねじ付きピンにねじ込まれてディスク3を磁化治具/関節構造に保持するようになっていてもよい。別の例では、磁化治具/関節構造は、ディスク3上のスルーホール60a、60b、60c、60dのパターンと同じ非対称パターンのねじ付き凹部を有していてもよい。ディスク3は、スルーホール60a、60b、60c、60dを通してねじ付き凹部内にディスク3を磁化治具/関節構造に対してネジ止めすることによって磁化治具/関節構造に保持していてもよい。
図9は、取付装置の取付形状としてのスルーホール60a、60b、60c、60dを示す。しかしながら、相補的形状が磁化治具/関節構造に同じ非対称パターンで提供される限り、そしてディスク3が取付形状と相補的形状によって磁化治具/関節構造に固定されることができる限り、他のタイプの取付形状が望ましい。例えば、ディスク3上の取付形状はピンであってもよく、磁化治具/関節構造は相補的形状を有している。
それゆえ、図9に示されているオフセット取付形状パターンの使用は、ディスク3を単一の向きでのみ相補的な磁化治具/関節構造に取り付けることを可能にする。
図9はまた、さらなる代表的な取付装置を示す。取付装置は、1つ以上の位置合わせノッチ61を含んでいる。磁化治具または関節構造上に取り付けられたとき、位置合わせノッチ61は、磁化治具/関節構造上の相補的形状に位置合わせされる。これにより、磁化治具と関節構造の両方に取り付けられたときにディスク3が同じ向きになることを可能にする。図9は位置合わせノッチ61を示しているが、対応するマーキングが磁化治具/関節構造上に提供されてディスク3のマーキングを位置合わせする限り、ディスク3上のマーキングの種類は任意のものでよい。
製造中に一旦ディスク3が磁化されると、磁極位置を正確に測定し記録することができる。各磁極の長さ、または意図した長さからの各磁極の長さの誤差が記録されていてもよい。ディスク3の回転軸と磁極との間の半径方向の距離が記録されてもよい。これらの測定値はプロセッシングユニット14に記録されていてもよい。磁極位置のこの特徴は、製造中にもたらされた誤差を補償するために、位置センサの使用に続いて用いられてもよい。ディスク3が磁化治具に取り付けられたのと同じ向きで関節構造に取り付けられることを確実にする取付装置を用いることによって、プロセッシングユニット14は、センサアレイのセンサからの感知データを磁気リングの記録された特徴付けデータにマッピングすることができる。そして、それにより既知の製造誤差を修正し、それによってより正確な位置測定をもたらす。
代替的に又は追加的に、位置検出装置は較正されていてもよい。較正プロセスは、より正確な補正位置読取値を生成するために位置読み取りに続いて適用される補正関数を生成することを含んでいる。
図10は、磁気リングが磁気センサアレイに対して回転するときに磁気センサアレイによって検出される磁界を示す。70は第1の磁極対から検出された磁界を示すグラフの部分を示し、71は第2の磁極対から検出された磁界を示すグラフの部分を示す。個々のセンサは、磁極対に対して1、2、3および4と印を付けた位置に配置されていてもよい。言い換えれば、前述したように、センサの中心は磁極対の長さの4分の1だけ離れている。外側のセンサの中心(1と4とマークされている)は、磁極対の長さの4分の3離れている。理論的には、磁界は、磁気リングが磁気センサアレイを通過するにつれて正弦波的に変化し、正弦波の1周期が1つの磁極対を表している。しかしながら、磁気リングの製造および磁気センサアセンブリと磁気リングとの位置合わせにおける不完全性は、磁界を完全な正弦波から逸脱させる。
図11は、単一の磁極対が磁気センサアセンブリを通過する間に取得された理論的なセンサ読取値を示す。この理論的なセンサ読取値はマルチビットであり、図11の線72で表されている。図11はまた、単一の磁極対が磁気センサアセンブリを通過する間に取得された実際のセンサ読取値を示す。実際のセンサ読取値はマルチビットであり、図11の曲線73で表されている。
ここで、図11に示す誤差に対して、測定されたセンサ位置読取値を補正することを目的とした較正プロセスについて説明する。このプロセスはディスク3の各磁気リングに個別に適用される。
第1に、位置読取値73が磁気リングの各磁極対に対して磁気センサアレイによって取得される。この位置読取値は、以下ではその磁極対に対する較正磁極対位置読取値と呼ばれる。各磁極対に対して、その磁極対についての磁極対補正関数を生成するために、較正磁極対位置読取値73がモデル磁極対位置読取値72と比較される。図11から分かるように、較正磁極対位置読取値73の曲線は、モデル磁極対位置読取値72の直線周りに振動する。較正磁極対位置読取値73の曲線は、モデル磁極対位置読取値72の直線周りに周期的に振動していてもよい。各磁極対に対して、磁極対補正関数は、較正磁極対位置読取値73に曲線をフィッティングし、次いでフィッティングされた曲線からモデル磁極対位置読取値の直線を差し引くことによって生成されていてもよい。この曲線は、最小二乗法を使用してフィッティングされていてもよい。あるいは、この曲線は当技術分野で公知の他の方法を使用してフィッティングされていてもよい。フィッティングされた曲線は、周期的に振動する関数によって記述されていてもよい。例えば、フィッティングされた曲線は正弦関数であってもよい。図12は、振幅Aの正弦波である磁極対の補正関数を示している。言い換えれば、Asinθであり、ここで、θは磁極対正弦波内の角度である。図12は第1次高調波であるAsinθのみを示しているが、より高次の高調波が磁極対の補正関数に含まれていてもよい。
次に、磁気リングの磁極対の磁極対補正関数を平均して、磁気リングの平均磁極対補正関数を生成する。各磁極対の補正関数が正弦波で表される場合、平均磁極対補正関数は次式で与えられる。
Figure 0006990231000012
好ましくは、この補正関数はプロセッシングユニット14に記憶されていることが望ましい。続いて、位置センサが位置測定を行うときには、位置測定は平均磁極対補正関数を用いて補正される。位置測定は、複数の磁極対位置読取値を含んでいる。平均磁極対補正関数は、位置測定値の各磁極対位置読取値から差し引かれ、それによって補正位置測定値が生成される。
磁気リングの各磁極対の位置読取値から平均磁極対補正関数を差し引くことは、各個々の磁極対の誤差を利用するよりも正確ではない。しかしながら、磁気リング毎に1つの平均磁極対補正関数のみを記憶することは、補正に必要なメモリ使用量を減少させる。また、平均磁極対補正関数を差し引くことは、個々の磁極対誤差を使用するよりもアルゴリズム的に複雑ではないので、補正に必要な処理能力が減少する。
図13は、磁気リング全体が磁気センサアセンブリを通過する間に取得された理論的センサ読取値を示す。これらの理論的センサ読取値はマルチビットであり、図13の線74によって表されている。図13はまた、磁気リング全体が磁気センサアセンブリを通過する間に取得された実際のセンサ読取値を示している。これらの実際のセンサ読取値はマルチビットであり、図13の曲線75で表されている。曲線76は、図10から図12に関して説明したように磁極対誤差に対して補正された実際のセンサ読取値を表す。図13は、実際のセンサ読取値のさらなる誤差を示す。この誤差は、直線74で表される理論的センサ読取値と比較してほぼ正弦波誤差である。
図13に示されたさらなる誤差に対して測定されたセンサ位置読取値を補正することを目的とする較正プロセスがここで説明される。このプロセスはディスクの各磁気リングに個別に適用される。
第1に、位置読取値73が磁気リングの各磁極対について磁気センサアレイによって取得される。上記のように、この位置読取値は、その磁極対に対する較正磁極対位置読取値と呼ばれる。各磁極対に対して、較正磁極対位置読取値73をモデル磁極対位置読取値72と比較して、上述したようにその磁極対についての磁極対補正関数を生成する。次に、各磁極対に対して、その磁極対に対する較正磁極対位置読取値から磁極対補正関数を差し引くことによって、補正された較正磁極対位置読取値が生成される。図13の例では、曲線76は磁気リングの全ての磁極対の補正された較正磁極対位置読取値を表す。
次に、磁気リング上の全ての磁極対に対する補正された較正磁極対位置読取値をモデル回転位置読取値と比較することによって回転補正関数が生成される。図13から分かるように、補正された較正磁極対位置読取値76の曲線は、モデル回転位置読取値74の直線の周りで振動する。補正された較正磁極対位置読取値76の曲線は、モデル回転位置読取値74の直線周りに周期的に振動してもよい。回転補正関数は、補正された較正磁極対位置読取値76に曲線をフィッティングし、そしてフィッティングされた曲線からモデル回転位置読取値74の直線を差し引くことによって生成されていてもよい。この曲線は、最小二乗法を使用してフィッティングされていてもよい。あるいは、曲線は当技術分野で公知の他の方法を使用してフィッティングされていてもよい。フィッティングされた曲線は、周期的に振動する関数によって記述されていてもよい。例えば、フィッティングされた曲線は正弦関数であってもよい。正弦関数は振幅Bの正弦波、すなわちBsinφであってもよく、ここでφは回転正弦波内の角度である。この例では、フィッティングされた曲線は第1次高調波Bsinφのみであるが、より高次の高調波が含まれていてもよい。
回転補正関数はプロセッシングユニット14に記憶されていてもよい。続いて、位置センサが位置測定を行うとき、位置測定値から回転補正関数を差し引くことにより回転補正関数を使用して位置測定が補正される。
説明した両方の較正機構を位置測定値に対して実行してもよく、これにより位置測定値は平均磁極対補正関数と回転補正関数の両方を使用して補正される。あるいは、較正機構のうちの1つのみが実行されてもよい。この単一の較正機構は、平均磁極対補正機構でも回転補正機構であってもよい。
較正機構は、磁気ディスクが回転ジョイントまたは関節構造内で相対的な回転が感知されている他のエレメントに取り付けられた後に実行されてもよい。この段階で較正を実行することによって、製造中に導入された誤差だけでなく、位置センサを適所に組み立てる間に(例えば、磁気センサアセンブリを磁気ディスク上に位置合わせさせるときに)導入される誤差を検出し補償されていてもよい。センサは、上述の較正機構を使用して、使用中に再較正されてもよい。較正機構は製造中に実行されてもよく、位置センサは、上述の補正関数を備え、補正関数はプロセッシングユニット14に記憶されており、その後使用中に測定位置読取値に上述の補正関数が適用される。
ロボット工学、特に外科用ロボット工学の分野では、ロボットアームは可能な限り小型で軽量であることが望ましい。ロボットアームの各ジョイントに使用される位置センサもまた小型で軽量であることが望ましい。例えば、ディスク3はアルミニウム製でもよい。この分野では、ロボットアーム上でその場でディスク3を磁化することは実用的ではない。ロボットアームのコンパクトな性質のために、ディスク3を磁化するためにロボットアームの周りに標準的な磁化治具を適用するためのスペースが十分ではない。さらに、ディスク3を磁化するために、磁化の間にディスク3に対して磁気バックプレートが使用される。このバックプレートとしては、例えば鋼が用いられる。その場でディスク3を磁化するためには、ディスク3は鋼鉄または他の磁性材料で作られる必要がある。これは、ディスク3をアルミニウムのような軽量材料で作ることを妨げるであろう。それゆえ、ディスク3はその場で磁化されないが、その代わりに、製造中に導入された誤差を補償するために、関節構造において磁化治具環境を再現する本明細書に記載されている手段がとられている。
出願人はこれによって、ここに記載の分離した各個別の特徴および2つ以上のそのような特徴の任意の組み合わせを開示しており、そのような特徴または特徴の組み合わせが当業者の共通の一般的な知識に照らして全体として本明細書に基づいて実施されることが可能な程度に開示されている。なお、そのような特徴または特徴の組合せが本明細書に開示される任意の問題を解決するかどうかは関係がなく、またかかる具体的記載が特許請求の範囲を限定するものでもない。出願人は、本発明の態様は、このような個々の特徴または特徴の組み合わせから成ってもよいことを示している。以上の説明に鑑みて、種々の改変が本発明の範囲内でなされ得ることは当業者にとって明らかであろう。

Claims (16)

  1. 関節構造の回転ジョイントの位置を検出するための位置検出装置の組立方法であって、前記位置検出装置は、磁気センサアセンブリと、j個の磁極対を含む第1の磁気リングおよびk個の磁極対を含む第2の磁気リングを有するディスクを含み、そこにおいて|j-k|>1であり、前記ディスクの境界が前記関節構造によって拘束されており、
    前記第1の磁気リングの中心線が少なくとも該中心線と前記拘束された境界との間に配置された前記磁気センサアセンブリによって半径方向の幅の分だけ前記拘束された境界から離されるように、前記第1の磁気リングの磁極対の数を整数pとなるように決定し、
    前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離されるように、前記第2の磁気リングの磁極対の数を整数qとなるように決定し、
    pとqが互いに素である場合、jをpとなるように、かつkをqとなるように選択し、前記ディスクと前記回転ジョイントの両方が同じ軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより、前記位置検出装置を組み立てること、
    を含む、位置検出装置の組立方法。
  2. pとqが互いに素でない場合、
    pとqとの間の差が各反復毎に1ずつ増加するように、前記第2の磁気リングの前記磁極対の数に対してさらなる値qを反復して決定し、
    各反復に対して、pとqが互いに素である場合、前記第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、前記第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、
    p'が前記第1の磁気リングの磁極対の数の前記範囲内にあり、q'が前記第2の磁気リングの極対の数の前記範囲内にあり、そのp'、q'対に対して前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、
    最大値を有する前記識別されたp'のある前記識別されたp'、q'対の中から、p'の前記最大値を有する前記識別されたp'、q'対を選択し、
    jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより前記位置検出装置を組み立てること、
    を含む請求項1に記載の位置検出装置の組立方法。
  3. pとqが互いに素でない場合、
    pとqとの間の差が各反復毎に1ずつ増加するように、前記第2の磁気リングの前記磁極対の数に対してさらなる値qを反復して決定し、
    各反復に対して、pとqが互いに素である場合、前記第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、前記第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、
    p'が前記第1の磁気リングの磁極対の数の前記範囲内にあり、q'が前記第2の磁気リングの極対の数の前記範囲内にあり、そのp'、q'対に対して前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、
    最大値を有する前記識別されたq'のある前記識別されたp'、q'対の中から、q'の前記最大値を有する前記識別されたp'、q'対を選択し、
    jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより前記位置検出装置を組み立てること、
    を含む請求項1に記載の位置検出装置の組立方法。
  4. pとqが互いに素でない場合、
    pとqとの間の差が各反復毎に1ずつ増加するように、前記第2の磁気リングの前記磁極対の数に対してさらなる値qを反復して決定し、
    各反復に対して、pとqが互いに素である場合、前記第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、前記第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、
    p'が前記第1の磁気リングの磁極対の数の前記範囲内にあり、q'が前記第2の磁気リングの極対の数の前記範囲内にあり、そのp'、q'対に対して前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、
    最小値を有する前記識別されたq'のある前記識別されたp'、q'対の中から、q'の前記最小値を有する前記識別されたp'、q'対を選択し、
    jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより前記位置検出装置を組み立てること、
    を含む請求項1に記載の位置検出装置の組立方法。
  5. pとqが互いに素でない場合、
    pとqとの間の差が各反復毎に1ずつ増加するように、前記第2の磁気リングの前記磁極対の数に対してさらなる値qを反復して決定し、
    各反復に対して、pとqが互いに素である場合、前記第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、前記第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、
    p'が前記第1の磁気リングの磁極対の数の前記範囲内にあり、q'が前記第2の磁気リングの極対の数の前記範囲内にあり、そのp'、q'対に対して前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、
    最小値を有する前記識別された|p'-q'|のある前記識別されたp'、q'対の中から、|p'-q'|の前記最小値を有する前記識別されたp'、q'対を選択し、
    jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより前記位置検出装置を組み立てること、
    を含む請求項1に記載の位置検出装置の組立方法。
  6. 前記第1の磁気リングと前記第2の磁気リングは同心であり、前記第1の磁気リングは前記第2の磁気リングの内側にあり、前記拘束された境界は前記ディスクの前記内側の半径方向の境界である請求項1~5の何れか1項に記載の位置検出装置の組立方法。
  7. p'>pおよびq'<qの場合、各反復毎にqを1だけ増加することによってさらなる値qを反復して決定することを含み、pとqが互いに素である場合、各反復に対して、pを前記第1の磁気リングの磁極対の数の範囲の下限とし、qを前記第2の磁気リングの磁極対の数の範囲の上限とすることを含む、請求項2,4,5の何れか1項に従属する時の請求項6に記載の位置検出装置の組立方法。
  8. 前記第1の磁気リングと前記第2の磁気リングは同心であり、前記第1の磁気リングは前記第2の磁気リングの外側にあり、前記拘束された境界は前記ディスクの前記外側の半径方向の境界である請求項1~5の何れか1項に記載の位置検出装置の組立方法。
  9. p'<pおよびq'>qの場合、各反復毎にqを1だけ減少することによってさらなる値qを反復して決定することを含んでおり、各反復に対して、pとqが互いに素である場合、pを前記第1の磁気リングの磁極対の数の範囲の前記上限とし、qを前記第2の磁気リングの磁極対の数の範囲の前記下限とすることを含む請求項3または5に従属する時の請求項8に記載の位置検出装置の組立方法。
  10. pとqが互いに素でない場合、
    pとqとの間の差が各反復毎に1ずつ増加するように、前記第2の磁気リングの前記磁極対の数に対してさらなる値qを反復して決定し、
    各反復に対して、pとqが互いに素である場合、前記第1の磁気リングの磁極対の数の範囲の限界となるようにpを選択し、前記第2の磁気リングの磁極対の数の範囲の限界となるようにqを選択し、
    p'が前記第1の磁気リングの磁極対の数の前記範囲内にあり、q'が前記第2の磁気リングの極対の数の前記範囲内にあり、そのp'、q'対に対して前記第2の磁気リングが前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離れている場合に、一対あるいは複数対の他の互いに素となるp'、q'を識別し、
    前記位置検出装置により検出された前記回転ジョイントの最大回転角によって識別されたp'、q'対を選択し、
    jを前記選択されたp'となるように、かつkを前記選択されたq'となるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、前記ディスクと前記磁気センサアセンブリの相対的な回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより前記位置検出装置を組み立てること、
    を含む請求項1に記載の位置検出装置の組立方法。
  11. 前記ディスクが、l個の磁極対を有する第3の磁気リングをさらに含んでおり、
    前記第3の磁気リングが前記第2の磁気リングから前記磁極対の長さだけ半径方向に離されるように、前記第3の磁気リングの磁極対の数を整数sに決定し、
    p、qおよびsが互いに素である場合、jをpとなるように、kをqとなるように、かつlをsとなるように選択し、
    前記ディスクと前記回転ジョイントの両方が同じ前記軸周りに回転できるように前記ディスクを前記関節構造に取り付け、そして前記ディスクと前記磁気センサアセンブリの相対的回転が検知できるように前記磁気センサアセンブリを前記関節構造に取り付けることにより、前記位置検出装置を組み立てること、
    をさらに含む、請求項1~10の何れか1項に記載の位置検出装置の組立方法。
  12. 前記関節構造がロボットアームである請求項1~10の何れか1項に記載の位置検出装置の組立方法。
  13. 関節構造に取り付けられている位置検出装置であって、
    j個の磁極対を有する第1の磁気リングと、
    k個の磁極対を有する第2の磁気リングと、前記第2の磁気リングは前記第1の磁気リングに対して固定されており、
    磁気センサアセンブリと前記第1の磁気リングと前記第2の磁気リングの相対的な位置を検出する前記磁気センサアセンブリと、を含み、
    ここで、jとkは互いに素で、|j-k|>1であり、
    前記関節構造の回転ジョイントの位置を検出するためのものであり、前記第1の磁気リング,前記第2の磁気リングおよび前記回転ジョイントはすべて同じ軸周りに回転可能となるように、前記第1の磁気リングと前記第2の磁気リングは前記関節構造に取り付けられており、前記第2の磁気リングは前記第1の磁気リングから少なくとも前記磁極対の長さだけ半径方向に離されている、
    位置検出装置。
  14. 前記第1および前記第2の磁気リングは両方ともディスク上に配置されている請求項1に記載の位置検出装置。
  15. 前記磁気センサアセンブリは、前記第1の磁気リング上に配置された第1の磁気センサアレイと、前記第2の磁気リング上に配置された第2の磁気センサアレイを含み、前記第1および前記第2の磁気センサアレイのそれぞれの隣接するセンサが磁極対の前記長さの4分の1だけ離されている請求項13または14に記載の位置検出装置。
  16. 前記関節構造がロボットアームである請求項13~15の何れか1項に記載の位置検出装置。
JP2019503253A 2016-07-22 2017-07-19 位置検出装置およびその組立方法 Active JP6990231B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
GB1612768.0 2016-07-22
GB1612768.0A GB2552478B (en) 2016-07-22 2016-07-22 Magnetic position sensor
PCT/GB2017/052125 WO2018015750A1 (en) 2016-07-22 2017-07-19 Magnetic position sensor

Publications (2)

Publication Number Publication Date
JP2019521362A JP2019521362A (ja) 2019-07-25
JP6990231B2 true JP6990231B2 (ja) 2022-01-12

Family

ID=56894390

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019503253A Active JP6990231B2 (ja) 2016-07-22 2017-07-19 位置検出装置およびその組立方法

Country Status (7)

Country Link
US (1) US11054282B2 (ja)
EP (1) EP3488188B1 (ja)
JP (1) JP6990231B2 (ja)
CN (1) CN109564105B (ja)
ES (1) ES2885109T3 (ja)
GB (1) GB2552478B (ja)
WO (1) WO2018015750A1 (ja)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2552385B (en) * 2016-07-22 2021-09-15 Cmr Surgical Ltd Calibrating position sensor readings
JP6940955B2 (ja) * 2017-02-14 2021-09-29 日本電産サンキョー株式会社 ロータリエンコーダ
JP6877170B2 (ja) * 2017-02-14 2021-05-26 日本電産サンキョー株式会社 ロータリエンコーダ及びその絶対角度位置検出方法
US11280636B2 (en) 2018-07-09 2022-03-22 Sensata Technologies, Inc. Rotary position sensor and method of manufacturing the same
JP2021071444A (ja) * 2019-11-01 2021-05-06 株式会社東海理化電機製作所 回転角検出装置
CN112775467B (zh) * 2020-12-24 2022-04-15 襄阳易日自动化设备有限公司 一种钻床用双工位定位输送装置
CN112757048B (zh) * 2021-01-22 2021-11-19 武汉城市职业学院 一种汽轮机转子叶轮中心轴线的定位装置
TWI774322B (zh) * 2021-04-15 2022-08-11 賀欣機械廠股份有限公司 縫紉機馬達之旋轉軸感測裝置
CN113633398B (zh) * 2021-06-30 2022-10-14 北京东软医疗设备有限公司 用于手术位快速锁定的机架臂及治疗设备

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070132447A1 (en) 2005-12-09 2007-06-14 Ssi Technologies, Inc. Position and torque sensor
US20100176799A1 (en) 2009-01-14 2010-07-15 Infineon Technologies Ag Sensor including two code rings and a magnetic field sensor between the code rings
JP2012107753A (ja) 2011-12-19 2012-06-07 Jtekt Corp 転がり軸受装置の組立て方法
JP2015175762A (ja) 2014-03-17 2015-10-05 セイコーエプソン株式会社 エンコーダー、電気機械装置、ロボット、及び、鉄道車両
WO2016083825A1 (en) 2014-11-28 2016-06-02 Imperial Innovations Limited Absolute rotary encoder

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5757180A (en) * 1994-11-29 1998-05-26 Industrial Technology Research Institute Disk type of absolute-position magnetic encoder for rotary devices
US5568048A (en) * 1994-12-14 1996-10-22 General Motors Corporation Three sensor rotational position and displacement detection apparatus with common mode noise rejection
DE19818799C2 (de) * 1997-12-20 1999-12-23 Daimler Chrysler Ag Verfahren und Vorrichtung zum Messen von Winkeln
DE10041095B4 (de) 1999-12-06 2015-11-12 Robert Bosch Gmbh Vorrichtung zur Messung eines Winkels und/oder eines Drehmomentes eines drehbaren Körpers
US6935193B2 (en) * 1999-12-06 2005-08-30 Robert Bosch Gmbh Device for measuring the angle and/or the angular velocity of a rotatable body and/or the torque acting upon said body
US6515471B1 (en) * 2000-10-11 2003-02-04 The Torrington Company Absolute position hall string sensor
DE202004014849U1 (de) * 2004-09-23 2005-02-03 Trw Automotive Safety Systems Gmbh Vorrichtung zur Bestimmung eines absoluten Drehwinkels
GB0616437D0 (en) 2006-08-18 2006-09-27 Trw Ltd Methods of processing encoder signals
JP5583317B2 (ja) * 2007-02-23 2014-09-03 Ntn株式会社 回転検出装置および回転検出装置付き軸受
DE112008002827B4 (de) 2007-10-22 2019-03-21 The Timken Company Magnetischer Absolut-Positionskodierer mit Binär- und Dezimal-Ausgabe
US8024956B2 (en) * 2008-09-02 2011-09-27 Infineon Technologies Ag Angle measurement system
JP5221494B2 (ja) * 2008-12-24 2013-06-26 Ntn株式会社 回転検出装置および回転検出装置付き軸受
WO2015008622A1 (ja) * 2013-07-16 2015-01-22 Ntn株式会社 磁気エンコーダ装置および回転検出装置
DE102014113374B4 (de) 2014-09-17 2024-01-11 Infineon Technologies Ag Magnetpositionssensor und Erfassungsverfahren
US10052761B2 (en) * 2015-07-17 2018-08-21 Deka Products Limited Partnership Robotic surgery system, method, and apparatus
GB2541369B (en) * 2015-07-22 2021-03-31 Cmr Surgical Ltd Drive mechanisms for robot arms
GB2540599B (en) * 2015-07-22 2021-04-14 Cmr Surgical Ltd Rotary encoder.

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070132447A1 (en) 2005-12-09 2007-06-14 Ssi Technologies, Inc. Position and torque sensor
US20100176799A1 (en) 2009-01-14 2010-07-15 Infineon Technologies Ag Sensor including two code rings and a magnetic field sensor between the code rings
JP2012107753A (ja) 2011-12-19 2012-06-07 Jtekt Corp 転がり軸受装置の組立て方法
JP2015175762A (ja) 2014-03-17 2015-10-05 セイコーエプソン株式会社 エンコーダー、電気機械装置、ロボット、及び、鉄道車両
WO2016083825A1 (en) 2014-11-28 2016-06-02 Imperial Innovations Limited Absolute rotary encoder

Also Published As

Publication number Publication date
EP3488188A1 (en) 2019-05-29
GB2552478A (en) 2018-01-31
EP3488188B1 (en) 2021-07-14
GB2552478B (en) 2021-04-28
CN109564105B (zh) 2021-09-14
ES2885109T3 (es) 2021-12-13
US11054282B2 (en) 2021-07-06
JP2019521362A (ja) 2019-07-25
WO2018015750A1 (en) 2018-01-25
US20190265069A1 (en) 2019-08-29
GB201612768D0 (en) 2016-09-07
CN109564105A (zh) 2019-04-02

Similar Documents

Publication Publication Date Title
JP6990231B2 (ja) 位置検出装置およびその組立方法
JP7374283B2 (ja) 位置検出装置の位置読取値の補正方法
US20230025430A1 (en) Magnetic position sensor mounting arrangement
US10670383B2 (en) Calibrating and operating rotary devices, in particular for rotating probe heads and/or probes of coordinate measuring machines
JP5085657B2 (ja) 測定要素および測定要素の動作方法
JP2005531008A (ja) 2つの磁気トラックを有する角変位エンコーダ
US11486740B2 (en) Angle measuring device and method for operating an angle measuring device
TWI687039B (zh) 旋轉軸件之偏移感測機構
KR20200054392A (ko) 톱니 구조를 갖는 엔코더 및 상기 엔코더를 구비한 장치
JP2006047199A (ja) 角度データ作成方法

Legal Events

Date Code Title Description
A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190326

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200618

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210709

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20211006

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211203

R150 Certificate of patent or registration of utility model

Ref document number: 6990231

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150