| 主权项 |
1. A robot apparatus including: a first link that is made of a longitudinal member, and has a base end supported to a fixing member so as to be swingable; a second link that is made of a longitudinal member, and that has a base end supported to a tip of the first link so as to be swingable in a plane where the first link swings; a pair of first actuators that is connected to the fixing member and the first link for allowing the first link to swing owing to a difference in contraction forces between the first actuators; a pair of second actuators that is connected to the first link and the second link for allowing the second link to swing owing to a difference in contraction forces between the second actuators; and a pair of third actuators that is connected to the fixing member and the second link for allowing the first link and the second link to swing owing to a difference in contraction forces between the third actuators, the apparatus comprising:
a storing unit that preliminarily stores operational expressions that are derived under the condition that an orthogonal coordinate system is defined in the plane, a stiffness characteristic at the tip of the second link is represented by an ellipse having its center defined as the tip of the second link on the orthogonal coordinate system, and one of a long axis and a short axis of the ellipse is parallel to a reference axis of the orthogonal coordinate system, the operational expressions including: a first operational expression for obtaining a first stiffness instruction value U1 expressed by Equation A, which indicates a sum of contraction force instruction values of the pair of first actuators, a second operational expression for obtaining a second stiffness instruction value U2 expressed by Equation B, which indicates a sum of contraction force instruction values of the pair of second actuators, and a third operational expression for obtaining a third stiffness instruction value U3 expressed by Equation C, which indicates a sum of contraction force instruction values of the pair of third actuators, wherein a first swing angle of the first link with the reference axis being defined as a reference and a second swing angle of the second link with an axis extending in the longitudinal direction of the first link being defined as a reference are specified as variables, and the length of the first link and the length of the second link are specified as constants; a subtracting unit that acquires a signal indicating a value of the first swing angle of the first link and a signal indicating a value of a target tilt angle of one axis with the reference axis being defined as a reference, and outputs a signal indicating a new value of the first swing angle, the new value being specified as the result obtained by subtracting the value of the target tilt angle from the value of the first swing angle; a calculating unit that acquires a signal indicating the value of the first swing angle output from the subtracting unit and a signal indicating the value of the second swing angle of the second link, and calculates the first stiffness instruction value, the second stiffness instruction value, and the third stiffness instruction value from the first operational expression, the second operational expression, and the third operational expression stored in the storing unit; and a contraction force instruction value generating unit that generates contraction force instruction values of each of the pair of first actuators, the pair of second actuators, and the pair of third actuators from the stiffness instruction values calculated by the calculating unit, Equation A:U1={(β−α)l1l2 cos(5θ2+2θ1)+(β−α)l12 cos(4θ2+2θ1)+(β−α)l12 cos(4θ2−2θ1) +(4α−4β)l1l2 cos(3θ2+2θ1)+(β−α)l1l2 cos(3θ2−2θ1)+(4α−4β)l12 cos(2θ2+2θ1) +(4α−4β)l12 cos(2θ2+2θ1)+(6β−6α)l1l2 cos(θ2−2θ1)+(4α−4β)l1l2 cos(θ2+2θ1) +(β+α)l1l2 cos(5θ2) +(2β+2α)l12 cos(4θ2)+(−3β−3α)l1l2 cos(3θ2) +(−8α−8β)l12 cos(2θ2)+(2β−2α)l1l2 cos(θ2)+(6α−6β)l12 cos(2θ1)+(6β+6α)l12}/ {kr2 cos(4θ2)−4kr2 cos(2θ2)+3kr2},
Equation B:U2={(β−α)l1l2 cos(5θ2+2θ1)+(4β−4α)l1l2 cos(3θ2+2θ1)+(β−α)l12 cos(3θ2−2θ1) +(6β−6α)l1l2 cos(θ2+2θ1)+(4α−4β)l1l2 cos(θ2−2θ1)+(β−α)l12 cos(5θ2) +(−3β−3α)l12 cos(3θ2)+(2β+2α)l1l2 cos(θ2)}/ {kr2 cos(4θ2)−4kr2 cos(3θ2)+3kr2},
Equation C:U3={(β−α)l22 cos(6θ2+2θ1)+(β−α)l1l2 cos(5θ2+2θ1)+(4α−4β)l22 cos(4θ2−2θ1) +(4α−4β)l1l2 cos(3θ2+2θ1)+(β−α)l1l2 cos(3θ2−2θ1)+(6β−6α)l12 cos(2θ2+2θ1) +(β−α)l22 cos(2θ2−2θ1)+(6β−6α)l1l2 cos(θ2+2θ1)+(4α−4β)l12 cos(θ2−2θ1) +(β−α)l1l2 cos(5θ2)+(2β−2α)l22 cos(4θ2)+(−3β−3α)l12 cos(3θ2) +(−8β−8α)l22 cos(2θ2)+(2β+2α)l1l2 cos(θ2)+(4α−4β)l22 cos(2θ1)+(6β+6α)l22}/ {kr2 cos(4θ2)−4kr2 cos(2θ2)+3kr2}, where α is a value obtained by dividing a length of the short axis by two, β is a value obtained by dividing a length of the long axis by two, l1 is a link length of the first link, l2 is a link length of the second link, θ1 is a swing angle of the first link, θ2 is a swing angle of the second link, and k is a value obtained by dividing a spring coefficient of an elastic component of the first, the second, or the third actuator by a contraction force of a force generating component of the first, the second, or the third actuator. |
