WO2019003405A1 - 着陸装置、着陸制御方法、着陸制御プログラム - Google Patents

着陸装置、着陸制御方法、着陸制御プログラム Download PDF

Info

Publication number
WO2019003405A1
WO2019003405A1 PCT/JP2017/024076 JP2017024076W WO2019003405A1 WO 2019003405 A1 WO2019003405 A1 WO 2019003405A1 JP 2017024076 W JP2017024076 W JP 2017024076W WO 2019003405 A1 WO2019003405 A1 WO 2019003405A1
Authority
WO
WIPO (PCT)
Prior art keywords
parachute
control
landing
risk
flight type
Prior art date
Application number
PCT/JP2017/024076
Other languages
English (en)
French (fr)
Inventor
真史 江村
小川　雅嗣
真澄 一圓
Original Assignee
日本電気株式会社
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 日本電気株式会社 filed Critical 日本電気株式会社
Priority to PCT/JP2017/024076 priority Critical patent/WO2019003405A1/ja
Priority to US16/626,705 priority patent/US20210147075A1/en
Priority to JP2019526084A priority patent/JP6838656B2/ja
Publication of WO2019003405A1 publication Critical patent/WO2019003405A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/105—Simultaneous control of position or course in three dimensions specially adapted for aircraft specially adapted for unpowered flight, e.g. glider, parachuting, forced landing
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64C—AEROPLANES; HELICOPTERS
    • B64C39/00—Aircraft not otherwise provided for
    • B64C39/02—Aircraft not otherwise provided for characterised by special use
    • B64C39/024—Aircraft not otherwise provided for characterised by special use of the remote controlled vehicle type, i.e. RPV
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D17/00—Parachutes
    • B64D17/80—Parachutes in association with aircraft, e.g. for braking thereof
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D45/00—Aircraft indicators or protectors not otherwise provided for
    • B64D45/04—Landing aids; Safety measures to prevent collision with earth's surface
    • B64D45/08—Landing aids; Safety measures to prevent collision with earth's surface optical
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D17/00—Parachutes
    • B64D17/22—Load suspension
    • B64D17/34—Load suspension adapted to control direction or rate of descent
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENTS OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D45/00—Aircraft indicators or protectors not otherwise provided for
    • B64D45/04—Landing aids; Safety measures to prevent collision with earth's surface
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U10/00—Type of UAV
    • B64U10/10—Rotorcrafts
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2101/00—UAVs specially adapted for particular uses or applications
    • B64U2101/30—UAVs specially adapted for particular uses or applications for imaging, photography or videography
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U50/00—Propulsion; Power supply
    • B64U50/10—Propulsion
    • B64U50/19—Propulsion using electrically powered motors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U70/00—Launching, take-off or landing arrangements
    • B64U70/80—Vertical take-off or landing, e.g. using rockets
    • B64U70/83—Vertical take-off or landing, e.g. using rockets using parachutes, balloons or the like

