IPC분류정보
국가/구분 |
United States(US) Patent
등록
|
국제특허분류(IPC7판) |
|
출원번호 |
US-0313318
(2011-12-07)
|
등록번호 |
US-8942847
(2015-01-27)
|
우선권정보 |
JP-2010-278470 (2010-12-14) |
발명자
/ 주소 |
- Ohno, Nobuyuki
- Sekiya, Makoto
|
출원인 / 주소 |
|
대리인 / 주소 |
|
인용정보 |
피인용 횟수 :
0 인용 특허 :
5 |
초록
▼
Provided is a system and the like capable of appropriately searching a desired trajectory for a controlled subject in a time-space coordinate system in view of a state of the controlled subject. An initial positional relationship (k=1) between a first reference point q1(k) and a second reference poi
Provided is a system and the like capable of appropriately searching a desired trajectory for a controlled subject in a time-space coordinate system in view of a state of the controlled subject. An initial positional relationship (k=1) between a first reference point q1(k) and a second reference point q2(k) in the time-space coordinate system is set to satisfy a first condition defined according to a motion performance of an actuator 2. When a previous trajectory candidate tr(k−1) is determined to have a contact with an object trajectory tro, a current positional relationship (k1) between the first reference point q1(k) and the second reference point q2(k) in the time-space coordinate system is set to satisfy a second condition that a current time interval between the first reference point q1(k) and the second reference point q2(k) is longer than a previous time interval or the like.
대표청구항
▼
1. A control system configured to control motions of an actuator so as to make time-series positions of a controlled subject in real space follow a desired trajectory in a time-space coordinate system defined by a real-space coordinate system and a time coordinate system, comprising: a first arithme
1. A control system configured to control motions of an actuator so as to make time-series positions of a controlled subject in real space follow a desired trajectory in a time-space coordinate system defined by a real-space coordinate system and a time coordinate system, comprising: a first arithmetic processing element configured to:set an initial positional relationship between a first reference point and a second reference point in the time-space coordinate system to satisfy a first condition defined according to a motion performance of the actuator;perform an extending process to extend a first line segment from the first reference point and extend a second line segment from the second reference point on the basis of a sequence of points in the time-space coordinate system; andperform a joining process to join the first line segment and the second line segment to search a line segment as a trajectory candidate; anda second arithmetic processing element configured to determine whether the trajectory candidate has a contact with an object trajectory representing time-series positions of an object discrete from the controlled subject in the time-space coordinate system;the first arithmetic processing element is configured to set a current positional relationship between the first reference point and the second reference point to satisfy a second condition, on a condition that a previous trajectory candidate is determined to have a contact with the object trajectory by the second arithmetic processing element, the second condition including that a current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than a previous space interval, or a current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than a previous time interval, or the current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than the previous space interval and the current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than the previous time interval, and search a current trajectory candidate, andthe first arithmetic processing element is configured to set the previous trajectory candidate as the desired trajectory, on a condition that the previous trajectory candidate is determined to have no contact with the object trajectory by the second arithmetic processing element,wherein the first arithmetic processing element is configured to set the initial positional relationship between the first reference point and the second reference point through adjusting the length of at least one of the initial time interval and the initial space interval between the first reference point and the second reference point in the time-space coordinate system according to a level of a contact probability between the controlled subject and the object. 2. The control system according to claim 1, wherein the first arithmetic processing element is configured to eliminate a point positioned in the past of the time sequence with respect to a preceding point from the sequence of points proceeding to the first reference point used in searching the trajectory candidate and a point positioned in the future of the time sequence with respect to a preceding point from the sequence of points proceeding to the second reference point used in searching the trajectory candidate. 3. The control system according to claim 2, wherein the first arithmetic processing element is configured to eliminate a point beyond an allowable range defined in accordance with the motion performance of the actuator with respect to the preceding point from the sequence of points used in searching the trajectory candidate. 4. The control system according to claim 1, wherein the first arithmetic processing element is configured to define a plurality of second reference points with respect to a singular first reference point or a plurality of first reference points with respect to a singular second reference point in the time-space coordinate system, andsearch a line segment joining the singular first reference point to a singular second reference point among the plurality of the second reference points or a line segment joining a singular first reference point among the plurality of the first reference points and the singular second reference point which is obtained fastest by performing the extending process and the joining process, as the trajectory candidate. 5. The control system according to claim 1, wherein the first arithmetic processing element is configured to define a plurality of second reference points with respect to a singular first reference point or a plurality of first reference points with respect to a singular second reference point in the time-space coordinate system,select a singular line segment from a plurality of line segments obtained by joining the singular first reference point to the plurality of the second reference points respectively or a line segment from a plurality of line segments obtained by joining the plurality of the first reference points and the singular second reference point, by performing the extending process and the joining process, in accordance with the time interval between the first reference point and the second reference point, andsearch the selected line segment as the trajectory candidate. 6. The control system according to claim 1, wherein the first arithmetic processing element is configured to set the current positional relationship between the first reference point and the second reference point by adjusting the length of at least one of the current time interval and the current space interval between the first reference point and the second reference point in the time-space coordinate system, taking at least one of the previous time interval and the previous space interval as a reference, according to the level of the contact probability between the controlled subject and the object, on a condition that a previous trajectory candidate is determined to have a contact with the object trajectory by the second arithmetic processing element. 7. The control system according to claim 1, wherein the first arithmetic processing element is configured to perform an interpolation process to generate line segments represented by a linear combination of the sequence of points, in which a basis function for space interpolation serves as a combination coefficient, according to the mutually discrete points lined up in the time-space coordinate system,add new points to the sequence of points which is the base of one line segment generated by the interpolation process to define a new sequence of points and perform the interpolation process with the new sequence of points as the base,so as to perform the extending process to generate a new line segment in which the one line segment is extended by an extended line segment, andperform the interpolation process on the new sequence of points which is the base of the one line segment recently extended according to the extending process and another sequence of points which is the base of another line segment generated by the interpolation process,so as to perform the joining process which generates a line segment with a form of the one line segment and the another line segment being joined by a joining line segment. 8. The control system according to claim 7, wherein the second arithmetic processing element is configured to perform a second determination process which determines whether or not a specified condition including that the joining line segment deviates from the object trajectory in the time-space coordinate system is satisfied, andthe first arithmetic processing element is configured to redefine a new sequence of points and perform the extending process on condition that the determination result of the second determination process is negative. 9. The control system according to claim 7, wherein the second arithmetic processing element is configured to perform a first determination process which determines whether or not a specified condition including that the extended line segment deviates from the object trajectory in the time-space coordinate system is satisfied, andthe first arithmetic processing element is configured to discard the one line segment and perform the extending process on condition that the determination result of the first determination process is that the specified condition is not satisfied. 10. A robot comprising a base body, a limb extended from the base body, an actuator and a control system, wherein the limb serves as a controlled subject to the control system,the control system is configured to control motions of the actuator so as to displace the limb to make the robot follow a desired trajectory in real space and is provided witha first arithmetic processing element configured to:set an initial positional relationship between a first reference point and a second reference point in the time-space coordinate system to satisfy a first condition defined according to a motion performance of the actuator;perform an extending process to extend a first line segment from the first reference point and extend a second line segment from the second reference point on the basis of a sequence of points in the time-space coordinate system; andperform a joining process to join the first line segment and the second line segment to search the line segment as a trajectory candidate; anda second arithmetic processing element configured to determine whether the trajectory candidate has a contact with an object trajectory representing time-series positions of an object discrete from the controlled subject in the time-space coordinate system;the first arithmetic processing element is configured to set a current positional relationship between the first reference point and the second reference point to satisfy a second condition, on a condition that a previous trajectory candidate is determined to have a contact with the object trajectory by the second arithmetic processing element, the second condition including that a current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than a previous space interval, or a current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than a previous time interval, or the current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than the previous space interval and the current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than the previous time interval, and search a current trajectory candidate, andthe first arithmetic processing element is configured to set the previous trajectory candidate as the desired trajectory, on a condition that the previous trajectory candidate is determined to have no contact with the object trajectory by the second arithmetic processing element,wherein the first arithmetic processing element is configured to set the initial positional relationship between the first reference point and the second reference point through adjusting the length of at least one of the initial time interval and the initial space interval between the first reference point and the second reference point in the time-space coordinate system according to a level of a contact probability between the controlled subject and the object. 11. A mobile apparatus comprising an actuator and a control system, wherein the mobile apparatus serves as a controlled subject to the control system,the control system is configured to control motions of the actuator so as to make the mobile apparatus follow a desired trajectory in real space and is provided witha first arithmetic processing element configured to:set an initial positional relationship between a first reference point and a second reference point in the time-space coordinate system to satisfy a first condition defined according to a motion performance of the actuator;perform an extending process to extend a first line segment from the first reference point and extend a second line segment from the second reference point on the basis of a sequence of points in the time-space coordinate system; andperform a joining process to join the first line segment and the second line segment to search the line segment as a trajectory candidate; anda second arithmetic processing element configured to determine whether the trajectory candidate has a contact with an object trajectory representing time-series positions of an object discrete from the controlled subject in the time-space coordinate system;the first arithmetic processing element is configured to set a current positional relationship between the first reference point and the second reference point to satisfy a second condition, on a condition that a previous trajectory candidate is determined to have a contact with the object trajectory by the second arithmetic processing element, the second condition including that a current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than a previous space interval, or a current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than a previous time interval, or the current space interval between the first reference point and the second reference point in the time-space coordinate system is shorter than the previous space interval and the current time interval between the first reference point and the second reference point in the time-space coordinate system is longer than the previous time interval, and search a current trajectory candidate, andthe first arithmetic processing element is configured to set the previous trajectory candidate as the desired trajectory, on a condition that the previous trajectory candidate is determined to have no contact with the object trajectory by the second arithmetic processing element,wherein the first arithmetic processing element is configured to set the initial positional relationship between the first reference point and the second reference point through adjusting the length of at least one of the initial time interval and the initial space interval between the first reference point and the second reference point in the time-space coordinate system according to a level of a contact probability between the controlled subject and the object.
※ AI-Helper는 부적절한 답변을 할 수 있습니다.