JP2005254395A - Skiing robot and its controlling method - Google Patents

Skiing robot and its controlling method Download PDF

Info

Publication number
JP2005254395A
JP2005254395A JP2004069821A JP2004069821A JP2005254395A JP 2005254395 A JP2005254395 A JP 2005254395A JP 2004069821 A JP2004069821 A JP 2004069821A JP 2004069821 A JP2004069821 A JP 2004069821A JP 2005254395 A JP2005254395 A JP 2005254395A
Authority
JP
Japan
Prior art keywords
ski
robot
leg
hip joint
load
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.)
Pending
Application number
JP2004069821A
Other languages
Japanese (ja)
Inventor
Takeshi Yoneyama
米山  猛
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.)
Kanazawa University NUC
Original Assignee
Kanazawa University NUC
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 Kanazawa University NUC filed Critical Kanazawa University NUC
Priority to JP2004069821A priority Critical patent/JP2005254395A/en
Publication of JP2005254395A publication Critical patent/JP2005254395A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a skiing robot capable of controlling action by itself according to condition changes of a sliding surface, and stably skiing along a predetermined turn path. <P>SOLUTION: The skiing robot has a body part, and right and left leg parts for supporting a load of the body part through right and left hip joints provided under the body part. In order to slide on a snow surface or the similar low friction slope, a pair of skis is installed to grounding surfaces of the leg parts of the skiing robot. Hip joint inward/outward rotating shafts for rotating the leg parts inward/outward are provided on the hip joints, and a measuring device capable of measuring the orientation or speed of the skiing robot during sliding is provided in any part of the skiing robot. The body part is provided with a controller. On the basis of detection amount from the measuring device, the controller can control the hip joint inward/outward rotating shafts. <P>COPYRIGHT: (C)2005,JPO&NCIPI

Description

本発明は、スキーターンを行うロボットに関し、特には自身で動作を制御し所定のターン経路に沿って滑走を行えるスキーロボットに関する。   The present invention relates to a robot that performs a ski turn, and more particularly to a ski robot that controls its own operation and can slide along a predetermined turn path.

従来、スキー技術の要をなすターン技術は、スキーの運動が非常に高速であり、かつ腰、膝等の関節の微妙な動きを必要とするため、スキーヤーの関節動作からこれを詳細に解析することは非常に困難であった。このため、ロボットにスキー板を履かせてスキー操作を行わせ、ターン技術を原理的に解析してスキー操作技術の上達、スキー用品の進歩などに役立てるためにスキーロボットが研究されてきた。   Traditionally, the turn technology, which is a key part of ski technology, is very fast in skiing and requires delicate movements of the joints such as the hips and knees. It was very difficult. For this reason, ski robots have been studied in order to allow the robot to perform ski operations by wearing skis, to analyze the turn technique in principle and to improve the ski operation technique and to improve ski equipment.

例えば特許文献1には、絨毯面などからなる斜面をラジコン操作により大腿部の回旋動作を制御してプルークボーゲン、シュテムターン、パラレルターン、ウエーデルンなどのアルペンスキーの技術で滑走しうるスキーロボットが開示されている。即ち、このスキーロボットには、腰部材の両側に設けた脚部材下端に前後方向に長いスキー部材が取り付けられている。またこの各脚部材は、その上側部位において下方に傾斜する軸線を中心として左方向あるいは右方向に同時に回動可能(内旋および外旋が可能)となるように前記腰部材に取り付けてなり、該各脚部材を、各々独立したサーボモータを用いて作動させ得るように構成している。そして、左右のサーボモータをラジコンによって独立的に作動させ、スキーロボットを所要動作で滑走させるものである。この構成からスキーロボットは、遠隔操作によって各々のスキー部材に関して回旋と角付けとを独立的に同時に行わせることができ、しかも回旋角度や角付け角度を独立的かつ微妙に調整することが可能であるとしている。   For example, Patent Document 1 discloses a ski robot that can slide on a slope made of a carpet surface or the like by using a radio control operation to swing the thigh by alpine skiing techniques such as pluchbogen, stem turn, parallel turn, and wedeln. Has been. That is, this ski robot has a ski member that is long in the front-rear direction attached to lower ends of leg members provided on both sides of the waist member. Further, each leg member is attached to the waist member so that it can be rotated simultaneously in the left direction or the right direction (internal rotation and external rotation) around an axis inclined downward in the upper portion thereof, Each of the leg members can be operated using an independent servo motor. Then, the left and right servo motors are independently operated by the radio control, and the ski robot is slid in a required motion. With this configuration, the ski robot can rotate and angle each ski member independently by remote control, and can independently and finely adjust the rotation angle and angle. There is.

また従来スキーロボットとしては、予め決められた動作プログラムに従って所定の関節を動作させてスキーターンを行わせるものもあった。例えば、非特許文献1には、股関節の内外転動作のみを行うスキーロボットが紹介されている。このスキーロボットは、胴体部の下方左右にサーボモータにより内外転動作のみを自在とした股関節と、この股関節下部にそれぞれスキー板を足に履かせた左右2本の脚部とを有したロボットである。そしてこのロボットには、一定の斜度をもち表面に雪を敷いた滑走台の上でスキーターンを行わせており、またそのターン駆動制御は、所定のターン軌跡を創生するよう予め股関節の角度の変化動作を組んでおいた動作プログラムにより股関節を内外転のみ駆動して行われているものである。   In addition, some conventional ski robots perform a ski turn by operating a predetermined joint in accordance with a predetermined operation program. For example, Non-Patent Document 1 introduces a ski robot that performs only hip joint inward and outward motions. This ski robot is a robot having a hip joint that can be freely rotated inward and outward by a servomotor on the lower left and right sides of the body part, and two left and right leg parts each having a ski on the foot below the hip joint. is there. This robot is allowed to make a ski turn on a slide with a certain inclination and snow on its surface, and the turn drive control is performed in advance so as to create a predetermined turn trajectory. This is performed by driving the hip joint only inward and outward with an operation program in which an angle change operation is combined.

また例えば、非特許文献2には、胴体部の下方左右の股関節にサーボモータ駆動の内外転軸と、左右の股関節にそれぞれ支承された脚部の大腿部にサーボモータ駆動の回旋軸とを設け、左右2本の脚部下端にそれぞれスキー板を履かせた構成のスキーロボットを開示している。このスキーロボットは、プログラム動作により脚部の内外転運動と、大腿部の回旋運動とを行わせてスキーターンを実現させている。そして、上記2軸の関節動作とスキー板に発生する力、ターン運動を照らし合わせてそれらの関係を分析している。   Further, for example, in Non-Patent Document 2, servomotor-driven inner and outer rotation shafts are provided at the lower left and right hip joints of the body portion, and servomotor-driven rotation shafts are provided at the thighs of the leg portions respectively supported by the left and right hip joints. There is disclosed a ski robot having a configuration in which skis are put on the lower ends of two right and left legs. This ski robot realizes a ski turn by performing an inward and outward rotation motion of a leg and a rotation motion of a thigh by a program operation. Then, the relationship between the two-axis joint operation, the force generated on the ski, and the turn motion are compared and analyzed.

特開昭61−122881号公報(第2−3頁、第1図)JP 61-122881 A (page 2-3, FIG. 1) 米山猛・香川博之「スキーロボットターンと作用力」日本機械学会論文集(C編)、64巻623号(1998−7)、p.2369、p.2370、fig.3Takeshi Yoneyama and Hiroyuki Kagawa “Ski Robot Turn and Acting Force” Transactions of the Japan Society of Mechanical Engineers (C), Vol. 64, No. 623 (1998-7), p. 2369, p. 2370, fig.3 米山猛・香川博之・舟橋奈津子「スキーロボットを用いたターン動作と作用力に関する研究」日本機械学会、スポーツ工学シンポジウム講演論文集、NO.01−22(2001−11)、p.126、p.127、fig.1Takeshi Yoneyama, Hiroyuki Kagawa, Natsuko Funahashi “Study on Turn Motion and Action Force Using Ski Robots” The Japan Society of Mechanical Engineers, Proceedings of Sports Engineering Symposium, NO.01-22 (2001-11), p. 126, p. 127, fig.1

スキーヤーが実際に自然環境下で滑降する場合、その滑走面である雪面の物理的条件、即ち、滑走斜面の傾斜角度や凹凸の大小、並びに粉雪、ざらめ雪、アイスバーン、新雪、深雪などの積雪状態は、刻々と変化する。このためスキーヤーは、これらの次々と変化する滑降条件に対しスキー操作により自己の滑走速度や滑走方向、滑走姿勢などを臨機応変に変化させて対応している。よってこのスキーヤーのスキー操作に似せようとすると、スキーロボットは、斜面の角度や凹凸、斜面とスキー板との摩擦係数などの物理的条件の変化にタイムリーに対応して自身の動作速度や動作状態を変化させ、スキー板の滑走速度や滑走方向、および自身の姿勢を制御できねばならない。しかしながら、確かに従来のスキーロボットには、関節を制御してスキー動作を行わせるロボットは存在したものの、自身の滑走状態を把握しながら、自らが動作の制御を行えるものではなかった。   When a skier actually slides down in a natural environment, the physical conditions of the snow surface that is the sliding surface, that is, the slope angle and unevenness of the sliding slope, as well as powder snow, rough snow, ice burn, fresh snow, deep snow, etc. The snow cover condition of is constantly changing. For this reason, the skier responds to these continuously changing downhill conditions by changing his / her own running speed, running direction, running posture, and the like by skiing. Therefore, when trying to resemble the skiing operation of this skier, the ski robot responds to changes in physical conditions such as the slope angle and unevenness, the friction coefficient between the slope and the ski in a timely manner, and its speed and motion. It must be able to change the state and control the skiing speed and direction and the attitude of the ski. However, although there is certainly a robot that controls the joints to perform the skiing operation in the conventional skiing robot, the robot itself cannot control the operation while grasping its own sliding state.

たとえば、特許文献1に記載のスキーロボットは、各種の関節動作でターンが可能であること、およびその中でも大腿部の回旋動作が効果的な動作であることなどを示している。しかし、ロボット操作は、マニュアルによる操作と実演に限られており、ロボットが自己判断により自身でスキー操作を行っている技術ではない。   For example, the ski robot described in Patent Document 1 shows that it is possible to turn with various joint motions, and that the rotation motion of the thigh is an effective motion among them. However, the robot operation is limited to manual operation and demonstration, and is not a technique in which the robot performs its own ski operation based on self-judgment.

また従来、例えば非特許文献1、または非特許文献2に開示されたロボットのように、予め決められた動作プログラムに従って関節を動作させてスキーターンを行わせるスキーロボットもあった。これらの内で前者の非特許文献1に紹介されたスキーロボットは、一定の斜度をもち表面に雪を敷いた滑走台の上でスキーターンを行っており、またそのターン駆動制御は、所定のターン軌跡を追従するよう予め股関節の角度の変化動作を組込んでおいた動作プログラムにより股関節の内外転のみを駆動して行っているものである。次いで後者の非特許文献2のスキーロボットは、胴体部の左右股関節に内外転軸と、左右股関節に支承された脚部の大腿部に回旋軸とを設けた構成であり、やはりプログラム動作によりこれら脚部の内外転運動と、大腿部の回旋運動とを行わせてスキーターンを実現させている。このようにこれらのスキーロボットは、前もって入力設定されたプログラム動作により所定の関節を制御して定められたスキー動作を行うものであり、滑降時に自己判断により自身で滑走を制御していない。   Conventionally, there has been a ski robot that performs a ski turn by operating a joint according to a predetermined operation program, such as the robot disclosed in Non-Patent Document 1 or Non-Patent Document 2, for example. Among these, the ski robot introduced in the former Non-Patent Document 1 performs a ski turn on a slide having a certain inclination and snow on the surface, and the turn drive control is predetermined. In this case, only the hip joint inversion / extraction is driven by an operation program in which a change operation of the angle of the hip joint is incorporated in advance so as to follow the turn trajectory. Next, the latter ski robot of Non-Patent Document 2 has a configuration in which an inward and outward rotation shaft is provided at the left and right hip joints of the trunk and a rotation shaft is provided at the thigh of the leg portion supported by the left and right hip joints. The ski turn is realized by performing the inward and outward rotation motions of the legs and the rotational motion of the thighs. As described above, these ski robots perform a predetermined ski operation by controlling a predetermined joint by a program operation input and set in advance, and do not control the skiing by self-judgement at the time of downhill.

以上述べた理由から、従来のスキーロボットでは、滑降斜面の物理的条件変化の激しい状況の中で、常に安定して滑走することは極めて難しい。即ち、従来のロボット制御方法では、斜面の角度が変化したり、斜面とスキー板との摩擦係数が変化したりすると、その都度、即座に、ターンのプログラムを予め探索しておいた転倒しないための条件(変化後に適応する条件)でのプログラムに変更する必要がある。しかし、この条件設定は至難であるばかりかその変更にも即応性がない。よって、この従来のスキーロボットでは、コースを定めないフリー滑走は勿論、ターン切換え位置を指定したターン軌道の滑走もこれを安定して行うことができない。また例えば、予め立てられたポールの間をターンするコースなど所定のターン経路を設定しその通過速度を競うスキー競技などでは、そのスキー動作をロボットの実演解析によりスキルアップするのが有効であると考えられるが、この高速かつ複雑なスキーターン動作を従来型のロボットで実現させることは不可能であると言える。   For the reasons described above, it is extremely difficult for a conventional ski robot to always stably skate in a situation where physical conditions of downhill slopes change drastically. That is, in the conventional robot control method, if the angle of the slope changes or the friction coefficient between the slope and the ski changes, the turn program that has been searched for in advance is not immediately overturned. It is necessary to change to a program under the above conditions (conditions that adapt after change). However, this condition setting is not only difficult, but the change is not responsive. Therefore, in this conventional ski robot, it is not possible to stably perform the sliding of the turn trajectory in which the turn switching position is specified as well as the free sliding without defining the course. In addition, for example, in a skiing competition where a predetermined turn path is set such as a course that turns between poles set in advance and competes for the passing speed, it is effective to improve the skill of the skiing operation by analyzing the demonstration of the robot. It can be considered that it is impossible to realize this high-speed and complicated ski turn operation with a conventional robot.