Definitions

  • the present invention relates to a landing gear, a landing control method, and a landing control program.
  • Patent Document 1 discloses a technique for deploying a parachute or an air bag when the unmanned air vehicle is equipped with a parachute or an air bag and the flight body becomes incapable of flight. This makes it possible to protect the aircraft and the mounted precision equipment from the impact of a crash.
  • Patent Document 2 discloses a technology for performing emergency landing using an air bag and a parachute when an unmanned helicopter becomes uncontrollable.
  • emergency landing use both according to the altitude of the helicopter. For example, if the height of the helicopter is higher than a predetermined height, both the parachute and the air bag are deployed, and if lower than the predetermined height, only the air bag is deployed. With the above configuration, it is possible to perform appropriate soft landing according to the altitude.
  • Patent Document 3 discloses a technique for providing a parachute with a suspension control cord for parachute, expanding and contracting the suspension control cord, and performing movement control of the parachute during descent.
  • the current value is detected by a descent trajectory sensor, GPS (Global Positioning System) or the like, and the descent trajectory is calculated based on the wind direction, the falling velocity, and the like.
  • the movement of the parachute can be aerodynamically controlled, and the parachute can be moved along the target track and guided to the destination.
  • Patent Document 1 and Patent Document 2 there is a problem that the collision with an obstacle such as a high-rise building or a pedestrian, a car or the like can not be avoided since it becomes uncertain where the landing point will be.
  • Patent Document 3 is a technology for guiding a parachute to a predetermined target point, and it has become possible to avoid dangerous materials which are not anticipated by this technology.
  • the present invention has been made in view of the above problems, and it is an object of the present invention to provide a landing gear for guiding a flight type drone to avoid an obstacle or the like and landing at a low risk point. .
  • the landing gear of this invention has a dangerous material position detection apparatus, a movement target point calculation apparatus, and a parachute control apparatus.
  • the hazardous material position detection device detects the position of the hazardous material present around the flying drone to be landed using a parachute.
  • the movement target point calculation device moves the flying drone every time to avoid collision with the dangerous material and landing on the dangerous place based on the position of the dangerous material acquired by the dangerous material position detection device. Calculate the movement target point to be done.
  • the parachute control device controls the parachute so that the flight type drone moves to the movement target point calculated by the movement target point calculation device.
  • An advantage of the present invention is that it can provide a landing gear for guiding a flight type drone to avoid an obstacle or the like and landing at a low risk point.
  • FIG. 1 is a block diagram showing a landing gear of a first embodiment.
  • the landing gear includes a dangerous substance position detection device 1, a movement target point calculation device 2, and a parachute control device 3.
  • Dangerous goods position detection device 1 detects the position of dangerous goods existing around the flight type drone which it is going to land using a parachute.
  • the movement target point calculation device 2 sometimes uses a flying drone to avoid a collision with a dangerous material and landing on a dangerous place based on the position of the dangerous material acquired by the dangerous material position detection device 1. Calculate the movement target point that should move.
  • the parachute control device 3 controls the parachute so that the flight type unmanned vehicle moves to the movement target point calculated by the movement target point calculation device.
  • FIG. 2 is a block diagram showing a landing gear of a second embodiment. In addition to the configuration of the first embodiment, it has a drop detection device 4 for detecting a drop of a flight type drone and a parachute unfolding device 5 for deploying a parachute for suppressing a drop of the flight type drone.
  • the fall detection device 4 determines that the flight type unmanned vehicle is falling and detects the fall, for example, when the condition that the descent speed becomes equal to or more than a predetermined value is satisfied.
  • the parachute deployment device 5 deploys the parachute when the fall detection device 4 detects a fall.
  • the configurations and operations of the dangerous substance position detection device 1, the movement target point calculation device 2, and the parachute control device 3 are the same as those in the first embodiment.
  • FIG. 3 is a schematic perspective view showing an outline of the landing gear 100 of the third embodiment.
  • the landing gear 100 is mounted on the flight type drone 200.
  • FIG. 3 shows a state in which the drop detection device (not shown) detects the drop of the flight type drone 200 and the parachute 111 is developed with this as a trigger.
  • FIG. 3 exemplifies a multicopter in which the flight type drone 200 flies using a plurality of rotors 210
  • the landing gear 100 of the present embodiment is also applicable to flight type drone with other configurations. It is possible to apply.
  • the landing gear 100 includes a parachute 111 deployed by a parachute deployment device (not shown), a parachute control device 120, a system control device 130, and a camera 140.
  • FIG. 3 shows an example in which the parachute 111 has a square shape.
  • the parachute 111 is connected to the parachute controller 120 by a wire 112.
  • the left and right ends of the parachute 111 are connected to the parachute controller 120 by a pair of control wires 113.
  • the left and right control wires are described as a control wire L_113L and a control wire R_113R.
  • the parachute control device 120 controls the posture and the direction of the parachute 111 by individually adjusting the length and the feeding position of the control wire L_113L and the control wire R_113R. By this control, the posture and the traveling direction of the parachute 111 can be controlled.
  • the camera 140 captures images of the lower and side of the flying drone 200.
  • the camera 140 is, for example, a device that acquires image data in all directions in the downward direction and the lateral direction, and can be configured by, for example, one fisheye camera or a combination of a plurality of cameras. From the lower and side images taken by the camera 140, it is possible to detect the position where the dangerous material position is present.
  • dangerous materials include obstacles such as high-rise buildings, pedestrians, and automobiles.
  • the system control device 130 analyzes the image acquired by the camera 140, and calculates in real time the movement target point for the flight type drone 200 to avoid dangerous materials and safely land. Then, a control signal for controlling the parachute is output to the parachute control device 120 so that the flight type drone moves to the movement target point at each time point.
  • the parachute control device 120 controls the control wire L_113L and the control wire R_113R according to the control signal to control the posture and movement direction of the parachute 111. By this control, the parachute 111 moves toward the target point.
  • FIG. 4 is a block diagram showing the landing gear 100 in detail.
  • the fall detection device 150 detects the fall of the flight type unmanned aircraft 200 to which the landing gear 100 is attached.
  • a three-axis accelerometer 151 is provided.
  • the battery 152 supplies power for operating the drop detection device 150.
  • the fall detection device 150 determines that the downward acceleration output from the three-axis accelerometer 151 and the downward speed calculated based on the fall satisfy a predetermined condition, thereby determining that the falling detection device 150 is falling. Detect 200 drops.
  • the determination condition of the fall can be set as, for example, that the acceleration in the ground direction becomes equal to or more than a predetermined value, or that the downward movement distance (falling speed) per unit time calculated from the acceleration becomes equal to or more than a predetermined value.
  • the drop detection device 150 is always in operation. Then, the fall detection device 150 outputs a signal notifying the fall to the parachute expansion device 110.
  • the parachute unfolding apparatus 110 unfolds the parachute 111 upon receiving the notification of the fall.
  • the drop detection device 150 is separated from the system control device 130 in FIG. 4, the drop detection device 150 may be configured as a part of the system control device 130.
  • the system controller 130 has a descent and landing controller 131.
  • the landing gear 131 is mounted on, for example, a computer or processor.
  • Information from the three-axis accelerometer 132, the three-axis angular velocity meter 133, the ground altimeter 134, and the camera 140 is input to the descent and landing control device 131.
  • the descent and landing control device 131 is supplied with power from the battery 135.
  • the descent and landing control device 131 determines information on surrounding obstacles and a movement target point from the input values from the camera 140 and the measuring instrument described above.
  • a parachute control parameter for making the parachute 111 approach the movement target point is calculated. Then, the control parameter is transmitted to the parachute control device 120.
  • the descent and landing control device 131 operates only when, for example, the drop detection device 150 detects a drop. In addition, since the drop detection device 150 operates at all times, if the descent and landing control device 131 and the battery for driving the drop detection device 150 are separately provided, it is possible to select a battery suitable for each application. It is.
  • FIG. 5 is a detailed block diagram of the parachute control device 120.
  • the parachute control device 120 has a wire control device 121, and two control systems for controlling the left and right control wires, the control wire L_113L, and the control wire R_113R.
  • the control wire L_113L is wound around the wire reel L_123L via the wire guide L_122L. Then, by rotating the wire reel L_123L, the length of the control wire L_113L is controlled. Further, the position of the wire guide L_122L can be controlled by the wire guide position adjustment device L_124L, and with this control, the delivery position of the control wire L_113L can be adjusted.
  • the length and the feeding position of the control wire L_113L can be controlled.
  • the length and the delivery position of the control wire R_113R can be controlled by the wire reel R_123R, the wire guide R_122R, and the wire guide position adjuster R_124R.
  • the parachute control device 120 can control the right turn, the left turn, and the descent rate by adjusting the lengths of the left and right control wires, respectively. Further, by controlling the wire feeding position, it is possible to adjust the balance of the flight type unmanned aerial vehicle 200 suspended from the parachute 111.
  • the parachute control device 120 controls the attitude and movement direction of the parachute 111 by the above configuration and the control signal from the landing and landing control device 131.
  • the control wires are assumed to be a left and right pair, but may be another number, for example, two pairs or three pairs.
  • the length of the wire 112 and the attachment position to the parachute control device 120 may be adjusted.
  • FIG. 6 is an overall control sequence diagram when the landing gear 100 performs emergency landing control.
  • A represents the descent trajectory of the flying drone
  • G represents the ground.
  • the drop detection S1 is a section in which the drop detection is performed
  • the parachute development S2 is a section in which the drop detection is performed and the parachute is developed. Control of descent is not implemented in these sections.
  • the control model construction S3 is a section for calculating control model characteristic values of the parachute.
  • the parachute control model may be referred to as a control model
  • the parachute control model characteristic value may be referred to as a control model characteristic value.
  • the control model characteristic value is a characteristic value when modeling the relationship between the control and the behavior of the parachute. Specifically, it is described as a model equation for estimating the relationship between the feed amount (length) of the control wire that controls the parachute, the feed position of the control wire, and the turning ratio and the descent ratio of the parachute.
  • the descent rate is y
  • the feed amount of the left wire is x 1 L
  • the feed position is x 2 L
  • the feed amount of the right wire is x 1 R
  • the feed position is x 2 R
  • the horizontal movement speed of the parachute is v
  • the wind speed w I assume.
  • the air resistance on the left side of the parachute is R L (x 1 L , x 2 L , v, w)
  • the air resistance on the right side is R R (x 1 R , x 2 R , v, w)
  • the lift on the left is L L (x 1 L , X 2 L , v, w)
  • the lift on the right side can be described as a function of L R (x 1 R , x 2 R , v, w).
  • the falling rate y can be modeled as represented by the following equation. The notation of variables is omitted in the notation of each function of the following expression.
  • y (aR L + bR R + cL L + dL R ) ⁇ t (equation 1)
  • a, b, c, d are coefficients
  • ⁇ t is the above-mentioned coefficients a, b, c, d vary depending on the current installation condition of the flying drone and the surrounding environmental conditions
  • control model characteristic values can be set to an initial value determined based on the structure of the parachute.
  • control model construction S3 In the section of the control model construction S3, the descent and landing control device actively carries out increase and decrease of the turn rate by the parachute and the descent rate. Then, control model characteristic values necessary for adjustment of the turning rate and the descent rate are calculated based on the current installation state of the flying drone and the surrounding environmental conditions. Thus, control model construction is realized by determining control model characteristic values.
  • the control model characteristic values largely fluctuate depending on the state of the flight type drone and the surrounding environmental conditions. For this reason, the control model characteristic value needs to be calculated as a value when the landing gear is actually operated.
  • the adjustment of the control model characteristic value can be performed, for example, as follows.
  • control model characteristic values a, b, c, and d are each increased or decreased by a predetermined range from the current value in predetermined intervals by the expression 1 representing the descent rate control model .
  • the present control value is substituted into all the expressions to calculate the descent rate, and the combination closest to the actual descent rate is adopted. At this time, even if the calculated value does not completely match the actual drop rate, it is preferable that the difference be within the threshold.
  • a procedure may be adopted in which the size of the step is increased or decreased to recalculate. In any case, it is necessary to adopt a calculation method experimentally verified that the calculation results do not diverge.
  • the characteristic value adjustment of the turning ratio is performed using (Equation 2).
  • a plurality of equations are generated by changing h, i, j, k of the control model characteristic value in a predetermined range and in predetermined intervals, and the turning ratio is calculated by all the expressions, among which an actual turning ratio is one Adopt the closest combination. At this time, even if the calculated value does not completely coincide with the actual turning rate, it is preferable that the difference be within the threshold.
  • an example of a specific calculation method is shown. However, the present invention is not limited to this calculation method, and another calculation method may be used as long as the calculation result of the control model approaches the actual falling rate and turning rate. It may be adopted.
  • the descent and landing control S4 is a section in which the landing gear performs descent and landing control while obtaining information on its surroundings.
  • the position of the dangerous substance is detected, the movement target point for avoiding the dangerous substance is calculated, and the parachute is controlled to move to the movement target point. .
  • control model characteristic value largely fluctuates depending on the state of the flight type drone and the surrounding environmental conditions. Therefore, recalculation of the control model characteristic value is periodically performed also in the section of the descent and landing control S4, and the control model is adjusted to be adapted to the current state. This process is control model adjustment S5. This is done because the posture of the flight type drone and the surrounding environmental conditions change during descent, and it is necessary to correct the control model characteristic value calculated in the control model construction S3 each time. . That is, it is desirable to optimize the control model characteristic values in real time in accordance with changes in the environment.
  • FIG. 7 is a flowchart showing operations of the falling detection process and the parachute expansion process of the landing gear 100.
  • the drop detection process first, the drop distance for each unit time is calculated (S101).
  • the drop detection device 150 constantly obtains an acceleration signal from the three-axis accelerometer 151 for drop detection, integrates the acceleration signal, and periodically calculates the drop distance per unit time, that is, the drop velocity. If the falling speed calculated here is less than the threshold set in advance (S102_No), the process returns to S101 and the calculation of the falling speed is continued.
  • the parachute unfolding apparatus 110 unfolds the parachute 111 upon receiving the fall notification (S103).
  • the system control device 130 powers on the descent and landing control device 131 (S104).
  • FIG. 8 is a flowchart showing parachute control model construction processing in the emergency landing control of the present embodiment.
  • a test is first performed to measure the behavior (fall rate, turning rate) of the parachute when control is actually performed.
  • steps S201 to S203 are this test operation.
  • the left control wire L_113L is wound and shortened by a predetermined amount for a predetermined period, which is a predetermined period, and a left turning operation is performed (S201). And the turning rate at this time is stored.
  • the right control wire R_113R is wound up and shortened by a predetermined amount for a predetermined period determined in advance, and a right turning operation is performed (S202). And the turning rate at this time is stored.
  • both control wires are wound by a predetermined amount, and a descent operation is performed (S203). And the descent rate at this time is stored.
  • the difference between the wire winding amount (length) obtained by these operations, the measured values of the turning rate and the falling rate, and the predicted value calculated from the current control model characteristic value is calculated (S204) . Then, if the difference is less than the threshold set in advance (S205_Yes), construction of the parachute control model is completed (S206). On the other hand, when the difference is equal to or more than the threshold (S205_No), the parachute control model characteristic value is adjusted to adjust the parachute control model (S207). Then, the left turn operation S201, the right turn operation S202, and the descent operation S203 are performed again to verify whether the current parachute control model is appropriate.
  • FIG. 9 is a block diagram showing the flow of data in the drop landing control and control parameter adjustment of this embodiment.
  • the descent and landing control / control parameter adjustment 301 is processing executed by the descent and landing control device 131.
  • the descent and landing control device 131 uses lower side camera image information 302, acceleration information (for descent control) 303, angular velocity information 304, ground altitude information 305 as input signals, and parachute control information 317 as output signals.
  • Posture movement calculation processing 308 is processing for periodically calculating its own posture and movement information (movement information) from acceleration information (for descent control) 303, angular velocity information 304 and ground altitude information 305. Since this process is common in the inertial navigation system, the detailed description is omitted here.
  • lower image analysis processing 306 lower side image information input from the lower side camera image information 302, and the posture and motion information input from the posture motion calculation processing 308, all around the image information except for the upper part, and three-dimensional It is a process of calculating spatial information. Since the image processing method used here is a general one, the detailed description is omitted. From the information obtained here, the image information in the lower direction and the three-dimensional space information are extracted, and are output as the lower image analysis processing 306.
  • side image information and a three-dimensional space are obtained from the lower side image information input from the lower side camera image information 302 and the posture and motion information input from the posture motion calculation processing 308. It is a process of outputting information.
  • the lower risk determination process 310 is a process of determining the risk at each position in the lower direction of the flight type drone based on the image analysis data input from the lower image analysis process 306. By this processing, for example, a high degree of risk is set at the position where the dangerous substance that needs to be avoided exists.
  • the downward image information and three-dimensional space information calculated in the lower image analysis process 306 are input, and the lower risk determination information of the two-dimensional grid GD is output.
  • FIG. 10 is an example of the risk determination.
  • the dark part in the figure represents the high risk area H, and the light part represents the medium risk area M.
  • mobile object detection is performed to detect an avoidance object present in the downward direction of the flight type drone.
  • Moving object detection can be performed, for example, using an optical flow or the like obtained from image information.
  • a mobile body for example, a pedestrian or a moving vehicle is assumed.
  • the degree of risk can be appropriately weighted according to, for example, the type of the object recognized in the image processing. For example, in addition to setting a high degree of risk near the moving body as described above, it is possible to set a high degree of risk also for a stationary object determined to be a person or a car by image recognition. As described above, the degree of risk is set at each point of the grid.
  • the method of the danger degree setting here changes with operation conditions, suppose that it is parameterized and does not take out details here.
  • the side danger determination process 311 is a process of determining the danger at each position in the side direction of the flight type drone.
  • a high degree of risk is set at the position where the dangerous substance that needs to be avoided exists.
  • the image information in the lateral direction calculated in the side image analysis processing 307 and the three-dimensional space information are input, and, for example, the side risk determination information of the three-dimensional grid GT in three dimensions is output.
  • An example of the risk setting is shown in FIG.
  • the dark part in the figure represents the high risk area H, and the light part represents the medium risk area M.
  • the avoidance objects present in the side direction of the flight type drone are high-rise buildings etc. which may cause a collision with the flight type drone. For this reason, all objects with height obtained by three-dimensional space information are set as the avoidance target and the risk degree is set. As described above, the danger level is set at each point on the side.
  • the action control process 313 is a dangerous position based on the input lower risk determination information (310), side risk determination information (311), posture motion information (308), and parachute control model characteristic value (316). Calculate behavior control suitable for avoidance. This behavior control is control for moving the parachute to the target point, and is represented by, for example, a turning rate and a descent rate, which are basic control parameters of the parachute. Then, in the action control process 313, the result is output to the parachute control information calculation process 315. The details of the above-mentioned action control will be described later.
  • the parachute control information calculation processing 315 calculates control information for performing the target control based on the turning rate and the descent rate calculated in the action control processing 313 and the control model using the parachute control characteristic value 316.
  • the control information is calculated, for example, as the winding / unwinding amount of the left and right control wires and the unwinding position.
  • the parachute control information calculated here is converted into a signal for mechanically driving the reel 123 and the wire guide 122 by the parachute control information 317, and is transmitted to the parachute control device 120.
  • the control model determination process 312 needs to adjust the current control model based on the difference between the motion prediction information calculated by inputting the current control value into the current parachute control model and the measured posture motion information. It is a process of determining whether there is any.
  • the motion prediction information and the posture motion information include, for example, a turning rate and a falling rate.
  • motion prediction information is calculated by motion prediction processing 309
  • posture motion information is calculated by posture motion calculation processing 308 based on outputs (303, 304, 305) of the respective sensors.
  • the control model determination processing 312 for example, if the difference between the motion prediction information (turning rate, descent rate) calculated from the control model and the actual motion information is equal to or more than a predetermined threshold, it is necessary to adjust the parachute control model.
  • the parachute control model is readjusted by the control model adjustment processing 314, and the parachute control model characteristic value 316 is updated.
  • the calculation method of the action suitable for dangerous material avoidance executed in the action control process 313 is as follows. First, as shown in FIG. 12, from the current parachute control characteristic parameters and the current attitude data of oneself, the required time t 1 to reach from the current point P 0 to the attention point P 1 , the turning rate T 1 to be set, The descent rate F 1 is calculated. In other words, FIG. 12, the turning rate T 1, when controlling the descent rate F 1, at the required time t 1, represents the expected case and reaches the point of interest P 1 risk C 1.
  • the risk C 1 can be arbitrarily set by the user as the need arises, and a high numerical value is used for a thing which itself suffers a great damage as a result of a collision or causes a heavy impact on a collision object.
  • a high value can be assigned to people and cars, and a low value can be assigned to grass unevenness.
  • FIG. 13 is a graph showing an example of the evaluation function E (t) for calculating the risk C at each time in the case of FIG. Evaluation function, continuing control approaching from the current point P 0 to the point of interest P 1, with time, risk C is defined as a function of approaching the danger C 1 set to the point of interest P 1.
  • the risk at the current point P0 is 0 .
  • the flight type drone approaches P 1 with the passage of time, and the risk increases with the approach, and the risk becomes C 1 at the time of arrival. Then, as shown in FIG.
  • control risk degree e about the coordinates (F 1 , T 1 ) on the control parameter space Plot values with a distribution with 1 as a parameter.
  • the control parameter space is a space having the dimensions of the descent rate and the turning rate, which are basic control parameters of the parachute, and having the degree of influence of the control indicated by each coordinate on the risk as the value of the control risk.
  • the control with the parameter in which this value is high is dangerous, and the control with the parameter in which this value is low means that the risk is relatively low.
  • the above processing is implemented with the grids of the lower risk determination information and the side risk determination information as the points of interest.
  • a plurality of distributions indicating overall risks to the basic control parameters are calculated as shown in an example in FIG. 15 on the control parameter space.
  • the distribution of the control risk level e is like the distribution represented by each of e 2 -e 7 circles.
  • a control parameter determination value 1401 is a point at which a value with the lowest control risk is taken on the control parameter space.
  • control risk calculation and the plotting in the control parameter space need not be performed on the grid calculated by all the lower risk determination information and the side risk determination information.
  • it can be implemented only on a high risk grid or a grid existing at a short distance from itself.
  • the flight type unmanned aerial vehicle which is unable to fly is guided to a point where the risk of collision with an obstacle is low, and the risk is landed safely. be able to.
  • an optical camera is used as means for obtaining dangerous goods position information, but instead of the optical camera, it is possible to use an active distance measuring sensor such as LIDAR, radar, or ultrasonic distance measuring sensor.
  • FIG. 17 shows a block diagram of the landing gear 101 using the distance measurement sensor 160 instead of the camera.
  • the descent and landing control device 131 uses the distance measurement data measured by the distance measurement sensor 160 instead of the optical image to perform object recognition, calculation of the degree of danger, and the like.
  • the other configuration is the same as that of the second embodiment.
  • the above LIDAR is an abbreviation for Light Detection and Ranging.
  • the accelerometer, the angular velocity meter, and the ground altimeter are used to acquire their own posture and motion information, by performing a gyro process using image information, It is possible to omit the sensor.
  • FIG. 17 is a block diagram showing an example of a landing gear 400 using an image gyro.
  • the landing gear 400 includes a parachute deployment device 410, a parachute control device 420, a system control device 430, a camera 440, and a drop detection device 450.
  • the system control unit 430 includes a landing and landing control unit 431, an image gyro calculation unit 432, a map information storage unit 433 and a battery 434.
  • the image gyro calculation device 432 calculates its own position and ground height based on the image information acquired from the camera 440 and the map information stored in the map information storage device 433. In addition, the speed and acceleration are calculated from these time changes.
  • the fall detection device 450 detects a fall when the calculated downward acceleration and fall speed exceed a predetermined threshold, and operates the parachute deployment device 410 to deploy the parachute.
  • the drop detection device 450 is configured to be driven by the battery 434 that drives the descent and landing control device and another battery 452, but may be configured to be driven by the same battery.
  • the descent and landing control device 431 calculates the degree of danger at each of the lower and side points based on the position, the ground height, the velocity, the acceleration and the like calculated by the image gyro calculation device 432. Then, the parachute control device 420 is controlled to move the parachute 411 so as to avoid the high risk position and guide the flying drone to a safe point.
  • the flight type drone can be guided to a safe point and landed without using an accelerometer, an angular velocity meter, and a ground altimeter.
  • the drop detection device 450 is separated from the system control device 430 in FIG. 17, it may be configured as a part of the system control device 430.
  • a program that causes a computer to execute the processes of the above first to fourth embodiments and a recording medium storing the program are also included in the scope of the present invention.
  • a recording medium for example, a magnetic disk, a magnetic tape, an optical disk, a magneto-optical disk, a semiconductor memory, or the like can be used.
  • a dangerous goods position detection device for detecting the position of dangerous goods around a flying drone landing using a parachute
  • a movement target position calculation device for calculating a movement target position for the flight type drone to move avoiding the dangerous material based on the position of the dangerous material detected by the dangerous material position detection device
  • a parachute control device for controlling the parachute so that the flight type unmanned vehicle moves to the movement target position.
  • (Supplementary Note 2) Fall detection means for detecting the fall of the flight type drone; Parachute deployment means for deploying a parachute when the fall detection means detects a fall of the flight type drone;
  • the landing gear according to appendix 1, characterized in that it comprises: (Supplementary Note 3) The movement target position calculation device The grid corresponding to the lower and side coordinates of the flight type drone is created, and the degree of risk based on the position of the dangerous material is set for each point of the grid.
  • the landing gear as described in 2.
  • (Supplementary Note 4) At least one pair of control wires connecting the parachute to the parachute controller;
  • the parachute control device A reel for controlling the feed amount of each of at least a pair of the control wires; 3.
  • a wire guide for controlling the delivery position of each of the at least one pair of control wires.
  • the parachute control device Create a control parameter space whose dimensions are the turning rate and falling rate of the parachute, For each point in the control parameter space, calculate a control risk corresponding to the risk, The landing gear according to appendix 5, wherein a control corresponding to a point of the control parameter space with a low degree of control risk is selected based on the parachute control model.
  • the movement target position calculation device The landing gear according to any one of appendices 3 to 6, wherein the grid having the low degree of risk is set as a movement target position.
  • a grid corresponding to lower and side coordinates of the flight type drone is created, and a degree of risk based on the position of the dangerous material is set for each point of the grid.
  • Landing control method described. At least one pair of control wires connecting the flight type drone and the parachute; Controlling an amount of delivery of each of at least one pair of control wires from the flight type drone; The landing control method according to appendix 12, further comprising: controlling a delivery position of each of at least a pair of control wires from the flight type drone.
  • (Supplementary Note 16) Create a control parameter space whose dimensions are the turning rate and falling rate of the parachute, For each point in the control parameter space, calculate a control risk corresponding to the risk, The landing control method according to claim 14 or 15, wherein the control corresponding to the point of the control parameter space having the low control risk is selected based on the parachute control model. (Supplementary Note 17) The landing control method according to appendix 16, wherein a predetermined offset value is set to the control risk for each point of the control parameter space. (Appendix 18) The landing control method according to any one of appendices 12 to 17, wherein the grid having the low degree of risk is set as a movement target position.

