Method and apparatus for visual servoing of a linear apparatus
AssigneeSiemens Corporate Research, Inc.
InventorBénédicte Bascle
Life of this patent
Estimating the term…
Abstract
A method and system for visual servoing of a linear apparatus rotatable in a plane about a fixed point implements cross-ratios and provides alignment of the linear apparatus to the target in an image, such as a fluoroscope image in 3 iterations. The imaging device through which the scene is observed can be of any suitable type and does not need to be calibrated.
Claims14
A method for visual servoing of a linear apparatus for aiming at a fixed target, said linear apparatus being rotatable in a defined plane about a fixed point, and wherein said linear apparatus and target are viewed by an imaging process in a two-dimensional (2D) image plane, said method comprising the steps of:
- beginning at an arbitrary first line direction in space of said linear apparatus, detecting and storing an image of said first line direction in said 2D image plane;
- detecting and storing an image of said fixed target in said 2D image plane;
- rotating said linear apparatus through a first angle in said defined plane about said fixed point to a second line direction;
- detecting and storing an image of said second line direction in said 2D image plane;
- rotating said linear apparatus through a second angle in said defined plane about said fixed point to a third line direction;
- detecting and storing an image of said third line direction in said 2D image plane;
- determining and storing the point of intersection in said 2D image plane of said images of said first, second, and third line directions;
- storing an image of a virtual straight line in said 2D image plane passing through said image of said fixed target in said 2D image plane and said point of intersection, said image of a virtual straight line being associated with a corresponding virtual line passing through said fixed point and said target;
- determining the cross-ratio of said 2D images of said first, second, third, and virtual line directions;
- calculating from said cross-ratio an aiming angle between said third and said virtual line directions in 3D space;
- and
- aligning said linear apparatus along said virtual line in accordance with said aiming angle so as to visually aim at said target.
Apparatus for visual servoing of a linear apparatus for aiming at a fixed target, said linear apparatus being rotatable in a defined plane about a fixed point, and wherein said linear apparatus and target are viewed by an imaging process in a two-dimensional (2D) image plane, said apparatus for visual servoing including computerized apparatus for reading, storing and processing data, and wherein
- said computerized apparatus detects and stores an image of said fixed target in said 2D image plane;
- detects and stores an image in said 2D image plane of a first arbitrary line direction in space of said linear apparatus;
- detects and stores an image in said 2D image plane of a second line direction in space of said linear apparatus wherein said second direction line in space is at a first angle in said defined plane relative to said first line direction;
- detects and stores an image in said 2D image plane of a third line direction in space of said linear apparatus wherein said third direction line in space is at a second angle in said defined plane relative to said second line direction;
- determines and stores the point of intersection in said 2D image plane of said images of said first, second, and third line directions;
- stores an image of a virtual straight line in said 2D image plane passing through said image of said fixed target in said 2D image plane and said point of intersection, said image of a virtual straight line being associated with a corresponding virtual line passing through said fixed point and said target;
- determines the cross-ratio of said images of said first, second, third, and virtual line directions;
- and obtains from said cross-ratio an aiming angle between said third and said virtual line directions for alignment of said linear apparatus along said virtual line in accordance with said aiming angle.
Dependencies are inferred from the claim text.