Continuum robot control system and continuum robot control method

Patent metadata

Field	Value
Publication number	US-2018304458-A1
Application number	US-201815953034-A
Country	US
Kind code	A1
Filing date	Apr 13, 2018
Priority date	Apr 21, 2017
Publication date	Oct 25, 2018
Grant date	—

Abstract

A kinematic model arithmetic portion calculates a coordinate value (ze1 (θe)) as distance information indicating the distance between a member that serves as a reference surface for the curve shape of a curvable portion and a member in the curvable portion that is closest to the reference surface. A switch determination unit determines based on the coordinate value whether to drive a wire for driving the curvable portion by a drive displacement calculated for the wire along with the coordinate value by the kinematic model arithmetic portion.

First claim

What is claimed is:

1 . A continuum robot control system for controlling a continuum robot, the continuum robot includes a curvable portion including:
a plurality of wires extending through a reference surface; a first wire guide to which the plurality of wires are fixed and configured to guide the plurality of wires; and a second wire guide to which a part of the plurality of wires are fixed and configured to guide the plurality of wires, the second wire guide being provided between the reference surface and the first wire guide, the curvable portion being curvable by driving one or more of the plurality of wires, the continuum robot control system comprising:
a calculation unit configured to calculate, from input of a target curve angle and a target rotation angle, a drive displacement amount of the one or more of the plurality of wires and distance information, the target curve angle being a target value of a curve angle of the curvable portion, the target rotation angle being a target value of a rotation angle of the curvable portion, the distance information indicating a distance between a proximal end, which is one of end portions of the second wire guide that is closer to the reference surface, and the reference surface; and
a control unit configured to control drive of the one or more of the plurality of wires,
wherein the control unit includes a determination unit configured to determine, based on the distance information, whether to drive the one or more of the plurality of wires by the drive displacement amount calculated along with the distance information by the calculation unit.

2 . A continuum robot control system according to claim 1 , wherein the control unit is configured to perform, when the distance information indicates a distance equal to or less than a threshold value, control so that the one or more of the plurality of wires is kept from being driven by the drive displacement amount calculated along with the distance information by the calculation unit.

3 . A continuum robot control system according to claim 1 , wherein the control unit is configured to perform, when the distance information indicates a distance equal to or less than a threshold value, control so that the one or more of the plurality of wires is driven by a drive displacement amount of the one or more of the plurality of wires stored in a memory portion in advance.

4 . A continuum robot control system according to claim 2 , wherein the control unit is configured to perform, when the distance information indicates a distance equal to or less than the threshold value, control so that the one or more of the plurality of wires is driven by a drive displacement amount of the one or more of the plurality of wires stored in a memory portion in advance.

5 . A continuum robot control system according to claim 3 , wherein the drive displacement amount of the one or more of the plurality of wires stored in the memory portion includes the drive displacement amount calculated along with the distance information by the calculation unit when the distance information indicates a distance larger than the threshold value.

6 . A continuum robot control system according to claim 1 ,
wherein the second wire guide includes a plurality of second wire guides, wherein the curvable portion includes the plurality of second wire guides, and wherein the calculation unit is configured to calculate, as the distance information, distance information indicating a distance between the reference surface and the proximal end of one of the plurality of second wire guides that is closest to the reference surface.

7 . A continuum robot control system according to claim 1 ,
wherein more than one of the plurality of wires is driven, and wherein the calculation unit is configured to calculate the drive displacement amount for each of wires that are the plurality of predetermined wires.

8 . A continuum robot control system according to claim 1 , wherein the curvable portion has a length that varies depending on a curve shape of the curvable portion.

9 . A continuum robot control system according to claim 1 ,
wherein the curvable portion includes a plurality of curvable portions, wherein the continuum robot includes the plurality of curvable portions in series in a longitudinal axial direction of the continuum robot, wherein the calculation unit is configured to calculate, for each of the plurality of curvable portions, the drive displacement amount of the one or more of the plurality of wires and the distance information, and wherein the control unit is configured to perform the control for each of the plurality of curvable portions.

10 . A continuum robot control system according to claim 1 , wherein the second wire guide is configured to fix a wire remaining after excluding the one or more of the plurality of wires from the plurality of wires at a predetermined point in the second wire guide.

11 . A continuum robot control system according to claim 1 , wherein the curvable portion is configured so as to be curvable by driving all of the plurality of wires as the one or more of the plurality of wires.

12 . A continuum robot control method for controlling a continuum robot, the continuum robot including a curvable portion including:
a plurality of wires extending through a reference surface; a first wire guide to which the plurality of wires are fixed and configured to guide the plurality of wires; and a second wire guide to which a part of the plurality of wires are fixed and configured to guide the plurality of wires, the second wire guide being provided between the reference surface and the first wire guide, the curvable portion being curvable by driving one or more of the plurality of wires, the continuum robot control method comprising:
calculating, from input of a target curve angle and a target rotation angle, a drive displacement amount of the one or more of the plurality of wires and distance information, the target curve angle being a target value of a curve angle of the curvable portion, the target rotation angle being a target value of a rotation angle of the curvable portion, the distance information indicating a distance between a proximal end, which is one of end portions of the second wire guide that is closer to the reference surface, and the reference surface; and
determining, based on the distance information, whether to drive the one or more of the plurality of wires by the drive displacement amount calculated along with the distance information in the calculating.

13 . A continuum robot control method according to claim 12 , further comprising performing, when the distance information indicates a distance equal to or less than a threshold value, control so that the one or more of the plurality of wires is kept from being driven by the drive displacement amount calculated along with the distance information.

14 . A continuum robot control method according to claim 12 , further comprising performing, when the distance information indicates a distance equal to or less than a threshold value, control so that the one or more of the plurality of wires is driven by a drive displacement amount of the one or more of the plurality of wires stored in a memory portion in advance.

15 . A continuum robot control method according to claim 13 , wherein the control unit is configured to perform, when the distance information indicates a distance equal to or less than the threshold value, control so that the one or more of the plurality of wires is driven by a drive displacement amount of the one or more of the p

Assignees

• Canon Kk

Inventors

• Takagi Kiyoshi

Classifications

• Y10S901/27

  Arm part · CPC title

• Y10S901/09

  Closed loop, sensor feedback controls arm movement · CPC title

• Y10S901/21

  Flaccid drive element · CPC title

• B25J18/06

  flexible · CPC title

• B25J9/104 Primary

  with cables, chains or ribbons · CPC title