Abstract

飛行型無人機を、障害物等を避けるように誘導し、危険性の低い地点に着陸させる着陸装置を提供する。着陸装置は、危険物位置検出装置と、移動目標地点算出装置と、パラシュート制御装置とを有している。危険物位置検出装置は、パラシュートを用いて着陸しようとする飛行型無人機の周囲に存在する危険物の位置を検出する。移動目標地点算出装置は、危険物位置検出装置が取得した危険物の位置に基づいて、危険物との衝突および危険な場所への着地を回避するために、その時々に飛行型無人機が移動するべき移動目標地点を算出する。パラシュート制御装置は、移動目標地点算出装置が算出した移動目標地点に飛行型無人機が移動するようにパラシュートを制御する。

Description

着陸装置、着陸制御方法、着陸制御プログラム
　本発明は、着陸装置、着陸制御方法、着陸制御プログラムに関する。
　現在、飛行型無人機を活用した配送システムや監視システムが開発され、これらの用途に用いられる飛行型無人機管制システム等が開発されている。これらのシステムでは飛行型無人機が通常の飛行を行うことが前提とされているが、実際の運用時は無人機が制御不可能となる場合がある。このため、制御不可能になった場合の対処方法が検討されている。
　例えば特許文献１には、無人の飛行体がパラシュートまたはエアバッグを備え、飛行体が飛行不能となった場合に、パラシュートまたはエアバッグを展開する技術が開示されている。これにより、飛行体および搭載された精密機器を墜落の衝撃から守ることができる。
　また特許文献２には、無人型のヘリコプターが制御不可能となった場合に、エアバッグおよびパラシュートを使用し、不時着を行う技術が開示されている。不時着に当たっては、ヘリコプターの高度に応じて両者を使い分ける。例えば、ヘリコプターの高度が所定高度より高い場合には、パラシュートとエアバッグの両方を展開し、所定高度より低い場合にはエアバッグのみを展開する。以上のような構成とすることにより、高度に応じた適切な軟着陸を行うことができる。
　また特許文献３には、パラシュートに、パラシュート用吊下制御索を設け、これを伸縮させて、降下中のパラシュートの移動制御を行う技術が開示されている。この技術では、まず、降下軌道センサやGPS（Ｇｌｏｂａｌ　Ｐｏｓｉｔｉｏｎｉｎｇ　Ｓｙｓｔｅｍ）等によって現在値を検出し、風向、落下速度等に基づいて降下軌道を計算する。そして、パラシュート用吊下制御索を伸縮制御することで、空気力学的にパラシュートの移動を制御し、パラシュートを目標の軌道に沿って移動させ、目的地に誘導することができる。
国際公開第２０１６／０９８１４６号 特開２０１６－８８１１１号公報 特開平０８－１５６８９３号公報
　しかしながら、特許文献１および特許文献２の技術では、着陸地点がどこになるか不定となるため、高層ビル等の障害物や歩行者や自動車等への衝突が避けられないという問題があった。
　また特許文献３の技術は、予め定めた目標地点にパラシュートを誘導する技術であり、この技術では予期されていない危険物を回避することができなった。
　本発明は上記の問題点に鑑みてなされたものであり、飛行型無人機を、障害物等を避けるように誘導し、危険性の低い地点に着陸させる着陸装置を提供することを目的としている。
　上記の課題を解決するため、本発明の着陸装置は、危険物位置検出装置と、移動目標地点算出装置と、パラシュート制御装置とを有している。危険物位置検出装置は、パラシュートを用いて着陸しようとする飛行型無人機の周囲に存在する危険物の位置を検出する。移動目標地点算出装置は、危険物位置検出装置が取得した危険物の位置に基づいて、危険物との衝突および危険な場所への着地を回避するために、その時々に飛行型無人機が移動するべき移動目標地点を算出する。パラシュート制御装置は、移動目標地点算出装置が算出した移動目標地点に飛行型無人機が移動するようにパラシュートを制御する。
　本発明の効果は、飛行型無人機を、障害物等を避けるように誘導し、危険性の低い地点に着陸させる着陸装置を提供できることである。
第１の実施形態の着陸装置を示すブロック図である。 第２の実施形態の着陸装置を示すブロック図である。 第３の実施形態の着陸装置を示す斜視模式図である。 第３の実施形態の着陸装置を示すブロック図である。 第３の実施形態のパラシュート制御装置を示すブロック図である。 第３の実施形態の全体制御を示すシーケンス図である。 第３の実施形態の落下検出とパラシュート展開の動作を示すフローチャートである。 第３の実施形態のパラシュート制御モデル構築処理を示すフローチャートである。 第３の実施形態の降下着陸制御と制御パラメータ調整の処理の流れを示すブロック図である。 第３の実施形態の下方危険度判定処理結果の一例を示す模式図である。 第３の実施形態の側方危険度判定処理結果の一例を示す模式図である。 第３の実施形態の注目地点までの経路計算の一例を示す模式図である。 第３の実施形態の制御危険度算出方法を示すグラフである。 第３の実施形態の制御パラメータ空間での注目地点の制御危険度のプロット例を示すグラフである。 第３の実施形態の制御パラメータ空間での制御パラメータの決定方法を示すグラフである。 第４の実施形態の着陸装置を示すブロック図である。 第５の実施形態の着陸装置を示すブロック図である。
　以下、図を参照しながら、本発明の実施形態を詳細に説明する。但し、以下に述べる実施形態には、本発明を実施するために技術的に好ましい限定がされているが、発明の範囲を以下に限定するものではない。
　（第１の実施形態）
　図１は、第１の実施形態の着陸装置を示すブロック図である。着陸装置は、危険物位置検出装置１と、移動目標地点算出装置２と、パラシュート制御装置３とを有している。
　危険物位置検出装置１は、パラシュートを用いて着陸しようとする飛行型無人機の周囲に存在する危険物の位置を検出する。
　移動目標地点算出装置２は、危険物位置検出装置１が取得した危険物の位置に基づいて、危険物との衝突および危険な場所への着地を回避するために、その時々に飛行型無人機が移動するべき移動目標地点を算出する。
　パラシュート制御装置３は、移動目標地点算出装置が算出した移動目標地点に飛行型無人機が移動するようにパラシュートを制御する。
　以上説明したように、本実施形態によれば、飛行型無人機を、危険物を避けるように誘導し、危険性の低い地点に着陸させる着陸装置を提供することができる。
　（第２の実施形態）
　図２は、第２の実施形態の着陸装置を示すブロック図である。第１の実施形態の構成に加えて、飛行型無人機の落下を検出する落下検出装置４と、飛行型無人機の落下を抑制するパラシュートを展開するパラシュート展開装置５とを有している。
　落下検出装置４は、例えば降下速度が所定値以上となった等の条件が満たされたときに、飛行型無人機の落下と判定して、この落下を検出する。
　パラシュート展開装置５は、落下検出装置４が落下を検出した場合に、パラシュートを展開する。
　危険物位置検出装置１、移動目標地点算出装置２、パラシュート制御装置３の構成と動作は第１の実施形態と同様である。
　以上の構成とすると、飛行型無人機が制御不能となり落下を開始した場合に、パラシュートを展開し、飛行型無人機を、危険物を避けるように誘導し、危険性の低い地点に緊急着陸させることができる。
　以上説明したように、本実施形態によれば、制御不能に陥った飛行型無人機を、安全に緊急着陸させる着陸装置を構成することができる。
　（第３の実施形態）
　図３は、第３の実施形態の着陸装置１００の概要を示す斜視模式図である。着陸装置１００は、飛行型無人機２００に搭載されている。図３では、図示しない落下検出装置が飛行型無人機２００の落下を検出し、これを契機としてパラシュート１１１を展開した状態を示している。なお、図３では、飛行型無人機２００が複数のローター２１０を用いて飛行するマルチコプターを例示しているが、本実施形態の着陸装置１００は他の構成の飛行型無人機に対しても適用することが可能である。
　着陸装置１００は、パラシュート展開装置（図示せず）によって展開されたパラシュート１１１と、パラシュート制御装置１２０と、システム制御装置１３０と、カメラ１４０とを有する。なお図３では、パラシュート１１１がスクエア型の例を示している。パラシュート１１１は、ワイヤ１１２によってパラシュート制御装置１２０に連結されている。またパラシュート１１１の左右端は一対の制御ワイヤ１１３によってパラシュート制御装置１２０に接続されている。ここでは、左右それぞれの制御ワイヤを、制御ワイヤＬ＿１１３Ｌ、制御ワイヤＲ＿１１３Ｒと表記している。パラシュート制御装置１２０は、制御ワイヤＬ＿１１３Ｌ、制御ワイヤＲ＿１１３Ｒの長さおよび繰り出し位置を個々に調整することによって、パラシュート１１１の姿勢と向きを制御する。この制御により、パラシュート１１１の姿勢と進行方向を制御することができる。
　カメラ１４０は、飛行型無人機２００の下方および側方の画像を取得する。カメラ１４０は、例えば、下方向、および側面方向の全方位の画像データを取得する装置であり、例えば、一つの魚眼カメラや、複数のカメラの組み合わせによって構成することができる。カメラ１４０が撮影した下方および側方の画像から、危険物位置の存在する位置を検出することができる。前述したように、危険物の例としては、高層ビル等の障害物や歩行者や自動車等が挙げられる。
　システム制御装置１３０は、カメラ１４０が取得した画像を解析し、飛行型無人機２００が危険物を避け、安全に着陸するための移動目標地点をリアルタイムで算出する。そして、各時点における移動目標地点に飛行型無人機が移動するようにパラシュートを制御するための制御信号をパラシュート制御装置１２０に出力する。パラシュート制御装置１２０は、この制御信号に従って、制御ワイヤＬ＿１１３Ｌ、制御ワイヤＲ＿１１３Ｒを制御し、パラシュート１１１の姿勢と移動方向を制御する。この制御により、パラシュート１１１は、目標地点に向かって移動する。
　図４は、着陸装置１００の詳細を示すブロック図である。落下検出装置１５０は、用着陸装置１００が取り付けられた飛行型無人機２００の落下を検出する。そのために、３軸加速度計１５１を有する。なお、ここでは、落下検出装置１５０を動作させる電力はバッテリー１５２が供給する構成としている。落下検出装置１５０は、３軸加速度計１５１の出力する下方向の加速度や、これに基づいて計算される下方向の速度が所定の条件を満たした時に落下と判定することで、飛行型無人機２００の落下を検出する。落下の判定条件は、例えば地面方向の加速度が所定値以上となることや、加速度から算出される単位時間当たりの下方向への移動距離（落下速度）が所定値以上となることとして設定できる。この落下検出装置１５０は常に動作している。そして落下検出装置１５０は、落下を通知する信号をパラシュート展開装置１１０に出力する。パラシュート展開装置１１０は、落下の通知を受け取ると、パラシュート１１１を展開する。なお、図４では、落下検出装置１５０をシステム制御装置１３０と分離した構成としているが、システム制御装置１３０の一部として構成されていても良い。
　システム制御装置１３０は、降下着陸制御装置１３１を有している。降下着陸装置１３１は、例えばコンピュータやプロセッサに実装される。降下着陸制御装置１３１には、３軸加速度計１３２、３軸角速度計１３３、対地高度計１３４、カメラ１４０からの情報が入力される。また、降下着陸制御装置１３１にはバッテリー１３５から電力が供給されている。降下着陸制御装置１３１は、カメラ１４０および上記の計測器からの入力値から、周囲の障害物の情報と移動目標となる地点を決定する。また、パラシュート１１１を移動目標地点に近付けるためのパラシュート制御パラメータを算出する。そして、制御パラメータをパラシュート制御装置１２０に送信する。この降下着陸制御装置１３１は、例えば、落下検出装置１５０にて落下が検出された際にのみ動作するものである。なお、落下検出装置１５０は常に動作するものであるため、降下着陸制御装置１３１と落下検出装置１５０を駆動するバッテリーとを別々にしておくと、それぞれの用途に適したバッテリーを選択することが可能である。
　図５は、パラシュート制御装置１２０の詳細構成図である。パラシュート制御装置１２０は、ワイヤ制御装置１２１と、左右の制御ワイヤ、制御ワイヤＬ＿１１３Ｌ、制御ワイヤＲ＿１１３Ｒを制御する２系統の制御系を有する。制御ワイヤＬ＿１１３Ｌは、ワイヤガイドＬ＿１２２Ｌを介して、ワイヤリールＬ＿１２３Ｌに卷回されている。そして、ワイヤリールＬ＿１２３Ｌが回転することにより、制御ワイヤＬ＿１１３Ｌの長さが制御される。また、ワイヤガイドＬ＿１２２Ｌは、ワイヤガイド位置調整機Ｌ＿１２４Ｌによって位置を制御できるようになっており、この制御により、制御ワイヤＬ＿１１３Ｌの繰り出し位置を調整することができる。上記の構成により、制御ワイヤＬ＿１１３Ｌの長さと繰り出し位置を制御することができる。同様に、ワイヤリールＲ＿１２３Ｒ、ワイヤガイドＲ＿１２２Ｒ、ワイヤガイド位置調整機Ｒ＿１２４Ｒによって、制御ワイヤＲ＿１１３Ｒの長さと繰り出し位置を制御することができる。上記の構成によれば、パラシュート制御装置１２０は、左右の制御ワイヤの長さを、それぞれ調整することで、右旋回、左旋回、および降下率を制御することができる。また、ワイヤ繰り出し位置の制御により、パラシュート１１１から吊下げられた飛行型無人機２００のバランス調整が可能である。以上説明したように、パラシュート制御装置１２０は、上記の構成と、降下着陸制御装置１３１からの制御信号によって、パラシュート１１１の姿勢および移動方向を制御する。なお、上記の説明では制御ワイヤを左右一対と仮定したが、別の本数、例えば二対や三対などであっても良い。またワイヤ１１２の、長さや、パラシュート制御装置１２０への取り付け位置を調整できるようにしても良い。
　図６は、着陸装置１００が緊急着陸制御を行う時の全体制御シーケンス図である。図５中のＡは飛行型無人機の降下軌道、Ｇは地面を表している。落下検出Ｓ１は落下検出を行っている区間であり、パラシュート展開Ｓ２は、落下の検出が実施され、パラシュートが展開している区間である。これらの区間では降下の制御は実施されていない。
　制御モデル構築Ｓ３は、パラシュートの制御モデル特性値を算出する区間である。なお以降の説明では、パラシュート制御モデルを制御モデル、パラシュート制御モデル特性値を制御モデル特性値と称する場合がある。
　制御モデル特性値は、制御とパラシュートの挙動との関係をモデル化する時の特性値である。具体的には、パラシュートを制御する制御ワイヤの繰り出し量（長さ）および制御ワイヤの繰り出し位置と、パラシュートの旋回率および降下率の関係を推定するモデル式として記述される。
　以下に具体的なモデル化の一例を示す。ここでは、降下率をｙ、左ワイヤの繰り出し量をｘ１Ｌ、繰り出し位置をｘ２Ｌ、右ワイヤの繰り出し量をｘ１Ｒ、繰り出し位置をｘ２Ｒ、パラシュートの水平方向移動速度をｖ、風速をｗとする。そして、パラシュート左側の空気抵抗がＲＬ（ｘ１Ｌ、ｘ２Ｌ、ｖ、ｗ）、右側の空気抵抗がＲＲ（ｘ１R、ｘ２R、ｖ、ｗ）、左側の揚力がＬＬ（ｘ１Ｌ、ｘ２Ｌ、ｖ、ｗ）、右側の揚力がＬＲ（ｘ１R、ｘ２R、ｖ、ｗ）の関数で記述できるものとする。この時、例えば、降下率ｙが次式で表されるものとして、モデル化することができる。なお次式の各関数の表記では変数の表記を省略している。また簡単のため、パラシュートとペイロード（飛行型無人機）の質量の和を１としている。
ｙ＝（aＲＬ＋ｂＲＲ＋ｃＬＬ＋ｄＬＲ）Δｔ　　　　　　　（式１）
ただし、ａ、ｂ、ｃ、ｄ、は係数、Δｔは単位時間
上記の係数ａ、ｂ、ｃ、ｄ、は、現状の飛行型無人機への取り付け状態、および周囲の環境条件によって変化するものであり、これらを制御モデル特性値と呼ぶものとする。それぞれの制御モデル特性値には、パラシュートの構造に基づいて定まる初期値を設定することができる。
　同様にして旋回率ｚを次式でモデル化できるものとする。なお、簡単のため、パラシュートとペイロードの慣性モーメントの和を１としている。
ｚ＝（hＲＬ＋ｉＲＲ＋jＬＬ＋kＬＲ）Δｔ　　　　　　　（式２）
上記のｈ、ｉ、ｊ、ｋも、制御モデル特性値であり、それぞれに、パラシュートの構造に基づいた初期値が設定される。
　制御モデル構築Ｓ３の区間において、降下着陸制御装置は、能動的にパラシュートによる旋回率、および降下率の増減を実施する。そして、現状の飛行型無人機への取り付け状態、および周囲の環境条件に基づいて、旋回率および降下率の調整のために必要な制御モデル特性値を算出する。こうして制御モデル特性値を決定することによって、制御モデル構築が実現される。なお、制御モデル特性値は、飛行型無人機の状態や周囲の環境条件に依存して大きく変動する。このため、制御モデル特性値は、実際に着陸装置が動作した際の値として算出する必要がある。制御モデル特性値の調整は、例えば、次のようにして行うことができる。まず、降下率の制御モデルを表す（式１）で、制御モデル特性値のａ、ｂ、ｃ、ｄのそれぞれを、現在の値から所定範囲、所定刻みで増減させた複数の式を作成する。例えば、それぞれで、プラス側に２つ、マイナス側に２つの値を設定すると、１つの特性値について４つの値が設定でき、特性値の種類が４つなので、４４＝２５６個の式ができる。そして、この全ての式に、現在の制御値を代入して降下率を計算し、実際の降下率に一番近い組み合わせを採用する。この時、計算値が実際の降下率と完全に一致しなくても、差分が閾値以内に収まっていれば良いものとする。閾値内に収まる組み合わせが無ければ、刻みの大きさを増減させて再計算するといった手順を採用しても良い。いずれにしても、計算結果が発散しないことを実験的に検証した計算方法を採用する必要がある。同様に（式２）を用いて旋回率の特性値調整を行う。制御モデル特性値のｈ、ｉ、ｊ、ｋを、所定範囲、所定刻みで変化させた複数の式を作成し、全ての式で旋回率を計算し、その中で、実際の旋回率に一番近い組み合わせを採用する。この時、計算値が実際の旋回率と完全に一致しなくても、差分が閾値以内に収まっていれば良いものとする。上記の説明では、具体的な計算方法の一例を示したが、この計算方法に限らず、制御モデルの計算結果を、実際の降下率、旋回率に近付ける方法であれば、他の計算方法を採用しても良い。
　降下着陸制御Ｓ４は、着陸装置が、自身の周囲の情報を得ながら降下および着陸の制御を行う区間である。この区間では、第２の実施形態で述べたように、危険物の位置を検出し、危険物を回避するような移動目標地点を算出し、その移動目標地点に移動するようにパラシュートを制御する。
　ところで、前述したように、制御モデル特性値は、飛行型無人機の状態や周囲の環境条件に依存して大きく変動する。このため、降下着陸制御Ｓ４の区間においても、制御モデル特性値の再計算を定期的に実行し、現状に適合するように制御モデルを調整する。このプロセスが制御モデル調整Ｓ５である。このようにするのは、降下中にも飛行型無人機の体勢や周囲の環境条件が変化し、その度に、制御モデル構築Ｓ３で算出した制御モデル特性値を修正する必要があるためである。すなわち、制御モデル特性値は、環境の変化に合わせてリアルタイムに最適化することが望ましい。
　図７は、着陸装置１００の落下検出処理とパラシュート展開処理の動作を示すフローチャートである。落下検出処理では、まず単位時間毎の落下距離の算出を実施する（Ｓ１０１）。落下検出装置１５０は、常に落下検出用の３軸加速度計１５１から加速度信号を取得し、加速度信号を積分して、定期的に単位時間当たりの落下距離、すなわち落下速度を算出する。ここで算出された落下速度が、事前に設定された閾値未満であった場合は（Ｓ１０２＿Ｎｏ）、Ｓ１０１に戻り、落下速度の算出を継続する。一方、落下速度が閾値以上だった場合は（Ｓ１０２＿Ｙｅｓ）、飛行型無人機２００の落下と判定して、落下の通知をパラシュート展開装置１１０およびシステム制御装置１３０に送信する。パラシュート展開装置１１０は、落下の通知を受信すると、パラシュート１１１を展開する（Ｓ１０３）。また、システム制御装置１３０は、落下の通知を受信すると、降下着陸制御装置１３１の電源を投入する（Ｓ１０４）。
　図８は、本実施形態の緊急着陸制御におけるパラシュート制御モデル構築処理を示すフローチャートである。制御モデル構築では、まず実際に制御を行った時のパラシュートの挙動（降下率、旋回率）を測定するテストを行う。図８のフローチャートではＳ２０１からＳ２０３までが、このテスト動作である。
　まず、予め定めた所定期間だけ、例えば左の制御ワイヤＬ＿１１３Ｌを巻き取って所定量短くして、左旋回動作を行う（Ｓ２０１）。そしてこの時の旋回率を記憶する。次に予め定めた所定期間だけ、例えば右の制御ワイヤＲ＿１１３Ｒを巻き取って所定量短くして、右旋回動作を行う（Ｓ２０２）。そしてこの時の旋回率を記憶する。次に、例えば両方の制御ワイヤを所定量巻き取って、降下動作を行う（Ｓ２０３）。そしてこの時の降下率を記憶する。以上の動作により、制御ワイヤ巻き取り量と実際の旋回および降下率の変化の関係を記録する。なお、左旋回、右旋回、降下動作の順序は順不同である。
　次に、これらの動作で得られたワイヤ巻き取り量（長さ）と、旋回率および降下率の実測値と、現在の制御モデル特性値から算出した予測値との差分を算出する（Ｓ２０４）。そして、差分が事前に設定した閾値未満であれば（Ｓ２０５＿Ｙｅｓ）、パラシュート制御モデルの構築を完了する（Ｓ２０６）。一方、差分が閾値以上であった場合は（Ｓ２０５＿Ｎｏ）、パラシュート制御モデル特性値を調整して、パラシュート制御モデルの調整を行う（Ｓ２０７）。そして、再度、左旋回動作Ｓ２０１、右旋回動作Ｓ２０２、降下動作Ｓ２０３を実施して、現在のパラシュート制御モデルが適切であるか検証する。
　図９は、本実施形態の降下着陸制御および制御パラメータ調整におけるデータの流れを示すブロック図である。
　降下着陸制御／制御パラメータ調整３０１は、降下着陸制御装置１３１が実行する処理である。降下着陸制御装置１３１は、下方側方カメラ画像情報３０２、加速度情報（降下制御用）３０３、角速度情報３０４、対地高度情報３０５を入力信号とし、パラシュート制御情報３１７を出力信号とする。
　姿勢運動算出処理３０８は、加速度情報（降下制御用）３０３、角速度情報３０４および対地高度情報３０５から、自身の姿勢および運動情報（移動情報）を定期的に算出する処理である。この処理は慣性航法装置において一般的であるためここでは詳細な説明は省略する。
　下方画像解析処理３０６は、下方側方カメラ画像情報３０２から入力した下方側方画像情報と、姿勢運動算出処理３０８から入力した姿勢および運動情報から、上方を除く全周の画像情報と、３次元空間情報とを算出する処理である。ここで用いる画像処理手法は一般的なものであるため、詳細な説明は省略する。ここで得られた情報から下方向の画像情報と３次元空間情報を取り出し、下方画像解析処理３０６の出力とする。
　側方画像解析処理３０７も同様に、下方側方カメラ画像情報３０２から入力した下方側方画像情報と、姿勢運動算出処理３０８から入力した姿勢および運動情報から、側面方向の画像情報と３次元空間情報を出力する処理である。
　下方危険度判定処理３１０は、下方画像解析処理３０６から入力された画像解析データに基づいて、飛行型無人機の下方向の各位置における危険度を判定する処理である。この処理により、例えば、回避が必要な危険物が存在する位置には高い危険度が設定される。この処理では、下方画像解析処理３０６で算出された下方向の画像情報と３次元空間情報を入力とし、２次元グリッド状の２次元グリッドＧＤの下方危険度判定情報を出力とする。図１０は、危険度判定の一例である。図の色の濃い部分が高危険度領域Ｈを表し、色の薄い部分が中危険度領域Ｍを表している。
　上記の下方危険度判定処理３１０では、飛行型無人機の下方向に存在する回避対象物を検出するための、移動体検出を実施する。移動体検出は、例えば画像情報から得たオプティカルフロー等を利用して行うことができる。移動体としては、例えば、移動中の歩行者や自動車等が想定される。危険度には、例えば画像処理で認識した物体の種類に応じて、適宜重み付けを行うことができる。例えば、上記のような移動体の付近には高い危険度を設定するほか、画像認識により人や車と判定された静止物体に対しても高い危険度を設定することができる。以上のようにして、グリッドの各地点に危険度を設定する。なお、ここでの危険度設定の方法は運用状況により変化するものであるため、パラメータ化するものとし、ここでは詳細はとりあげない。
　側方危険度判定処理３１１は、飛行型無人機の側面方向の各位置における危険度を判定する処理である。この処理により、例えば、回避が必要な危険物が存在する位置には高い危険度が設定される。この処理では、側方画像解析処理３０７で算出された側面方向の画像情報と３次元空間情報を入力とし、例えば、３次元グリッド状の３次元グリッドＧＴの側方危険度判定情報を出力とする。危険度設定の一例を図１０に示す。図の色の濃い部分が高危険度領域Ｈを表し、色の薄い部分が中危険度領域Ｍを表している。
　飛行型無人機の側面方向に存在する回避対象物は、飛行型無人機との衝突を引き起こす可能性のある高層建築物等である。このため、３次元空間情報により得られた高さのある物体は、全て回避対象とし危険度を設定する。以上のようにして、側方の各地点に危険度を設定する。
　行動制御処理３１３は、入力された下方危険度判定情報（３１０）、側方危険度判定情報（３１１）、姿勢運動情報（３０８）、およびパラシュート制御モデル特性値（３１６）に基づいて、危険位置回避に適した行動制御を算出する。この行動制御は、目標地点にパラシュートを移動させるための制御であり、例えば、パラシュートの基本制御パラメータである旋回率および降下率によって表される。そして、行動制御処理３１３では、結果をパラシュート制御情報算出処理３１５へ出力する。なお上記の行動制御の詳細については後述する。
　パラシュート制御情報算出処理３１５は、行動制御処理３１３で算出した旋回率および降下率と、パラシュート制御特性値３１６とを用いた制御モデルとに基づいて、目的の制御を行うための制御情報を算出する、この制御情報は、例えば、左右の制御ワイヤの巻取り／繰り出し量と、繰り出し位置として算出される。ここで算出されたパラシュート制御情報は、パラシュート制御情報３１７で、リール１２３およびワイヤガイド１２２を機械的に駆動するための信号に変換され、パラシュート制御装置１２０へ送信される。
　制御モデル判定処理３１２は、現在のパラシュート制御モデルに現在の制御値を入力して算出した運動予測情報と、実測された姿勢運動情報との差分に基づいて、現在の制御モデルを調整する必要があるか否かを判定する処理である。運動予測情報および姿勢運動情報は、例えば旋回率と降下率を含むものである。ここで、運動予測情報は、運動予測処理３０９で算出し、姿勢運動情報は、各センサの出力（３０３、３０４、３０５）に基づいて、姿勢運動算出処理３０８が算出する。制御モデル判定処理３１２では、例えば、制御モデルから算出した運動予測情報（旋回率、降下率）と、実際の運動情報との差分が所定の閾値以上であれば、パラシュート制御モデル調整の必要ありと判定し、閾値未満であれば調整の必要なしと判定する。ここで、パラシュート制御モデルの調整が必要と判定された場合は、制御モデル調整処理３１４によりパラシュート制御モデルを再調整し、パラシュート制御モデル特性値３１６を更新する。
　行動制御処理３１３にて実行される危険物回避に適した行動の算出方法は以下の通りである。まず、図１２に示すように、現在のパラシュート制御特性パラメータと自身の現在の姿勢データから、現在地点Ｐ０から注目地点Ｐ１へ到達するまでの所要時間ｔ１、設定する旋回率Ｔ１、降下率Ｆ１を算出する。言い換えると、図１２は、旋回率Ｔ１、降下率Ｆ１の制御を行うと、所要時間ｔ１で、危険性Ｃ１の注目地点Ｐ１に到達すると見込まれるケースを表している。なお、危険性Ｃ１は利用者が必要に応じて任意に設定できるものであり、衝突の結果、自身が大きな損傷を受けたり、被衝突物に大きな被害を与えたりするものには、高い数値を設定する。例えば、人や自動車などには高い値を付与し、草むらには低い値を付与するといった運用をすることができる。
　図１３は、図１２のケースで、各時刻における危険性Ｃを算出する評価関数Ｅ（ｔ）の一例を表すグラフである。評価関数は、現在地点Ｐ０から注目地点Ｐ１に近付く制御を続けると、時間の経過とともに、危険性Ｃが、注目地点Ｐ１に設定した危険性Ｃ１に近付く関数として定義する。このような関数は、例えば、Ｅ１（ｔ）＝Ｃ１（１－ｅｘｐ（－Ａ・ｔ／ｔ１））、ただしＡは定数、の形式で表すことができる。なお、ここでは現在地点Ｐ０における危険性を０としている。この評価関数によれば、時間の経過とともに、飛行型無人機がＰ１に接近し、接近にともなって危険性が増大し、到達時に危険性がＣ１となる。そして、図１２のように、危険性Ｃ１の注目地点Ｐ１に向かう制御を行った場合の、現時点時刻ｔ＝０における危険性の度合いを、傾きｅ１で表すことができる。すなわちｅ1は、旋回率Ｔ１、降下率Ｆ１の制御に関する危険性の度合いを表している。このため、ｅ1を制御危険度と呼称することにする。
　次に、図１４に示すように、注目地点Ｐ１について算出されたｅ１、Ｆ１、Ｔ１を用い、制御パラメータ空間上へ座標（Ｆ１、Ｔ１）を中心として、制御危険度ｅ１をパラメータとした分布を持つ値をプロットする。制御パラメータ空間とは、パラシュートの基本制御パラメータである降下率と旋回率の次元を持ち、各座標で示される制御の危険性への影響度を制御危険度の値として有する空間である。この値が高くなっているパラメータで制御をすると危険性が高く、この値が低くなっているパラメータで制御すると比較的危険性が低いという意味を示す。
　以上の処理を下方危険度判定情報、側方危険度判定情報のそれぞれのグリッドを注目地点として実施する。その結果、制御パラメータ空間上に図１５に一例を示すような、基本制御パラメータに対する総合的な危険性を示す複数の分布が算出される。図１５では、制御危険度eの分布が、ｅ２－ｅ７の各円で表される分布のようになっている。そして、制御パラメータ空間上で、最も制御危険度の低い値を取っている箇所の一点を制御パラメータ決定値１４０１としている。
　ここで、制御危険度計算および制御パラメータ空間へのプロットは、全ての下方危険度判定情報、側方危険度判定情報で算出されたグリッドに対して実施する必要は無い。例えば、危険度の高いグリッドや、自身から近距離に存在するグリッドに対してのみ実施することができる。
　また、制御パラメータ空間には事前に分布を持たせることが可能である。例えば、図１４に示す例で、旋回率が低く降下率が高い領域に低い制御危険度を設定すると、全く回避対象物が無い場合は、旋回をせずに早く降下するという動作が選択されるようになる。
　以上説明したように、本実施形態の着陸装置によれば、飛行不能に陥った飛行型無人機を、障害物との衝突等の危険性が低い地点へ誘導し、危険性が安全に着陸させることができる。
　（第４の実施の形態）
　第３の実施形態では危険物位置情報を得る手段として光学カメラを用いていたが、光学カメラの代わりに、ＬＩＤＡＲやレーダー、超音波測距センサといったアクティブ系の測距センサを用いることも可能である。図１７にカメラの代わりに測距センサ１６０を用いた着陸装置１０１のブロック図を示す。降下着陸制御装置１３１は、光学画像の代わりに、測距センサ１６０が測定した測距データを用いて、物体認識、危険度の算出等を行う。それ以外の構成については、第２の実施形態と同様である。
　特に光学カメラの性能が制限される夜間においては、これらのアクティブ系のセンサを用いる事で正確な周囲情報を取得できるようになる。なお上記のＬＩＤＡＲはＬｉｇｈｔ　Ｄｅｔｅｃｔｉｏｎ　ａｎｄ　Ｒａｎｇｉｎｇの略である。
　（第５の実施の形態）
　第２、第３の実施形態では、自身の姿勢と運動情報の取得のために、加速度計、角速度計および対地高度計を用いていたが、画像情報を用いたジャイロ処理を行うことで、これらのセンサを省略することが可能である。
　図１７は、画像ジャイロを利用する着陸装置４００の一例を示すブロック図である。着陸装置４００は、パラシュート展開装置４１０、パラシュート制御装置４２０、システム制御装置４３０、カメラ４４０、落下検出装置４５０を有している。
　システム制御装置４３０は、降下着陸制御装置４３１と、画像ジャイロ計算装置４３２と、地図情報記憶装置４３３と、バッテリー４３４とを有している。画像ジャイロ計算装置４３２は、カメラ４４０から取得した画像情報と、地図情報記憶装置４３３に記憶された地図情報とに基づいて、自身の位置、対地高度を算出する。また、これらの時間変化から、速度、加速度を算出する。落下検出装置４５０は、算出された下方加速度や落下速度が所定の閾値を超えたことで、落下を検出しパラシュート展開装置４１０を動作させてパラシュートを展開する。なお、ここでは、落下検出装置４５０を、降下着陸制御装置を駆動するバッテリー４３４と別のバッテリー４５２で駆動する構成としているが、同じバッテリーで駆動する構成であっても良い。降下着陸制御装置４３１は、画像ジャイロ計算装置４３２が算出した、位置、対地高度、速度、加速度等に基づいて、下方および側方の各地点における危険度を算出する。そして、危険度の高い位置を避けてパラシュート４１１が移動するようにパラシュート制御装置４２０を制御し、飛行型無人機を安全な地点に誘導する。
　以上説明したように、本実施形態によれば、加速度計、角速度計および対地高度計を用いることなく、飛行型無人機を安全な地点に誘導し、着陸させることができる。なお、図１７では、落下検出装置４５０をシステム制御装置４３０と分離した構成としているが、システム制御装置４３０の一部として構成されていても良い。
　以上、上述した実施形態を模範的な例として本発明を説明した。しかしながら、本発明は、上記実施形態には限定されない。即ち、本発明は、本発明のスコープ内において、当業者が理解し得る様々な態様を適用することができる。
　以上の第１から第４の実施形態の処理をコンピュータに実行させるプログラムおよび該プログラムを格納した記録媒体も本発明の範囲に含む。記録媒体としては、例えば、磁気ディスク、磁気テープ、光ディスク、光磁気ディスク、半導体メモリ、などを用いることができる。
（付記１）
　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出する危険物位置検出装置と、
　前記危険物位置検出装置が検出した前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出する移動目標位置算出装置と、
　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御するパラシュート制御装置と
　を有することを特徴とする着陸装置。
（付記２）
前記飛行型無人機の落下を検出する落下検出手段と、
　前記落下検出手段が前記飛行型無人機の落下を検出した場合にパラシュートを展開するパラシュート展開手段と、
　を有することを特徴とする付記１に記載の着陸装置。
（付記３）
　前記移動目標位置算出装置が、
　前記飛行型無人機の下方および側方の座標に対応するグリッドを作成し、前記グリッドの各点に対して、前記危険物の位置に基づいた危険度を設定する
　ことを特徴とする付記１または２に記載の着陸装置。
（付記４）
　前記パラシュートと前記パラシュート制御装置とを接続する少なくとも一対の制御ワイヤを有し、
　前記パラシュート制御装置が、
　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量を制御するリールと、
　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し位置を制御するワイヤガイドと
　を有することを特徴とする付記３に記載の着陸装置。
（付記５）
　前記パラシュート制御装置が、
　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量および繰り出し位置と、実際のパラシュートの挙動との関係に基づいて、
　前記パラシュートを制御した時の挙動を予測するパラシュート制御モデルを構築する
　ことを特徴とする付記４に記載の着陸装置。
（付記６）
　前記パラシュート制御装置が、
　前記パラシュートの旋回率および降下率を次元とする制御パラメータ空間を作成し、
　前記制御パラメータ空間の各点に対し、前記危険度に対応する制御危険度を算出し、
　前記パラシュート制御モデルに基づいて、前記制御危険度の低い前記制御パラメータ空間の点に対応する制御を選択する
　ことを特徴とする付記５に記載の着陸装置。
（付記７）
　前記移動目標位置算出装置が、
　前記危険度の低い前記グリッドを移動目標位置に設定する
　ことを特徴とする付記３乃至６のいずれか一項に記載の着陸装置。
（付記８）
　前記危険物位置検出装置がカメラであることを特徴とする付記１乃至７のいずれか一項に記載の着陸装置。
（付記９）
　前記危険物位置検出装置が測距センサであることを特徴とする付記１乃至７のいずれか一項に記載の着陸装置。
（付記１０）
　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出し、
　前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出し、
　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御する
　ことを特徴とする着陸制御方法。
（付記１１）
　前記飛行型無人機の落下を検出し、
　前記飛行型無人機の落下を検出した場合にパラシュートを展開する
　ことを特徴とする付記１０に記載の着陸制御方法。
（付記１２）
　前記飛行型無人機の下方および側方の座標に対応するグリッドを作成し、前記グリッドの各点に対して、前記危険物の位置に基づいた危険度を設定する
　ことを特徴とする付記１１に記載の着陸制御方法。
（付記１３）
　前記飛行型無人機と前記パラシュートとを接続する少なくとも一対の制御ワイヤを設け、
　少なくとも一対の前記制御ワイヤのそれぞれの前記飛行型無人機からの繰り出し量を制御し、
　少なくとも一対の前記制御ワイヤのそれぞれの前記飛行型無人機からの繰り出し位置を制御する
　ことを特徴とする付記１２に記載の着陸制御方法。
（付記１４）
　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量および繰り出し位置と、実際のパラシュートの挙動との関係に基づいて、
　前記パラシュートを制御した時の運動を予測するパラシュート制御モデルを構築する
　ことを特徴とする付記１３に記載の着陸制御方法。
（付記１５）
　前記パラシュート制御モデルを
　前記パラシュートの降下中に実際に行った前記パラシュートの制御と、前記パラシュートの制御に対応する前記パラシュートの運動との関係に基づいて調整する
　ことを特徴とする付記１４に記載の着陸制御方法。
（付記１６）
　前記パラシュートの旋回率および降下率を次元とする制御パラメータ空間を作成し、
　前記制御パラメータ空間の各点に対し、前記危険度に対応する制御危険度を算出し、
　前記パラシュート制御モデルに基づいて、前記制御危険度の低い前記制御パラメータ空間の点に対応する制御を選択する
　ことを特徴とする付記１４または１５に記載の着陸方制御法。
（付記１７）
　前記制御パラメータ空間の各点に対する前記制御危険度に予め定めたオフセット値を設定する
　ことを特徴とする付記１６に記載の着陸制御方法。
（付記１８）
　前記危険度の低い前記グリッドを移動目標位置に設定する
　ことを特徴とする付記１２乃至１７のいずれか一項に記載の着陸制御方法。
（付記１９）
　前記危険物の位置検出を撮像データに基づいて行うことを特徴とする付記１０乃至１８のいずれか一項に記載の着陸制御方法。
（付記２０）
　前記危険物の位置検出を測距データに基づいて行うことを特徴とする付記１０乃至１８のいずれか一項に記載の着陸制御方法。
（付記２１）
　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出するステップと、
　前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出するステップと、
　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御するステップと
　を有することを特徴とする着陸制御プログラムを記録したプログラム記録媒体。
　４、１５０、４５０　　落下検出装置
　５、１１０、４１０　　パラシュート展開装置
　１　　危険物位置検出装置
　２　　移動目標地点算出装置
　３、１２０、４２０　　パラシュート制御装置
　１００、１０１、４００　　着陸装置
　１１１、４１１　　パラシュート
　１１２　　ワイヤ
　１１３　　制御ワイヤ
　１３０、４３０　　システム制御装置
　１３１、４３１　　降下着陸制御装置
　１３２、１５１　　３軸加速度計
　１３３　　３軸角速度計
　１３４　　対地高度計
　１３５、１５２、４３４、４５２　　バッテリー
　１４０、４４０　　カメラ
　１６０　　測距センサ
　４３２　　画像ジャイロ計算装置
　４３３　　地図情報記憶装置

