WO2005081082A1 - 浮遊移動体の制御システム - Google Patents
浮遊移動体の制御システム Download PDFInfo
- Publication number
- WO2005081082A1 WO2005081082A1 PCT/JP2005/003158 JP2005003158W WO2005081082A1 WO 2005081082 A1 WO2005081082 A1 WO 2005081082A1 JP 2005003158 W JP2005003158 W JP 2005003158W WO 2005081082 A1 WO2005081082 A1 WO 2005081082A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- thrust
- main body
- effector
- transmission gate
- floating
- Prior art date
Links
- 238000007667 floating Methods 0.000 title claims abstract description 237
- 239000012636 effector Substances 0.000 claims abstract description 132
- 230000005540 biological transmission Effects 0.000 claims abstract description 123
- 230000001133 acceleration Effects 0.000 claims description 104
- 238000001514 detection method Methods 0.000 claims description 13
- 238000005259 measurement Methods 0.000 claims description 12
- 230000008878 coupling Effects 0.000 abstract 1
- 238000010168 coupling process Methods 0.000 abstract 1
- 238000005859 coupling reaction Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 37
- 239000011159 matrix material Substances 0.000 description 23
- 238000000034 method Methods 0.000 description 23
- 230000033001 locomotion Effects 0.000 description 21
- 230000000694 effects Effects 0.000 description 20
- 239000013598 vector Substances 0.000 description 13
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 13
- 238000006243 chemical reaction Methods 0.000 description 12
- 230000005484 gravity Effects 0.000 description 9
- 239000012530 fluid Substances 0.000 description 7
- 238000012546 transfer Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 6
- 230000007246 mechanism Effects 0.000 description 6
- 230000004044 response Effects 0.000 description 6
- 238000013461 design Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000010354 integration Effects 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 3
- 230000003993 interaction Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000002411 adverse Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000000704 physical effect Effects 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 238000002485 combustion reaction Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 230000001141 propulsive effect Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
- G05D1/0208—Control of position or course in two dimensions specially adapted to water vehicles dynamic anchoring
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Definitions
- the present invention relates to a control system for a floating mobile object in water, air, space, or the like, or a mobile object that slides on a plane.
- FIG. 11 is a schematic view of a conventionally known floating moving object
- FIGS. 11 and 14 are schematic views showing a conventionally known floating moving object control method.
- the main unit in order to control the position and speed of the floating mobile unit 10 including the underwater robot, the main unit is provided with a sensor 13, whereby the floating mobile unit 10 Is detected and given to the subtraction circuit 11 in the computer P.
- the subtraction circuit 11 is also provided with a signal indicating the target position and speed from the operator H.
- the output of the subtraction circuit 11 is supplied to a thruster control circuit 12 for controlling a thruster T serving as a propulsion force generating means (effector) provided in the floating moving body 10, and thus the position and speed of the floating moving body 10 are controlled. (So-called position / speed feedback control).
- FIG. 12 is a block diagram for controlling the floating moving object 10 shown in FIG.
- the effector thrust command signal output from the thruster control circuit 12 is given to a thruster T having a predetermined thrust characteristic 14, whereby the effector thrust is given to the floating moving body 10, and as shown by reference numeral 15,
- the dynamics that is, the input / output characteristics of the dynamics of the floating moving body 10 are obtained, and the position and speed of the main body are detected by the sensor 13 as described above, and given to the subtraction circuit 11.
- the thrust command to the effector is directly operated by feeding back information on the position and speed of the floating moving object to be controlled.
- the response speed of the effector is relatively slow, from issuing a command to the effector until the effect is reflected on the position and speed of the floating moving object and acquired by the sensor Time-consuming and adversely affect control performance (The so-called sensing delay problem). This tendency is more remarkable as the mass of the floating mobile unit is larger and the thrust of the effector is smaller.
- a floating mobile object in a fluid such as underwater or in the air is always affected by hydrodynamic disturbances such as waves, tidal currents, winds, etc.
- An umbilical cable C (feeding line, communication line, etc.) from the water is connected to the cable, and this cable often pulls the floating mobile unit 10.
- FIG. 11 when a floating arm 10 is further provided with a robot arm A having a plurality of links, a block diagram as illustrated in FIG. 13 is configured. become.
- the reaction force and torque by the robot arm A are added to the effector thrust by the thruster T, as exemplified by the addition circuit 17. Therefore, the movement, that is, the position and speed of the floating mobile unit 10 is disturbed by the reaction force and the torque from the robot arm A, and the position of the floating mobile unit 10 generated by the reaction force and the torque from the robot arm A is disturbed.
- the thruster T is controlled to correct the speed error.
- the conventional position control corrects the resulting position and speed errors. Activate the thruster T so that
- the thruster T is actuated after the floating moving object 10 is moved by the reaction force and the torque of the robot arm A, and the response speed to the disturbance is low.
- the problem of so-called sensing delay was not solved.
- FIG. 14 shows a block diagram of another prior art.
- This control method considers the mutual interference between the movement of the mouth bot arm A and the movement of the floating mobile unit 10, and determines the effector thrust and the robot arm joint torque at once so that each movement matches the purpose. It is a technique to determine.
- the floating moving body 10 equipped with the robot arm A is used as a multi-body link system, and the effect of the equation of motion
- the joint torque of each robot arm on the movement of the floating moving body 10 is mathematically expressed.
- the propulsive force of the main body 10 is determined by solving the equation (V, so-called model best control).
- V so-called model best control
- the thruster's thruster thrust command signal from the robot arm control circuit 18 is given to the thruster T, and the torque command signal for the robot arm A is given to the joint actuator 19.
- the combined dynamics 20 of the floating mobile unit 10 and the robot arm A is formed by the effector thrust output from the thruster T and the joint torque by the joint actuator 19, and the sensor 13 detects the position and speed of the floating mobile unit 10 body. Is detected and supplied to a subtractor 11, which receives a signal indicating a target position and orientation of the main body of the floating moving object 10.
- the robot arm control variables from the complex dynamics 20, that is, signals representing the position, posture, joint angle, speed, hand reaction force, etc., are given to a subtraction circuit 21. Is given.
- the outputs of the subtracters 11 and 21 are supplied to a thruster's robot arm control circuit 18.
- the thruster is actuated before the floating mobile body moves due to disturbance by the manipulator to cancel the influence on the floating mobile body, This makes it possible to prevent the floating mobile body from moving due to disturbances caused by the manipulator.
- a thruster used as an effector for controlling the position of a floating moving object and a speed generates thrust using a fluid, and therefore, an input command to the thruster and a thrust actually output are used.
- ⁇ there is a wide range of factors that constitute such nonlinearity, and it has been difficult in the past to perform control that takes all of them into account ( ⁇ ⁇ However, according to the thrust-port-one-car feedback control according to Non-Patent Document 1, the control performance of the floating moving object caused by the nonlinearity of the effector dynamic characteristics is prevented. It was possible to do.
- Patent Literature 1 and Non-Patent Literature 1 both measure a part of the force and feed back the force, it is the largest disturbance to the floating moving object. It did not cancel out the effects of waves, tides, winds, etc.
- inertial navigation is widely used as a conventionally known method for navigating a floating moving object.
- this inertial navigation has the following problems.
- inertial navigation uses acceleration for which the floating mobile force is also required.If the floating mobile body itself is heavy and heavy, the acceleration is converted into a displacement and the acceleration is converted into a displacement. Due to the structure of a conventionally known acceleration sensor that outputs a value as an electric signal, it is not possible to accurately detect a small change in acceleration, and a significant error occurs between the acceleration value obtained by the sensor force and the actual acceleration value. There was a problem. Such an error in the acceleration value significantly affects the accuracy of the inertial navigation itself, and causes a disadvantage that the floating moving object cannot be accurately guided on a desired trajectory.
- Patent Document 1 Japanese Patent Application Laid-Open No. 5-119837
- Non-Patent Document 1 Kanaoka, Nakayama, Hayashi, Kawamura, "Thruster Thrust Local Feedback Control for Realizing High-Precision Motion in Water", Proc. Of the JSME Robotics 'Mechatronics Seminar' 03, 2P1— 2F- A6, 2003
- the present invention makes it possible to accurately stop the floating moving body at a predetermined position or to move the floating moving body to a target trajectory even under a disturbance such as a wave, a tide, a wind, or a reaction of a robot arm attached to the floating moving body.
- An object of the present invention is to provide a control system for a floating moving object that can be made to follow with high accuracy.
- the present invention can accurately detect the acceleration of the floating moving object up to a minute change in acceleration without depending on the size and weight of the floating moving object or the performance of the acceleration sensor. It is an object to provide an acceleration detection system for a floating moving object.
- the inventor can regard the floating mobile as a single rigid body that occupies a part of the floating mobile. Separated into the main body and the effector that generates thrust to the floating mobile unit, and a force torque sensor is installed at the only part (thrust transmission gate) that dynamically couples the main body and the effector. Since the value sensed by this force / torque sensor is the thrust applied to the main unit from the effector, all the forces and torques applied between the main unit and the effector are measured. If this value is fed back, the thrust applied to the floating mobile object can be directly controlled, so that the floating mobile object can be accurately stopped at a predetermined position even under hydrodynamic disturbances such as waves and tidal currents. And found that it is possible to accurately follow the target trajectory, and completed the present invention.
- a control system for a floating mobile object capable of solving the above-mentioned problems is: (1) A control system for a floating mobile object, wherein the floating mobile object occupies a part of the floating mobile object.
- a main body that can be regarded as a rigid body, an effector that generates a thrust on the floating moving body, and a part that mechanically couples the main body and the effector.
- a thrust transmission gate configured to measure the thrust acting on the main body, and a thrust command for the effector unit is obtained using a measured thrust from the thrust transmission gate. It is a feature.
- the main body includes acceleration measuring means capable of measuring an acceleration of the main body
- the thrust transmission gate includes: A force or torque measuring means capable of measuring a force or torque applied between the main body and the effector section.
- control system and the acceleration detection system of the present invention are applied to a floating moving object that slides on a slope, in addition to a floating moving object that floats in a three-dimensional space, which will be described in each of the embodiments and examples described later. In this case, it is necessary to compensate for the effects of gravitational acceleration.
- a tilt angle measuring means capable of measuring the tilt of the main body is provided Is needed.
- the tilt angle measuring means is unnecessary as specified in the invention according to (3) described below or (7) below.
- the present invention further provides the above-described floating mobile object control system, wherein (3) the thrust transmission gate is capable of measuring a force or torque applied between the main body portion and the effector portion.
- the main body is mechanically coupled only to the thrust transmission gate, and substantially all of the forces acting on the main body are connected to the effector unit and the thrust transmission gate.
- a target acceleration trajectory command obtained by converting a target position / velocity trajectory command of the operator, and an output from the force or torque measurement means from the thrust transmission gate.
- a thrust command for the effector unit is obtained.
- the typical configuration is such that the main body is mechanically coupled only to the thrust transmission gate, and substantially all the forces acting on the main body are input via the effector section and the thrust transmission gate.
- the effector section may form a shell surrounding the main body section.
- the main body is necessarily sealed with an effector that forms a shell.
- the main unit is configured so that disturbance such as water pressure or strong wind pressure or other external force is not applied directly. For example, floating movement that slides on water or on the ground The degree to which air comes into contact with the main body housed inside the body is a level that can be ignored sufficiently, and is not a particular problem in applying the invention according to (3).
- the main body further includes an inclination angle measuring means capable of measuring an inclination of the main body.
- the thrust command for the effector section is obtained by further utilizing the output from the inclination angle measuring means of the main body section.
- the present invention provides (5) a control system for a floating mobile object, wherein the floating mobile object occupies a part of the floating mobile object in calculation and can be regarded as a single rigid body. And an effector unit that generates a thrust to the floating moving object, virtually separated from the floating moving object, and the floating moving object includes acceleration measuring means that can measure the acceleration of the floating moving object,
- the present invention is characterized in that a force or torque from a virtual thrust transmission gate is estimated by calculation using an output from the acceleration measuring means, and a thrust command for the effector section is obtained.
- the floating mobile object further includes an inclination angle measuring means capable of measuring an inclination of the floating mobile object, A thrust command for the virtual thrust transmission gate obtained by calculating the force or torque from the virtual thrust transmission gate using the outputs from the inclination angle measuring means and the acceleration measuring means. It is.
- the control of the floating mobile object is performed by calculating the thrust to be received from the thrust transmission gate by the main body unit in order to achieve the target trajectory.
- the thrust planning unit that performs the thrust control, and the current value of the thrust at the thrust transmission gate is fed back to the effector unit and sent to the thrust transmission gate to directly drive the effector unit to achieve the commanded thrust. Is performed in a two-stage configuration.
- the above mechanism design and control method are collectively referred to as a “thrust transmission gate system”.
- a state in which the main body is exposed to the outside that is, a configuration in which disturbance or other external force such as water pressure or strong wind pressure can be exerted directly on the main body, and further provided with a thrust transmission gate (first embodiment, See the first example],
- ii) A thrust transmission gate is provided, and the main body is mechanically connected only to the thrust transmission gate so that disturbance such as water pressure or strong wind pressure or other external force is not directly applied to the main body.
- a configuration in which substantially all of the forces acting on the parts are input via the effector unit and the thrust transmission gate (for example, the main unit is covered with the effector unit and hermetically sealed) Form, see second example]
- the floating mobile unit is separated into the main unit and the effector unit for calculation, and the inertia matrix of the main unit is prepared in advance in the computer, and the floating mobile unit is used.
- a mode in which the thrust command for the effector unit is obtained using the output of the acceleration sensor provided on the body and, if necessary, the output of the tilt angle sensor provided on the floating moving body [virtual thrust transmission Gate, see the following first embodiment and third example].
- the control performance is lower than in the methods i) and ii) .
- Acceleration sensors that do not require a change in the hardware design of the force-floating vehicle, and, if necessary, an inclination sensor,
- the thrust transmission gate system can be used simply by adding a to the existing floating vehicle, and control performance can be improved.
- known inertial navigation devices currently installed in aircraft and the like can also be used as the acceleration sensor, tilt angle sensor, body position / speed sensor used in the present invention. Even without modification, it is possible to achieve higher speed and higher accuracy than existing control.
- the present invention relates to (7) a system for detecting acceleration of a floating moving object, wherein the floating moving object occupies a part of the floating moving object and can be regarded as a single rigid body. And an effector section that generates a thrust to the floating moving body; and a section that mechanically couples the main body section and the effector section, and a thrust acting on the main body section from the effector section.
- a thrust transmission gate configured to enable actual measurement, wherein the thrust transmission gate includes a force or torque measuring means capable of measuring a force or torque applied between the main body portion and the effector portion.
- the main body is mechanically connected only to the thrust transmission gate. , And substantially all the forces acting on the main body are input through the effector section and the thrust transmission gate, and the force or torque from the thrust transmission gate is provided.
- An estimated value of the acceleration of the main body is obtained by using an output from the measuring means.
- the main body further includes an inclination angle measuring means capable of measuring an inclination of the main body.
- the estimated value of the acceleration is obtained by further using the output from the inclination angle measuring means of the main body.
- the floating moving body can be accurately stopped at a predetermined position, Alternatively, it is possible to accurately follow the target trajectory, and it is possible to provide a system configuration capable of controlling the floating moving object at high speed and with high accuracy.
- Floating moving objects refer to various moving objects that float in water, in the air, in outer space, and the like.
- moving objects that slide on a plane or on rails are also included in the concept of floating moving objects.
- Space Space robots, spacecraft, satellites, etc.
- Aerial Aerial robots, aircraft, helicopters, airships, etc.
- the above-mentioned ground vehicle is provided with some different thrust transmitting means (thrusters of various types). Will be understood from the respective descriptions.
- Main body refers to a physical structure that occupies a part of a floating moving object and can be regarded as a single rigid body. In principle, there should be no mechanically movable parts in the main body. Even if there is a mechanically movable part, it is sufficient if its effect is negligibly small. Even if it is not negligible, it can be canceled if its effect can be predicted.
- the main body portion and the effector portion are performed merely for convenience. It is up to the user to decide which part is the main part. Therefore, in actually carrying out the invention corresponding to the first embodiment and the third example described later, the main body may be defined as occupying a major part of the mass of the floating moving object, and conversely. In addition, it is also possible to define an object (for example, a weight of about several kg) additionally installed in a part of the floating moving object as the main body.
- an object for example, a weight of about several kg
- both of the criteria for distinguishing the main body portion from the effector portion are different. It is only the presence or absence of the force coupled by the thrust transmission gate described below, and if satisfied, there is no particular limitation on the proportion of the main body in the floating moving object.
- the main body is not limited to a physical structure composed of a single rigid body that occupies a major part of the mass of the floating moving body.
- Effect unit refers to a physical structure that generates thrust on a floating moving object. It shall include all the propulsion force generating means (effectors) for controlling the position and speed of the floating moving object.
- Mechanismally coupled refers to a state in which some force interaction is acting between the target objects. Most of the cases are mechanically connected, but even if they are not mechanically connected, they include a state in which non-contact force interaction is exerted by, for example, electromagnetic force. On the other hand, “mechanically separated” refers to a state in which the interaction of forces between target objects is inactive.
- the "thrust transmission gate” is the only part that mechanically couples the main unit and the effector unit, and a sensor that can measure all the force and torque applied between the main unit and the effector unit. This means that all the thrusts acting on the effector force main body can be measured by providing it.
- a “virtual thrust transmission gate” is a thrust transmission gate that is not physically present in the floating moving object but is virtually provided, and is separated into a main body portion and an effector portion for convenience of calculation. Based on the measured acceleration of the main unit, the existing floating mobile unit is configured so that the force and torque applied between the main unit and the effector unit, that is, the effector unit force can also estimate all thrusts acting on the main unit. Say something.
- thrust transmission gate simply includes “virtual thrust transmission gate” unless otherwise specified.
- the "estimated thrust value at the virtual thrust transmission gate” refers to a physically existing thrust transmission gate! And to a virtual thrust transmission gate that is not the actual measured value! This means a virtual value obtained by calculation from the measured value of the acceleration sensor (measured value of the main body acceleration).
- the "thrust planning unit” is a computer which instructs the thrust control unit to calculate the target thrust to be received by the main unit and the effector unit force in order to achieve the target trajectory, and instructs the thrust control unit. A part or function.
- the "thrust control unit” outputs a thrust measurement value or an estimated thrust value at the thrust transmission gate and outputs a thrust command to the effector so as to achieve a desired target thrust at the thrust transmission gate.
- a part or function on a computer is a part or function on a computer.
- target thrust refers to a thrust that the main body portion should receive the effector portion force from the thrust transmission gate in order to achieve the target trajectory.
- Target acceleration refers to an acceleration obtained by a differential operation from a desired target trajectory or target speed.
- a “thrust transfer gate system (TTGS)" is a system in which a floating mobile body equipped with a thrust transfer gate is controlled by a control system including a thrust planning unit and a thrust control unit. Refers to the control system that is controlled.
- effector thrust characteristics refer to a relationship between an effector thrust command input to an effector such as a thruster and an effector thrust actually output.
- effector thrust characteristics include not only the mechanical dynamics of the effector itself, but also the effects of anti-force and lift in fluid dynamics. It is assumed that complex dynamics are involved.
- the thrust of the thruster is controlled by feeding back the sensor information of the position and speed of the floating moving object.
- the thrust of the effector is controlled by directly feeding back the generated thrust. A fast response is realized. Therefore, the problem of the sensing delay is reduced.
- the thrust transmission gate is configured as hardware (see the first and second examples of the first embodiment), the sensing delay can be obtained even if the mass of the floating mobile unit is large or the thrust of the effector is small. Does not increase.
- the thrust of the effector is controlled by feeding back the thrust at the thrust transmission gate in the thrust control unit.
- the nonlinearity of the effect dynamics can be reduced by applying an existing control method that is robust against nonlinearity (such as sliding mode control) to the thrust controller. It is possible to suppress the pressure and to prevent adverse effects on the control performance.
- the linearization of the effector dynamic characteristic has been performed by feedforward compensation based on the dynamic characteristic model of the effector, but it requires a great deal of labor and calculation load.
- the control system since the linear motion is realized by the thrust feed knock that does not necessarily use the dynamic characteristic model, the control system can be constructed with a small calculation load.
- the thruster can be given a truly necessary thrust in a timely manner, so that the thruster and the floating moving body are not given unnecessary movement.
- the floating mobile body does not consume wasteful thruster driving energy, the effect of reducing the energy consumption of the floating mobile body can be obtained.
- the influence of an unknown disturbance is immediately sensed as an error of the thrust at the thrust transmission gate in the control system of the floating moving object of the present invention, and is compensated by the local feedback control of the thrust control unit.
- the thrust planning unit can automatically compensate for the effects of disturbances by simply giving instructions such as "Stand still” and "Go straight", and can achieve the desired operation planned in advance. It is. Further, a high-speed response is realized as compared with a conventional case where the influence of disturbance is sensed by a position-speed error.
- the acceleration detection system for a floating moving object of the present invention the inertia matrix of the main body, which has been identified in advance, the output of the force 'torque sensor force from the thrust transmission gate, and Accordingly, the estimated acceleration value of the main body can be obtained using the output of the inclination angle sensor force of the main body, so that it does not depend on the weight or size of the floating moving object or depends on the performance of the acceleration sensor. Acceleration of a floating mobile object can be detected with high accuracy up to a small change in acceleration, and when the floating mobile object is guided using inertial navigation, the floating mobile object is accurately guided on a desired orbit. It becomes possible.
- FIG. 1 is a schematic diagram showing an example of a floating moving object to which a control system according to the present invention is applied.
- FIG. 2 is a block diagram showing a configuration example of a control system according to the present invention.
- FIG. 3 is a schematic diagram showing another example of a floating moving object to which the control system of the present invention is applied.
- FIG. 4 is a block diagram showing another configuration example of the control system of the present invention.
- FIG. 5 is a schematic view showing another example of a floating moving object to which the control system of the present invention is applied.
- FIG. 6 is a block diagram showing another configuration example of the control system of the present invention.
- FIG. 7 is a block diagram showing a second embodiment of the control system of the present invention.
- FIG. 8 is a block diagram showing one embodiment of a control system of the present invention.
- FIG. 9 is a block diagram showing another embodiment of the control system of the present invention.
- FIG. 10 is a block diagram showing another embodiment of the control system of the present invention.
- FIG. 11 is a diagram showing an outline of a conventionally known floating moving object.
- FIG. 12 is a block diagram showing a control system of a conventionally known floating moving object.
- FIG. 13 is another block diagram showing a control system of a conventionally known floating moving object.
- FIG. 14 is another block diagram showing a control system of a conventionally known floating moving object. Explanation of symbols
- Underwater robots are nothing but floating mobile bodies that float in a three-dimensional space.
- a force S is required to have a tilt angle measuring means capable of measuring the tilt of the main body.
- the invention according to the above (2) or (3), which further comprises an inclination angle measuring means, which is the invention according to the above (4), is described in the first or second example of the first embodiment, respectively, and This corresponds to the first embodiment or the second embodiment.
- the invention according to (6) above corresponds to the third example of the first embodiment and Example 3 described later.
- the application target is not limited to the underwater robot, too, from the above-mentioned definition column and the description in the examples described later.
- the underwater robot is not limited to the typical example used for deep sea exploration etc. shown in the figure, but a relatively small one that can also be used for rescue and oil field search etc. Included in the category.
- FIG. 1 is a schematic diagram showing an example of a floating moving object to which the control system of the present invention is applied
- FIG. 2 is a block diagram showing an example of a configuration of the control system of the present invention
- FIGS. 3 and 5 are schematic diagrams showing another example of the floating moving object to which the control system of the present invention is applied
- FIGS. 4 and 6 are block diagrams showing another configuration example of the control system of the present invention.
- FIG. 7 is a block diagram showing a second embodiment of the control system of the present invention.
- thin solid lines connecting the respective blocks represent signals.
- a double line connecting each block in the floating mobile object 10 represents a phenomenon (a dynamic conversion action or the like) occurring in the floating mobile object 10 as a physical action.
- the reference coordinate system fixed to the absolute position of the inertial system is denoted by ⁇
- the origin is located at the center of gravity of the floating mobile body
- the floating mobile body is
- the body coordinate system fixed to the body is defined as ⁇ .
- the columns are expressed in terms of the body coordinate system output. Furthermore, the floating moving object is in m-dimensional space (
- FIGS. Fig. 1 is a schematic diagram of a floating vehicle
- Fig. 2 is a block diagram of a control system.
- the floating moving body 10 is mechanically separated into a main body B and an effector E, and a thrust transmission gate G is provided as hardware between the main body B and the effector E.
- the main part B is provided with an acceleration sensor 2 and an inclination angle sensor 3, and the thrust transmission gate G is provided with a force / torque sensor.
- the main body B and the thrust transmission gate G are exposed to the outside like the effector E.
- the equation of motion representing the physical dynamics of a floating moving object can be generally written as the following equation.
- Equation (1) is the equation representing the main body and equation (2) is the equation representing the effector.
- the definition of each variable is as follows: ⁇ ⁇ ( ⁇ ) 6 ⁇ : Center of gravity)
- JOB eS mXm Jacobian matrix that performs ⁇ to main body speed or thrust can gate speed
- Thrust transfer from the floating moving body effector (not shown in the other terms of equation (2)), which is generated by the thrust can (the inertial force of the effector, the external force due to the wind of the wind wave, etc.)
- the thrust transmission gate system 1 of the present example has a structure in which the thrust transmission gate G is fixed on a single rigid structure of the main body B.
- the Jacobi matrix and the inertia matrix M are constant matrices.
- the target thrust u (t) at the thrust transmission gate G required to achieve the target acceleration a (t) of the main part B
- u (t) [m-dimensional vector] is the target value of gate thrust u (t), u (t) [m-dimensional vector
- a feedback control system with little delay that controls thrust by feedback can be constructed.
- the effector dynamic characteristics such as the effector thrust characteristics, the disturbance to the effector unit, and the dynamic force f (t), which are indicated by reference numeral E1 in the effector unit E in FIG.
- the thrust control unit P3 can be constructed as follows.
- the thrust command u (t) to the effective effector is determined as follows.
- Thrust that can be used as the ⁇ th component of the effect contribution
- the minimum thrust at the age of job is the i-th component of female difficulty
- the values required for feedback to the thrust planning unit and the thrust control unit are u (and
- the value measured by the sensor is used as it is.
- the measured value a (t) [m-dimensional vector] of the acceleration obtained by the main body acceleration sensor indicated by reference numeral 2 in the main body B of FIG. 2 is given as follows. This measurement
- the constant value includes the gravitational acceleration, it is used as the estimated value of the body acceleration a (t).
- G (s) is a transfer function matrix of m rows and m columns representing the characteristics of the main body tilt angle sensor.
- a gate thrust measurement value u (t) [m-dimensional vector
- G (s) is the force of the thrust transmission gate ', which represents the characteristic of the torque sensor.
- the estimated value "a (t) of the main body acceleration a (t) is determined as the following equation.
- This equation (9) is subjected to Laplace transform and the above equations (6) and (7) are substituted.
- G (s) is a transfer function representing the same sensor characteristics
- I is a unit matrix.
- equation (9) ′ is
- Equation (8) can be used to estimate the main body acceleration a (t)! Equation (14)
- the main body acceleration a (t) is directly measured.
- the condition for matching the sensor characteristics is realized by selecting a sensor that has a sufficiently high-speed response and high accuracy compared to, for example, the dynamics of a floating moving object.
- FIG. 3 is a schematic diagram of a floating vehicle
- Figure 4 is a block diagram of a control system.
- the floating moving body 10 is mechanically separated into a main part B and an effector E, and a thrust transmission gate G is provided as hardware between the main part B and the effector E. It has been.
- the body B has an inclination sensor 3 and the thrust transmission gate G has a force / torque sensor. Provided.
- the effector section E is a shell (pressure-resistant shell S shown in Fig. 3) that covers the main body B, and the main body B and the thrust transmission gate G are connected to this shell S Is completely isolated from the outside world.
- This structure eliminates the need for the acceleration sensor 2 of the main part B that was required in the first example!
- the inertia matrix M of the main body and J, J As in the first example, the inertia matrix M of the main body and J, J, J
- the equation of motion representing the physical dynamics of a floating moving object can be generally written as the following equation.
- Equation (15) is an equation representing the main body
- Equation (16) is an equation representing the effector section.
- G2 dimensional vector is defined as follows.
- the target thrust u (t) at the thrust transmission gate G required to achieve the target acceleration a (t) of the main part B
- Bd G2d is determined by the following equation.
- the thrust control unit P3 can be constructed as follows.
- the thrust command u (t) to the effective effector is determined as follows.
- u (t) [m-dimensional vector] is an estimated value of u (t).
- the feedback to the thrust planning unit P2 is not necessary, and the value required for the feedback to the thrust control unit P3 is the estimated value of u (t) in equation (17), “u (t) Only
- Equation (22) The gate thrust u (t) can be estimated by equation (21). Equation (22)
- Fig. 5 is a schematic diagram of a floating vehicle
- Fig. 6 is a block diagram of a control system.
- the floating moving body 10 is not mechanically separated into the main body B and the effector E, and the thrust transmission gate G is not provided as hardware.
- the floating moving object 10 of this example is provided with the acceleration sensor 2 and the inclination angle sensor 3.
- the inertia matrix M of the main part B is appropriately determined, and based on this M, the total
- the thrust transmission gate system is constructed as if there is a thrust transmission gate.
- J and J expressing the geometric structure of the floating moving object 10, the first
- the matrix is measured in advance and given as a known matrix.
- the inertia matrix M of the main body B is determined, for example, when designing the floating mobile object 10. Design, main specifications, and other forces.
- the equation of motion representing the physical dynamics of a floating moving object can be generally written as the following equation.
- Equation (23) is an equation representing the main body
- equation (24) is an equation representing the effector section. This is almost the same as the case of the second example, but in this third example, since the thrust transmission gate does not physically exist, the thrust u [m-dimensional vector] of the thrust transmission gate is a virtual value. It was noticed!
- the thrust control unit P3 can be constructed as follows.
- the thrust command u (t) to the effective effector is determined as follows. [0104] [Number 17]
- 'u (t) [m-dimensional vector] is an estimated value of u (t).
- the feedback to the thrust planning unit P2 is not required.
- the value required for the feedback to the thrust control unit P3 is the estimated value of u (t) “u (t
- the estimated value "u (t) of the gate thrust u (t) is determined as follows.
- a floating mobile object acceleration detection system Similar to the first embodiment, the present embodiment will be described below with an application target being an underwater robot.
- the underwater robot is nothing but a floating moving object that floats in a three-dimensional space, and when the acceleration detection system of the present invention is applied to this underwater robot, it compensates for the effects of gravitational acceleration, as in the first embodiment. Because of the necessity, it is necessary to provide a tilt angle measuring means that can measure the tilt of the main body, as defined as the invention according to the above (8).
- the main body acceleration is estimated using the thrust transmission gate.
- the configuration of the acceleration detection system according to the present embodiment is as shown in FIGS.
- FIG. 3 is a schematic diagram of a floating moving object
- FIG. 7 is a block diagram of an acceleration detection system.
- a thrust transmission gate system is constructed as the control system 1 of the floating mobile object 10, whereas in the second embodiment, the high precision of the floating mobile object 10 is achieved.
- Thrust transmission gate G is used as an acceleration sensing system.
- the hardware configuration of the present embodiment is exactly the same as the second example (FIG. 3) according to the first embodiment. That is, the floating moving body 10 is mechanically separated into a main body B and an effector E, and the main body B is provided with the inclination angle sensor 3 and the thrust transmission gate G is provided with a force / torque sensor. I have.
- the purpose is to estimate the main body acceleration a (t) with high accuracy.
- the thrust planning unit and the thrust control unit are not included in the present embodiment because they are not intended for control.
- the inertia matrix M of the main body and the J that expresses the geometric structure of It is assumed that the force is measured and given as a known constant matrix.
- This main body inertia matrix M is detected in the present embodiment by the measurement range of the force / torque sensor of the thrust transmission gate.
- Accurate acceleration measurement can be performed by properly designing in consideration of the power acceleration range.
- the estimated value "a (t) of the main body acceleration a (t) is determined by the following equation.
- the thrust control is performed in the control system of the floating moving object according to the present invention, and therefore, strictly, not the position / velocity trajectory but the acceleration trajectory is realized.
- the influence of the drift caused by the integration error of the acceleration is inevitable, and therefore, the present invention exerts a remarkable effect alone on the motion in a relatively high frequency band.
- the conventional control method for feedback of position and speed.However, even in this case, accuracy can be improved compared to using the conventional method alone. It is possible.
- FIG. 8 is a block diagram showing an example of the control system of the present invention, which corresponds to the first example of the first embodiment
- FIG. 9 is another block diagram of the control system of the present invention
- FIG. 10 is a block diagram showing an example and corresponds to the second example of the first embodiment
- FIG. 10 is a block diagram showing another example of the control system according to the present invention, which is a second example of the first embodiment. This is equivalent to three cases.
- FIGS. 8 to 10 the same components as those in FIGS. 17 and 11 to 14 described above are denoted by the same reference numerals and described.
- the thin solid lines connecting the blocks in FIGS. 8-10 represent signals.
- a double line connecting each block in the floating mobile object 10 represents a phenomenon (a dynamic conversion action or the like) occurring in the floating mobile object 10 as a physical action.
- Example 1 corresponds to the first embodiment and the first example.
- FIG. 8 shows a block diagram of the control system 1 according to the present embodiment. The schematic configuration of the floating moving object 10 of this embodiment is As shown in FIG.
- this embodiment is obtained by applying the configuration shown in FIG. 2 described in the first example of the first embodiment to a conventionally known position / speed feedback control system. is there. Therefore, the configuration of the thrust transmission gate system and the operation of the control system according to the present invention will be described with reference to FIGS.
- the control system 1 that is, the thrust transmission gate system, includes a mechanism of a floating moving object indicated by reference numeral 10 and a main body part B receiving thrust, an effector part E generating thrust, and a mechanical mechanism.
- the main feature of this is that a thrust transmission gate G is added to the joint part after the separation.
- the thrust transmission gate G is the only part that connects the main part B and the effector part E, and a sensor (force ') that can measure all the force and torque applied between the main part B and the effector part E Torque sensor).
- the force / torque sensor general-purpose products sold on the market (such as multi-channel products capable of outputting multidimensional force and torque components) can be used.
- the main unit B and the effector unit E are connected by the thrust transmission gate G, so that all the thrust acting on the main unit B from the effector unit E can be measured.
- a main body B is provided with an acceleration sensor 2 and an inclination angle sensor 3.
- the thrust feedback control by the thrust transmission gate system of the present invention is performed simultaneously with the conventionally known position / velocity feedback control.
- the control system of the present invention that is, the thrust transmission gate
- the thrust transmission gate can be used while avoiding the influence of the drift caused by the integration error of the caro speed by using the conventional position / speed feedback control method.
- the floating mobile body can be accurately stopped at a predetermined position even if it is under disturbance due to waves, tides, wind, or recoil of a robot arm attached to the floating mobile body, or a target trajectory can be obtained. Since it is possible to accurately follow a moving object, it becomes possible to control a floating moving object at higher speed and with higher accuracy.
- FIG. 9 shows a block diagram of the control system 1 according to the present embodiment.
- the schematic configuration of the floating moving object 10 of the present embodiment is This is as shown in FIG.
- control system 1 also dynamically separates the mechanism of the underwater robot 10 into a main body part B that receives thrust and an effector part E that generates thrust, and further connects the joint part.
- the main feature of this is the addition of a thrust transmission gate G to the vehicle.
- the main unit B is housed inside the effector unit E, and any external disturbance or reaction of the robot arm A is applied to the effector unit E, which is the pressure shell S.
- the main part B is carried only through the thrust transmission gate G inside the effector part E. Therefore, the thrust transmission gate G is the same as the first embodiment in that it is the only part that connects the main body B and the effector E. Therefore, in this embodiment, even when the main unit B and the effector unit E are connected by the thrust transmission gate G, all the thrusts acting on the main unit B from the effector unit E can be measured. Has been done.
- the control system of the present invention that is, the thrust transmission gate system according to the present invention is also used while avoiding the influence of the drift caused by the integration error of the acceleration by using the conventional control method for feeding back the position and speed. Even if the robot is under disturbance due to waves, tides, wind, or recoil of the robot arm attached to the floating mobile object, the floating mobile object can be accurately stopped at a predetermined position, or can follow the target trajectory accurately. The floating mobile object can be controlled at higher speed and with higher accuracy.
- FIG. 10 shows a block diagram of the control system 1 according to the present embodiment.
- the schematic configuration of the floating mobile unit 10 of the present embodiment is as shown in FIG.
- the mechanism of the underwater robot is computationally separated into a main body part B that receives thrust and an effector part E that generates thrust, and a virtual thrust transmission gate G ′ is provided between the two.
- the main feature is that it is provided virtually.
- the conventional control method for feeding back the position and speed is used together.
- the control system of the present invention i.e., the thrust transmission gate system is used, for example, due to waves, tides, wind, or recoil of a robot arm attached to a floating moving body.
- the floating moving object can be accurately stopped at a predetermined position or can follow the target trajectory with high accuracy, so that the floating moving object can be controlled at higher speed and with higher accuracy. It becomes possible.
- the inertial navigation system which is an existing technology, which is widely used for floating moving objects such as aircraft, is to be used as the acceleration sensor, the inclination angle sensor, and the body position / speed sensor used in the present invention. Is possible.
- the hardware according to the third embodiment or the third embodiment of the first embodiment can be applied only by changing the software without adding or changing any hardware. It is possible to implement the control system of the present invention, and therefore, it is possible to more easily realize high-speed and high-precision of the existing floating moving object.
- existing inertial navigation systems use only position and velocity information obtained by integrating the acceleration for control, despite the fact that acceleration is measured with sufficiently high accuracy. It is. However, by using acceleration information that was not used as it is until now for thrust measurement within the framework of the thrust transmission gate system of the present invention, the hardware remains the same as before and the existing control It is also possible to realize higher speed and higher accuracy.
- the above-mentioned inertial navigation system has recently become the mainstream of the hybrid inertial navigation system, which acquires acceleration, speed and displacement information by integrating acceleration sensors, gyros, GPS (Global Positioning System) and other sensors.
- the overall measurement speed has improved. Therefore, the above inertial navigation device can be said to be a suitable sensor unit that can be used when implementing the control system of the present invention.
- control system of the present invention may be a floating vehicle in water, air, space, or the like, such as a submarine, a helicopter, an airship, an aircraft, a spacecraft, or a space robot, as exemplified in the definition section, in addition to the underwater robot.
- control system of the present invention can be applied to various moving objects that slide on a plane, such as a hovercraft that slides on water or on the ground, and a vehicle in which wheels are slipping.
- the control system or the acceleration detection system of the present invention is applied to a floating moving object that floats in a three-dimensional space.
- the present invention is applied to a floating mobile object that floats in outer space where gravity does not work in the first place, or a floating mobile object that slides on a horizontal plane where the inclination does not need to be considered or can be ignored.
- the inclination angle measuring means is not required as defined in the invention according to the above (2), (3), (5) or (7).
- the gravitational acceleration g 0 acting on the main body (center of gravity) of the floating moving object
- the control law of the force thrust control unit P3 using sliding mode control which is an existing control method that is robust against the nonlinearity of the effector dynamic characteristic, is as follows. It is not limited to this. Therefore, for example, as the control law of the thrust control unit P3, it is also possible to apply the thrust measurement at the thrust transmission gate G and the thrust at the thrust transmission gate G or the PID control of the thruster T input voltage for the thrust error of the estimated value. .
- the thruster T is a thrust generating device using a propeller mechanically connected to a motor as a driving source, but the configuration of the thruster T is not limited to this. Therefore, the thruster T may be of a jet injection type, and the drive source thereof is not limited to a motor, but may be of various types such as an internal combustion engine, a steam turbine, and a nuclear turbine.
- the present invention makes it possible to accurately stop a floating moving object at a predetermined position even under a disturbance such as a wave, a tidal current, a wind, or a recoil of a robot arm attached to the floating moving object. Or to accurately follow the target trajectory, It is clear that this is a novel and extremely useful invention that provides a system configuration capable of controlling a floating moving object at high speed and with high accuracy.
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
Claims
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006510324A JP4742329B2 (ja) | 2004-02-25 | 2005-02-25 | 浮遊移動体の制御システム |
EP05710708.8A EP1724653B1 (en) | 2004-02-25 | 2005-02-25 | Control system of floating mobile body |
US10/590,344 US7339339B2 (en) | 2004-02-25 | 2005-02-25 | Control system of floating mobile body |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004050586 | 2004-02-25 | ||
JP2004-050586 | 2004-02-25 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2005081082A1 true WO2005081082A1 (ja) | 2005-09-01 |
Family
ID=34879595
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2005/003158 WO2005081082A1 (ja) | 2004-02-25 | 2005-02-25 | 浮遊移動体の制御システム |
Country Status (5)
Country | Link |
---|---|
US (1) | US7339339B2 (ja) |
EP (1) | EP1724653B1 (ja) |
JP (1) | JP4742329B2 (ja) |
CN (1) | CN100476669C (ja) |
WO (1) | WO2005081082A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101217054B1 (ko) | 2009-09-10 | 2012-12-31 | 호발츠벨케 도이췌 벨프트 게엠베하 | 바다 조건 변수들을 결정하는 방법 |
Families Citing this family (45)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8169169B2 (en) * | 2005-04-13 | 2012-05-01 | Brian Hass | Door operator for controlling a door and method of same |
JP2008073830A (ja) * | 2006-09-25 | 2008-04-03 | Fanuc Ltd | ロボット制御装置 |
JP5090045B2 (ja) * | 2007-04-03 | 2012-12-05 | テルモ株式会社 | マニピュレータ及びその制御方法 |
US7658694B2 (en) * | 2007-04-30 | 2010-02-09 | Nike, Inc. | Adaptive training system |
NL1035322C2 (nl) * | 2008-04-21 | 2009-10-22 | Us Of Entertainment B V | Systeem en werkwijze voor uitvoeren van een show. |
KR20100028376A (ko) * | 2008-09-04 | 2010-03-12 | 전남대학교산학협력단 | 자이로 모멘텀을 이용한 수중로봇 |
US8215252B1 (en) * | 2009-07-14 | 2012-07-10 | Lockheed Martin Corporation | System and method for dynamic stabilization and navigation in high sea states |
US9566710B2 (en) | 2011-06-02 | 2017-02-14 | Brain Corporation | Apparatus and methods for operating robotic devices using selective state space training |
JP5907678B2 (ja) * | 2011-07-20 | 2016-04-26 | オリンパス株式会社 | 医療用動作機構およびマニピュレータ |
JP5399593B2 (ja) * | 2011-11-10 | 2014-01-29 | パナソニック株式会社 | ロボット、ロボットの制御装置、制御方法、及び制御プログラム |
JP6145613B2 (ja) * | 2012-03-16 | 2017-06-14 | 株式会社人機一体 | 浮遊移動体および該浮遊移動体を用いた浮遊移動体システム |
JP5409844B2 (ja) * | 2012-05-30 | 2014-02-05 | 株式会社神戸製鋼所 | 多関節ロボットの軌跡制御装置および制御方法 |
KR101417488B1 (ko) * | 2012-12-17 | 2014-07-08 | 현대자동차주식회사 | 착용로봇의 의도토크 추출방법 및 추출시스템 |
RU2513157C1 (ru) * | 2012-12-24 | 2014-04-20 | Федеральное государственное бюджетное учреждение науки Институт проблем управления им. В.А. Трапезникова Российской академии наук | Способ отказоустойчивого управления движением корабля по глубине |
US9764468B2 (en) | 2013-03-15 | 2017-09-19 | Brain Corporation | Adaptive predictor apparatus and methods |
US9242372B2 (en) | 2013-05-31 | 2016-01-26 | Brain Corporation | Adaptive robotic interface apparatus and methods |
US9792546B2 (en) | 2013-06-14 | 2017-10-17 | Brain Corporation | Hierarchical robotic controller apparatus and methods |
US9384443B2 (en) | 2013-06-14 | 2016-07-05 | Brain Corporation | Robotic training apparatus and methods |
US9314924B1 (en) | 2013-06-14 | 2016-04-19 | Brain Corporation | Predictive robotic controller apparatus and methods |
US9579789B2 (en) | 2013-09-27 | 2017-02-28 | Brain Corporation | Apparatus and methods for training of robotic control arbitration |
US9463571B2 (en) | 2013-11-01 | 2016-10-11 | Brian Corporation | Apparatus and methods for online training of robots |
US9597797B2 (en) | 2013-11-01 | 2017-03-21 | Brain Corporation | Apparatus and methods for haptic training of robots |
US9358685B2 (en) * | 2014-02-03 | 2016-06-07 | Brain Corporation | Apparatus and methods for control of robot actions based on corrective user inputs |
US9346167B2 (en) | 2014-04-29 | 2016-05-24 | Brain Corporation | Trainable convolutional network apparatus and methods for operating a robotic vehicle |
US9630318B2 (en) | 2014-10-02 | 2017-04-25 | Brain Corporation | Feature detection apparatus and methods for training of robotic navigation |
US10029366B2 (en) * | 2014-11-21 | 2018-07-24 | Canon Kabushiki Kaisha | Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device |
US9717387B1 (en) | 2015-02-26 | 2017-08-01 | Brain Corporation | Apparatus and methods for programming and training of robotic household appliances |
US10471594B2 (en) * | 2015-12-01 | 2019-11-12 | Kindred Systems Inc. | Systems, devices, and methods for the distribution and collection of multimodal data associated with robots |
DE102017000063B4 (de) * | 2016-01-14 | 2019-10-31 | Fanuc Corporation | Robotereinrichtung mit Lernfunktion |
US10241514B2 (en) | 2016-05-11 | 2019-03-26 | Brain Corporation | Systems and methods for initializing a robot to autonomously travel a trained route |
US9987752B2 (en) | 2016-06-10 | 2018-06-05 | Brain Corporation | Systems and methods for automatic detection of spills |
US10282849B2 (en) | 2016-06-17 | 2019-05-07 | Brain Corporation | Systems and methods for predictive/reconstructive visual object tracker |
US10016896B2 (en) | 2016-06-30 | 2018-07-10 | Brain Corporation | Systems and methods for robotic behavior around moving bodies |
CN107656530B (zh) * | 2016-07-26 | 2022-04-19 | 深圳华清精密科技有限公司 | 变参数开架式海洋水下机器人的轨迹跟踪控制方法、装置和系统 |
US10274325B2 (en) | 2016-11-01 | 2019-04-30 | Brain Corporation | Systems and methods for robotic mapping |
US10001780B2 (en) | 2016-11-02 | 2018-06-19 | Brain Corporation | Systems and methods for dynamic route planning in autonomous navigation |
US10723018B2 (en) | 2016-11-28 | 2020-07-28 | Brain Corporation | Systems and methods for remote operating and/or monitoring of a robot |
CN106788084B (zh) * | 2016-12-12 | 2019-06-21 | 深圳市优必选科技有限公司 | 运动控制方法及装置、运动轨迹规划方法 |
US10377040B2 (en) | 2017-02-02 | 2019-08-13 | Brain Corporation | Systems and methods for assisting a robotic apparatus |
US10852730B2 (en) | 2017-02-08 | 2020-12-01 | Brain Corporation | Systems and methods for robotic mobile platforms |
US10293485B2 (en) | 2017-03-30 | 2019-05-21 | Brain Corporation | Systems and methods for robotic path planning |
CN107274721B (zh) * | 2017-06-07 | 2020-03-31 | 北京科技大学 | 一种智能交通系统中多车辆协作定位方法 |
CN108062091B (zh) * | 2017-11-14 | 2020-12-11 | 北京臻迪科技股份有限公司 | 浮游移动体的浮潜动力补偿方法、装置及浮游移动体 |
WO2019204324A1 (en) | 2018-04-16 | 2019-10-24 | The Regents Of The University Of California | Linear and angular position stabilization and control of an underwater robotic system |
CN108555911A (zh) * | 2018-04-22 | 2018-09-21 | 北京工业大学 | 基于虚拟推力的遥操作机械臂三维避障方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1035587A (ja) * | 1996-07-26 | 1998-02-10 | Mitsubishi Heavy Ind Ltd | 水中ロボット |
JP2000084016A (ja) * | 1998-09-17 | 2000-03-28 | Hitachi Ltd | 歩行訓練装置 |
JP2000203491A (ja) * | 1999-01-14 | 2000-07-25 | Mitsubishi Electric Corp | 無線中継基地システム |
JP2004098866A (ja) * | 2002-09-10 | 2004-04-02 | Toyota Motor Corp | 飛行装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5406488A (en) * | 1987-05-06 | 1995-04-11 | The Secretary Of State For Defence In Her Britannic Majesty's Government Of The United Kingdom Of Great Britain And Northern Ireland | Correction of errors in autopilots |
JPH0362205A (ja) * | 1989-07-31 | 1991-03-18 | Toshiba Corp | 人工衛星の制御装置 |
JP2929328B2 (ja) * | 1991-07-04 | 1999-08-03 | 川崎重工業株式会社 | 浮遊ロボットの制御装置 |
JPH0717496A (ja) * | 1993-07-07 | 1995-01-20 | Fujitsu Ltd | 人工衛星の姿勢制御方式 |
US6169981B1 (en) * | 1996-06-04 | 2001-01-02 | Paul J. Werbos | 3-brain architecture for an intelligent decision and control system |
-
2005
- 2005-02-25 EP EP05710708.8A patent/EP1724653B1/en active Active
- 2005-02-25 JP JP2006510324A patent/JP4742329B2/ja active Active
- 2005-02-25 CN CNB2005800094794A patent/CN100476669C/zh not_active Expired - Fee Related
- 2005-02-25 WO PCT/JP2005/003158 patent/WO2005081082A1/ja active Application Filing
- 2005-02-25 US US10/590,344 patent/US7339339B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH1035587A (ja) * | 1996-07-26 | 1998-02-10 | Mitsubishi Heavy Ind Ltd | 水中ロボット |
JP2000084016A (ja) * | 1998-09-17 | 2000-03-28 | Hitachi Ltd | 歩行訓練装置 |
JP2000203491A (ja) * | 1999-01-14 | 2000-07-25 | Mitsubishi Electric Corp | 無線中継基地システム |
JP2004098866A (ja) * | 2002-09-10 | 2004-04-02 | Toyota Motor Corp | 飛行装置 |
Non-Patent Citations (1)
Title |
---|
See also references of EP1724653A4 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101217054B1 (ko) | 2009-09-10 | 2012-12-31 | 호발츠벨케 도이췌 벨프트 게엠베하 | 바다 조건 변수들을 결정하는 방법 |
Also Published As
Publication number | Publication date |
---|---|
EP1724653A4 (en) | 2012-05-23 |
CN1934513A (zh) | 2007-03-21 |
EP1724653B1 (en) | 2014-05-07 |
US20070200525A1 (en) | 2007-08-30 |
JPWO2005081082A1 (ja) | 2007-11-22 |
CN100476669C (zh) | 2009-04-08 |
US7339339B2 (en) | 2008-03-04 |
JP4742329B2 (ja) | 2011-08-10 |
EP1724653A1 (en) | 2006-11-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2005081082A1 (ja) | 浮遊移動体の制御システム | |
Brantner et al. | Controlling Ocean One: Human–robot collaboration for deep‐sea manipulation | |
CN107957727B (zh) | 水下机器人控制系统及动力定位方法 | |
Antonelli et al. | A novel adaptive control law for underwater vehicles | |
Antonelli et al. | Tracking control for underwater vehicle-manipulator systems with velocity estimation | |
Caccia et al. | Guidance and control of a reconfigurable unmanned underwater vehicle | |
Sarkar et al. | Coordinated motion planning and control of autonomous underwater vehicle-manipulator systems subject to drag optimization | |
Zhang et al. | NNFFC-adaptive output feedback trajectory tracking control for a surface ship at high speed | |
CN106950974B (zh) | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 | |
Hoang et al. | Adaptive PD-controller for positioning of a remotely operated vehicle close to an underwater structure: Theory and experiments | |
CN101419464B (zh) | 一种采用矢量推进器的无人潜水器定深航行控制方法 | |
CN103942383B (zh) | 一种深海作业型水下机器人的动力学和运动学估计方法 | |
Bagheri et al. | Tracking performance control of a cable communicated underwater vehicle using adaptive neural network controllers | |
JP6806462B2 (ja) | 水中航走体制御装置、水中航走システム、水中航走体制御方法及びプログラム | |
CN112068440B (zh) | 基于模型预测控制的auv回收对接动力定位控制方法 | |
Woolsey et al. | Cross-track control of a slender, underactuated AUV using potential shaping | |
Ismail et al. | A region boundary-based control scheme for an autonomous underwater vehicle | |
Sarda et al. | Development of a USV station-keeping controller | |
Antonelli et al. | External force control for underwater vehicle-manipulator systems | |
Tran et al. | Design, control, and implementation of a new AUV platform with a mass shifter mechanism | |
CN112327892B (zh) | 一种auv误差受限的抗扰控制方法 | |
Wang et al. | Dynamic model-aided localization of underwater autonomous gliders | |
Liu et al. | An improved 3D modeling of water-jet propellers for a spherical underwater robot | |
Tran et al. | The design of an VIAM-USVI000 unmanned surface vehicle for environmental monitoring applications | |
Gao et al. | Analysis and innovation of key technologies for autonomous underwater vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 200580009479.4 Country of ref document: CN |
|
AK | Designated states |
Kind code of ref document: A1 Designated state(s): AE AG AL AM AT AU AZ BA BB BG BR BW BY BZ CA CH CN CO CR CU CZ DE DK DM DZ EC EE EG ES FI GB GD GE GH GM HR HU ID IL IN IS JP KE KG KP KR KZ LC LK LR LS LT LU LV MA MD MG MK MN MW MX MZ NA NI NO NZ OM PG PH PL PT RO RU SC SD SE SG SK SL SY TJ TM TN TR TT TZ UA UG US UZ VC VN YU ZA ZM ZW |
|
AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): GM KE LS MW MZ NA SD SL SZ TZ UG ZM ZW AM AZ BY KG KZ MD RU TJ TM AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LT LU MC NL PL PT RO SE SI SK TR BF BJ CF CG CI CM GA GN GQ GW ML MR NE SN TD TG |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application | ||
DPEN | Request for preliminary examination filed prior to expiration of 19th month from priority date (pct application filed from 20040101) | ||
WWE | Wipo information: entry into national phase |
Ref document number: 10590344 Country of ref document: US Ref document number: 2007200525 Country of ref document: US Ref document number: 2006510324 Country of ref document: JP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2005710708 Country of ref document: EP |
|
WWP | Wipo information: published in national office |
Ref document number: 2005710708 Country of ref document: EP |
|
WWP | Wipo information: published in national office |
Ref document number: 10590344 Country of ref document: US |