本発明は前述の問題点に着目してなされたもので、滑走面の条件変化に対応して自身で動作を制御し、所定のターン経路に沿って安定して滑走できるスキーロボットを提供することを目的とする。   The present invention has been made paying attention to the above-mentioned problems, and provides a ski robot that can control its operation in response to a change in the condition of the sliding surface and can stably slide along a predetermined turn path. With the goal.

上記目的を達成するために、第1発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記股関節に上記脚部を内外転させる股関節内外転軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記計測装置からの検出量に基いて、上記コントローラが上記股関節内外転軸を制御可能なことを特徴とする。
上記「計測装置」とは、滑走中のスキーロボットの方位と速度を測定できる様々な装置をいい、方位センサや速度センサのみならず、3軸加速度計を含むものとする。また、後述するロボットを外部からビデオカメラにより撮影した画像から検出し無線によってロボットにフィードバックする実施形態の場合、このフィードバックするための装置が計測装置に該当する。
In order to achieve the above object, the first invention has a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part. In order to slide on a snow surface or a similar low friction slope, a ski robot having a ski board on the ground contact surface of the leg,
A hip joint inversion shaft for turning the leg portion inward and outward at the hip joint is provided,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A controller is provided in the body part, and the controller can control the hip joint inversion / extraction shaft based on a detection amount from the measuring device.
The “measuring device” refers to various devices that can measure the direction and speed of a skiing robot, and includes not only an orientation sensor and a speed sensor but also a three-axis accelerometer. In an embodiment in which a robot described later is detected from an image captured by a video camera from the outside and fed back to the robot wirelessly, this feedback device corresponds to the measurement device.

また、スキーロボットの用途に応じて、第2発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には股関節を屈曲させる股関節屈曲軸を、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記計測装置からの検出量に基いて、上記コントローラが上記股関節屈曲軸と上記膝関節屈曲軸を制御可能なことを特徴とする。
Further, according to the application of the ski robot, the second invention includes a torso part and two left and right leg parts that support the load of the torso part via left and right hip joints provided below the torso part. In a ski robot with a ski board attached to the ground contact surface of the leg to slide on a snow surface or similar low friction slope,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint bending axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A controller is provided in the body part, and the controller can control the hip flexion axis and the knee flexion axis based on a detection amount from the measuring device.

更に、第3発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には上記脚部を内外転させる股関節内外転軸と上記股関節を屈曲させる股関節屈曲軸を設け、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記測定装置からの検出量に基いて、上記コントローラが任意の上記股関節内外転軸、上記股関節屈曲軸、上記膝関節屈曲軸を制御可能なことを特徴とする。
Furthermore, the third invention has a body part and two left and right leg parts for supporting the load of the body part via the left and right hip joints provided below the body part, and the snow surface or the like To ski on a low friction slope, in the ski robot each equipped with a ski on the ground contact surface of the leg,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint abduction shaft for turning the leg inward and outward, and a hip joint bend axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A controller is provided in the body part, and the controller can control any of the hip joint inversion / extraction shaft, the hip joint flexion axis, and the knee joint flexion axis based on a detection amount from the measurement device.

また、第4発明は、上記したスキーロボットにおいて、前記脚部と前記スキー板の接続部に荷重センサを設け、
上記荷重センサからの検出量に基いて、前記コントローラが任意の前記股関節内外転軸、前記股関節屈曲軸、前記膝関節屈曲軸を制御可能なことを特徴とする。これにより、スキーヤーの動作に近いスキー操作が可能となる。
Further, the fourth invention is the above-described ski robot, wherein a load sensor is provided at a connection portion between the leg portion and the ski.
The controller can control any of the hip joint inversion / extraction shaft, the hip joint flexion axis, and the knee joint flexion axis based on a detection amount from the load sensor. Thereby, a ski operation close to the operation of the skier is possible.

第5発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記股関節に上記脚部を内外転させる股関節内外転軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラが上記股関節内外転軸を制御可能なことを特徴とする。
5th invention has a trunk | drum and two right-and-left leg parts which support the load of the said trunk | drum via the left and right hip joint provided under this trunk | drum, and it is a snow surface or the same low friction In ski robots, each of which is equipped with a ski on the ground contact surface of the leg to slide down the slope,
A hip joint inversion shaft for turning the leg portion inward and outward at the hip joint is provided,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
The controller is capable of controlling the hip joint inversion / extraction shaft based on a detection amount from the load sensor.

第6発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には股関節を屈曲させる股関節屈曲軸を、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラにより上記股関節屈曲軸と上記膝関節屈曲軸を制御可能なことを特徴とする。
6th invention has a trunk | drum and two right and left leg parts which support the load of the said trunk | drum via the left and right hip joint provided under this trunk | drum, and it is a snow surface or the same low friction In ski robots, each of which is equipped with a ski on the ground contact surface of the leg to slide down the slope,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint bending axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
The hip flexion axis and the knee flexion axis can be controlled by the controller based on a detection amount from the load sensor.

第7発明は、胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には上記脚部を内外転させる股関節内外転軸と上記股関節を屈曲させる股関節屈曲軸を設け、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラにより任意の上記股関節内外転軸、上記股関節屈曲軸、上記膝関節屈曲軸を制御可能なことを特徴とする。
7th invention has a trunk | drum and two right and left leg parts which support the load of the said trunk | drum via the left and right hip joints provided under the trunk | drum, and it is a snow surface or the same low friction In ski robots, each of which is equipped with a ski on the ground contact surface of the leg to slide down the slope,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint abduction shaft for turning the leg inward and outward, and a hip joint bend axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
Based on the detection amount from the load sensor, the controller can control any of the hip joint inversion / extraction axis, the hip flexion axis, and the knee flexion axis.

第8発明は、上記したスキーロボットにおいて、
前記脚部に脚部の下肢部を旋回させる大腿部回転軸を設け、
前記コントローラは、前記計測装置、および/または、前記荷重センサからの検出量に基いて、前記大腿部回転軸を制御可能なことを特徴とする。
The eighth invention is the above-described ski robot,
A thigh rotation axis for turning the lower limb of the leg is provided in the leg,
The controller can control the thigh rotation axis based on a detection amount from the measurement device and / or the load sensor.

また、第9発明は、上記したスキーロボットにおいて、前記計測装置は少なくとも速度センサと方位センサを備えることを特徴とする。これにより、簡易・安価に本発明を実施することが可能となる。   According to a ninth aspect of the present invention, in the above-described ski robot, the measurement device includes at least a speed sensor and an orientation sensor. Thereby, it becomes possible to implement this invention simply and cheaply.

第10発明は、上記した構成になるスキーロボットを制御する方法において、前記方位センサで斜面上の滑走方向を検出すると共に前記速度センサで前記スキー板の滑走速度を検出し、これらの検出量とターン半径からスキーロボットに作用する遠心力を求め、該遠心力と前記荷重センサから求めた重力との合力からスキーの回転に必要なスキー板の角付け角およびスキーロボットの姿勢を制御する方法としている。   According to a tenth aspect of the present invention, in the method for controlling a ski robot having the above-described configuration, the direction sensor detects a sliding direction on a slope, and the speed sensor detects a skiing speed of the ski. As a method of obtaining the centrifugal force acting on the ski robot from the turn radius, and controlling the angle of the ski plate and the attitude of the ski robot necessary for ski rotation from the resultant force of the centrifugal force and the gravity obtained from the load sensor Yes.

また第11発明は、上記した構成になるスキーロボットを制御する方法において、前記スキーロボットの滑走中の現在位置を求めると共に該現在位置と予め設定した所定のターン位置との間の距離を求め、該距離に対応してスキー板のエッジ角度を増減させてそのエッジを反転することによりターン切換えを行う制御方法としている。   The eleventh aspect of the invention is a method for controlling a ski robot having the above-described configuration, wherein the current position of the ski robot during sliding is obtained and the distance between the current position and a predetermined turn position set in advance is obtained. In accordance with the distance, a control method for switching the turn is performed by increasing / decreasing the edge angle of the ski and reversing the edge.

第12発明は、上記した構成になるスキーロボットを制御する方法において、前記スキーロボットの前記脚部下端の足部に設けた前記荷重センサから求めたそれぞれの検出量を用いることにより前記スキーロボットの各関節を動作させて、左右の上記足部がそれぞれ所定の荷重になるように左右方向へ重心移動を行って左右荷重のバランス制御を行う、または上記足部の前後がそれぞれ所定の荷重になるように前後方向へ重心移動を行って前後荷重のバランス制御を行う制御方法としている。   According to a twelfth aspect of the present invention, in the method for controlling a ski robot having the above-described configuration, the detection amount of the ski robot is determined by using the respective detection amounts obtained from the load sensors provided on the foot portions at the lower ends of the leg portions of the ski robot. Operate each joint and move the center of gravity in the left and right direction so that the left and right foot parts have a predetermined load, respectively, to control the balance of the left and right loads, or the front and rear of the foot parts have a predetermined load, respectively. Thus, the control method is such that balance control of the longitudinal load is performed by moving the center of gravity in the longitudinal direction.

第13発明は、上記した構成になるスキーロボットを制御する方法において、前記コントローラは、滑走中の前記スキーロボットの速度を求め、この速度が所定の値より大きい/小さいときには、各関節を動作させて、減速制御/増速制御を行うことを特徴とするスキーロボットの速度制御方法としている。   A thirteenth aspect of the invention is a method for controlling a ski robot configured as described above, wherein the controller obtains the speed of the ski robot during sliding and operates each joint when the speed is larger / smaller than a predetermined value. Thus, the speed control method of the ski robot is characterized by performing deceleration control / acceleration control.

第1発明から第9発明により、スキーロボットは備えた計測装置(方位センサ、速度センサ)並びに荷重センサにより、滑走状態に関する様々な情報を得て、その情報に基いて適宜スキー操作を行える。これにより、用途や目的に応じた様々な滑走が実現可能となる。   According to the first to ninth aspects of the invention, the ski robot can obtain various information related to the sliding state by the measuring device (direction sensor, speed sensor) and load sensor provided, and can appropriately perform the ski operation based on the information. Thereby, various sliding according to a use and a purpose is realizable.

第1発明から第4発明によるとスキーロボットは、ロボット自身に搭載した速度センサ、方位センサによりロボット滑走時の各時点における滑走速度と滑走方向(斜面の最大傾斜ラインとのなす角度)を求めることができる。そして、自身のコントローラによりこの滑走速度と滑走方向のデータの積分からロボットの現在位置を求めることができる。更に、第4発明のスキーロボットは、コントローラにより(以降省略する)これらの検出量と荷重センサおよびロボットの各関節角度(ロボットの姿勢)とから所定位置における滑走中の荷重バランスの状態を知ることができ、次にロボットが取るべき転倒防止のための姿勢制御を行うことができる。これよりスキーロボットは、その滑走速度や滑走方向が斜面の角度や凹凸、斜面とスキー板との摩擦係数などの物理的条件やロボットの動作速度や動作状態によって変化しても、その時点で起こすべき次の動作を決めこれを自身でタイムリーに実行することができる。さらにロボットは、所定のターン軌道上での現在位置を求めると共にこれを認識してその都度次にとるべき姿勢ダイヤグラム(所定のターン軌跡を滑走するための関節角動作のダイヤグラム)を決定し、これに従った各関節の動作の制御を即座に実行することにより所定のターン軌道上を安定して滑走することができる。   According to the first to fourth inventions, the ski robot obtains a sliding speed and a sliding direction (an angle formed by the maximum slope line of the slope) at each time point when the robot slides by using a speed sensor and a direction sensor mounted on the robot itself. Can do. Then, the current position of the robot can be obtained from the integration of the data of the sliding speed and the sliding direction by its own controller. Furthermore, the ski robot according to the fourth aspect of the invention knows the state of load balance during sliding at a predetermined position from the detected amount, the load sensor, and each joint angle (robot posture) of the robot by the controller (hereinafter omitted). Next, posture control for preventing the robot from falling over can be performed. As a result, even if the skiing speed and direction of the ski robot change depending on the physical conditions such as the angle and unevenness of the slope, the coefficient of friction between the slope and the ski, and the operating speed and operating state of the robot, they will occur at that time. You can determine the next action to be performed and perform this in a timely manner. Furthermore, the robot obtains the current position on the predetermined turn trajectory and recognizes it to determine the posture diagram (joint angle motion diagram for sliding on the predetermined turn trajectory) to be taken each time. By immediately controlling the movement of each joint according to the above, it is possible to stably slide on a predetermined turn trajectory.

第9発明によると、簡易・安価に本発明を実施することが可能となる。また、装置の小型化・軽量化により、スキーロボットの操作性が向上する。   According to the ninth invention, the present invention can be implemented easily and inexpensively. In addition, the operability of the ski robot is improved by reducing the size and weight of the device.