Claims (21)

  1. 　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出する危険物位置検出手段と、
    　前記危険物位置検出手段が検出した前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出する移動目標位置算出手段と、
    　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御するパラシュート制御手段と
    　を有することを特徴とする着陸装置。
  2. 　前記飛行型無人機の落下を検出する落下検出手段と、
    　前記落下検出手段が前記飛行型無人機の落下を検出した場合にパラシュートを展開するパラシュート展開手段と、
    　を有することを特徴とする請求項１に記載の着陸装置。
  3. 　前記移動目標位置算出手段が、
    　前記飛行型無人機の下方および側方の座標に対応するグリッドを作成し、前記グリッドの各点に対して、前記危険物の位置に基づいた危険度を設定する
    　ことを特徴とする請求項１または２に記載の着陸装置。
  4. 　前記パラシュートと前記パラシュート制御手段とを接続する少なくとも一対の制御ワイヤを有し、
    　前記パラシュート制御手段が、
    　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量を制御するリールと、
    　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し位置を制御するワイヤガイドと
    　を有することを特徴とする請求項３に記載の着陸装置。
  5. 　前記パラシュート制御手段が、
    　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量および繰り出し位置と、実際のパラシュートの挙動との関係に基づいて、
    　前記パラシュートを制御した時の挙動を予測するパラシュート制御モデルを構築する
    　ことを特徴とする請求項４に記載の着陸装置。
  6. 　前記パラシュート制御手段が、
    　前記パラシュートの旋回率および降下率を次元とする制御パラメータ空間を作成し、
    　前記制御パラメータ空間の各点に対し、前記危険度に対応する制御危険度を算出し、
    　前記パラシュート制御モデルに基づいて、前記制御危険度の低い前記制御パラメータ空間の点に対応する制御を選択する
    　ことを特徴とする請求項５に記載の着陸装置。
  7. 　前記移動目標位置算出手段が、
    　前記危険度の低い前記グリッドを移動目標位置に設定する
    　ことを特徴とする請求項３乃至６のいずれか一項に記載の着陸装置。
  8. 　前記危険物位置検出手段がカメラであることを特徴とする請求項１乃至７のいずれか一項に記載の着陸装置。
  9. 　前記危険物位置検出手段が測距センサであることを特徴とする請求項１乃至７のいずれか一項に記載の着陸装置。
  10. 　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出し、
    　前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出し、
    　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御する
    　ことを特徴とする着陸制御方法。
  11. 　前記飛行型無人機の落下を検出し、
    　前記飛行型無人機の落下を検出した場合にパラシュートを展開する、
    　ことを特徴とする請求項１０に記載の着陸制御方法。
  12. 　前記飛行型無人機の下方および側方の座標に対応するグリッドを作成し、前記グリッドの各点に対して、前記危険物の位置に基づいた危険度を設定する
    　ことを特徴とする請求項１１に記載の着陸制御方法。
  13. 　前記飛行型無人機と前記パラシュートとを接続する少なくとも一対の制御ワイヤを設け、
    　少なくとも一対の前記制御ワイヤのそれぞれの前記飛行型無人機からの繰り出し量を制御し、
    　少なくとも一対の前記制御ワイヤのそれぞれの前記飛行型無人機からの繰り出し位置を制御する
    　ことを特徴とする請求項１２に記載の着陸制御方法。
  14. 　少なくとも一対の前記制御ワイヤのそれぞれの繰り出し量および繰り出し位置と、実際のパラシュートの挙動との関係に基づいて、
    　前記パラシュートを制御した時の運動を予測するパラシュート制御モデルを構築する
    　ことを特徴とする請求項１３に記載の着陸制御方法。
  15. 　前記パラシュート制御モデルを
    　前記パラシュートの降下中に実際に行った前記パラシュートの制御と、前記パラシュートの制御に対応する前記パラシュートの運動との関係に基づいて調整する
    　ことを特徴とする請求項１４に記載の着陸制御方法。
  16. 　前記パラシュートの旋回率および降下率を次元とする制御パラメータ空間を作成し、
    　前記制御パラメータ空間の各点に対し、前記危険度に対応する制御危険度を算出し、
    　前記パラシュート制御モデルに基づいて、前記制御危険度の低い前記制御パラメータ空間の点に対応する制御を選択する
    　ことを特徴とする請求項１４または１５に記載の着陸制御方法。
  17. 　前記制御パラメータ空間の各点に対する前記制御危険度に予め定めたオフセット値を設定する
    　ことを特徴とする請求項１６に記載の着陸制御方法。
  18. 　前記危険度の低い前記グリッドを移動目標位置に設定する
    　ことを特徴とする請求項１２乃至１７のいずれか一項に記載の着陸制御方法。
  19. 　前記危険物の位置検出を撮像データに基づいて行うことを特徴とする請求項１０乃至１８のいずれか一項に記載の着陸制御方法。
  20. 　前記危険物の位置検出を測距データに基づいて行うことを特徴とする請求項１０乃至１８のいずれか一項に記載の着陸制御方法。
  21. 　パラシュートを用いて着陸を行う飛行型無人機の周囲の危険物の位置を検出するステップと、
    　前記危険物の位置に基づいて、前記飛行型無人機が前記危険物を避けて移動するための移動目標位置を算出するステップと、
    　前記移動目標位置に前記飛行型無人機が移動するように前記パラシュートを制御するステップと
    　を有することを特徴とする着陸制御プログラムを記録したプログラム記録媒体。