また第10発明によると、スキー板に設けた方位センサおよび速度センサからの検出量を演算してスキーロボットの重心位置での滑走方向および滑走速度を検出し、これらの検出量とターン半径からスキーロボットの重心に作用する遠心力を求める。そして、該遠心力と前記荷重センサから求めた重力との合力からスキーの回転に必要なスキー板の角付け角およびスキーロボットの姿勢を制御することができる。即ち、スキーロボットの重心からの作用力の方向が2本のスキー板の間を通るように股関節の内外転軸角度を操作して、スキー板のエッジ角度を合わせることで転倒しない姿勢を保つことができる。このように本発明のスキーロボットは、スキーヤーがターン時に内傾姿勢をとってエッジを立てこの時生じる遠心力に対抗するスキー操作に似せた動作が行えるので、倒れることなく安定してターンができる。   According to the tenth invention, the detection amount from the azimuth sensor and speed sensor provided on the ski is calculated to detect the sliding direction and the sliding speed at the center of gravity of the ski robot. Find the centrifugal force acting on the center of gravity of the robot. The angle of the ski plate and the attitude of the ski robot necessary for the rotation of the ski can be controlled from the resultant force of the centrifugal force and the gravity obtained from the load sensor. That is, it is possible to maintain a posture that does not fall by adjusting the edge angle of the ski by adjusting the angle of the hip joint so that the direction of the acting force from the center of gravity of the ski robot passes between the two skis. . As described above, the ski robot according to the present invention can perform an operation similar to a ski operation in which the skier takes an inclining posture at the time of turning to make an edge and counters the centrifugal force generated at this time, so that the skier can stably turn without falling down. .

第11発明によると、スキーロボットは、所定ターンの動作中にスキー板上の速度センサと方位センサとの検出量から滑走速度と滑走方向とをそれぞれ求め、また滑走速度と滑走方向との検出量の積分から滑走現在位置を計算で求める。そして、この現在位置と予め設定したターン位置(エッジ反転位置)との間の距離を求め、この距離に対応してスキー板のエッジ角度を増減させてそのエッジを反転することによりロボット自身でターン切換えを行うことができる。また、複数のターンを組み合わせた所定のターン軌道を滑走する場合も、ロボット自身が滑走状態を把握しながら次にとるべき姿勢ダイヤグラム(関節角動作のダイヤグラム)を作成することができ、このダイヤグラムに従って関節を操作することで複数のターンよりなる所定のターン経路に沿ってスキー操作ができる。例えばロボットは、所定のターン経路(予め立てられたポールの間をターンするコースなど)を滑走するように動作の制御が行える。   According to the eleventh aspect, the ski robot obtains the sliding speed and the sliding direction from the detection amounts of the speed sensor and the direction sensor on the ski during the predetermined turn, and the detection amount of the sliding speed and the sliding direction. The current gliding position is calculated from the integration of. Then, a distance between the current position and a preset turn position (edge reversal position) is obtained, and the robot turns itself by reversing the edge by increasing / decreasing the edge angle of the ski according to this distance. Switching can be performed. Also, when sliding along a predetermined turn trajectory that combines multiple turns, the robot itself can create a posture diagram (joint angle motion diagram) to be taken while grasping the sliding state, and according to this diagram By operating the joint, ski operation can be performed along a predetermined turn path composed of a plurality of turns. For example, the robot can control the operation so as to slide along a predetermined turn path (such as a course that turns between predetermined poles).

第12発明によると、スキーロボットは、脚部下端の左右足部に荷重センサをそれぞれ設けているので、これらの検出量を用いることにより股関節の内外転軸を動作させ、左右の該足部がそれぞれ所定の荷重になるよう前記スキーロボットの左右方向へ重心移動を行って左右荷重のバランス制御を行うことができる。この左右荷重のバランス制御によりスキーロボットは、例えば両足荷重を均等にする制御を行うことにより、新雪、深雪など両足の均等荷重を必要とするターンを行える。また左右の荷重比を一定にする制御を用いて、外足に多くの荷重をかけてターンすることにより、切れのいい(エッジがずれない)高速ターンが可能となる。   According to the twelfth aspect of the invention, since the ski robot is provided with load sensors on the left and right foot portions at the lower end of the leg portion, by using these detected amounts, the inner and outer shafts of the hip joint are operated and the left and right foot portions are moved. The balance control of the left and right loads can be performed by moving the center of gravity in the left and right direction of the ski robot so as to obtain predetermined loads. By controlling the balance between the left and right loads, the ski robot can perform a turn that requires an equal load on both feet, such as fresh snow and deep snow, by performing a control that equalizes the loads on both feet, for example. In addition, by using a control to make the right / left load ratio constant, the outer leg is turned with a large amount of load, thereby enabling a high-speed turn with good cutting (no edge shift).

一方、第4発明から第8発明などは、足部の前後にそれぞれ荷重センサを設けているので、これらの検出量を用いて足部の前後がそれぞれ所定の荷重になるよう股関節または膝関節の屈曲軸を動作させると共に前後方向へ重心移動を行って、前傾姿勢または後傾姿勢をとり前後荷重のバランス制御を行うこともできる。例えば、滑走中に滑走面の摩擦係数など抵抗が変化して急に減速(加速)した場合には、後傾姿勢(前傾姿勢)を即座にとって前後のバランスを取ることができる。また、滑走面の凹凸変化または傾斜変化が生じた場合においても、前後方向への重心移動を対応させて前後方向の姿勢制御ができる。またこの制御を応用して、ターンの前半で前荷重を後荷重より大きくすれば、スキー板の前部が押さえられるのでターンの始動(エッジの切込み)が容易になり、またターンの後半で後荷重を前荷重より大きくすれば、スキー板の前部が浮いて食い込んでいたエッジが外れ次のターンの切換え(エッジ切換え)が容易になる効果が得られる。   On the other hand, in the fourth to eighth inventions and the like, load sensors are provided on the front and rear of the foot, respectively, so that these detection amounts are used to adjust the hip or knee joint so that the front and rear of the foot have a predetermined load. It is also possible to operate the bending shaft and move the center of gravity in the front-rear direction to take a forward tilt posture or a rearward tilt posture and perform balance control of the front-rear load. For example, when the resistance such as the friction coefficient of the sliding surface changes during the sliding and the vehicle suddenly decelerates (accelerates), the backward leaning posture (forward leaning posture) can be immediately balanced. In addition, even when the unevenness or inclination change of the sliding surface occurs, the posture control in the front-rear direction can be performed by corresponding the movement of the center of gravity in the front-rear direction. If this control is applied to make the front load larger than the rear load in the first half of the turn, the front part of the ski can be held down, making it easier to start the turn (cutting the edge). If the load is made larger than the previous load, the effect of facilitating switching of the next turn (edge switching) by removing the edge that the front part of the ski floats and bites.

以下本発明に係るスキーロボットの実施形態について図面を参照して説明する。
まず、本発明のスキーロボットの構成を図1、2を用いて説明する。ここに、図1は本発明に係るスキーロボットおよびセンサを示す図であり、図1(a)はその正面図を、図1(b)はその側面図を示している。また、図2は本発明に係るスキーロボットの関節およびセンサの構成を示す簡略図である。図1、2に示すように、スキーロボット1は、胴体部4と、左右2本の脚部2と、この脚部2の下部にそれぞれ設けられた2本のスキー板3と、荷重センサ31、方位センサ32および速度センサ33などの各センサとで構成されている。
Embodiments of a ski robot according to the present invention will be described below with reference to the drawings.
First, the configuration of the ski robot of the present invention will be described with reference to FIGS. FIG. 1 is a view showing a ski robot and a sensor according to the present invention. FIG. 1 (a) shows a front view thereof, and FIG. 1 (b) shows a side view thereof. FIG. 2 is a simplified diagram showing the configuration of the joints and sensors of the ski robot according to the present invention. As shown in FIGS. 1 and 2, the ski robot 1 includes a body part 4, two right and left leg parts 2, two skis 3 provided respectively below the leg parts 2, and a load sensor 31. , And each sensor such as a direction sensor 32 and a speed sensor 33.

(胴体部4)
胴体部4は、人体の上半身の重量配分を模した概略直方体の形状を成して配設され、その下部の左右には股関節20(20L,20R:左側をL、右側をRで示す。以下同様)がそれぞれ設けられている。またこの胴体部4には、前記各センサ(31、32、33、)からの信号を受けて演算した指令値を各関節軸に設けられたサーボモータ(詳細図示せず)に出力して関節軸を駆動制御するコントローラ5が内装されている。
(Body part 4)
The torso part 4 is arranged in a substantially rectangular parallelepiped shape simulating the weight distribution of the upper body of the human body, and the hip joints 20 (20L, 20R: L on the left side and L on the right side are shown on the right and left sides below. The same). Further, the body part 4 outputs a command value calculated by receiving a signal from each of the sensors (31, 32, 33,) to a servo motor (not shown in detail) provided on each joint shaft. A controller 5 for driving and controlling the shaft is provided.

(コントローラ5)
コントローラ5は、前記演算を行うために、各センサ30からの信号を受け取る受信部と、前記信号を用いて演算を行う処理部と、データとプログラムを記憶する記憶部と、サーボモータへの指令値をサーボモータに送る送信部とからなる。処理部としてCPUを用い、記憶部としてRAMを用いる。これらは既知の装置を用いて実現可能である。センサ30とは、後述する荷重センサ31、方位センサ32、速度センサ33など、スキーロボットに用いられる各種センサを含む用語である。その装置としては、汎用されているセンサを用いれば足りる。なお、この発明を実施するにあたり、荷重センサ31、方位センサ32、速度センサ33のすべてを用いる必要は必ずしもなく、実施の目的に応じて、一つもしくは複数のセンサを組み合わせて実施してもよい。また、その他のセンサを追加して用いることも可能である。
(Controller 5)
In order to perform the calculation, the controller 5 includes a receiving unit that receives a signal from each sensor 30, a processing unit that performs calculation using the signal, a storage unit that stores data and a program, and a command to the servo motor. It consists of a transmitter that sends values to the servo motor. A CPU is used as the processing unit, and a RAM is used as the storage unit. These can be realized using known devices. The sensor 30 is a term including various sensors used for a ski robot, such as a load sensor 31, an orientation sensor 32, and a speed sensor 33 described later. As the device, it is sufficient to use a widely used sensor. Note that in implementing this invention, it is not always necessary to use all of the load sensor 31, the direction sensor 32, and the speed sensor 33, and one or a plurality of sensors may be combined in accordance with the purpose of implementation. . It is also possible to add other sensors.

(脚部2)
脚部2(2L,2R)は、前記股関節20(20L,20R)を介してその下方に連結されたそれぞれの大腿部13(13L,13R)と、その大腿部13(13L,13R)の下端で膝関節10(10L,10R)を介して連結された下肢部14(14L,14R)と、この下肢部14とスキー板3の間に設けられた足部15(15L,15R)とで構成されている。
(Leg 2)
The leg 2 (2L, 2R) includes a respective thigh 13 (13L, 13R) and a thigh 13 (13L, 13R) connected to the lower part thereof via the hip joint 20 (20L, 20R). A lower limb portion 14 (14L, 14R) connected via a knee joint 10 (10L, 10R) at the lower end of the leg, and a foot portion 15 (15L, 15R) provided between the lower limb portion 14 and the ski 3 It consists of

(スキー板3)
スキー板3(3L,3R)は、その長手方向を胴体部4に対し前後方向(進行方向)に向けて下肢部14(14L,14R)の下端に足部15(15L,15R)を介して装着されている。ここで下肢部14(14L,14R)は、スキー板3上面の垂直線に対し前後方向に所定の前傾角度(望ましくは10°±5°程度)をもって足部15(15L,15R)に装着されている。またスキー板3の幅方向の両側面には、所定のターン半径が得られるような円弧でカットされたサイドカーブを有している。これは昨今のカービングスキー板を模したものであるが、大回りターンまたは小回りターンなどの用途目的に合わせてさまざまなサイドカーブを持たせても良いのは勿論である。
(Ski 3)
The ski 3 (3L, 3R) is directed to the lower end of the lower limbs 14 (14L, 14R) via the foot 15 (15L, 15R) with its longitudinal direction directed in the front-rear direction (traveling direction) with respect to the body 4. It is installed. Here, the lower limb part 14 (14L, 14R) is attached to the foot part 15 (15L, 15R) with a predetermined forward tilt angle (desirably about 10 ° ± 5 °) with respect to the vertical line on the upper surface of the ski 3 in the front-rear direction. Has been. Further, both side surfaces of the ski 3 in the width direction have side curves cut by arcs so that a predetermined turn radius can be obtained. This is a simulation of a recent carving ski, but it goes without saying that various side curves may be provided depending on the purpose of use such as a large turn or a small turn.

(荷重センサ31)
荷重センサ31(31L、31R)は、下肢部14(14L,14R)と足部15(15L,15R)との間に設けられた左右の足首部荷重センサ31A(31AL、31AR)と、足部15(15L,15R)の前後でスキー板3(3L,3R)との間にそれぞれ足裏前部荷重センサ31B(31BL、31BR)と、足裏後部荷重センサ31C(31CL、31CR)とが設けられている。このように左右各3個の荷重センサ31を設けたことにより、左右の足首部荷重センサ31A(31AL、31AR)の検出量から左右の荷重配分、即ち内足外足の荷重配分が検出でき、また足裏前部荷重センサ31B(31BL、31BR)と足裏後部荷重センサ31C(31CL、31CR)の各検出量から胴体部4の前傾姿勢、後傾姿勢が判別できる。
(Load sensor 31)
The load sensor 31 (31L, 31R) includes left and right ankle load sensors 31A (31AL, 31AR) provided between the lower limb part 14 (14L, 14R) and the foot part 15 (15L, 15R), and the foot part. A front foot load sensor 31B (31BL, 31BR) and a rear foot load sensor 31C (31CL, 31CR) are provided between the front and rear skis 15 (15L, 15R) and the ski 3 (3L, 3R). It has been. By providing the left and right three load sensors 31 in this way, the left and right ankle load sensors 31A (31AL, 31AR) can detect the left and right load distribution, that is, the load distribution of the inner foot and outer foot, Further, the forward tilt posture and the backward tilt posture of the body portion 4 can be determined from the detected amounts of the sole front load sensor 31B (31BL, 31BR) and the sole rear load sensor 31C (31CL, 31CR).

(方位センサ32)
方位センサ32(32L、32R)は、スキー板3(3L,3R)の前方上面に載置されている。この方位センサ32により(下肢部の回旋角度が零の場合の)スキーロボット1の進行方向を認識できる。
(Direction sensor 32)
The direction sensor 32 (32L, 32R) is placed on the front upper surface of the ski 3 (3L, 3R). This direction sensor 32 can recognize the traveling direction of the ski robot 1 (when the rotation angle of the lower limb is zero).

(速度センサ33)
速度センサ33(33L、33R)は、図3に示すように、前記スキー板3(3L,3R)の速度をその検出部であるローラ33Aの回転量で読み取るため、該ローラ33Aを回転自在、かつ、ローラ取付軸35を中心に揺動自在にすると共に前記スキー板3の後端部に突出させて滑走面に接地するよう設けられている。ここでスキーロボット1はその滑走各地点において、方位センサ32の検出量より滑走方向(斜面の最大傾斜ラインとのなす角度)を、速度センサ33の検出量より滑走速度を、また速度センサ33と方位センサ32との検出量の積分値より滑走位置をそれぞれ求めることができる。具体的には、滑走各地点において、方位センサ32からの信号が電圧値の変化としてコントローラ5に送られる。速度センサ33からの信号は、単位時間当たりの回転数が電圧値の変化としてコントローラ5に送られる。このように、各センサから送られる信号が検出量である。
(Speed sensor 33)
As shown in FIG. 3, the speed sensor 33 (33L, 33R) reads the speed of the ski 3 (3L, 3R) with the amount of rotation of the roller 33A, which is a detection unit thereof. Further, it is provided so as to be swingable about the roller mounting shaft 35 and to protrude from the rear end portion of the ski 3 so as to be in contact with the running surface. Here, the ski robot 1 has a sliding direction (angle formed by the maximum inclination line of the slope) based on the detection amount of the azimuth sensor 32, the sliding speed based on the detection amount of the speed sensor 33, and the speed sensor 33. The sliding position can be obtained from the integral value of the detection amount with the direction sensor 32. Specifically, at each point of sliding, a signal from the direction sensor 32 is sent to the controller 5 as a change in voltage value. A signal from the speed sensor 33 is sent to the controller 5 as a change in the voltage value of the number of revolutions per unit time. Thus, the signal sent from each sensor is the detection amount.

(股関節20)
股関節20(20L,20R)は、股関節内外転軸21(21L,21R)とその下方に設けられた股関節屈曲軸22(22L,22R)とで構成されている。そして、前者の股関節内外転軸21(21L,21R)は、前記胴体部4に対し前後方向(スキー進行方向)の中心軸を有しこの軸を中心として前記脚部2(2L,2R)を前記胴体部4の左右方向(スキー進行方向に対して直角方向)に内外転させるために股関節20(20L,20R)に設けられている。また後者の股関節屈曲軸22(22L,22R)は、前記股関節内外転軸21(21L,21R)と軸直角に連結された中心軸を有しこの軸を中心として前記脚部2(2L,2R)を前後方向面内で屈曲させるために股関節20(20L,20R)に設けられている。
(Hip 20)
The hip joint 20 (20L, 20R) is composed of a hip joint inversion / inversion shaft 21 (21L, 21R) and a hip joint bending shaft 22 (22L, 22R) provided therebelow. The former hip joint internal and external rotation shaft 21 (21L, 21R) has a central axis in the front-rear direction (ski travel direction) with respect to the body portion 4, and the leg portion 2 (2L, 2R) is centered on this axis. A hip joint 20 (20L, 20R) is provided to inward and outwardly rotate the body portion 4 in the left-right direction (the direction perpendicular to the ski traveling direction). Further, the latter hip joint bending shaft 22 (22L, 22R) has a central axis connected at right angles to the hip joint internal / external rotation shaft 21 (21L, 21R), and the leg portion 2 (2L, 2R) around this axis. ) At the hip joint 20 (20L, 20R).

(膝関節10)
膝関節10(10L,10R)は、大腿部回旋軸11(11L,11R)とその下方に設けられた膝関節屈曲軸12(12L,12R)とで構成されている。そして前者の大腿部回旋軸11(11L,11R)は、前記下肢部14を前記大腿部13の長軸(長手方向の中心軸)回りに旋回自在とするためこの長軸に沿って大腿部13内に設けられている。また後者の膝関節屈曲軸12(12L,12R)は、前記大腿部回旋軸11(11L,11R)とその下方で軸直角に連結されると共に前記下肢部14(14L,14R)を前後方向面内で屈曲させるため膝関節10(10L,10R)に設けられている。なおこれらの各軸はすべてサーボモータ(図示せず)で回動可能な構成となっている。
(Knee joint 10)
The knee joint 10 (10L, 10R) includes a thigh rotation axis 11 (11L, 11R) and a knee joint bending axis 12 (12L, 12R) provided therebelow. The former thigh rotation axis 11 (11L, 11R) is large along the long axis so that the lower limb part 14 can turn around the long axis (longitudinal central axis) of the thigh 13. It is provided in the thigh 13. The latter knee joint bending shaft 12 (12L, 12R) is connected to the thigh rotation shaft 11 (11L, 11R) at a right angle below the thigh rotation shaft 11 (11L, 11R) and the lower limb portion 14 (14L, 14R) in the front-back direction The knee joint 10 (10L, 10R) is provided to bend in the plane. Each of these shafts can be rotated by a servo motor (not shown).

本発明のスキーロボット1は、前述の構成により以下のような制御を行うことができる。これらの制御を図4〜図12を用いて下記に説明する。   The ski robot 1 of the present invention can perform the following control by the above-described configuration. These controls will be described below with reference to FIGS.

(滑走速度の計測例)
図4は、本発明に係る速度センサから得られたスキーロボット1の滑走速度の計測例を示す図である。図のように速度センサ33により刻々と変化しているスキー板、即ちスキーロボット1の滑走速度を検出できる。
(Measurement example of gliding speed)
FIG. 4 is a diagram showing a measurement example of the sliding speed of the ski robot 1 obtained from the speed sensor according to the present invention. As shown in the figure, the speed sensor 33 can detect the ski speed of the ski, that is, the ski robot 1.

(足荷重の計測例)
図5は、本発明に係るスキーロボットのターン中における左右足荷重の計測例を示す図である。図の荷重値は、スキーロボット1のターン中に左右それぞれのスキー板3にかかる荷重値を表していることになる。図によれば、左右のスキー板3にかかる荷重は時間経過と共にその大小が交互に入れ替っており、またその値はある値を境にして略線対称となっているのが見てとれる。この交番荷重の交差部分は右左ターンの切換え位置を示している。また、左(右)スキー板3の荷重値の極大時はその右(左)エッジ角が最大となる右(左)ターン時で、この際他方の右(左)スキー板3の荷重値はほぼ極小値を示していることから、外足側の左(右)スキー板3にほぼ全荷重がのり、片足荷重の状態に近くなっているのがわかる。
(Measurement example of foot load)
FIG. 5 is a diagram showing a measurement example of the left and right foot loads during the turn of the ski robot according to the present invention. The load values in the figure represent the load values applied to the left and right skis 3 during the turn of the ski robot 1. According to the figure, it can be seen that the load applied to the left and right skis 3 alternates with time as the time passes, and that the value is substantially line symmetric with respect to a certain value. The crossing portion of this alternating load indicates the right / left turn switching position. When the load value of the left (right) ski 3 is maximum, the load value of the other right (left) ski 3 is the right (left) turn at which the right (left) edge angle is maximum. Since the local minimum value is almost shown, it can be seen that almost all the load is applied to the left (right) ski 3 on the outer foot side, which is close to the state of the one foot load.

(関節角のダイヤグラム)
図6は、本発明に係るスキーロボットの関節角のダイヤグラム例を示す図である。このうち図6(a)は、股関節内外転軸21の内外転角と大腿部回旋軸11の回旋角とのダイヤグラム例を示している。この図では股関節内外転軸21の内外転角は左右(+−)に振れておりスキー板3のエッジ角を切換えて左右交互のターン切換えが行われているのがわかる。また大腿部回旋軸11の回旋角は、このエッジ角切換えに対し少し遅らせたタイミングで回旋させることにより、前記エッジ角切換えでの左右のターンに連動させてスキー板3に左右交互の回旋を与えているのがわかる。また図6(b)は、左右それぞれの脚部2の股関節屈曲軸22と膝関節屈曲軸12との屈曲角のダイヤグラム例を示している。図によれば、左右の脚部の屈曲角は時間経過と共にその大小が交互に入れ替っており、またその値はある値を境にして略線対称となっているのが見てとれる。この左右屈曲角曲線の交差部分は、左右の屈曲角が同じ(脚部2の脚長が同じ)であり脚部の左右方向の傾きがないことからスキー板3のエッジ角が零になった状態、即ち右左ターンの切換え位置を示している。また、左右いずれか一方の脚部2が最大の屈曲角となり脚長が最大に伸びた時(図中、MPとして表記)、他方の脚部2は最小の屈曲角となり脚長が最小に縮まっている。これは、脚部の左右方向傾きが最大となった状態、即ちスキー板3のエッジ角が最大になった状態を表している。
(Diagram of joint angle)
FIG. 6 is a diagram showing an example of a joint angle diagram of the ski robot according to the present invention. Among these, FIG. 6A shows an example diagram of the inner and outer rotation angles of the hip joint inner and outer rotation shaft 21 and the rotation angle of the thigh rotation shaft 11. In this figure, it can be seen that the inner and outer rotation angles of the hip joint inner and outer rotation shafts 21 are swung to the left and right (+-), and the edge angle of the ski 3 is switched and the left and right turns are switched alternately. Further, the rotation angle of the thigh rotation shaft 11 is rotated at a timing slightly delayed from the edge angle switching, whereby the ski board 3 is rotated alternately to the left and right in conjunction with the left and right turns at the edge angle switching. You can see that you are giving. FIG. 6B shows an example diagram of the bending angle between the hip joint bending shaft 22 and the knee joint bending shaft 12 of the left and right legs 2. According to the figure, it can be seen that the bending angles of the left and right leg portions alternate with each other over time, and that the values are substantially line symmetric with respect to a certain value. In the intersection of the left and right bending angle curves, the left and right bending angles are the same (the leg length of the leg portion 2 is the same), and the edge angle of the ski 3 is zero because the leg portion does not tilt in the left-right direction. That is, the switching position of the right / left turn is shown. Also, when either the left or right leg 2 has the maximum bending angle and the leg length has extended to the maximum (denoted as MP in the figure), the other leg 2 has the minimum bending angle and the leg length has been reduced to the minimum. . This represents a state in which the right and left inclination of the leg portion is maximized, that is, a state in which the edge angle of the ski 3 is maximized.

(ターン制御方法の種類)
スキーロボット1に行わせるターン制御方法を、図7〜図12を用いて説明する。これには、(1) ターン反転制御、(2) ターン半径の制御、(3) 姿勢(転倒防止)制御、(4) 荷重バランス制御、(5)速度制御などがある。これらの制御は、センサ30からの信号を胴体部4に内蔵したコントローラ5で演算処理すると共に所定の動作をさせるための出力を所定の関節のサーボモータに与えこれを駆動させることで行われる。以下これらの制御について個々に説明する。
(Types of turn control methods)
A turn control method performed by the ski robot 1 will be described with reference to FIGS. These include (1) turn reversal control, (2) turn radius control, (3) attitude (preventing overturning) control, (4) load balance control, and (5) speed control. These controls are performed by processing the signal from the sensor 30 by the controller 5 built in the body part 4 and supplying an output for performing a predetermined operation to a servo motor of a predetermined joint. Hereinafter, these controls will be described individually.