PCT/JP2017/024076 2017-06-30 2017-06-30 着陸装置、着陸制御方法、着陸制御プログラム WO2019003405A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
PCT/JP2017/024076 WO2019003405A1 (ja) 2017-06-30 2017-06-30 着陸装置、着陸制御方法、着陸制御プログラム
US16/626,705 US20210147075A1 (en) 2017-06-30 2017-06-30 Landing apparatus, landing control method, and landing control program
JP2019526084A JP6838656B2 (ja) 2017-06-30 2017-06-30 着陸装置、着陸制御方法、着陸制御プログラム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/024076 WO2019003405A1 (ja) 2017-06-30 2017-06-30 着陸装置、着陸制御方法、着陸制御プログラム

Publications (1)

Publication Number Publication Date
WO2019003405A1 true WO2019003405A1 (ja) 2019-01-03

Family

ID=64741273

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/024076 WO2019003405A1 (ja) 2017-06-30 2017-06-30 着陸装置、着陸制御方法、着陸制御プログラム

Country Status (3)

Country Link
US (1) US20210147075A1 (ja)
JP (1) JP6838656B2 (ja)
WO (1) WO2019003405A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020246075A1 (ja) * 2019-06-04 2020-12-10 ソニー株式会社 行動制御装置と行動制御方法およびプログラム

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000159192A (ja) * 1998-11-24 2000-06-13 Fuji Heavy Ind Ltd パラフォイルを備えた飛行体の自動誘導システム及びその航法誘導装置
JP2004322965A (ja) * 2003-04-28 2004-11-18 Mitsubishi Heavy Ind Ltd パラフォイル制御装置、パラフォイル制御方法、および落下制御方法
JP2011253302A (ja) * 2010-06-01 2011-12-15 Toyota Motor Corp 車両用危険度算出装置
JP2016088111A (ja) * 2014-10-29 2016-05-23 ヤンマー株式会社 ヘリコプター
US20160318615A1 (en) * 2015-04-28 2016-11-03 SkyFallX, LLC Autonomous safety and recovery system for unmanned aerial vehicles
JP2016222244A (ja) * 2016-08-03 2016-12-28 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドＳｚ Ｄｊｉ Ｔｅｃｈｎｏｌｏｇｙ Ｃｏ．，Ｌｔｄ 衝突保護装置
WO2017033976A1 (ja) * 2015-08-25 2017-03-02 日本電気株式会社 飛行体制御装置、飛行体制御方法、及びコンピュータ読み取り可能な記録媒体

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000159192A (ja) * 1998-11-24 2000-06-13 Fuji Heavy Ind Ltd パラフォイルを備えた飛行体の自動誘導システム及びその航法誘導装置
JP2004322965A (ja) * 2003-04-28 2004-11-18 Mitsubishi Heavy Ind Ltd パラフォイル制御装置、パラフォイル制御方法、および落下制御方法
JP2011253302A (ja) * 2010-06-01 2011-12-15 Toyota Motor Corp 車両用危険度算出装置
JP2016088111A (ja) * 2014-10-29 2016-05-23 ヤンマー株式会社 ヘリコプター
US20160318615A1 (en) * 2015-04-28 2016-11-03 SkyFallX, LLC Autonomous safety and recovery system for unmanned aerial vehicles
WO2017033976A1 (ja) * 2015-08-25 2017-03-02 日本電気株式会社 飛行体制御装置、飛行体制御方法、及びコンピュータ読み取り可能な記録媒体
JP2016222244A (ja) * 2016-08-03 2016-12-28 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドＳｚ Ｄｊｉ Ｔｅｃｈｎｏｌｏｇｙ Ｃｏ．，Ｌｔｄ 衝突保護装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020246075A1 (ja) * 2019-06-04 2020-12-10 ソニー株式会社 行動制御装置と行動制御方法およびプログラム