((1) ターン反転制御)
ターン反転制御(ターン切換え制御)について、ターンの反転方法を示す図7を用いて説明する。スキーロボット1は、滑走中に常に自身の現在位置を算出している。この現在位置は、ある元の位置において、方位センサ32による滑走方向データと速度センサ33による滑走速度データとから、該元の位置から微小時間後の位置変位を求め、これをスタート位置から累積して求めている。図においてターン反転制御は、滑走中の現在位置Toと予め設定した所定のターン反転位置(ターン反転点)Tとの間の距離Xに対応してスキー板のエッジ角度αを操作してターン反転を行う。即ちスキーロボット1は、現在の左(右)ターン滑走中に現在位置Toと予め設定した所定のターン反転位置Tとの距離Xを求める。そして、このターン反転点Tからの距離が所定の規定値より小さくなった時点でスキー板3の左(右)エッジの反転前のエッジ角α1を減少させ始め、このターン反転位置でエッジ角は零(α=0)となるようにする。そして、ターン反転位置Tを通過した後に、スキー板3の右(左)エッジの反転後のエッジ角α2(α2はα1に対し正負逆符号)に反転させ除々にこの反転後のエッジ角αを増大させて、右(左)ターンを始動させる。なお、ターン反転位置Tの前後におけるエッジ角αの増減量は、ターン反転位置Tからの距離Xに比例した量で制御している。本制御におけるエッジ角αの増減は、二つの実施形態で実現可能である。一つは、股関節20および膝関節10の屈曲動作による左右両脚2L、2Rの屈曲差を用いた脚部2の傾け動作であり、もう一つは、股関節20の内外転動作により行う。
((1) Turn reversal control)
Turn inversion control (turn switching control) will be described with reference to FIG. 7 showing a turn inversion method. The ski robot 1 always calculates its current position during the sliding. This current position is obtained at a certain original position from the sliding direction data by the azimuth sensor 32 and the sliding speed data by the speed sensor 33, and the position displacement after a minute time is obtained from the original position, and this is accumulated from the start position. Looking for. In the figure, the turn inversion control is performed by operating the ski edge angle α in accordance with the distance X between the current position To during sliding and a predetermined turn inversion position (turn inversion point) T set in advance. I do. That is, the ski robot 1 obtains the distance X between the current position To and a predetermined turn inversion position T set in advance during the current left (right) turn. When the distance from the turn reversal point T becomes smaller than a predetermined specified value, the edge angle α1 before reversal of the left (right) edge of the ski 3 starts to decrease, and the edge angle at this turn reversal position is It is set to zero (α = 0). Then, after passing through the turn reversal position T, the right (left) edge of the ski 3 is reversed to the inverted edge angle α2 (α2 is a sign opposite to α1), and the inverted edge angle α 2 gradually. Increase the and start the right (left) turn. The increase / decrease amount of the edge angle α before and after the turn reversal position T is controlled by an amount proportional to the distance X from the turn reversal position T. The increase / decrease of the edge angle α in this control can be realized in two embodiments. One is a tilting operation of the leg 2 using a bending difference between the left and right legs 2L and 2R by a bending operation of the hip joint 20 and the knee joint 10, and the other is performed by an inward and outward rotation operation of the hip joint 20.

「左右両脚の屈曲差」とは、右脚部2Rの屈曲の程度と左脚部2Lの屈曲の程度を不均一として、胴体部4から一方のスキー板3までの距離と、胴体部4から他方のスキー板3までの距離の差を意味する。左右両脚の屈曲差は、股関節屈曲部22と膝関節屈曲部12の屈曲の程度を適宜に設定することで実施可能である。その際、股関節と膝関節、左右の関節の屈曲の程度は、同じ比率にする必要はなく、各関節(22L、22R、12L、12R)のそれぞれを独立した値で制御してもよい。この脚部2の傾け動作を実施する場合、股関節屈曲部22と膝関節屈曲部12が必須の構成である。股関節内外転軸21は、必須ではないものの、実施に望ましい構成である。   “Bending difference between right and left legs” means that the degree of bending of the right leg 2R and the degree of bending of the left leg 2L are non-uniform, the distance from the body 4 to one ski 3 and the body 4 This means the difference in distance to the other ski 3. The bending difference between the left and right legs can be implemented by appropriately setting the degree of bending of the hip joint bending portion 22 and the knee joint bending portion 12. At this time, the degree of flexion of the hip joint, the knee joint, and the left and right joints does not have to be the same ratio, and each of the joints (22L, 22R, 12L, 12R) may be controlled with an independent value. When the tilting operation of the leg 2 is performed, the hip joint bending portion 22 and the knee joint bending portion 12 are essential components. The hip joint inversion / extraction shaft 21 is not essential, but is a desirable configuration for implementation.

「股関節20の内外転動作」とは、股関節20に設けた股関節内外転軸21を用い、この股関節内外転軸21を左右に適宜回旋させることで、エッジ角αの増減を行う。この動作を行う場合、股関節屈曲部22と膝関節屈曲部12を屈曲させなくともよいし、適宜屈曲させてもよい。「股関節20の内外転動作」の実施形態においては、股関節内外転軸21が必須の構成であり、股関節屈曲部22と膝関節屈曲部12は、実施に望ましい構成といえる。   The “inner and outer rotation operation of the hip joint 20” is to increase or decrease the edge angle α by using the hip joint inner and outer shaft 21 provided in the hip joint 20 and appropriately rotating the hip joint inner and outer shaft 21 from side to side. When performing this operation, the hip joint bending portion 22 and the knee joint bending portion 12 may not be bent, or may be bent appropriately. In the embodiment of “inner and outer rotation operation of the hip joint 20”, the hip joint inner and outer rotation shaft 21 is an essential configuration, and the hip joint bending portion 22 and the knee joint bending portion 12 can be said to be desirable configurations for implementation.

このターン反転制御を用いれば、スキーロボット1は自身で滑走状態を把握しながら予め指定した所定のターン軌道に沿ってターン切換えを行うことができる。また、複数のターンよりなるターン軌道を滑走する場合も、ロボット自身が滑走状態を把握しながら次にとるべき関節角動作のダイヤグラム(図6参照)を作成しこのダイヤグラムに従って関節を操作することでターン経路に沿ってスキー操作ができる。例えばロボットは、所定のターン経路(予め立てられたポールの間をターンするコースなど)を滑走するようにスキー動作の制御が行える。   If this turn reversal control is used, the ski robot 1 can perform turn switching along a predetermined turn trajectory specified in advance while grasping the sliding state by itself. Also, when sliding on a turn trajectory consisting of a plurality of turns, the robot itself creates a diagram of the joint angle motion to be taken next (see FIG. 6) while grasping the sliding state, and operates the joint according to this diagram. You can ski along the turn path. For example, the robot can control the skiing motion so as to slide along a predetermined turn path (such as a course that turns between poles set in advance).

((2) ターン半径の制御)
ターン半径の制御を図8により説明する。このターン半径(ターン弧の大きさ)を換える制御はエッジ角の変化速度を増減させて行っている。即ち図において、ターン半径Rがエッジ角αに依存し、ターン反転位置Tの前後のエッジ角αを変化させる速度を遅くすればターン半径は大きめに、速くすれば小さめになることを利用して、スキー板3のエッジ角の変化速度βを増減させて行っている。スキーロボット1は、前述のようにエッジ角αを変化させることによりターン反転を行うが、図8(a)に示すように、ターン反転位置Tの前の左(右)ターン滑走中においてエッジ角の変化速度βを所定のエッジ角減少速度β0とした場合、このターン半径Rは、所定のターン半径R0の円弧を描くものとする。そして、図8(b)に示すように、ターン反転位置Tの前の左(右)ターン滑走中に、エッジ角変化速度β1を上記所定のエッジ角変化速度β0より小さくすれば、この場合のターン半径R1は上記所定のターン半径R0より大きくなる。また、これとは逆に(図示しないが)、ターン反転位置Tの前の左(右)ターン滑走中にエッジ角変化速度β1を上記所定のエッジ角変化速度β0より大きくすれば、この場合のターン半径R1は上記所定のターン半径R0より小さくなる。またさらに、ターン反転点位置Tの後の右(左)ターン滑走中においても、エッジ角変化速度とターン半径の大小の関係は前述と同様であるので、エッジ角変化速度を小さく(大きく)すれば、ターン半径は大きく(小さく)なる。
((2) Turn radius control)
The control of the turn radius will be described with reference to FIG. The control for changing the turn radius (the size of the turn arc) is performed by increasing / decreasing the change speed of the edge angle. That is, in the figure, the turn radius R depends on the edge angle α, and it is utilized that the turn radius becomes larger if the speed for changing the edge angle α before and after the turn reversal position T is made slower, and becomes smaller if the speed is made faster. The change speed β of the edge angle of the ski 3 is increased or decreased. As described above, the ski robot 1 performs the turn inversion by changing the edge angle α. As shown in FIG. 8A, the edge angle during the left (right) turn before the turn inversion position T is determined. When the change speed β is set to a predetermined edge angle decrease speed β0, this turn radius R is assumed to draw an arc having a predetermined turn radius R0. Then, as shown in FIG. 8B, if the edge angle change speed β1 is made smaller than the predetermined edge angle change speed β0 during the left (right) turn before the turn reversal position T, The turn radius R1 is larger than the predetermined turn radius R0. On the other hand (not shown), if the edge angle change speed β1 is made larger than the predetermined edge angle change speed β0 during the left (right) turn before the turn reversal position T, The turn radius R1 is smaller than the predetermined turn radius R0. Further, even during the right (left) turn after the turn reversal point T, the relationship between the edge angle change speed and the turn radius is the same as described above, so the edge angle change speed should be reduced (increased). In this case, the turn radius becomes larger (smaller).

この実施形態は、ターン反転点位置Tの通過を契機として、エッジ角の変化速度を大きくする、もしくは、小さくすることを特徴とする実施形態である。   This embodiment is an embodiment characterized in that the change speed of the edge angle is increased or decreased with the passage of the turn reversal point T as a trigger.

本制御におけるエッジ角の変化速度の増減は、前述の股関節20および膝関節10の屈曲動作による左右両脚2L、2Rの屈曲差を用いた脚部2の傾け動作、または股関節回転軸21の内外転動作を加速または減速することにより行うことができる。さらに、左右方向の重心移動の速度を変化させてエッジ角変化速度を増減させてもターン半径のコントロールを行うことができる。   In this control, the change rate of the edge angle is increased or decreased by tilting the leg 2 using the bending difference between the left and right legs 2L and 2R due to the bending motion of the hip joint 20 and the knee joint 10 or inward and outward rotation of the hip rotation shaft 21. The operation can be performed by accelerating or decelerating. Furthermore, the turn radius can also be controlled by changing the speed of the center of gravity movement in the left-right direction to increase or decrease the edge angle change speed.

((3) 姿勢制御)
姿勢(転倒防止)制御を、転倒防止制御の説明図である図9を参照してこれを説明する。この転倒防止制御は、スキーロボット1がターン動作により発生する遠心力に対抗してターン中心へ向かう方向への重心移動により向心力を発生させると共に、これらを釣合わせることで行っている。スキーロボット1は、次のようにして現状の姿勢をバランスさせる制御を行っている。即ちスキーロボット1はターン滑走中に、図9に示すように、自身の重心Gからの重力ベクトルFgを求めると共に、方位センサ32、速度センサ33からそれぞれ演算して得た滑走方向、滑走速度vと現在のエッジ角αから演算したターン半径rとから遠心力ベクトルFc(m×v2/r、mはスキーロボット1の質量)を求め、これら重力ベクトルFgと遠心力ベクトルFcから合ベクトルFを求める。そして、スキーロボット1の重心Gからこの合ベクトルFの方向に引いた直線が左右両スキー板3L,3Rの間の滑走面上位置Pを通るように、スキー板3L,3Rのエッジ角αを合わせる補正を行い、左右方向に重心Gの移動を行う。この際、補正前(現状)のエッジ角αは左右脚部2L,2Rの内外転角または左右脚部2L,2Rの屈曲差を用いた脚部2の傾き角から算出でき、またエッジ角αの増減操作は、股関節および膝関節の屈曲動作による左右脚部2L,2Rの屈曲差を用いた脚部2の傾け動作、または股関節の内外転動作により行える。このようにして、スキーロボット1の重心Gからの作用力(合ベクトルF)の方向が左右2本のスキー板3L,3Rの間を通るようにすれば、重心Gからの前記合ベクトルFが両スキー板3L,3Rに作用する滑走面からの反力ベクトルNと釣合う、言い換えれば、重心位置において、ターン動作により発生した遠心力ベクトルFcが、重心移動により発生させたこの反力ベクトルの遠心力方向の分力である向心力ベクトルNcと釣合うので、スキーロボット1は転倒しない。このように左右方向へ重心移動を行うことによりターン時にスキーヤーのように遠心力に対抗させる内傾姿勢がとれてターン中の姿勢が安定する。
((3) Attitude control)
Posture (fall prevention) control will be described with reference to FIG. 9, which is an explanatory view of the fall prevention control. This overturn prevention control is performed by generating a centripetal force by moving the center of gravity in the direction toward the center of the turn against the centrifugal force generated by the ski robot 1 by the turn operation, and balancing them. The ski robot 1 performs control to balance the current posture as follows. That is, the ski robot 1 obtains the gravity vector Fg from its own center of gravity G, as shown in FIG. 9, during the turn, and also obtains the running direction and the running speed v obtained from the direction sensor 32 and the speed sensor 33, respectively. Then, a centrifugal force vector Fc (m × v 2 / r, where m is the mass of the ski robot 1) is obtained from the turn radius r calculated from the current edge angle α, and a combined vector F is obtained from the gravity vector Fg and the centrifugal force vector Fc. Ask for. Then, the edge angle α of the skis 3L, 3R is set so that the straight line drawn from the center of gravity G of the ski robot 1 in the direction of the resultant vector F passes through the position P on the sliding surface between the left and right skis 3L, 3R. Correction for matching is performed, and the center of gravity G is moved in the horizontal direction. At this time, the edge angle α before correction (current state) can be calculated from the inversion / inversion angle of the left and right legs 2L, 2R or the inclination angle of the leg 2 using the bending difference between the left and right legs 2L, 2R. The increase / decrease operation can be performed by tilting the leg 2 using the bending difference between the left and right legs 2L and 2R by the bending operation of the hip joint and the knee joint, or the hip joint's internal / external rotation operation. In this way, if the direction of the acting force (combined vector F) from the center of gravity G of the ski robot 1 passes between the two left and right skis 3L, 3R, the combined vector F from the center of gravity G is obtained. In balance with the reaction force vector N from the running surface acting on both skis 3L, 3R, in other words, the centrifugal force vector Fc generated by the turn operation at the center of gravity position is the reaction force vector generated by the center of gravity movement. Since the centripetal force vector Nc, which is a component in the centrifugal force direction, is balanced, the ski robot 1 does not fall. By moving the center of gravity in the left-right direction in this way, the inclining posture that opposes the centrifugal force is taken like a skier at the time of turn, and the posture during the turn is stabilized.