Also Published As

Publication number Publication date
JPWO2019003405A1 (ja) 2020-03-19
US20210147075A1 (en) 2021-05-20
JP6838656B2 (ja) 2021-03-03

Similar Documents

Publication Publication Date Title
US20220146263A1 (en) Dynamically Adjusting UAV Flight Operations Based On Thermal Sensor Data
Scherer et al. Flying fast and low among obstacles
JP2020505261A (ja) 無人航空機のための衝突回避システム及び方法
JP6844916B2 (ja) 航空機フライトエンベロープ保護及び回復オートパイロット
KR20200031165A (ko) 내비게이션 차트 구성 방법, 장애물 회피 방법 및 장치, 단말기, 무인 항공기
US20190172358A1 (en) Methods and systems for obstacle identification and avoidance
JP5688700B2 (ja) 移動体制御装置及び移動体制御装置を搭載した移動体
US20220317705A1 (en) Aircraft return control method and device, aircraft and storage medium
JP2009173263A (ja) 無人航空機（ｕａｖ）によって移動目標物を自律的に追跡するための方法及びシステム
CN104503466A (zh) 一种微小型无人机导航装置
JP2014227166A (ja) 飛行体型目視点検装置
CN108698696B (zh) 主动运载工具控制系统和方法
EP3868652B1 (en) Information processing system, information processing method, and program
JP2007245797A (ja) 飛行制御装置及び飛行制御装置を備えた飛行体
US20170330467A1 (en) Flight control method and unmanned unmannered aerial vehicle
JP2019196150A (ja) 安全着陸可能領域を識別するためのシステム、方法、プログラム及びプログラムを記憶した記憶媒体
JP2017206224A (ja) 飛行制御方法及び無人飛行体
WO2022044533A1 (ja) 情報処理装置及び情報処理方法、コンピュータプログラム、並びに移動体装置
Meister et al. Adaptive path planning for a vtol-uav
CN110632945B (zh) 一种直升机着陆方法、装置及系统
JP6838656B2 (ja) 着陸装置、着陸制御方法、着陸制御プログラム
KR20180032966A (ko) 송배전설비 감시용 무인 항공기, 송배전설비 감시 시스템 및 송배전설비 감시용 무인 항공기 제어방법
CN113892070A (zh) 学习装置、信息处理装置、及完成学习的控制模型
CN114521248A (zh) 信息处理设备、信息处理方法和程序
US20230312091A1 (en) Semantic Adjustment of Unmanned Aerial Vehicle Delivery Points

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17915269

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2019526084

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17915269

Country of ref document: EP

Kind code of ref document: A1