なお、前述では、方位センサと速度センサとから求めた重力ベクトルと遠心力ベクトルとにより合ベクトルを算出したが、この方法によらずスキーロボット1に3軸加速度計を取り付けて、これより重心に作用する合ベクトルを直接求めてもよい。そしてこの場合も、重心からこの合ベクトルの方向に引いた直線が両スキーの間を通るようにエッジ角を合わせることで姿勢(転倒防止)制御を行えばよい。   In the above description, the combined vector is calculated from the gravity vector and the centrifugal force vector obtained from the azimuth sensor and the velocity sensor. However, regardless of this method, a triaxial accelerometer is attached to the ski robot 1 so that the center of gravity is obtained. The acting combined vector may be obtained directly. Also in this case, posture (prevention of fall) control may be performed by adjusting the edge angle so that a straight line drawn from the center of gravity in the direction of the resultant vector passes between both skis.

((4) 荷重バランス制御)
荷重バランス制御を説明する。この本発明の荷重バランス制御には、左右バランス制御と前後荷重のバランス制御とがある。これらのうち前者の制御は、左右バランス制御の説明図である図10を、また後者の制御は、前後バランス制御の説明図である図11を用いて以下説明する。
((4) Load balance control)
The load balance control will be described. The load balance control of the present invention includes left-right balance control and front-rear load balance control. Of these, the former control will be described below with reference to FIG. 10 which is an explanatory diagram of left / right balance control, and the latter control will be described below with reference to FIG. 11 which is an explanatory diagram of front / rear balance control.

(左右の荷重バランス制御)
前者の左右荷重のバランス制御には、図10に示すように、左右足部の荷重を均等にする制御と左右足部の荷重比を一定にする制御とがある。図10(a)に示すように、先の左右足部の荷重を均等にする制御は、まず、左右のスキー板3L,3R上に取り付けた足首部荷重センサ31AL,31ARの出力から左右のスキー板3L,3Rにかかる現在の足部左荷重WaLおよび足部右荷重WaRをそれぞれ求める(図5参照)。そして、図10[a1]のように股関節の内外転動作によるか、または、図10[a2]のように左右の股関節および膝関節の屈曲差を用いた脚部2の傾け動作(体の傾け)によるかの上体の左右重心移動により、これら左右のスキー板3L,3Rにかかる現在の荷重を均等にする制御を行う。即ち、外足のスキー板3L(ターン円弧の外側にあるスキー板)にかかる足部左荷重WaLと内足スキー板3R(ターン円弧の内側にあるスキー板)にかかる足部右荷重WaRとが均等(WaL=WaR)になるように補正制御する。
(Left and right load balance control)
As shown in FIG. 10, the former balance control of the left and right loads includes a control for equalizing the loads on the left and right foot portions and a control for making the load ratio of the left and right foot portions constant. As shown in FIG. 10 (a), the control for equalizing the loads on the left and right foot portions is performed first from the outputs of the ankle load sensors 31AL and 31AR mounted on the left and right skis 3L and 3R. The current foot left load WaL and foot right load WaR applied to the plates 3L and 3R are respectively obtained (see FIG. 5). Then, the leg 2 is tilted (inclined by the hip joint) by using the hip joint inward and outward movement as shown in FIG. 10 [a1] or by using the bending difference between the left and right hip joints and knee joints as shown in FIG. 10 [a2]. ), The current load applied to the left and right skis 3L, 3R is controlled to be equal. That is, the foot left load WaL applied to the outer foot ski 3L (the ski outside the turn arc) and the foot right load WaR applied to the inner foot ski 3R (the ski inside the turn arc). Correction control is performed so as to be equal (WaL = WaR).

また、図10(b)に示すように、後の左右足部の荷重比を一定にする制御は、図10[b1]のように、股関節の内外転動作によるか、または、図10[b2]のように、左右の股関節および膝関節の屈曲差を用いた脚部2の傾け動作(体の傾け)によるかの上体の左右重心移動により、左右のスキー板3L,3Rにかかる現在の足部左荷重WaL,足部右荷重WaRをこれらの比が一定になる制御を行う。即ち、外足のスキー板3Lにかかる足部左荷重WaLと内足スキー板3Rにかかる足部右荷重WARとの比が一定の割合(WaL/WaR=一定)になるように補正制御することで行われる。この左右足部を均等にする制御を用いれば、新雪、深雪など両足の均等荷重を必要とするターンに有効である。また左右足部の荷重比一定の制御を用いて外足に多くの荷重をかけてターンすれば、切れのいい高速ターンが可能となる。   Further, as shown in FIG. 10B, the control to make the load ratio of the rear left and right foot portions constant is based on the hip joint inward and outward movement as shown in FIG. 10 [b1], or FIG. 10 [b2 As shown in FIG. 4, the current applied to the left and right skis 3 </ b> L and 3 </ b> R by the left and right center-of-gravity movement of the upper body by the tilting motion (body tilt) of the leg 2 using the bending difference between the left and right hip joints and knee joints The foot left load WaL and the foot right load WaR are controlled so that the ratio between them is constant. That is, correction control is performed so that the ratio of the left foot load WaL applied to the outer ski 3L and the right foot WAR applied to the inner ski 3R is a constant ratio (WaL / WaR = constant). Done in Using this control to equalize the left and right foot portions is effective for turns that require equal loads on both feet, such as fresh snow and deep snow. In addition, if a turn is applied with a large load applied to the outer legs using a control with a constant load ratio between the left and right foot portions, a sharp high-speed turn is possible.

(前後の荷重バランス制御)
後者の前後足部荷重のバランス制御を、図11を用いて説明する。ところで前述のように左右スキー板3L,3Rには、足の前部に足裏前部荷重センサ31B(31BL、31BR)と後部位置に足裏後部荷重センサ31C(31CL、31CR)との荷重センサがそれぞれ取り付けられており(図1参照)、スキー板3の前部にかかる足部前荷重Wbと後部にかかる足部後荷重Wcとをそれぞれ求めることができる。そこで足部荷重の前後のバランス制御は、まずこれらの足裏前部荷重センサ31Bと足裏後部荷重センサ31Cとから現在のスキー板3の足部前荷重Wbと足部後荷重Wcを計測する。そしてこの計測値(検出量)に対応して、股関節の屈曲角を変化させて重心を前後に移動させ、図11(a)のように足部前荷重Wbが足部後荷重Wcより大きく(Wb>Wc前傾姿勢)、図11(b)のように足部前荷重Wbが足部後荷重Wcと均等に(Wb=Wc中立姿勢)、または図11(c)のように足部前荷重Wbが足部後荷重Wcより小さく(Wb<Wc後傾姿勢)なるようにそれぞれ補正制御している。この制御を応用すれば、上体を前後方向へ重心移動を行うことで必要に応じて前傾姿勢または後傾姿勢をとり両足の前後荷重のバランス制御を行うことができる。例えば、滑走中に雪質が変化してその抵抗が変わり急に減速(加速)した場合には、即座に後傾姿勢(前傾姿勢)をとって前後のバランスを取ることができる。また、滑走面の凹凸変化、または傾斜変化が生じた場合においても、前後方向への上体の重心移動を対応させて前後方向の姿勢制御ができる。またターン時に、その前半では前荷重が後荷重より大きくなるように、またその後半では後荷重が前荷重より大きくなるように、股関節の屈曲角を変化させて重心の前後移動を行うことで切れのあるターンを行うこともできる。上述の通り、このスキーロボットは、前部荷重センサ31Bと足裏部荷重センサ31Cとから得られた検出量に基いて、足部前荷重Wbと足部後荷重Wcとを算出し、その値が所定の比率となるように股関節の屈曲角を制御する。
(Front and rear load balance control)
The latter balance control of the front and rear foot load will be described with reference to FIG. By the way, as described above, the left and right skis 3L and 3R include load sensors 31F (31BL, 31BR) at the front of the foot and a load sensor 31C (31CL, 31CR) at the rear of the foot. Are attached (see FIG. 1), and the foot front load Wb applied to the front portion of the ski 3 and the foot rear load Wc applied to the rear portion can be obtained, respectively. Therefore, in the balance control before and after the foot load, first, the front foot load Wb and the foot rear load Wc of the current ski 3 are measured from the front foot load sensor 31B and the rear foot load sensor 31C. . Corresponding to this measured value (detected amount), the hip joint flexion angle is changed to move the center of gravity back and forth, and the foot front load Wb is larger than the foot rear load Wc as shown in FIG. Wb> Wc forward leaning posture), the front foot load Wb is equal to the rear foot load Wc (Wb = Wc neutral posture) as shown in FIG. 11B, or the front of the foot as shown in FIG. 11C. Correction control is performed so that the load Wb is smaller than the foot rear load Wc (Wb <Wc backward tilt posture). By applying this control, it is possible to perform a balance control of the front and rear loads of both feet by moving the upper body in the front-rear direction and moving the center of gravity in the front-rear direction to take a forward leaning posture or a backward leaning posture. For example, if the snow quality changes during a run and the resistance changes and suddenly decelerates (accelerates), it is possible to immediately take a backward leaning posture (forward leaning posture) and balance the front and back. In addition, even when the unevenness or inclination of the sliding surface changes, the posture control in the front-rear direction can be performed by corresponding the center of gravity movement of the upper body in the front-rear direction. When turning, the center of gravity is moved back and forth by changing the hip flexion angle so that the front load is greater than the rear load in the first half and the rear load is greater than the front load in the second half. You can also make a certain turn. As described above, the ski robot calculates the foot front load Wb and the foot rear load Wc based on the detection amounts obtained from the front load sensor 31B and the sole load sensor 31C, and the values thereof are calculated. The flexion angle of the hip joint is controlled so that becomes a predetermined ratio.

((5) 速度制御)
速度制御をこの制御の説明図である図12を参照して説明する。この制御法には減速制御と増速制御とがある。まず減速制御には、図12(a)に示すように、左右スキー板3をハの字に向け迎え角(滑走方向に対して板を交差させる角度)を作って滑走抵抗を増やす制御と、図12(b)に示すように、左右スキー板3の両方をそろえて滑走方向に対してスキー板の向きを交差させて迎え角を作り滑走抵抗を増やす制御とがある。また増速制御は、図11(c)に示すように、両スキー板3の方向を滑走方向に揃える(迎え角を零にする)ことによって滑走速度を増加させる。なおこれら速度制御で迎え角を操作する動作は、股関節の内外転動作や下肢部の回旋動作や股関節および膝関節の屈曲動作などのそれぞれの組合わせ動作または単独動作により行われる。
((5) Speed control)
The speed control will be described with reference to FIG. 12, which is an explanatory diagram of this control. This control method includes deceleration control and acceleration control. First, in the deceleration control, as shown in FIG. 12 (a), the left and right skis 3 are turned in a letter C and the angle of attack (the angle at which the plates cross the sliding direction) is increased to increase the sliding resistance. As shown in FIG. 12 (b), there is a control in which both the left and right skis 3 are aligned and the direction of the skis intersects the running direction to create an angle of attack and increase the sliding resistance. In the speed increasing control, as shown in FIG. 11 (c), the skiing speed is increased by aligning the directions of both skis 3 with the skiing direction (making the angle of attack zero). The operations for manipulating the angle of attack by the speed control are performed by respective combined operations such as hip joint inversion and rotation, lower limb rotation, hip joint and knee joint, or individual operations.

(滑走の事例)
滑走面にポールを設置したターン経路(コース)を滑走する事例を、この説明図である図13を参照して説明する。スキーロボット1は、図において、ターン経路L滑走中にその現在位置Aで荷重センサ31および各関節角度(ロボットの姿勢)からスキー板3にかかる荷重バランスの状態を認識すると共に、次にスキーロボット1が取るべき姿勢およびスキー板3の角付け角を求める。一方前述のように、速度センサ33と方位センサ32との検出量を積分して上記ターン経路L上の現在位置Aを求め、この現在位置Aと滑走方向および次のポール位置Bとの関係から、次のポール40を通過すべき次のターン経路Lを求める。そして、このターン経路Lと上記取るべき姿勢およびスキー板3の角付け角の関係から各関節角動作のダイヤグラム(姿勢ダイヤグラム)を作成する。続いてスキーロボット1は、前述した姿勢(転倒防止)制御、荷重バランス制御などの制御を適宜行い安定した滑走姿勢を保つと共に、前述したターン反転制御、ターン半径の制御、速度制御などの組み合わせ制御を用いて上記関節角動作のダイヤグラムに従い所定の各関節を制御しながら、上記次のポール位置B上を通過する。そしてその後、同様にして次々と残ったポール40を通過してターン経路Lの全コースを完走する。
(Sliding example)
An example of sliding along a turn route (course) in which a pole is installed on the running surface will be described with reference to FIG. In the figure, the ski robot 1 recognizes the state of the load balance applied to the ski 3 from the load sensor 31 and each joint angle (robot posture) at the current position A during the turn path L, and then the ski robot. The posture to be taken by 1 and the cornering angle of the ski 3 are obtained. On the other hand, as described above, the current position A on the turn path L is obtained by integrating the detection amounts of the speed sensor 33 and the azimuth sensor 32, and the relationship between the current position A, the sliding direction, and the next pole position B is obtained. Next, the next turn path L to be passed through the next pole 40 is obtained. Then, a diagram of each joint angle operation (posture diagram) is created from the relationship between the turn path L, the posture to be taken, and the cornering angle of the ski 3. Subsequently, the ski robot 1 appropriately controls the above-described posture (prevention of fall) control, load balance control, and the like to maintain a stable sliding posture, and combines control such as the above-described turn inversion control, turn radius control, and speed control. Is passed through the next pole position B while controlling each predetermined joint in accordance with the diagram of the joint angle motion using the. After that, all the courses of the turn route L are completed through the remaining poles 40 one after another.

なお、速度制御の演算に際してはスキー板と滑走面との摩擦係数が必要となるが、これは予めスキーロボットに同じ滑走面を直滑降させその滑走距離と時間の関係から求めておく。   In calculating the speed control, the friction coefficient between the ski and the sliding surface is required, and this is obtained in advance from the relationship between the sliding distance and time by directly sliding down the same sliding surface on the ski robot.

スキーロボットの滑走速度、滑走方位、および滑走位置のデータについては、本発明ではロボットが内装する各センサの検出により求めたが、これらデータは、ロボットを外部からビデオカメラにより撮影した画像から検出し無線によってロボットにフィードバックすることで求めてもよい。この実施形態の場合、無線によってフィードバックするための装置が、「計測装置」である。   In the present invention, the data of the skiing robot's sliding speed, sliding direction, and sliding position are obtained by detecting each sensor built in the robot. These data are detected from an image of the robot captured by a video camera from the outside. You may obtain | require by feeding back to a robot by radio | wireless. In the case of this embodiment, the device for feeding back wirelessly is a “measuring device”.

本発明のスキーロボット1は、前述の様々なターン制御が可能なことから次に述べるような人のスキー操作に似せたスキー操作を行うことができる。即ちスキーロボット1は、股関節20に設けた股関節内外転軸21をサーボモータにより駆動して脚部2を内転または外転させることにより、股関節20に設けた股関節屈曲軸22や膝関節屈曲軸12のサーボ駆動による屈曲運動を行いながら脚部2を左右に角度付けしスキー板3を角付けして、これら2本のスキー板が平行を保った状態でのパラレルターンが行える。   The ski robot 1 according to the present invention can perform various kinds of turn control as described above, and can perform a ski operation resembling a human ski operation as described below. That is, the ski robot 1 drives the hip joint inversion shaft 21 provided on the hip joint 20 by rotating the leg 2 inward or outward by driving the hip joint inversion shaft 21 by a servo motor. While performing the bending motion by the 12 servo drives, the leg 2 is angled left and right and the ski 3 is angled, and a parallel turn can be performed with these two skis kept parallel.

またこのスキーロボット1には、股関節20に設けた股関節屈曲軸22と膝関節10として設けられた膝関節屈曲軸12とをサーボ駆動により連動させて屈曲運動を行うことにより、脚部2の屈身動作または伸身動作をさせることもできる。即ち不整斜面、コブ斜面などの凹凸斜面の滑走時には、この脚部2の屈伸動作により上体の高さを一定に維持するように操作できる。またターン時には、脚部2の左右それぞれ個別の屈伸動作により内足を外足よりも屈曲させるなどそれぞれの脚長を調整して胴体部4を内傾させることにより、前述のように、ターン弧の大小に応じて生じた遠心力に対抗する向心力を得て内傾外向姿勢を保つことができる。こうして、ロボットは滑降面の物理的な条件変化に対応して常に安定してスキー滑降ができる。   Further, the ski robot 1 performs bending motion by interlocking the hip joint bending shaft 22 provided at the hip joint 20 and the knee joint bending shaft 12 provided as the knee joint 10 by servo drive, so that the leg 2 is bent. It can also be moved or stretched. That is, when sliding on uneven slopes such as irregular slopes and bump slopes, it is possible to operate so that the height of the upper body is kept constant by the bending and stretching operations of the legs 2. Further, at the time of turning, the body 4 is tilted inward by adjusting the length of each leg, for example, the inner leg is bent more than the outer leg by separate bending and stretching operations of the left and right of the leg 2, as described above. An centripetal force that opposes the centrifugal force generated according to the magnitude can be obtained and the inward and outward posture can be maintained. In this way, the robot can always ski down stably in response to changes in physical conditions of the downhill surface.

またさらにスキーロボット1は、前述の脚部2の屈伸動作を行うことにより屈身抜重(沈み込み抜重)または伸身抜重(伸び上がり抜重)動作を行うことができる。そしてターン切換え時には、これらの屈伸それぞれの抜重動作を行ってスキー板への荷重を抜重し大腿部回転軸11のサーボ駆動による下肢部14のひねり操作を行い易くすることができる。この脚部2の屈伸動作を用いた抜重によるターン切換え技術は、特に小回りターンまたは急斜面でのターン切換え時に有効であり従来ロボットには行えなかったスキーヤー操作と同様な高度なターン切換え操作が可能となる。   Further, the ski robot 1 can perform a bending-extraction (sinking-extraction) or a stretching-extraction (elongation-extraction) by performing the bending / extending operation of the leg 2 described above. When the turn is switched, each of the bending and stretching operations can be performed to extract the load on the ski, thereby facilitating the twisting operation of the lower limb portion 14 by the servo drive of the thigh rotation shaft 11. This turn switching technology by pulling using the bending and stretching movements of the leg 2 is particularly effective when switching small turns or turns on steep slopes, and enables advanced turn switching operations similar to skier operations that could not be performed by conventional robots. Become.

また、この実施例によるスキーロボット1は、少なくとも、脚部2を内外転させる股関節内外転軸21と、脚部2を屈曲させる股関節屈曲軸22と、下肢部14を旋回させる大腿部回転軸11との左右各3軸計6軸(6自由度)を有している。よって、スキーターン動作の3要素である股関節の内外転、屈曲、回旋、を組み合わせた動作が行え、人間のスキー動作に類似した動作が可能である。即ち、前述のパラレルターンは勿論のこと大腿部回転軸11のサーボ駆動により下肢部14を回旋させて胴体部4の向きをスキー板3の向きに対して斜め方向に向けることができ、この作用によりプルークボーゲン、シュテムターンなどのターン動作も行える。さらに例えば小回りターンではターン前半は、スキー板3があまり撓まずスキー板3を回旋する力が殆どないためこの部分では脚部2のひねりが必要となるが、この脚部2のひねり操作が大腿部回転軸11のサーボ駆動により可能となりスキーロボット1に小回りターンを行わせることもできる。   Further, the ski robot 1 according to this embodiment includes at least a hip joint inversion / inversion shaft 21 for turning the leg 2 inward and outward, a hip joint bending shaft 22 for bending the leg 2, and a thigh rotation axis for turning the lower limb 14. 11 in total, 6 axes (6 degrees of freedom). Therefore, it is possible to perform an operation combining the hip joint inward and outward rotation, bending, and rotation, which are the three elements of the ski turn operation, and an operation similar to a human ski operation is possible. That is, not only the above-mentioned parallel turn but also the lower limb part 14 can be rotated by the servo drive of the thigh rotation shaft 11 so that the body part 4 can be oriented obliquely with respect to the ski 3. Turn action such as prukebogen and stem turn can be performed by the action. Further, for example, in the small turn, in the first half of the turn, the ski 3 does not bend very much and there is almost no force to rotate the ski 3, so that the leg 2 needs to be twisted at this part, but the twisting operation of the leg 2 is large. It becomes possible by servo driving of the thigh rotation shaft 11, and the ski robot 1 can also make a small turn.

以上のようにスキーロボット1は、スキーヤーの動作に酷似した関節動作が可能なので、これを実滑走させてどの関節をどのように動かせば良い滑りができるかを検証することによりスキーヤーのターン技術上達の一助とすることができる。また、スキーヤーの様々な用途(レベル)を想定したスキー板を装着してそれぞれ所定のターン技術での性能テストを行うことにより、安定してより早く滑走できるスキー板の開発に寄与できるのはもちろん、各スキーヤーの用途に最適なスキー板の開発の手助けとなることも期待できる。   As described above, since the ski robot 1 can perform joint motions that are very similar to the skier's motions, it is possible to improve the skier's turn technology by verifying which joints can be slid by using the actual slides. Can help. In addition, it is possible to contribute to the development of a ski that can be slid stably and faster by installing a ski that assumes various uses (levels) of the skier and performing a performance test with each turn technology. It can also be expected to help develop skis that are optimal for each skier's application.

本発明に係るスキーロボットおよびセンサを示す図である。(a)正面図(b)側面図It is a figure which shows the ski robot and sensor which concern on this invention. (A) Front view (b) Side view 本発明に係るスキーロボットの関節およびセンサを示す簡略図である。1 is a simplified diagram showing joints and sensors of a ski robot according to the present invention. 本発明に係る速度センサを示す図である。It is a figure which shows the speed sensor which concerns on this invention. 本発明に係る速度センサから得られたスキーロボットの滑走速度の計測例を示す図である。It is a figure which shows the example of a measurement of the skiing speed of the ski robot obtained from the speed sensor which concerns on this invention. 本発明に係るスキーロボットのターン中における左右足荷重の計測例を示す図である。It is a figure which shows the example of a measurement of the left-right foot load in the turn of the ski robot which concerns on this invention. 本発明に係るスキーロボットの関節角のダイヤグラム例を示す図である。 (a)内外転角と回旋角のダイヤグラム (b)股関節と膝の屈曲角のダイヤグラムIt is a figure which shows the example of a diagram of the joint angle of the ski robot which concerns on this invention. (A) Diagram of internal and external rotation angle and rotation angle (b) Diagram of hip joint and knee flexion angle 本発明に係るターンの反転制御の説明図である。It is explanatory drawing of the inversion control of the turn which concerns on this invention. 本発明に係るターン半径の制御の説明図である。 (a)所定のエッジ角減少速度でのターン (b)所定のエッジ角減少速度より小さいエッジ角減少速度でのターンIt is explanatory drawing of control of the turn radius which concerns on this invention. (A) Turn at a predetermined edge angle decreasing speed (b) Turn at an edge angle decreasing speed smaller than the predetermined edge angle decreasing speed 本発明に係る姿勢(転倒防止)制御の説明図である。It is explanatory drawing of the attitude | position (fall prevention) control which concerns on this invention. 本発明に係る左右バランス制御の説明図である。 (a)左右足部の荷重を均等に制御 [a1]内外転による重心移動 [a2]左右の屈曲差による重心移動 (b)左右足部の荷重比を一定に制御 [b1]内外転による重心移動 [b2]左右の屈曲差による重心移動It is explanatory drawing of the left-right balance control which concerns on this invention. (A) Uniform control of left and right foot load [a1] Center of gravity movement due to inward and outward rotation [a2] Center of gravity movement due to left and right bending difference (b) Constant control of right and left foot part load ratio [b1] Center of gravity due to inward and outward rotation Movement [b2] Center of gravity movement due to left / right bending difference 本発明に係る前後バランス制御の説明図である。 (a)足部前荷重が足部後荷重より大きい (b)足部前荷重が足部後荷重と均等 (c)足部前荷重が足部後荷重より小さいIt is explanatory drawing of the front-back balance control which concerns on this invention. (A) Foot front load is larger than foot rear load (b) Foot front load is equal to foot rear load (c) Foot front load is smaller than foot rear load 本発明に係る速度制御の説明図である。 (a)減速 (b)減速 (c)増速It is explanatory drawing of the speed control which concerns on this invention. (A) Deceleration (b) Deceleration (c) Increased speed 本発明に係るスキーロボットのポール設置のターン経路を滑走する例を示す図である。It is a figure which shows the example which slides the turn path | route of the pole installation of the ski robot which concerns on this invention.

符号の説明Explanation of symbols

1…スキーロボット、2、2L、2R…脚部、3、3L、3R…スキー板、4…胴体部、5…コントローラ、10、10L、10R…膝関節、11、11L、11R…大腿部回旋軸、12、12L、12R…膝関節屈曲軸、13、13L、13R…大腿部、14、14L、14R…下肢部、15、15L、15R…足部、20、20L、20R…股関節、21、21L、21R…股関節内外転軸、22、22L、22R…股関節屈曲軸、30…センサ、31、31L、31R…荷重センサ、31A、31AL、31AR…足首部荷重センサ、31B、31BL、31BR…足裏前部荷重センサ、31C、31CL、31CR…足裏後部荷重センサ、32、32L、32R…方位センサ、33、33L、33R…速度センサ、33A…ローラ、35…ローラ取付軸、40…ポール、A…現在位置、B…次のポール位置、F…合ベクトル、Fc…遠心力ベクトル、Fg…重力ベクトル、G…重心、L…ターン経路、m…質量、N…反力ベクトル、Nc…向心力ベクトルP…滑走面上位置、r…ターン半径、R…ターン半径、R0…所定のターン半径R1…ターン半径T……ターン反転位置、T0…現在位置、v…滑走速度、WaL…足部左荷重、WaR…足部右荷重、Wb…足部前荷重Wc…足部後荷重、X…距離、α…エッジ角度、α1…反転前のエッジ角α2…反転後のエッジ角β…エッジ角の変化速度、β0…所定のエッジ角減少速度、β1…エッジ角減少速度。

DESCRIPTION OF SYMBOLS 1 ... Ski robot, 2, 2L, 2R ... Leg part 3, 3L, 3R ... Ski board, 4 ... Torso part, 5 ... Controller 10, 10L, 10R ... Knee joint, 11, 11L, 11R ... Thigh Rotation axis, 12, 12L, 12R ... Knee joint bending axis, 13, 13L, 13R ... Thigh, 14, 14L, 14R ... Lower limb, 15, 15L, 15R ... Foot, 20, 20L, 20R ... Hip joint, 21, 21 </ b> L, 21 </ b> R ... hip joint internal / external shaft, 22, 22 </ b> L, 22 </ b> R ... hip joint flexion axis, 30 ˜ sensor, 31, 31 </ b> L, 31 </ b> R—load sensor, 31 </ b> A, 31 AL, 31 AR. ... Sole front load sensor, 31C, 31CL, 31CR ... Sole rear load sensor, 32, 32L, 32R ... Direction sensor, 33, 33L, 33R ... Speed sensor, 33A ... Roller, 5 ... roller mounting shaft, 40 ... pole, A ... current position, B ... next pole position, F ... combined vector, Fc ... centrifugal force vector, Fg ... gravity vector, G ... center of gravity, L ... turn path, m ... mass , N ... reaction force vector, Nc ... centripetal force vector , P ... sliding surface position, r ... turn radius, R ... turn radius, R0 ... predetermined turn radius , R1 ... turn radius , T ... turn reversal position, T0 ... Current position, v ... sliding speed, WaL ... foot left load, WaR ... foot right load, Wb ... foot front load , Wc ... foot rear load, X ... distance, α ... edge angle, α1 ... before inversion Edge angle : α2: Edge angle after inversion , β: Edge angle changing speed, β0: Predetermined edge angle decreasing speed, β1: Edge angle decreasing speed.

Claims (13)

胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記股関節に上記脚部を内外転させる股関節内外転軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記計測装置からの検出量に基いて、上記コントローラが上記股関節内外転軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
A hip joint inversion shaft for turning the leg portion inward and outward at the hip joint is provided,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A ski robot characterized in that a controller is provided in the body part, and the controller can control the hip joint inversion / extraction shaft based on a detection amount from the measuring device.
胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には股関節を屈曲させる股関節屈曲軸を、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記計測装置からの検出量に基いて、上記コントローラが上記股関節屈曲軸と上記膝関節屈曲軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint bending axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A ski robot characterized in that a controller is provided in the torso, and the controller can control the hip joint flexion axis and the knee joint flexion axis based on a detection amount from the measuring device.
胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には上記脚部を内外転させる股関節内外転軸と上記股関節を屈曲させる股関節屈曲軸を設け、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記スキーロボットのいずれかの部位に滑走中のスキーロボットの方位と速度を計測できる計測装置を設け、
上記胴体部にコントローラを設け、上記測定装置からの検出量に基いて、上記コントローラが任意の上記股関節内外転軸、上記股関節屈曲軸、上記膝関節屈曲軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint abduction shaft for turning the leg inward and outward, and a hip joint bend axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A measuring device that can measure the direction and speed of the skiing robot that is sliding on any part of the skiing robot is provided.
A ski provided with a controller in the torso, wherein the controller can control any of the hip joint inversion / extraction shaft, the hip joint flexion axis, and the knee joint flexion axis based on a detection amount from the measurement device robot.
請求項1から請求項3のいずれかに記載のスキーロボットにおいて、
前記脚部と前記スキー板の接続部に荷重センサを設け、
上記荷重センサからの検出量に基いて、前記コントローラが任意の前記股関節内外転軸、前記股関節屈曲軸、前記膝関節屈曲軸を制御可能なことを特徴とするスキーロボット。
The ski robot according to any one of claims 1 to 3,
A load sensor is provided at the connecting portion between the leg and the ski,
A ski robot characterized in that the controller can control any of the hip joint inversion and rotation axes, the hip joint flexion axis, and the knee joint flexion axis based on a detection amount from the load sensor.
胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記股関節に上記脚部を内外転させる股関節内外転軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラが上記股関節内外転軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
A hip joint inversion shaft for turning the leg portion inward and outward at the hip joint is provided,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
A ski robot characterized in that the controller can control the hip joint inversion / extraction shaft based on a detection amount from the load sensor.
胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には股関節を屈曲させる股関節屈曲軸を、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラにより上記股関節屈曲軸と上記膝関節屈曲軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint bending axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
A ski robot characterized in that the hip joint bending axis and the knee joint bending axis can be controlled by the controller based on a detection amount from the load sensor.
胴体部と、該胴体部の下方に設けられた左右の股関節を介して上記胴体部の荷重を支持する左右2本の脚部とを有し、雪面または同様の低摩擦斜面を滑走させるため、該脚部の接地面にそれぞれスキー板を装着したスキーロボットにおいて、
上記脚部には、脚部を屈曲可能とする膝関節を設け、
上記股関節には上記脚部を内外転させる股関節内外転軸と上記股関節を屈曲させる股関節屈曲軸を設け、上記膝関節には膝関節を屈曲させる膝関節屈曲軸を設け、
上記脚部と上記スキー板の接続部に荷重センサを設け、
上記胴体部にコントローラを設け、
上記荷重センサからの検出量に基いて、上記コントローラにより任意の上記股関節内外転軸、上記股関節屈曲軸、上記膝関節屈曲軸を制御可能なことを特徴とするスキーロボット。
In order to slide on a snowy surface or a similar low-friction slope having a body part and two left and right leg parts that support the load of the body part via left and right hip joints provided below the body part , In a ski robot in which a ski is attached to each ground contact surface of the leg,
The above leg is provided with a knee joint that allows the leg to bend,
The hip joint is provided with a hip joint abduction shaft for turning the leg inward and outward, and a hip joint bend axis for bending the hip joint, and the knee joint is provided with a knee joint bending axis for bending the knee joint,
A load sensor is provided at the connection between the leg and the ski,
A controller is provided in the body part,
A ski robot characterized in that any of the hip joint inversion / extraction shaft, the hip joint flexion axis, and the knee joint flexion axis can be controlled by the controller based on a detection amount from the load sensor.
請求項2から請求項4、請求項6と請求項7のいずれかに記載のスキーロボットにおいて、
前記脚部に脚部の下肢部を旋回させる大腿部回転軸を設け、
前記コントローラは、前記計測装置、および/または、前記荷重センサからの検出量に基いて、前記大腿部回転軸を制御可能なことを特徴とするスキーロボット。
In the ski robot according to any one of claims 2 to 4, 6 and 7,
A thigh rotation axis for turning the lower limb of the leg is provided in the leg,
The ski robot, wherein the controller is capable of controlling the thigh rotation axis based on a detection amount from the measuring device and / or the load sensor.
請求項1から請求項4と請求項8のいずれかに記載のスキーロボットにおいて、前記計測装置は少なくとも速度センサと方位センサを備えることを特徴とするスキーロボット。   9. The ski robot according to claim 1, wherein the measurement device includes at least a speed sensor and an orientation sensor. 請求項4に記載の構成になるスキーロボットを制御する方法において、前記測定装置で斜面上の滑走方向を検出すると共に前記スキー板の滑走速度を検出し、これらの検出量とターン半径からスキーロボットに作用する遠心力を求めて、該遠心力と前記荷重センサから求めた重力との合力からスキーの回転に必要なスキー板の角付け角およびスキーロボットの姿勢を制御することを特徴とするスキーロボットの姿勢制御方法。   5. The method of controlling a ski robot according to claim 4, wherein the measuring device detects a skiing direction on a slope and a skiing speed of the ski, and detects the ski robot from the detected amount and the turn radius. A ski characterized in that it obtains a centrifugal force acting on the ski, and controls the angle of the ski plate and the attitude of the ski robot necessary for the rotation of the ski from the resultant force of the centrifugal force and the gravity obtained from the load sensor Robot attitude control method. 請求項1から請求項4、請求項8、請求項9のいずれかに記載の構成になるスキーロボットを制御する方法において、前記スキーロボットの滑走中の現在位置を求めると共に該現在位置と予め設定した所定のターン位置との間の距離を求め、該距離に対応してスキー板のエッジ角度を増減させてそのエッジを反転することにより、ターン切換えを行うことを特徴とするスキーロボットのターン切換え制御方法。   A method for controlling a ski robot according to any one of claims 1 to 4, claim 8, and claim 9, wherein a current position of the ski robot during sliding is obtained and preset with the current position. A turn change of a ski robot characterized in that a turn change is performed by calculating a distance between the predetermined turn position and increasing or decreasing the edge angle of the ski according to the distance and inverting the edge. Control method. 請求項4請求項8のいずれかに記載の構成になるスキーロボットを制御する方法において、前記スキーロボットの前記脚部下端の足部に設けた前記荷重センサから求めたそれぞれの検出量を用いることにより前記スキーロボットの各関節を動作させて、左右の上記足部がそれぞれ所定の荷重になるように左右方向へ重心移動を行って左右荷重のバランス制御を行う、または上記足部の前後がそれぞれ所定の荷重になるように前後方向へ重心移動を行って前後荷重のバランス制御を行うことを特徴とするスキーロボットの荷重バランス制御方法。   9. A method for controlling a ski robot according to claim 8, wherein each detection amount obtained from the load sensor provided on a foot portion at a lower end of the leg portion of the ski robot is used. By operating the joints of the ski robot, the left and right foot parts are moved in the left and right direction so as to have a predetermined load, and the left and right load balance control is performed, or the front and rear parts of the foot parts are respectively A load balance control method for a ski robot, wherein balance control of the front and rear loads is performed by moving the center of gravity in the front and rear direction so as to obtain a predetermined load. 請求項1から請求項4、請求項8、請求項9のいずれかに記載の構成になるスキーロボットを制御する方法において、前記コントローラは、滑走中の前記スキーロボットの速度を求め、この速度が所定の値より大きい/小さいときには、各関節を動作させて、減速制御/増速制御を行うことを特徴とするスキーロボットの速度制御方法。


The method for controlling a ski robot according to any one of claims 1 to 4, claim 8, and claim 9, wherein the controller obtains a speed of the ski robot during sliding, and the speed is A speed control method for a ski robot, characterized in that when it is larger / smaller than a predetermined value, each joint is operated to perform deceleration control / acceleration control.


JP2004069821A 2004-03-11 2004-03-11 Skiing robot and its controlling method Pending JP2005254395A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004069821A JP2005254395A (en) 2004-03-11 2004-03-11 Skiing robot and its controlling method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004069821A JP2005254395A (en) 2004-03-11 2004-03-11 Skiing robot and its controlling method

Publications (1)

Publication Number Publication Date
JP2005254395A true JP2005254395A (en) 2005-09-22

Family

ID=35080625

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004069821A Pending JP2005254395A (en) 2004-03-11 2004-03-11 Skiing robot and its controlling method

Country Status (1)

Country Link
JP (1) JP2005254395A (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111702809A (en) * 2020-06-27 2020-09-25 上海工程技术大学 Robot track self-checking device and method thereof
CN114310963A (en) * 2022-01-18 2022-04-12 上海交通大学 Multi-foot skiing robot
CN114435507A (en) * 2022-03-11 2022-05-06 上海交通大学 Skating multi-foot robot
CN114454189A (en) * 2022-02-11 2022-05-10 成都锦城学院 Bionic inchworm robot for structural member flaw detection
CN114590338A (en) * 2022-03-11 2022-06-07 上海交通大学 Skating hexapod robot structure
CN114771680A (en) * 2022-04-12 2022-07-22 上海交通大学 Single-board skiing multi-foot robot

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61122881A (en) * 1984-11-16 1986-06-10 清水 直美 Alpen ski robot
JP2001138272A (en) * 1999-11-12 2001-05-22 Sony Corp Leg type mobile robot and control method for its motion

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61122881A (en) * 1984-11-16 1986-06-10 清水 直美 Alpen ski robot
JP2001138272A (en) * 1999-11-12 2001-05-22 Sony Corp Leg type mobile robot and control method for its motion

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111702809A (en) * 2020-06-27 2020-09-25 上海工程技术大学 Robot track self-checking device and method thereof
CN111702809B (en) * 2020-06-27 2021-10-08 上海工程技术大学 Robot track self-checking device and method thereof
CN114310963A (en) * 2022-01-18 2022-04-12 上海交通大学 Multi-foot skiing robot
CN114310963B (en) * 2022-01-18 2024-02-13 上海交通大学 Skiing multi-legged robot
CN114454189A (en) * 2022-02-11 2022-05-10 成都锦城学院 Bionic inchworm robot for structural member flaw detection
CN114435507A (en) * 2022-03-11 2022-05-06 上海交通大学 Skating multi-foot robot
CN114590338A (en) * 2022-03-11 2022-06-07 上海交通大学 Skating hexapod robot structure
CN114435507B (en) * 2022-03-11 2022-12-27 上海交通大学 Skating multi-foot robot
CN114771680A (en) * 2022-04-12 2022-07-22 上海交通大学 Single-board skiing multi-foot robot

Similar Documents

Publication Publication Date Title
KR100560556B1 (en) Bipedal humanoid
JP3836154B2 (en) Ski simulation equipment
EP0488693B1 (en) System for controlling locomotion of legged walking robot
JP4872115B2 (en) Caster skate equipment
CN100333937C (en) Motion control of a transporter
KR20170033780A (en) The bike simulator
JP5338726B2 (en) Training system, training method and training program
JPH09742A (en) Operation input device for simulator
US20080135312A1 (en) Mobile robot
EP1454719A1 (en) Bipedal moving device; and device and method for controlling walking of the bipedal moving device
EP2343230A1 (en) Robot and control method thereof
JP2011140096A (en) Bipedal walking robot including center of gravity movement device, and center of gravity movement method
JP2005254395A (en) Skiing robot and its controlling method
JP6407409B2 (en) Leg-type mechanism, walking robot, posture control method and program
JP2004009205A (en) Two-foot walking robots
Iverach-Brereton et al. Ice skating humanoid robot
JP2005205510A (en) Constitution of ski robot
JP2010227491A (en) Individual moving implement
JP2005254396A (en) Remote controlling method of skiing robot, remote controlling system of skiing robot, and skiing robot
Varszegi et al. Skateboard: a human controlled non-holonomic system
JP2008126382A (en) Biped mobile robot and its control method
JP4291602B2 (en) Robot walking using passive change of joint angle and its control method
JP2009125838A (en) Biped walking robot and walking control method
JPH114970A (en) Pseudo-bodily sensation device
US20240173612A1 (en) Lean-to-Steer Devices with Active Steering Responses

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20070308

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20080307

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20080321

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100209

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20100824