WO2020136850A1 - 制御装置、フォーメーション決定装置、制御方法およびプログラム - Google Patents

制御装置、フォーメーション決定装置、制御方法およびプログラム Download PDF

Info

Publication number
WO2020136850A1
WO2020136850A1 PCT/JP2018/048355 JP2018048355W WO2020136850A1 WO 2020136850 A1 WO2020136850 A1 WO 2020136850A1 JP 2018048355 W JP2018048355 W JP 2018048355W WO 2020136850 A1 WO2020136850 A1 WO 2020136850A1
Authority
WO
WIPO (PCT)
Prior art keywords
unmanned aerial
aerial vehicle
formation
existence probability
controlled
Prior art date
Application number
PCT/JP2018/048355
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 JP2020562252A priority Critical patent/JPWO2020136850A1/ja
Priority to PCT/JP2018/048355 priority patent/WO2020136850A1/ja
Priority to US17/417,220 priority patent/US11853066B2/en
Publication of WO2020136850A1 publication Critical patent/WO2020136850A1/ja

Links

Images

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/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • 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/0011—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
    • G05D1/0027—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement involving a plurality of vehicles, e.g. fleet or convoy travelling
    • 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/0011—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement
    • G05D1/0016—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots associated with a remote control arrangement characterised by the operator's input device
    • 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/0094—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots involving pointing a payload, e.g. camera, weapon, sensor, towards a fixed or moving target

Definitions

  • the present invention relates to a control device, a formation determination device, a control method and a program.
  • unmanned aerial vehicles For example, disk-shaped robots that automatically clean the room, and drones that fly in the air are used for home delivery. In addition, robots that operate in dangerous environments such as nuclear power plants are also examples.
  • An application example using a plurality of unmanned aerial vehicles has also been proposed. For example, in an E-commerce (Electric Commerce) factory, a plurality of baggage-carrying robots are used to quickly collect products ordered by a customer (see Patent Document 1). In addition, there are applications such as searching for a search target using a plurality of unmanned aerial vehicles (see Patent Document 2).
  • the unmanned aerial vehicle in this case is generally called UxV (Unmanned x Vehicle), UAV (Unmanned Air Vehicle) for unmanned aerial vehicles, USV (Unmanned Surface Vehicle) for unmanned aerial vehicles, and UUV (Unmanned for unmanned underwater vehicles). Undersea Vehicle) is called.
  • UxV Unmanned x Vehicle
  • UAV Unmanned Air Vehicle
  • USV Unmanned Surface Vehicle
  • UUV Unmanned for unmanned underwater vehicles
  • the above unmanned aerial vehicles are classified into two types: those that can be operated remotely by humans and those that can operate autonomously by the installed programs. Of these, it is desired that an unmanned aerial vehicle or a group of unmanned aerial vehicles that can autonomously perform an action by an installed program, turn into a human being and perform various actions and work even if there is no human being.
  • One of the reasons why research on artificial intelligence is actively carried out is that it is expected that an unmanned aerial vehicle can operate wisely by mounting excellent artificial intelligence.
  • Paraphrasing that the drone operates wisely means that the drone changes its behavior autonomously depending on the situation.
  • drones often have multiple missions (actions), and it is necessary to change their behaviors depending on the situation.
  • an unmanned aerial vehicle may search for dangerous goods at first, track the found dangerous goods when they move, and sometimes capture the dangerous goods. Therefore, it is necessary to change the mission depending on the situation.
  • the missions include exploration, tracking and capture.
  • an unmanned aerial vehicle or a group of unmanned aerial vehicles has been proposed, and further, practical applications in various fields have begun to be examined.
  • One of the fields in which the utilization of unmanned aerial vehicles or a group of unmanned aerial vehicles is considered to be most important is the security field.
  • An example of the use of an unmanned aerial vehicle or a group of unmanned aerial vehicles in the security field is an operation of capturing a target such as a suspicious person, a criminal, a dangerous person, or an animal to be exterminated.
  • One example of the object of the present invention is to provide a control device, a formation determination device, a control method and a program that can more efficiently capture an object.
  • the control device is mounted on the unmanned aerial vehicle, and an information acquisition and development unit that acquires position information of the unmanned aerial vehicle to be controlled and positional information of the unmanned aerial vehicle other than the controlled object.
  • Existence probability calculation for calculating the existence probability distribution of the object based on the information of the object detection unit that attempts to detect the object using the sensor signal from the sensor and the position and time when the object is successfully detected Section, a formation determining unit that determines the formation of the plurality of unmanned aerial vehicles based on the existence probability distribution of the target object, and an operation amount calculation unit that calculates the operating amount of the unmanned aerial vehicle to be controlled based on the formation
  • an operation setting unit that sets an operation for the unmanned device to be controlled according to the calculated operation amount.
  • the formation determining device uses the information acquisition and development unit that acquires the position information of the plurality of unmanned aerial vehicles and the sensor signal from the sensor mounted on the unmanned aerial vehicles.
  • An object detection unit that attempts to detect, an existence probability calculation unit that calculates the existence probability distribution of the object based on information on the position and time at which the object is successfully detected, and based on the existence probability distribution of the object
  • a formation determining unit that determines formations of the plurality of unmanned aerial vehicles.
  • a control method includes a step of acquiring position information of an unmanned aerial vehicle to be controlled and position information of an unmanned aerial vehicle other than the controlled object, and a sensor mounted on the unmanned aerial vehicle. Attempting to detect an object using the sensor signal of, and the step of calculating the existence probability distribution of the object based on the information of the position and time at which the object was successfully detected; and the existence probability of the object. Based on the distribution, the step of setting a parameter value for determining the formation of the plurality of unmanned aerial vehicles, based on the formation, the step of calculating the operation amount of the unmanned aerial vehicle to be controlled, according to the calculated operation amount, And a step of performing operation setting for the unmanned aerial vehicle to be controlled.
  • a program is installed in the unmanned device, the process of acquiring the position information of the unmanned device to be controlled and the position information of the unmanned device other than the controlled object in the computer. Attempting to detect an object using a sensor signal from a sensor, calculating the existence probability distribution of the object based on the information of the position and time at which the object was successfully detected, and the object Based on the existence probability distribution, a step of setting a parameter value that determines the formation of the plurality of unmanned aerial vehicles, a step of calculating the operation amount of the unmanned aerial vehicle to be controlled based on the formation, and the calculated operation amount And a step of performing operation setting for the unmanned aerial vehicle to be controlled according to the above.
  • the target can be captured more efficiently.
  • FIG. 1 is a schematic diagram showing a first example of the configuration of the unmanned aerial vehicle system according to the embodiment.
  • the unmanned aerial vehicle system 1 includes a plurality of control devices 100 and a plurality of unmanned aerial vehicles 200.
  • the control device 100 includes an information acquisition and development unit 101, an object detection unit 102, an existence probability calculation unit 103, a parameter setting unit 104, a motion amount calculation unit 105, and a motion setting unit 106.
  • the unmanned aerial vehicle 200 includes a sensor 201.
  • the unmanned aerial vehicle system 1 is a system that detects and captures an object using a plurality of unmanned aerial vehicles 200.
  • the control device 100 is provided on a one-to-one basis with the unmanned aerial vehicle 200, and controls the one unmanned aerial vehicle 200.
  • the control device 100 may be mounted on the unmanned aerial vehicle 200 to be controlled. Alternatively, the control device 100 may be installed outside the unmanned aerial vehicle 200 to be controlled and communicate with the unmanned aerial vehicle 200 to be controlled.
  • the control device 100 may be configured by using a computer such as a workstation, a personal computer (PC), or a microcomputer. Alternatively, the control device 100 may be configured using hardware designed specifically for the control device 100, such as configured using an ASIC (Application Specific Integrated Circuit).
  • the unmanned aerial vehicles 200 other than the unmanned aerial vehicle 200 controlled by the control device 100 are referred to as other unmanned aerial vehicles 200. Any one of the plurality of unmanned aerial vehicles 200 is the unmanned aerial vehicle 200 to be controlled, and the other unmanned aerial vehicles 200 are other unmanned aerial vehicles 200.
  • the information acquisition/deployment unit 101 acquires position information and status information of the unmanned aerial vehicle 200 from the controlled unmanned aerial vehicle 200. In addition, the information acquisition and development unit 101 acquires the position information and the status information of the unmanned aerial vehicle 200 from another communicable unmanned aerial vehicle 200.
  • the status information is information indicating the status regarding the unmanned aerial vehicle 200.
  • the state information acquired by the information acquisition and development unit 101 includes an evaluation value related to the behavior of the plurality of unmanned aerial vehicles 200 in the unmanned aerial vehicle 200, and an evaluation function for calculating the evaluated value. Furthermore, the state information acquired by the information acquisition and development unit 101 includes an evaluation value or information associated with the evaluation function, such as a setting parameter applied to the evaluation function and a value obtained by mathematically processing the evaluation function.
  • Examples of values obtained by the information acquisition and development unit 101 by mathematically processing the evaluation function may include differentiation and/or integration of the evaluation function, but are not limited thereto.
  • Position information may be included in the state information. Alternatively, the state information and the position information may be treated as separate information as described above.
  • the information acquisition and development unit 101 also acquires information on the position at which the object is detected and the time thereof from the unmanned aerial vehicle 200 that has detected the object. Furthermore, the information acquisition and development unit 101 not only acquires information from other unmanned aerial vehicles 200, but also status information of the controlled unmanned aerial vehicles 200, detection information of an object by the controlled unmanned aerial vehicles 200, and the like. Notify the other drone 200.
  • the object detection unit 102 attempts to detect an object using the sensor signal from the sensor 201 of the unmanned aerial vehicle 200 to be controlled.
  • the sensor signal here is a signal indicating the sensing result.
  • any one of a camera, an infrared sensor, an ultrasonic sensor, or a combination thereof can be used, but the sensor 201 is not limited thereto.
  • the object detection unit 102 applies the sensor signal from the sensor 201 to a recognition algorithm and refers to the recognition result to determine whether or not the object is detected.
  • a known algorithm can be used as the recognition algorithm in this case.
  • the target object detection unit 102 When the target object is detected, the target object detection unit 102 records the position and time. The recorded position information and time information are used by the existence probability calculation unit 103 to determine the behavior of the unmanned aerial vehicle 200 to be controlled. Further, the object detection unit 102 outputs the position information and time information of the object detection to the information acquisition and development unit 101. The information acquisition and development unit 101 notifies the acquired position information and time information to another unmanned aerial vehicle 200 with which communication is possible.
  • the existence probability calculation unit 103 uses the signal from the target object detection unit 102 and the information on the target object held by another unmanned aerial vehicle 200 that is communicative and is obtained from the information acquisition and development unit 101. Calculate the existence probability distribution.
  • the existence probability calculation unit 103 calculates the existence probability distribution of the object using the object information of the unmanned aerial vehicle 200 to be controlled and the object information of the other unmanned aerial vehicle 200.
  • the object information of the unmanned aerial vehicle 200 to be controlled is information indicating a detection result such as a position and time when the object detecting unit 102 detects the object using the sensor information of the sensor 201 of the unmanned aerial vehicle 200 to be controlled. Is.
  • the object information of the other unmanned aerial vehicle 200 is the position when the object detection unit 102 of the control device 100 that controls the unmanned aerial vehicle 200 detects the object using the sensor information of the sensor 201 of the unmanned aerial vehicle 200. And information indicating the detection result such as time.
  • the existence probability calculation unit 103 calculates the existence probability of the target object, for example, using the following method.
  • a two-dimensional or three-dimensional Gaussian distribution is set around the position where the object is detected for all the object information of the unmanned aerial vehicle 200 to be controlled and the object information of the other unmanned aerial vehicle 200.
  • the existence probability calculation unit 103 changes the height of the peak and the spread of the distribution depending on the detection time of the object.
  • the existence probability calculation unit 103 makes the peak value of the information of the latest time the highest among the information of detecting the object, and decreases the peak value as the distance from the time increases. Also, the existence probability calculation unit 103 minimizes the spread of the distribution of information at the latest time, and increases the spread of the distribution as the distance from the time increases.
  • the existence probability calculation unit 103 calculates the existence probability distribution having a larger spatial extent as time passes after the object detection unit 102 has succeeded in detecting the object.
  • the large spatial spread here means that the distribution of the existence probability distribution is large.
  • the existence probability calculation unit 103 sets the existence probability distribution of the object as a Gaussian distribution
  • the Gaussian distribution with a larger variance may be set as the time elapses from the detection of the object. Good.
  • the existence probability calculation unit 103 sets a region having a finite area as a region in which the existence probability of the object is larger than 0, the area of the region in which the existence probability of the object is larger than 0 is increased with time. You may do so.
  • the existence probability calculation unit 103 forms a distribution map in which the pieces of object information are two-dimensionally or three-dimensionally mapped. Any position on the map will have some distribution value.
  • the existence probability calculation unit 103 divides the distribution value of the map by a value obtained by integrating all distribution values in two dimensions or three dimensions so that the information can be treated as the existence probability of the object. As a result, the total distribution value of the entire map becomes 1. For example, when an object is detected only once and is not detected thereafter, a Gaussian distribution (circular or spherical) having a peak at the position where the object is detected is formed, and the peak The map is updated so that the height becomes lower and the spread of the distribution becomes wider.
  • the existence probability calculation unit 103 may superimpose geographical information when calculating the existence probability distribution. For example, when there is a region, cliff, or valley where the object cannot enter, the existence probability calculation unit 103 may always calculate the existence probability of the place as 0. By doing so, it is possible to eliminate the waste of the drone 200 searching for a place where the target object cannot escape.
  • the parameter setting unit 104 sets parameters for formation formed by a plurality of unmanned aerial vehicles 200 based on the information from the information acquisition and development unit 101 and the calculation result of the existence probability calculation unit 103. Specifically, the parameter setting unit 104 sets parameters regarding the formation shape and the speed of formation change.
  • the parameter setting unit 104 corresponds to an example of the formation determining unit, and determines the formation of the plurality of unmanned aerial vehicles 200 by setting values in the parameters.
  • Parameter values indicating the shape of the formation such as a circle or an arc, an ellipse, a double circle, and an arbitrary shape, are predetermined, and the parameter setting unit 104 stores these parameter values. Further, the parameter setting unit 104 has a function of selecting a parameter value based on the information regarding the existence probability distribution of the target object.
  • a contour line shape of the existence probability distribution of the target object can be used, but the shape is not limited thereto.
  • the contour line of the existence probability of the object is a line obtained by tracing the position where the existence probability distribution has a certain value.
  • the size of the contour line (for example, the area of the portion surrounded by the contour line) can be used as the size of the existence probability distribution of the target object, but is not limited thereto.
  • the parameter setting unit 104 selects any one of a plurality of predetermined shapes as the formation shape of the unmanned aerial vehicle 200.
  • One or more parameters are provided for each formation shape, and the parameter setting unit 104 sets the value of the parameter provided for the selected shape.
  • a plurality of parameter value sets in which the values of the parameters are combined for each shape of the formation are prepared, and the parameter setting unit 104 may set a value for each parameter by selecting one of the parameter value sets. ..
  • the parameter setting unit 104 may select one of the parameter value sets based on the information regarding the existence probability distribution of the target object.
  • the parameter setting unit 104 may directly set values to at least some parameters.
  • the parameter setting unit 104 may calculate and set the value to be set for the parameter for which the value is not set, based on the information regarding the existence probability distribution of the object.
  • the speed at which the formation is changed may be set by the parameter setting unit 104 as a speed vector.
  • the parameter formation units 104 of all control devices 100 can share the same formation by performing the same setting or common setting. For this reason, when any one of the control devices 100 determines the formation of the unmanned aerial vehicle 200, the determined formation may be notified to the other control device 100.
  • the parameter setting unit 104 sets a parameter value indicating which of the first circle and the second circle the unmanned aerial vehicle 200 to be controlled is arranged. May be. Further, in the case of an elliptical formation, the parameter setting unit 104 may set a parameter value indicating at which position in the formation of the formation the controlled unmanned aerial vehicle 200 is arranged.
  • the setting of these parameter values corresponds to an example in which they are common settings although they are not the same settings.
  • the parameter setting unit 104 sets the formation shape in consideration of the existence probability distribution of the object. For example, when a parameter indicating an arbitrary shape is set among the parameter values indicating the shape of the formation, the parameter setting unit 104 sets a formation similar to the contour line of the existence probability distribution of the object.
  • the parameter setting unit 104 sets a certain value of the existence probability distribution of the target object to specify the contour line of the value.
  • the parameter setting unit 104 may use the identified contour lines as they are as the formation of the unmanned aerial vehicle 200.
  • the parameter setting unit 104 may use the position of the peak of the existence probability distribution as a reference to enlarge or reduce the specified contour line and use it as the formation of the unmanned aerial vehicle 200.
  • the parameter setting unit 104 determines the formation of the unmanned aerial vehicle 200 based on the information regarding the existence probability distribution of the target.
  • the parameter setting unit 104 specifies the contour line of the existence probability distribution, for example, by setting the existence probability (value of the existence probability distribution) of the object to 70% of its peak value. Then, the parameter setting unit 104 calculates the smallest circle among the circles that include the identified contour lines. The parameter setting unit 104 determines whether or not the ratio of the area of the portion surrounded by the contour lines of the calculated area of the circle is equal to or more than a predetermined threshold value (for example, 80% or more).
  • a predetermined threshold value for example, 80% or more
  • the parameter setting unit 104 determines the calculated circle as a formation, and sets the center coordinates and radius of the circle as the parameter values of the circular formation. Further, the parameter setting unit 104 determines that the drone 200 moves at a predetermined speed toward the center of the circle while keeping the circle, as the formation changes.
  • the parameter setting unit 104 determines the identified contour line as a formation.
  • the parameter setting unit 104 determines, for example, the coordinates of the representative point for approximately indicating the contour line and the position of the coordinates of the position at which the existence probability distribution of the object has a peak value as a parameter of the formation of an arbitrary shape. Set as a value.
  • the parameter setting unit 104 maintains a similar shape of the identified contour lines of the unmanned aerial vehicle 200, and moves toward a position where the existence probability distribution of the target object reaches a peak value, the predetermined average. Decided to move at speed.
  • the expression of the formation becomes easier than when the formation of any shape is selected. Since the formation can be easily expressed, the load of the processing for the parameter setting unit 104 to change the formation over time can be relatively light.
  • the parameter setting unit 104 selects a formation having an arbitrary shape, so that when the circle does not match the shape of the existence probability distribution of the object, the formation can be made more suitable to the shape of the existence probability distribution of the object. ..
  • the process in which the parameter setting unit 104 determines the formation of the unmanned aerial vehicle 200 is not limited to the process of this example.
  • the parameter setting unit 104 may have a function of selecting a parameter value according to an external signal.
  • the speed at which the formation is changed may be set as a speed vector from the outside.
  • the parameter setting unit 104 may calculate the shortest distance between the contour line of the existence probability distribution of the object and the position of the unmanned aerial vehicle 200 to be controlled, as a parameter value relating to the positional relationship between the object and the unmanned aerial vehicle 200. .. In this case, the parameter setting unit 104 outputs the parameter value indicating the formation shape, the velocity vector value, and the information on the shortest distance to the motion amount calculation unit 105.
  • the motion amount calculation unit 105 includes the state information of the other unmanned aerial vehicle 200 obtained from the information acquisition and development unit 101, the existence probability distribution of the object calculated by the existence probability calculation unit 103, and the setting calculated by the parameter setting unit 104.
  • the operation amount of the unmanned aerial vehicle 200 to be controlled is calculated in an integrated manner using the value.
  • the motion amount calculation unit 105 may use a motion amount determination method that uses an evaluation value obtained from an evaluation function as the motion amount calculation method.
  • the evaluation value can be said to be information indicating the state of the unmanned aerial vehicle 200 for the purpose of the unmanned aerial vehicle 200. Therefore, the evaluation value can be used as an index of the code of conduct for the group of the unmanned aerial vehicles 200.
  • the purpose of unmanned aerial vehicle 200 is to detect and capture an object.
  • the motion amount calculation unit 105 may use the following two evaluation functions.
  • the first evaluation function f 1 out of the two evaluation functions is an evaluation function for maintaining the formation shape, and is represented by Expression (1).
  • the subscript i is a serial number that identifies the unmanned aerial vehicle 200, and means the i-th unmanned aerial vehicle. Therefore, f 1,i represents the first evaluation function used for the i-th unmanned aerial vehicle 200. Therefore, the i-th unmanned aerial vehicle 200 is the unmanned aerial vehicle 200 to be controlled.
  • R represents the shortest distance between the contour line of the existence probability distribution of the object and the unmanned aerial vehicle 200. Therefore, R i indicates the shortest distance between the contour line of the existence probability distribution of the object and the i-th unmanned aerial vehicle 200.
  • the second evaluation function f 2 is an evaluation function for properly maintaining the interval between the unmanned aerial vehicles 200, and is represented by Expression (2).
  • f 2,i represents the second evaluation function used for the i-th unmanned aerial vehicle 200.
  • the coordinates (x, y, z) indicate the position coordinates of the unmanned aerial vehicle 200. Therefore, the coordinates (x i , y i , z i ) indicate the position coordinates of the i-th unmanned aerial vehicle 200.
  • the subscripts i-1 and i+1 indicate the unmanned aerial vehicle 200 located closest to the left and right of the i-th unmanned aerial vehicle 200 as viewed from the i-th unmanned aerial vehicle 200. Coordinates (x i ⁇ 1 , y i ⁇ 1 , z i ⁇ 1 ) and (x i+1 , y i+1 , z i+1 ) indicate the position coordinates of these unmanned aerial vehicles 200.
  • the motion amount calculation unit 105 uses the first evaluation function f 1 to calculate an evaluation value for evaluating the position of the unmanned aerial vehicle 200 with respect to the existence probability of the target object. In addition, the motion amount calculation unit 105 uses the second evaluation function f 2 to calculate an evaluation value for evaluating whether the distance between the unmanned aerial vehicle 200 to be evaluated and the neighboring unmanned aerial vehicle 200 is balanced. To do. The motion amount calculation unit 105 uses these evaluation functions to determine the motion amount as follows, for example. First, the motion amount calculation unit 105 uses Expression (3) for the speed of the unmanned aerial vehicle.
  • V is a standard value of the velocity vector.
  • the motion amount calculation unit 105 calculates the speed vector obtained by correcting the standard value V of the speed vector based on the relationship between the unmanned aerial vehicle 200 to be controlled and the unmanned aerial vehicles 200 on the left and right sides thereof by the calculation using the equation (3).
  • ⁇ is a coefficient that determines the degree of change and corresponds to a gain.
  • the calculation of the second term “ ⁇ (f 1,i ⁇ 1 ⁇ f 1,i )+(f 1,i+1 ⁇ f 1,i )+ ⁇ ” in the equation (3) is performed by evaluating the unmanned aerial vehicle 200 to be controlled.
  • the value of the function f 1 an operation for comparing the value of the evaluation function f 1 of the drone 200 of its left and right both sides.
  • the movement amount calculation unit 105 calculates the movement amount of the unmanned aerial vehicle 200 to be controlled by comparing the values (evaluation values) of the evaluation functions by performing the calculation of the equation (3).
  • ⁇ is an offset caused by the shape of the formation.
  • the parameter setting unit 104 sets ⁇ to a finite value according to the position in charge of the unmanned aerial vehicle 200 to be controlled.
  • the motion amount calculation unit 105 basically sets the traveling direction (vector) of the controlled unmanned aerial vehicle 200 to the direction toward the position where the probability that the object exists is highest. Specifically, the motion amount calculation unit 105 basically connects the traveling direction of the controlled unmanned aerial vehicle 200 to the position where the target object is most likely to exist and the controlled unmanned aerial vehicle 200 position. Set in the opposite direction.
  • the motion amount calculation unit 105 sets a speed vector so that the unmanned aerial vehicle 200 to be controlled travels in that direction at the speed calculated by Expression (3). This velocity vector is called the main velocity vector V m .
  • the momentum calculating section 105 for correction from the main speed vector V m, to calculate the orthogonal vector V n for the primary velocity vector V m.
  • the motion amount calculation unit 105 calculates the orthogonal vector V n as in Expression (4).
  • V ne indicates a unit vector that is orthogonal to the main velocity vector V m and is oriented in the direction in which the i ⁇ 1th drone is located.
  • ⁇ corresponds to the gain.
  • the evaluation function f 2 included in Expression (4) is an expression that compares the evaluation value of the unmanned aerial vehicle 200 to be controlled with the evaluation value of the adjacent unmanned aerial vehicle 200. Therefore, the expression (4) is also an expression for comparing the evaluation value of the unmanned aerial vehicle 200 to be controlled with the evaluation value of the adjacent unmanned aerial vehicle 200.
  • the movement amount calculation unit 105 sets the combined amount of V m and V n as the movement amount of the unmanned aerial vehicle 200 to be controlled.
  • the operation setting unit 106 sets an operation set value of an actuator that operates the unmanned aerial vehicle 200 to be controlled so that the unmanned aerial vehicle 200 to be controlled operates with the amount of operation calculated by the operation amount calculating unit 105.
  • the operation setting unit 106 operates the unmanned aerial vehicle 200 to be controlled such that the unmanned aerial vehicle 200 to be controlled operates with the speed vector (V m +V n ) calculated as the amount of operation by the operation amount calculating unit 105. Set the operation of.
  • the motion amount calculation unit 105 calculates the evaluation amount based on the formula (3) and the formula (4), so that the motion indicated by the evaluation values by the formula (1) and the formula (2) is higher. Calculate the amount.
  • the unmanned aerial vehicle 200 moves in accordance with the motion amount calculated by the motion amount calculation unit 105 to form a formation set by the parameter setting unit 104 and approaches the target object.
  • the operation amount calculation unit 105 calculates the operation amount of the unmanned aerial vehicle 200 to be controlled based on the expression (1).
  • the unmanned aerial vehicle 200 to be controlled moves on the contour line of the existence probability distribution of the object with the shortest distance from the unmanned aerial vehicle 200 as a target.
  • the motion amount calculation unit 105 based on the positional relationship and the speed relationship between the unmanned aerial vehicle 200 to be controlled and the other unmanned aerial vehicle 200, as in the examples of the equations (3) and (4), The operation amount of the unmanned aerial vehicle 200 to be controlled is calculated.
  • the controlled unmanned aerial vehicle 200 not only moves to the position on the contour line, but also moves while adjusting the positional relationship and speed relationship with other unmanned aerial vehicles 200.
  • the plurality of unmanned aerial vehicles 200 can move while maintaining the formation shape while maintaining an appropriate interval.
  • a combination of the information acquisition/deployment unit 101, the object detection unit 102, the existence probability calculation unit 103, and the parameter setting unit 104 in the control device 100 corresponds to an example of a formation determination device, and the formation of the unmanned aerial vehicle 200.
  • the formation determining device may be provided commonly to the plurality of unmanned aerial vehicles 200, and the plurality of unmanned aerial vehicles 200 may share the formation determined by the formation determining device.
  • the unmanned aerial vehicle system 1 further includes a manual command input unit that receives a user operation, in case that a part of the unmanned aerial vehicle 200 is to be manually switched, or if a person wants to appropriately change the parameter value for formation. It may be provided.
  • FIG. 2 is a schematic diagram showing a second example of the configuration of the unmanned aerial vehicle system according to the embodiment.
  • the unmanned aerial vehicle system 1 includes a plurality of control devices 100, a plurality of unmanned aerial vehicles 200, and a manual command input unit 300.
  • the control device 100 includes an information acquisition and development unit 101, an object detection unit 102, an existence probability calculation unit 103, a parameter setting unit 104, a motion amount calculation unit 105, and a motion setting unit 106.
  • the unmanned aerial vehicle 200 includes a sensor 201.
  • the unmanned aerial vehicle system 1 having the configuration of FIG. 2 is different from the configuration of FIG. 1 in that it further includes the manual command input unit 300. In other respects, the unmanned aerial vehicle system 1 having the configuration of FIG. 2 is similar to the case of FIG.
  • the manual command input unit 300 is configured as a terminal device including an input device such as a touch panel, an operation panel, or a keyboard and a mouse, or a combination thereof, and receives an operation performed by a person. A person who operates using the manual command input unit 300 is called a user.
  • the manual command input unit 300 transmits the input information indicating the accepted user operation to the control device 100.
  • the information acquisition expansion unit 101 acquires input information.
  • the information acquisition/development unit 101 notifies the input information to a functional unit that performs a process corresponding to a user input, such as the parameter setting unit 104 or the motion amount calculation unit 105.
  • the control unit 100 causes the unmanned aerial vehicle 200 to be controlled to operate according to the user's operation, when the functional unit that has received the notification performs processing according to the user's operation.
  • a user who collectively supervises a plurality of unmanned aerial vehicles 200 may instruct the manual command input unit 300 to set a parameter value, and the parameter setting unit 104 may set the parameter value in accordance with this instruction.
  • the user may instruct the formation shape from the manual command input unit 300, and the parameter setting unit 104 may determine the formation shape to be the instructed shape.
  • the parameter setting unit 104 may determine the shape of the formation based on the information regarding the existence probability distribution of the target object.
  • a plurality of parameter value sets in which the values of the parameters are combined for each shape of the formation are prepared, and the parameter setting unit 104 may set a value for each parameter by selecting one of the parameter value sets. ..
  • the user may instruct the parameter value set to be selected from the manual command input unit 300, and the parameter setting unit 104 may select the instructed parameter value set.
  • the parameter setting unit 104 may select any one of the parameter value sets based on the information regarding the existence probability distribution of the target object.
  • the parameter setting unit 104 may directly set values to at least some parameters.
  • the user may instruct the parameter and the value to be set to the parameter from the manual command input unit 300, and the parameter setting unit 104 may set the instructed parameter to the instructed value. ..
  • the parameter setting unit 104 may calculate and set the value to be set for the parameter for which the value is not set, based on the information regarding the existence probability distribution of the target object.
  • the user may specify the parameter values for all the parameters for determining the formation from the manual command input unit 300.
  • the user may specify the parameter values for only some of the formation determination parameters from the manual command input unit 300.
  • the user may instruct the formation shape from the manual command input unit 300, and the parameter setting unit 104 may determine the parameter value for the parameter provided for the instructed shape.
  • the user may specify the parameter value from the manual command input unit 300 for only some of the unmanned aerial vehicles 200.
  • the user may specify the parameter value from the manual command input unit 300 with a different degree of detail for each unmanned aerial vehicle 200.
  • the user may specify only the formation shape for some unmanned aerial vehicles 200 from the manual command input unit 300. Then, the user may specify, from the manual command input unit 300, not only the shape of the formation for some other unmanned aerial vehicles 200 but also the value of the parameter provided for that shape.
  • the user may instruct the operation amount of the unmanned aerial device 200 from the manual command input unit 300, in addition to or instead of instructing the formation parameter value of the unmanned aerial device 200.
  • the manual command input unit 300 may transmit an instruction of a moving direction and a moving speed of a specific unmanned aerial vehicle 200 to the unmanned aerial vehicle 200 according to a user operation.
  • the operation amount calculation unit 105 of the unmanned aerial vehicles 200 other than the instructed unmanned aerial vehicle 200 determines the amount of operation for forming the formation based on the positional relationship and the speed relationship with the instructed unmanned aerial vehicle 200. It may be calculated.
  • FIG. 3 is a diagram showing a first example of the arrangement of the control device 100.
  • FIG. 3 shows an example of the configuration of the unmanned aerial vehicle system 1 shown in FIG. 2, in which a central management system 2 including a plurality of control devices 100 corresponding to a plurality of unmanned aerial vehicles 200 is arranged in a cloud. ..
  • a central management system 2 including a plurality of control devices 100 corresponding to a plurality of unmanned aerial vehicles 200 is arranged in a cloud. ..
  • an unmanned aerial vehicle 200 for example, an unmanned aerial vehicle called an Unmanned Air Vehicle (UAV) that autonomously operates in the air and searches for a search target by a radar may be used.
  • UAV Unmanned Air Vehicle
  • each control device 100 may be configured as a function on the cloud instead of being an individual device having a real state. In other words, the control device 100 may be virtually deployed on the cloud. Then, as if the unmanned aerial vehicle 200 exchanges information with the neighboring unmanned aerial vehicle 200, the virtual controller 100 exchanges information with the virtual controller 100 that controls the unmanned aerial vehicle 200 near the unmanned aerial vehicle 200 to be controlled. However, the control instruction may be issued to the unmanned aerial vehicle 200 to be controlled.
  • the evaluation function and the like used in the arrangement example of FIG. 3 can be the same as the functions of the above-mentioned formulas (1) to (4).
  • each UAV is operating asynchronously, and the information uploaded from the UAV is also asynchronous. Therefore, even if the central management system 2 is arranged on the cloud, information does not gather synchronously. For this reason, it is not possible to perform normal optimization calculation regarding the search probability. Therefore, the central management system 2 controls the UAV by using the autonomous algorithm using the above-mentioned evaluation function to optimize the operation of the entire UAV group.
  • FIG. 4 is a diagram showing a first example of the operation result of the unmanned aerial vehicle system 1.
  • FIG. 4 is a snapshot showing an outline of the formation formed by the control device 100 controlling the unmanned aerial vehicle 200.
  • the line L11 indicates the formation of the drone 200.
  • the formation is a circle.
  • Each of the arrows B11 to B14 indicates information on a change in formation.
  • the direction of the arrow indicates the direction in which the formation changes.
  • the size (length) of the arrow indicates the rate of formation change.
  • the formation becomes smaller while maintaining the shape of the circle. That is, the area within the formation is narrowed.
  • the shade in the area A11 indicates the existence probability distribution of the target. The darker the display (blacker in FIG. 4), the higher the existence probability.
  • FIG. 4 shows that the unmanned aerial vehicle 200 is forming a formation in a circle formation according to the existence probability distribution of the object. From the state of FIG. 4, the unmanned aerial vehicle 200 keeps the formation of the circle and narrows the sieving net to enclose and capture the target object. As described above, when the unmanned aerial vehicle system 1 is used, the capturing operation of the object can be performed by the plurality of unmanned aerial vehicles 200 more effectively and efficiently.
  • FIG. 5 is a diagram showing a second example of the operation result of the unmanned aerial vehicle system 1.
  • FIG. 5 shows a snapshot of the formation formed by the control device 100 controlling the unmanned aerial vehicle 200.
  • FIG. 5 is a snapshot showing an outline of the formation formed by the control device 100 controlling the unmanned aerial vehicle 200 and further by an instruction from the manual command input unit 300.
  • Lines L21 and L22 show the formation of the drone 200.
  • the shape of the formation is changed from a circle to a double circle via the manual command input unit.
  • Each of the arrows B21 to B24 indicates the information on the change in formation indicated by the line L21.
  • Each of the arrows B21 to B24 indicates the information on the change in formation indicated by the line L21.
  • Each of the arrows B25 to B28 indicates the information on the change in formation indicated by the line L22.
  • the direction of arrow B11 indicates the direction in which the formation changes.
  • the size (length) of the arrow B11 indicates the rate of formation change. In the example of FIG. 5, the formation becomes smaller while maintaining the shape of the double circle. That is, the area within the formation is narrowed.
  • the shade in the area A21 indicates the existence probability distribution of the object. The darker the display (the darker it is in FIG. 5), the higher the existence probability.
  • FIG. 5 shows that the drone 200 forms a formation according to the existence probability distribution of the target object in the formation of a double circle. From the state of FIG. 5, the drone 200 keeps the formation of a double circle and narrows the sieving net to enclose and capture the target.
  • FIG. 6 is a diagram showing a first example of the arrangement of the control device 100.
  • FIG. 6 shows an example of the configuration of the unmanned aerial vehicle system 1 shown in FIG. 2, in which the control device 100 is mounted on each unmanned aerial vehicle 200 to be controlled.
  • each unmanned aerial vehicle 200 exchanges information with a neighboring unmanned aerial vehicle 200 capable of communication, and acts autonomously and decentrally in response to an instruction from the control device 100 mounted in the unmanned aerial vehicle 200 itself.
  • the arrangement in which the control device 100 is mounted on the unmanned aerial vehicle 200 as shown in FIG. Is Such cases are considered to be very large in actual application. Further, even in a case where it is difficult to assume a central management system, or a case where the central management system has failed, the arrangement in which the control device 100 is mounted on the unmanned aerial vehicle 200 as shown in FIG. 6 is effective.
  • FIG. 7 is a diagram showing a third example of the operation result of the unmanned aerial vehicle system 1.
  • the behavior of the unmanned aerial vehicle 200 when the formation shape is an arbitrary shape and the existence probability of the target object becomes an irregular shape was confirmed by simulation.
  • FIG. 7 shows a snapshot of the operation result.
  • the shade in the area A31 indicates the existence probability distribution of the object. The darker the display (the darker it is in FIG. 7), the higher the existence probability.
  • the arrows B31 to B34 indicate information on changes in the arrangement of the unmanned aerial vehicle 200.
  • the direction of the arrow indicates the direction in which the formation changes.
  • the size (length) of the arrow indicates the rate of formation change.
  • the unmanned aerial vehicle 200 since the formation of the unmanned aerial vehicle 200 is arbitrary, the line indicating the formation is not displayed in FIG. 7, but the unmanned aerial vehicle 200 has a similar shape to the contour line of the existence probability distribution of the object, It surrounds the region A31 where the existence probability distribution is high.
  • the unmanned aerial vehicle 200 moves in the directions and speeds indicated by the arrows B31 to B34 to maintain the shape similar to the contour line of the existence probability distribution of the target object and narrow the surrounding range. Thereby, the unmanned aerial vehicle 200 narrows the surrounding network while moving so as not to break the surrounding network, and encloses and captures the target object. In this way, even if the control device 100 is mounted on each of the unmanned aerial vehicles 200 and the control is performed, the operation is effectively performed.
  • FIG. 3 shows a case where the central management system 2 is implemented in the cloud.
  • This central management system may be constructed as a special system.
  • a central management system may be constructed and installed on the shore, and the central management system 2 may issue instructions to a plurality of UAVs.
  • the central management system may be set up on a mother ship that organizes multiple UAVs.
  • the unmanned aerial vehicle 200 a device other than the UAV described above may be used.
  • an airplane-type unmanned aerial vehicle that flies in the sky may be used, or an unmanned aerial vehicle that travels on land may be used.
  • the unmanned aerial vehicle system 1 may include a plurality of manual command input units 300, and a plurality of users may manually operate different unmanned aerial vehicles 200.
  • the information acquisition and development unit 101 acquires the position information of the unmanned aerial vehicle 200 that is the control target and the position information of the unmanned aerial device 200 that is not the control target.
  • the object detection unit 102 attempts to detect an object using the sensor signal from the sensor 201 mounted on the unmanned aerial vehicle 200.
  • the existence probability calculation unit 103 calculates the existence probability distribution of the target object based on the information on the position and time at which the target object was successfully detected.
  • the parameter setting unit 104 determines the formation of the plurality of unmanned aerial vehicles 200 by setting the parameter value.
  • the motion amount calculation unit 105 calculates the motion amount of the unmanned aerial vehicle to be controlled based on the set formation.
  • the operation setting unit 106 sets an operation for the unmanned aerial vehicle to be controlled according to the calculated operation amount.
  • the control device 100 can more efficiently capture the target object.
  • the target can be captured using the unmanned aerial vehicle 200, and the manpower can be reduced, so that the capture can be performed efficiently.
  • the unmanned aerial vehicle 200 can approach the target object while maintaining the formation and surrounding the target object. In this respect, the control device 100 can effectively detect and capture the target object.
  • the movement amount calculation unit 105 calculates the movement amount of the unmanned aerial vehicle 200 to be controlled based on the position information of the unmanned aerial vehicle 200 to be controlled and the position information of the unmanned aerial vehicle 200 other than the control subject. Accordingly, the motion amount calculation unit 105 can calculate the operation of the unmanned aerial vehicle 200 to be controlled based on the positional relationship between the position of the unmanned aerial vehicle 200 to be controlled and the position of the unmanned aerial vehicle 200 other than the controlled object. The relative positional relationship of the drone 200 can be adjusted. For example, the motion amount calculation unit 105 can maintain the interval between the unmanned aerial vehicles 200 at an appropriate interval.
  • the manual command input unit 300 receives a user operation.
  • the motion amount calculation unit 105 calculates the motion amount based on the user operation in addition to the formation.
  • the drone 200 is operated based on the user operation.
  • the drone 200 can be operated by reflecting the intention of the user.
  • the manual command input unit 300 receives a user operation for switching between manual setting and automatic setting of control of the unmanned aerial vehicle 200, and a user operation for performing control setting for the unmanned aerial vehicle 200 set to manual.
  • the motion amount calculation unit 105 calculates the motion amount based on the position and speed of the unmanned aerial vehicle 200 set to manual in addition to the formation.
  • control device 100 when the user manually operates some of the unmanned aerial vehicles 200, the operation of the other unmanned aerial vehicles 200 can be automatically controlled. Objects can be captured more efficiently. Specifically, according to the control device 100, some unmanned aerial vehicles 200 can be automatically operated to capture an object, and manpower can be reduced, so that capture can be performed efficiently. ..
  • the existence probability calculation unit 103 calculates the existence probability distribution of the object, which has a larger spatial extent as time passes after the object detection unit 102 succeeds in detecting the object. The longer the time has elapsed since the object detection unit 102 succeeded in detecting the object, the higher the possibility that the object is moving, and the distance that the object may be moving. Will be longer.
  • the existence probability calculation unit 103 calculates the existence probability distribution of the target object that has a larger spatial extent as time passes after the target object detection unit 102 succeeds in detecting the target object. It is possible to calculate the existence probability distribution according to the possibility that the object has moved and the distance that the object may have moved. In this respect, the existence probability calculation unit 103 can calculate the existence probability distribution of the object with high accuracy.
  • the motion amount calculation unit 105 based on the evaluation value of the controlled unmanned aerial vehicle 200 regarding the shape of the formation, and the evaluation value of the controlled unmanned aerial vehicle 200 regarding the relationship with other unmanned aerial vehicles 200, The motion amount is calculated so that the evaluation is higher. Accordingly, the motion amount calculation unit 105 can calculate the motion amount so that the unmanned aerial vehicles 200 form a formation and the unmanned aerial vehicles 200 are positioned at an appropriate distance.
  • the motion amount calculation unit 105 calculates the motion amount based on the relationship between the existence probability distribution of the target object and the position of the unmanned aerial vehicle 200 to be controlled. For example, the motion amount calculation unit 105 calculates the motion amount based on the positional relationship between the contour line of the existence probability distribution of the target object and the unmanned aerial vehicle 200 to be controlled. Accordingly, the motion amount calculation unit 105 can calculate the motion amount such that the unmanned aerial vehicle 200 to be controlled forms a formation based on the existence probability distribution of the target object.
  • FIG. 8 is a diagram illustrating an example of the configuration of the control device according to the embodiment.
  • the control device 400 illustrated in FIG. 8 includes an information acquisition and development unit 401, an object detection unit 402, an existence probability calculation unit 403, a formation determination unit 404, a motion amount calculation unit 405, and a motion setting unit 406. ..
  • the information acquisition and development unit 401 acquires the position information of the drone to be controlled and the position information of the drone other than the control target.
  • the target detection unit 402 attempts to detect a target by using a sensor signal from a sensor mounted on the unmanned aerial vehicle.
  • the existence probability calculation unit 403 calculates the existence probability distribution of the target object based on the information on the position and time at which the target object was successfully detected.
  • the formation determination unit 404 sets a parameter value that determines the formation of a plurality of unmanned aerial vehicles based on the existence probability distribution of the target.
  • the formation determining unit 404 has the same function as the parameter setting unit 104 described above.
  • the motion amount calculation unit 405 calculates the motion amount of the unmanned aerial vehicle to be controlled based on the set formation.
  • the operation setting unit 406 sets the operation for the unmanned aerial vehicle to be controlled according to the calculated operation amount. As a result, the control device 400 can more efficiently capture the target object.
  • FIG. 9 is a diagram showing an example of the configuration of the formation determining device according to the embodiment.
  • the formation determination device 410 shown in FIG. 9 includes an information acquisition/development unit 411, an object detection unit 412, an existence probability calculation unit 413, and a formation determination unit 414.
  • the information acquisition and development unit 411 acquires the position information of the unmanned aerial vehicle to be controlled and the position information of the unmanned aerial vehicle other than the controlled object.
  • the target detection unit 412 attempts to detect a target using a sensor signal from a sensor mounted on the unmanned aerial vehicle.
  • the existence probability calculation unit 413 calculates the existence probability distribution of the object based on the information on the position and time at which the object was successfully detected.
  • the formation determination unit 414 sets a parameter value that determines the formation of the unmanned aerial vehicles based on the existence probability distribution of the target object.
  • the formation determining unit 414 has the same function as the parameter setting unit 104 as described above. Thereby, the formation determining device 410 can determine the formation of the unmanned aerial vehicle according to the existence probability distribution of the target object. By using the formation determined by the formation determining device 410, the target can be captured more efficiently.
  • FIG. 10 is a schematic block diagram showing the configuration of a computer according to at least one embodiment.
  • the computer 700 includes a CPU (Central Processing Unit) 710, a main storage device 720, an auxiliary storage device 730, and an interface 740. Any one or more of the control devices 100 and 400 described above may be implemented in the computer 700. In that case, the operation of each processing unit described above is stored in the auxiliary storage device 730 in the form of a program.
  • the CPU 710 reads the program from the auxiliary storage device 730, expands it in the main storage device 720, and executes the above processing according to the program. In addition, the CPU 710 secures a storage area corresponding to each storage unit described above in the main storage device 720 according to a program. Communication between the unmanned aerial vehicle control device or the mobile device control device and another device is performed by the interface 740 having a communication function and performing communication under the control of the CPU 710.
  • the interface 740 having a communication function and performing communication under the control of the CPU 710.
  • the control device 100 When the control device 100 is installed in the computer 700, the information acquisition/development unit 101, the object detection unit 102, the existence probability calculation unit 103, the parameter setting unit 104, the operation amount calculation unit 105, and the operation setting unit 106.
  • the operations of and are stored in the auxiliary storage device 730 in the form of a program.
  • the CPU 710 reads the program from the auxiliary storage device 730, expands it in the main storage device 720, and executes the above processing according to the program.
  • Communication between the control device 100 and other devices such as the unmanned aerial vehicle 200 is executed by the interface 740 having a communication function and performing communication under the control of the CPU 710.
  • the control device 400 When the control device 400 is installed in the computer 700, the information acquisition and development unit 401, the object detection unit 402, the existence probability calculation unit 403, the formation determination unit 404, the movement amount calculation unit 405, and the movement setting unit 406.
  • the CPU 710 reads the program from the auxiliary storage device 730, expands it in the main storage device 720, and executes the above processing according to the program.
  • Communication between the control device 400 and the unmanned aerial vehicle is executed by the interface 740 having a communication function and performing communication under the control of the CPU 710.
  • a program for realizing all or a part of the functions of the control devices 100 and 400 is recorded in a computer-readable recording medium, and the program recorded in this recording medium is read by a computer system and executed. You may perform the process of each part by.
  • the “computer system” mentioned here includes an OS (operating system) and hardware such as peripheral devices.
  • the "computer-readable recording medium” is a portable medium such as a flexible disk, a magneto-optical disk, a ROM (Read Only Memory), a CD-ROM (Compact Disc Read Only Memory), a hard disk built in a computer system, or the like. A memory device.
  • the above-mentioned program may be one for realizing a part of the above-mentioned functions, and may be one for realizing the above-mentioned functions in combination with a program already recorded in the computer system.
  • the embodiment of the present invention may be applied to a control device, a control method, and a program.
  • Unmanned aerial vehicle system 2 Central management system 100, 400 Control device 101, 401, 411 Information acquisition development part 102, 402, 412 Object detection part 103, 403, 413 Existence probability calculation part 104 Parameter setting part 105, 405 Operation amount calculation Units 106 and 406 Operation setting unit 200 Unmanned aerial vehicle 300 Manual command input unit 404, 414 Formation determination unit 410 Formation formation device

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computing Systems (AREA)
  • Mathematical Physics (AREA)
  • Theoretical Computer Science (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

制御装置が、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する情報取得展開部と、前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる対象物検知部と、前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する存在確率算出部と、前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するフォーメーション決定部と、前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する動作量算出部と、算出された動作量に従って、制御対象の無人機に対する動作設定を行う動作設定部と、を備える。

Description

制御装置、フォーメーション決定装置、制御方法およびプログラム
　本発明は、制御装置、フォーメーション決定装置、制御方法およびプログラムに関する。
　無人機を使った応用が提案されている。例えば、自動的に部屋の掃除を行う円盤型ロボットや、空を飛ぶ無人機（ドローン（Drone））による宅配などである。また、原子力発電所などの危険な環境で活動するロボットなども例として挙げられる。
　また、複数の無人機を使用した応用例も提案されている。例えば、Ｅコマース（Electric Commerce）用の工場にて、複数の荷物運び用のロボットを使用し、顧客のオーダーした商品をいち早く集めるなどの応用が挙げられる（特許文献１参照）。また、探索対象を複数の無人機を使用して探索するなどの応用が挙げられる（特許文献２参照）。
　探索対象を複数の無人機で探索するという応用は、例えば、防衛関連技術として研究されている。この場合の無人機は、一般的にUxV（Unmanned x Vehicle）と呼ばれ、無人飛行機ならUAV（Unmanned Air Vehicle）、無人船ならUSV（Unmanned Surface Vehicle）と呼ばれ、無人水中船ならUUV（Unmanned Undersea Vehicle）などと呼ばれている。
　上記の無人機は、遠隔から人間が操作するものと、搭載されたプログラムにより自律的に行動を行えるものとの２種類に分類される。これらのうち、搭載されたプログラムにより自律的に行動を行える無人機あるいは無人機群が、人間不在でも、人間に変わり様々な行動、労働を肩代わりすることが望まれる。人工知能の研究が盛んに行われている一因は、優れた人工知能を搭載することで、無人機が賢く動作可能となる期待からである。
　無人機が賢く動作するという言葉を言い換えると、無人機が、状況によって、自律的に行動を変えるということである。一般的に、無人機は複数のミッション（行動）を持っていることが多く、状況により、行動を変える必要がある。例えば、無人機が、最初は危険物の探索を行い、発見した危険物が動く場合はそれを追跡し、場合によってはその危険物を捕獲するというように、状況によってミッションを変える必要がある。この例では、ミッションとして、探索、追跡および捕獲が挙げられている。
　現状では、遠隔で人間がミッションを切り替えていることが多いのに対し、将来的には無人機が自律的に判断して、自動でミッションを切り替えることが望まれている。
　行動の切り替えについて、電車に関連して、状態遷移を予め設定してIF-THENの条件判定で自動的に行動を切り替えるという手法が提案されている（特許文献３、および、特許文献４参照）。
日本国特許第４６１７２９３号公報 日本国特許第４９２６９５８号公報 日本国特許第５２７１７７２号公報 日本国特許第５５５９６７１号公報
上述のように、単体の無人機、または、無人機群の使用が提案されており、さらに、様々な分野での実応用が検討され始めている。無人機または無人機群の活用が有力視される分野の１つに、セキュリティ分野がある。セキュリティ分野での無人機または無人機群の活用事例として、不審者、犯罪者、危険人物、駆除対象の動物などの対象を捕獲するというオペレーションが挙げられる。
　例えば、何らかの事件が発生した場合、事件が発生した地点を中心に、逃げている対象を逃さずに捕獲する必要がある。その場合、人海戦術により、対象を見つけ出し、捕獲するという手法があるが、この手法では、消費されるマンパワーおよび時間は膨大であり、大きなコストとなる。また、昨今の人手不足の現状から、十分なマンパワーを確保できない可能性がある。
　十分なマンパワーを確保できない場合に人海戦術で対象を見つけ出して捕獲しようとすると、対象を取り逃がす事態が頻発する可能性がある。そこで、複数の無人機を活用してマンパワーを削減し、効率的に捕獲を行なうことが期待される。
　本発明の目的の一例は、対象物の捕獲をより効率的に行うことができる制御装置、フォーメーション決定装置、制御方法およびプログラムを提供することである。
　本発明の第１の態様によれば、制御装置は、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する情報取得展開部と、前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる対象物検知部と、前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する存在確率算出部と、前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するフォーメーション決定部と、前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する動作量算出部と、算出された動作量に従って、制御対象の無人機に対する動作設定を行う動作設定部と、を備える。
　本発明の第２の態様によれば、フォーメーション決定装置は、複数の無人機の位置情報を取得する情報取得展開部と、前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる対象物検知部と、前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する存在確率算出部と、前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するフォーメーション決定部と、を備える。
　本発明の第３の態様によれば、制御方法は、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する工程と、前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる工程と、前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する工程と、前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するパラメータ値を設定する工程と、前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する工程と、算出された動作量に従って、制御対象の無人機に対する動作設定を行う工程と、を含む。
　本発明の第４の態様によれば、プログラムは、コンピュータに、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する工程と、前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる工程と、前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する工程と、前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するパラメータ値を設定する工程と、前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する工程と、算出された動作量に従って、制御対象の無人機に対する動作設定を行う工程と、を実行させるためのプログラムである。
　上記した制御装置、フォーメーション決定装置、制御方法およびプログラムによれば、対象物の捕獲をより効率的に行うことができる。
実施形態に係る無人機システムの構成の第１例を示す概略図である。 実施形態に係る無人機システムの構成の第２例を示す概略図である。 実施形態に係る制御装置の配置の第１例を示す図である。 実施形態に係る無人機システムの動作結果の第１例を示す図である。 実施形態に係る無人機システムの動作結果の第２例を示す図である。 実施形態に係る制御装置の配置の第１例を示す図である。 実施形態に係る無人機システムの動作結果の第３例を示す図である。 実施形態に係る制御装置の構成の例を示す図である。 実施形態に係るフォーメーション決定装置の構成の例を示す図である。 少なくとも１つの実施形態に係るコンピュータの構成を示す概略ブロック図である。
　以下、本発明の実施形態を説明するが、以下の実施形態は請求の範囲にかかる発明を限定するものではない。また、実施形態の中で説明されている特徴の組み合わせの全てが発明の解決手段に必須であるとは限らない。
　図１は、実施形態に係る無人機システムの構成の第１例を示す概略図である。図１に示す構成で、無人機システム１は、複数の制御装置１００と複数の無人機２００とを備える。制御装置１００は、情報取得展開部１０１と、対象物検知部１０２と、存在確率算出部１０３と、パラメータ設定部１０４と、動作量算出部１０５と、動作設定部１０６とを備える。無人機２００は、センサ２０１を備える。
　無人機システム１は、複数の無人機２００を用いて対象物を検知し捕獲するシステムである。
　制御装置１００は、無人機２００と一対一に設けられ、その１つの無人機２００の制御を行う。制御装置１００が、制御対象の無人機２００に搭載されていてもよい。あるいは、制御装置１００が、制御対象の無人機２００の外部に設置され、制御対象の無人機２００と通信を行うようにしてもよい。
　制御装置１００が、例えば、ワークステーション（Workstation）、パソコン（Personal Computer、ＰＣ）、またはマイコン（Microcomputer）等のコンピュータを用いて構成されていてもよい。あるいは、制御装置１００がＡＳＩＣ（Application Specific Integrated Circuit）を用いて構成されるなど、制御装置１００専用に設計されたハードウェアを用いて構成されていてもよい。
　制御装置１００の制御対象の無人機２００以外の無人機２００を、他の無人機２００と称する。複数の無人機２００のうち何れか１つが制御対象の無人機２００であり、それ以外の無人機２００は他の無人機２００である。
　情報取得展開部１０１は、制御対象の無人機２００から、その無人機２００の位置情報および状態情報を取得する。加えて、情報取得展開部１０１は、通信可能な他の無人機２００から、その無人機２００の位置情報および状態情報を取得する。
　状態情報は、その無人機２００に関する状態を示す情報である。情報取得展開部１０１が取得する状態情報には、その無人機２００における、複数の無人機２００全体の行動に関わる評価値と、その評価値を算出するための評価関数とが含まれる。さらに、情報取得展開部１０１が取得する状態情報には、評価関数に適用される設定パラメータ、および、評価関数を数学的に処理した値など、評価値または評価関数に付随する情報が含まれる。
　情報取得展開部１０１が取得する、評価関数を数学的に処理した値の例として、評価関数の微分または積分、あるいはこれら両方を挙げることができるが、これらに限定されない。
　状態情報に位置情報が含まれていてもよい。あるいは、上記のように状態情報と位置情報とが別々の情報として扱われていてもよい。
　また、情報取得展開部１０１は、対象物を検知した無人機２００から、対象物を検知した位置およびその時刻の情報も取得する。
　さらに、情報取得展開部１０１は、他の無人機２００から情報を取得するだけでなく、制御対象の無人機２００の状態情報、および、制御対象の無人機２００による対象物の検知情報などを、他の無人機２００に通知する。
　対象物検知部１０２は、制御対象の無人機２００のセンサ２０１からのセンサ信号を用いて、対象物の検知を試みる。ここでいうセンサ信号は、センシング結果を示す信号である。センサ２０１として、カメラ、赤外線センサ、および、超音波センサのうちの何れか１つ、あるいはこれらの組み合わせを用いることができるが、これらに限定されない。
　対象物検知部１０２は、センサ２０１からのセンサ信号を認識アルゴリズムに適用し、認識結果を参照して対象物を検知したか否かを判定する。この場合の認識アルゴリズムとして、公知のアルゴリズムを用いることができる。
　対象物を検知した場合、対象物検知部１０２は、その位置と時刻とを記録する。記録された位置情報および時刻情報は、存在確率算出部１０３を通じて、制御対象の無人機２００の行動の決定に用いられる。また、対象物検知部１０２は、対象物検知の位置情報および時刻情報を情報取得展開部１０１に出力する。情報取得展開部１０１は、取得した位置情報および時刻情報を、通信可能な他の無人機２００に通知する。
　存在確率算出部１０３は、対象物検知部１０２からの信号と、情報取得展開部１０１から得られた、通信可能な他の無人機２００が保有する対象物の情報とを用いて、対象物の存在確率分布を算出する。
　存在確率算出部１０３は、制御対象の無人機２００の対象物情報、および、他の無人機２００の対象物情報を用いて、対象物の存在確率分布を算出する。制御対象の無人機２００の対象物情報は、制御対象の無人機２００のセンサ２０１のセンサ情報を用いて対象物検知部１０２が対象物を検知した場合の、位置および時刻など検知結果を示す情報である。他の無人機２００の対象物情報は、その無人機２００のセンサ２０１のセンサ情報を用いて、その無人機を制御する制御装置１００の対象物検知部１０２が対象物を検知した場合の、位置および時刻など検知結果を示す情報である。
　存在確率算出部１０３は、例えば、以下の手法を用いて対象物の存在確率を算出する。
　制御対象の無人機２００の対象物情報および他の無人機２００の対象物情報すべてに対して、対象物を検知した位置を中心に２次元または３次元のガウス分布を設定する。
　この際、存在確率算出部１０３は、対象物の検知時刻により、ピークの高さと分布の広がりを変える。存在確率算出部１０３は、対象物を検知した情報のうち、最も新しい時刻の情報のピーク値を最も高くし、その時刻から離れるほどピーク値を下げていく。また、存在確率算出部１０３は、最も新しい時刻の情報の分布の広がりを最も小さくし、その時刻から離れるほど分布の広がりを大きくしていく。
　従って、存在確率算出部１０３は、対象物検知部１０２が対象物の検知に成功してから時間が経過しているほど、空間的な広がりが大きい存在確率分布を算出する。ここでいう空間的な広がりが大きいとは、存在確率分布の分散が大きいことである。
　上記のように、存在確率算出部１０３が対象物の存在確率分布をガウス分布で設定する場合、対象物の検知から時間が経過しているほど、分散の大きいガウス分布を設定するようにしてもよい。
　また、存在確率算出部１０３が、対象物の存在確率が０よりも大きい領域として有限の面積の領域を設定する場合、時間経過とともに、対象物の存在確率が０よりも大きい領域の面積を広くするようにしてもよい。
　対象物情報が複数ある場合、存在確率算出部１０３は、複数の対象物情報を２次元または３次元にマップした分布図を形成する。マップ上の任意の位置が、何らかの分布値を持つ状態になる。存在確率算出部１０３は、その情報を対象物の存在確率として扱えるようにするために、２次元または３次元上のすべての分布値を積分した値で、マップの分布値を除算する。これにより、マップ全体の分布値の合計が１になる。
　例えば、対象物が１度だけ検知され、その後は検知されなかった場合、対象物が検知された場所をピークとしたガウス分布（円状または球状）が形成され、時間経過に応じて、ピークの高さが低くなり分布の広がりが大きくなっていくように、マップが更新される。
　存在確率算出部１０３が、この存在確率分布の計算の際に、地理的な情報を重ね合わせるようにしても良い。例えば、対象物が侵入できない地域、崖、谷などがあった場合、存在確率算出部１０３が、その場所の存在確率を常に０と算出するようにしてもよい。そうすることで、対象物が逃げ込めない場所を無人機２００が捜索する無駄を省くことができる。
　パラメータ設定部１０４は、情報取得展開部１０１からの情報および存在確率算出部１０３の算出結果をもとに、複数の無人機２００が形成するフォーメーション用のパラメータを設定する。具体的には、パラメータ設定部１０４は、フォーメーション形状、および、フォーメーション変化のスピードに関するパラメータを設定する。パラメータ設定部１０４は、フォーメーション決定部の例に該当し、パラメータに値を設定することで複数の無人機２００のフォーメーションを決定する。
　例えば、円または円弧、楕円、二重円、任意の形状など、フォーメーションの形状を示すパラメータ値を予め定められ、パラメータ設定部１０４が、これらのパラメータ値を記憶しておく。また、パラメータ設定部１０４は、対象物の存在確率分布に関する情報に基づいてパラメータ値を選択する機能を有しておく。
　対象物の存在確率分布に関する情報として、対象物の存在確率分布のピーク値の大きさ、分散値、存在確率分布の形状、存在確率分布の大きさ、および、対象物が検知されてからの経過時間のうち何れか１つ以上を用いることができるが、これらに限定されない。
　対象物の存在確率分布の形状として、対象物の存在確率分布の等高線の形状を用いることができるが、これに限定されない。対象物の存在確率の等高線は、存在確率分布がある値をとる位置を辿って得られる線である。対象物の存在確率分布の大きさとして、等高線の大きさ（例えば、等高線で囲まれた部分の面積）を用いることができるが、これに限定されない。
　例えば、パラメータ設定部１０４が、無人機２００のフォーメーションの形状として予め定められている複数の形状のうち何れか１つを選択する。フォーメーションの形状毎に１つ以上のパラメータが設けられ、パラメータ設定部１０４は、選択した形状に設けられているパラメータの値を設定する。
　フォーメーションの形状毎に各パラメータの値を組み合わせたパラメータ値セットが複数用意され、パラメータ設定部１０４が、何れかのパラメータ値セットを選択することで、各パラメータに値を設定するようにしてもよい。パラメータ設定部１０４が、対象物の存在確率分布に関する情報に基づいて、何れかのパラメータ値セットを選択するようにしてもよい。
　あるいは、パラメータ設定部１０４が、少なくとも一部のパラメータに値を直接設定するようにしてもよい。パラメータ設定部１０４が、値が設定されていないパラメータに設定する値を、対象物の存在確率分布に関する情報に基づいて算出し、設定するようにしてもよい。
　フォーメーションを変化させるスピードも、パラメータ設定部１０４が、速度ベクトルとして設定するようにしてもよい。
　全ての制御装置１００のパラメータ設定部１０４が、同じ設定、あるいは共通の設定を行うことで、同じフォーメーションを共有することができる。そのために、何れか１つの制御装置１００が、無人機２００のフォーメーションを決定した場合に、決定したフォーメーションを他の制御装置１００に通知するようにしてもよい。
　また、例えば二重円のフォーメーションの場合、パラメータ設定部１０４が、制御対象の無人機２００が第１の円および第２の円のうち何れに配置されるかを示すパラメータ値を設定するようにしてもよい。また、楕円形状のフォーメーションの場合、パラメータ設定部１０４が、制御対象の無人機２００が、フォーメーションの形状のどの位置に配置されるかを示すパラメータ値を設定するようにしてもよい。これらのパラメータ値の設定は、同じ設定ではないが共通の設定である例に該当する。
　フォーメーションの形状を示すパラメータ値のうち任意の形状を示すパラメータ値が設定された場合、パラメータ設定部１０４は、対象物の存在確率分布を勘案したフォーメーション形状に設定する。
　例えば、フォーメーションの形状を示すパラメータ値のうち任意の形状を示すパラメータが設定された場合、パラメータ設定部１０４は、対象物の存在確率分布の等高線と相似形のフォーメーションに設定する。
　具体的には、パラメータ設定部１０４は、対象物の存在確率分布のある値を設定することで、その値の等高線を特定する。パラメータ設定部１０４が、特定した等高線をそのまま無人機２００のフォーメーションとして用いるようにしてもよい。あるいは、パラメータ設定部１０４が、存在確率分布のピークの位置を基準として、特定した等高線を拡大または縮小して、無人機２００のフォーメーションとして用いるようにしてもよい。
　パラメータ設定部１０４が、対象物の存在確率分布に関する情報に基づいて、無人機２００のフォーメーションを決定する例について説明する。ここでは、無人機２００のフォーメーションの形状として、円および任意形状の２つの形状が用意されているものとする。
　パラメータ設定部１０４は、例えば、対象物の存在確率（存在確率分布の値）を、そのピーク値の７割に設定することで、存在確率分布の等高線を特定する。そして、パラメータ設定部１０４は、特定した等高線を内包する円のうち最小の円を算出する。パラメータ設定部１０４は、算出した円の面積のうち等高線に囲まれた部分の面積の割合が所定の閾値以上（例えば８割以上）かを判定する。
　面積の割合が閾値以上であると判定した場合、パラメータ設定部１０４は、算出した円をフォーメーションに決定し、その円の中心座標および半径を、円形状のフォーメーションのパラメータ値として設定する。また、パラメータ設定部１０４は、フォーメーションの変化として、無人機２００が円形を保ったまま円の中心に向かって、予め定められた速度で移動することに決定する。
　一方、面積の割合が閾値未満であると判定した場合、パラメータ設定部１０４は、特定した等高線をフォーメーションに決定する。この場合、パラメータ設定部１０４は、例えば、等高線を近似的に示すための代表点の座標、および、対象物の存在確率分布がピーク値になる位置の座標の位置を、任意形状のフォーメーションのパラメータ値として設定する。また、パラメータ設定部１０４は、フォーメーションの変化として、無人機２００が特定された等高線の相似形を保ったまま、対象物の存在確率分布がピーク値になる位置に向かって、予め定められた平均速度で移動することに決定する。
　この例で、パラメータ設定部１０４が円形のフォーメーションを選択することで、任意形状のフォーメーションを選択する場合よりも、フォーメーションの表現が容易になる。フォーメーションの表現が容易になることで、パラメータ設定部１０４が時間経過に応じてフォーメーションを変化させる処理の負荷が比較的軽くて済む。
　一方、パラメータ設定部１０４が任意形状のフォーメーションを選択することで、円形が対象物の存在確率分布の形状に適合しない場合に、対象物の存在確率分布の形状により適合するフォーメーションにすることができる。
　但し、パラメータ設定部１０４が無人機２００のフォーメーションを決定する処理は、この例の処理に限定されない。
　図２を参照して後述するように、パラメータ設定部１０４が、外部信号に応じてパラメータ値を選択する機能を有していてもよい。フォーメーションを変化させるスピードも、速度ベクトルとして、外部から設定できるようにしておいてもよい。
　フォーメーション形状を考慮して無人機２００の動作量を決定するためには、対象物と無人機２００との位置関係に関するパラメータ値が必要になる。パラメータ設定部１０４が、対象物と無人機２００の位置関係に関するパラメータ値として、対象物の存在確率分布の等高線と、制御対象の無人機２００の位置との最短距離を算出するようにしてもよい。
　この場合、パラメータ設定部１０４は、フォーメーション形状を示すパラメータ値、速度ベクトル値、および、上記の最短距離の情報を、動作量算出部１０５へ出力する。
　動作量算出部１０５は、情報取得展開部１０１から得られた他の無人機２００の状態情報、存在確率算出部１０３が算出した対象物の存在確率分布、および、パラメータ設定部１０４が算出した設定値を用いて統合的に、制御対象の無人機２００の動作量を算出する。
　動作量算出部１０５が、動作量の算出の方法として、評価関数による評価値を使用した動作量の決定方法を用いるようにしてもよい。評価値は、無人機２００の目的に対する無人機の状態を表す情報といえる。従って、評価値を、無人機２００の群としての行動規範の指標として用いることができる。ここでは、無人機２００の目的は、対象物を検知して捕獲することである。
　無人機２００の上記の目的を達成するために、無人機２００がフォーメーションを保ちながら、対象物を捕獲することが重要である。そこで、動作量算出部１０５が、以下の２つの評価関数を用いるようにしてもよい。
　２つの評価関数のうち１つ目の評価関数ｆ１は、フォーメーション形状を保つための評価関数であり、式（１）のように示される。
Figure JPOXMLDOC01-appb-M000001
　ここで、下付き文字ｉは無人機２００を識別する通し番号であり、ｉ番目の無人機を意味する。従って、ｆ１，ｉは、ｉ番目の無人機２００に用いられる、１つ目の評価関数を示す。従って、ｉ番目の無人機２００が制御対象の無人機２００である。
　Ｒは、対象物の存在確率分布の等高線と、無人機２００との最短距離を示す。従って、Ｒｉは、対象物の存在確率分布の等高線と、ｉ番目の無人機２００との最短距離を示す。
　２つ目の評価関数ｆ２は、無人機２００同士の間隔を適正に保つための評価関数であり、式（２）のように示される。
Figure JPOXMLDOC01-appb-M000002
　ｆ２，ｉは、ｉ番目の無人機２００に用いられる、２つ目の評価関数を示す。座標（ｘ，ｙ，ｚ）は、無人機２００の位置座標を示す。従って、座標（ｘｉ，ｙｉ，ｚｉ）は、ｉ番目の無人機２００の位置座標を示す。
　下付き文字ｉ－１、ｉ＋１は、ｉ番目の無人機２００から見て、その左右で最も近くに位置する無人機２００を示す。座標（ｘｉ－１，ｙｉ－１，ｚｉ－１）、（ｘｉ＋１，ｙｉ＋１，ｚｉ＋１）は、これらの無人機２００の位置座標を示す。
　動作量算出部１０５は、１つ目の評価関数ｆ１を用いて、対象物の存在確率に対する無人機２００の位置を評価する評価値を算出する。また、動作量算出部１０５は、２つ目の評価関数ｆ２を用いて、評価対象の無人機２００と近隣の無人機２００との距離がバランスを保てているかを評価する評価値を算出する。
　動作量算出部１０５は、これらの評価関数を使って、例えば以下のように動作量を決める。まず、動作量算出部１０５は、無人機の速度に関しては、式（３）を用いる。
Figure JPOXMLDOC01-appb-M000003
　ここで、Ｖは、速度ベクトルの標準値である。動作量算出部１０５は、式（３）を用いた演算によって、制御対象の無人機２００と、その左右両隣の無人機２００との関係に基づいて、速度ベクトルの標準値Ｖを補正した速度ベクトルを算出する。
　αは、変化の度合いを決める係数であり、ゲインに相当する。式（３）第２項「・｛（ｆ１，ｉ－１－ｆ１，ｉ）＋（ｆ１，ｉ＋１－ｆ１，ｉ）＋β｝」の演算は、制御対象の無人機２００の評価関数ｆ１の値と、その左右両隣の無人機２００の評価関数ｆ１の値とを比較する演算である。動作量算出部１０５は、式（３）の演算を行うことで、評価関数の値（評価値）の比較で制御対象の無人機２００の動作量を算出することになる。
　βは、フォーメーションの形状に起因するオフセットである。フォーメーションの形状が円、円弧または任意形状の場合、β＝０とする。フォーメーションの形状が二重円または楕円の場合、パラメータ設定部１０４は、制御対象の無人機２００が担当する位置に応じて、βに有限の値を設定する。
　動作量算出部１０５は、制御対象の無人機２００の進む方向（ベクトル）を、基本的に、対象物が存在する確率が最も高い位置へ向かう方向に設定する。具体的には、動作量算出部１０５は、制御対象の無人機２００の進む方向を、基本的に、対象物が存在する確率が最も高い位置と、制御対象の無人機２００の位置とを結んだ方向に設定する。動作量算出部１０５は、制御対象の無人機２００が、その方向に、式（３）で算出した速度で進むように、速度ベクトルを設定する。
　この速度ベクトルを、主速度ベクトルＶｍと称する。
　フォーメーションを組む無人機２００同士が等間隔で、対象物を捕獲するのが望ましい。そのために、動作量算出部１０５は、主速度ベクトルＶｍからの補正のための、主速度ベクトルＶｍに対する直交ベクトルＶｎを算出する。動作量算出部１０５は、直交ベクトルＶｎを、式（４）のように算出する。
Figure JPOXMLDOC01-appb-M000004
　ここで、Ｖｎｅは、主速度ベクトルＶｍに直交し、かつ、ｉ－１番目の無人機がある方向に向いた、単位ベクトルを示す。γはゲインに相当する。式（４）に含まれる評価関数ｆ２が、制御対象の無人機２００の評価値と、隣の無人機２００の評価値とを比較する式となっている。したがって、式（４）も、制御対象の無人機２００の評価値と、隣の無人機２００の評価値とを比較する式となっている。
　動作量算出部１０５は、ＶｍとＶｎとを足し合わせた合成ベクトルを、制御対象の無人機２００の動作量に設定する。
　動作設定部１０６は、動作量算出部１０５が算出した動作量で制御対象の無人機２００を動作させるように、制御対象の無人機２００を動作させるアクチュエータの動作設定値を設定する。上記の例の場合、動作設定部１０６は、動作量算出部１０５が動作量として算出した速度ベクトル（Ｖｍ＋Ｖｎ）で制御対象の無人機２００を動作させるように、制御対象の無人機２００の動作設定を行う。
　動作量算出部１０５は、式（３）および式（４）に基づいて評価量を算出することで、式（１）および式（２）による評価値が示す評価をより高くするように、動作量を算出する。無人機２００は、動作量算出部１０５が算出した動作量に従って移動することで、パラメータ設定部１０４が設定したフォーメーションを形成して対象物に近付いていく。
　例えば、式（３）の例のように動作量算出部１０５が式（１）に基づいて制御対象の無人機２００の動作量を算出する。これにより、制御対象の無人機２００は、対象物の存在確率分布の等高線上で、無人機２００自らとの距離が最短の位置を目標として移動する。その際、式（３）および式（４）の例のように、動作量算出部１０５は、制御対象の無人機２００と他の無人機２００との位置関係および速度の関係にも基づいて、制御対象の無人機２００の動作量を算出する。これにより、制御対象の無人機２００は、単に等高線上の位置へ移動するだけでなく、他の無人機２００との位置関係および速度の関係を調整しながら移動する。これにより、複数の無人機２００が適切な間隔を保ちながらフォーメーションの形状を維持して移動することができる。
　制御装置１００のうち、情報取得展開部１０１と、対象物検知部１０２と、存在確率算出部１０３と、パラメータ設定部１０４との組み合わせは、フォーメーション決定装置の例に該当し、無人機２００のフォーメーションを決定する。例えば、フォーメーション決定装置が複数の無人機２００に共通して設けられ、複数の無人機２００が、フォーメーション決定装置が決定したフォーメーションを共有するようにしてもよい。
　なお、一部の無人機２００を手動に切り替えたい場合、および、人がフォーメーション用のパラメータ値を適宜変更したい場合等に備えて、無人機システム１が、ユーザ操作を受け付ける手動命令入力部をさらに備えるようにしてもよい。
　　図２は、実施形態に係る無人機システムの構成の第２例を示す概略図である。図２に示す構成で、無人機システム１は、複数の制御装置１００と複数の無人機２００と、手動命令入力部３００とを備える。制御装置１００は、情報取得展開部１０１と、対象物検知部１０２と、存在確率算出部１０３と、パラメータ設定部１０４と、動作量算出部１０５と、動作設定部１０６とを備える。無人機２００は、センサ２０１を備える。
　図２の構成の無人機システム１は、手動命令入力部３００をさらに備える点で、図１の構成の場合と異なる。それ以外の点では、図２の構成の無人機システム１は、図１の場合と同様である。
　手動命令入力部３００は、例えばタッチパネル、操作盤、または、キーボードおよびマウス、あるいはこれらの組み合わせ等の入力デバイスを備えた端末装置として構成され、人が行う操作を受け付ける。手動命令入力部３００を用いて操作を行う者をユーザと称する。
　手動命令入力部３００は、受け付けたユーザ操作を示す入力情報を制御装置１００へ送信する。制御装置１００では、情報取得展開部１０１が、入力情報を取得する。情報取得展開部１０１は、パラメータ設定部１０４または動作量算出部１０５など、ユーザの入力に対応する処理を行う機能部に入力情報を通知する。通知を受けた機能部がユーザ操作に従って処理を行うことで、制御装置１００は、ユーザ操作に従って制御対象の無人機２００を動作させる。
　例えば、複数の無人機２００を一括して監督するユーザが、手動命令入力部３００からパラメータ値の設定の指示を行い、パラメータ設定部１０４が、この指示に従ってパラメータ値の設定を行うようにしてもよい。
　具体的には、ユーザが、手動命令入力部３００からフォーメーションの形状を指示し、パラメータ設定部１０４が、フォーメーションの形状を指示された形状に決定するようにしてもよい。あるいは、上述したように、パラメータ設定部１０４が、対象物の存在確率分布に関する情報に基づいて、フォーメーションの形状を決定するようにしてもよい。
　フォーメーションの形状毎に各パラメータの値を組み合わせたパラメータ値セットが複数用意され、パラメータ設定部１０４が、何れかのパラメータ値セットを選択することで、各パラメータに値を設定するようにしてもよい。この場合、ユーザが手動命令入力部３００から、選択すべきパラメータ値セットを指示し、パラメータ設定部１０４が、指示されたパラメータ値セットを選択するようにしてもよい。あるいは、上述したように、パラメータ設定部１０４が、対象物の存在確率分布に関する情報に基づいて、何れかのパラメータ値セットを選択するようにしてもよい。
　あるいは、上述したように、パラメータ設定部１０４が、少なくとも一部のパラメータに値を直接設定するようにしてもよい。この場合、ユーザが手動命令入力部３００から、パラメータと、そのパラメータに設定すべき値とを指示し、パラメータ設定部１０４が、指示されたパラメータに指示された値を設定するようにしてもよい。あるいは、上述したように、パラメータ設定部１０４が、値が設定されていないパラメータに設定する値を、対象物の存在確率分布に関する情報に基づいて算出し、設定するようにしてもよい。
　ユーザが手動命令入力部３００から、フォーメーション決定用の全てのパラメータについてパラメータ値を指定するようにしてもよい。あるいは、ユーザが手動命令入力部３００から、フォーメーション決定用のパラメータのうち一部のみについてパラメータ値を指定するようにしてもよい。例えば、ユーザが、手動命令入力部３００からフォーメーションの形状を指示し、指示された形状について設けられているパラメータについては、パラメータ設定部１０４が、パラメータ値を決定するようにしてもよい。
　また、ユーザが手動命令入力部３００から、複数の無人機２００のうち一部の無人機２００のみについて、パラメータ値を指定するようにしてもよい。また、ユーザが手動命令入力部３００から、無人機２００毎に異なる詳細度でパラメータ値を指定するようにしてもよい。例えば、ユーザが手動命令入力部３００から、一部の無人機２００についてはフォーメーションの形状のみを指定するようにしてもよい。そして、ユーザが手動命令入力部３００から、他の一部の無人機２００についてはフォーメーションの形状に加えて、その形状について設けられているパラメータの値も指定するようにしてもよい。
　また、ユーザが手動命令入力部３００から、無人機２００のフォーメーションのパラメータ値の指示に加えて、あるいは代えて、無人機２００の動作量を指示するようにしてもよい。例えば、手動命令入力部３００が、ユーザ操作に従って、特定の無人機２００の移動方向および移動速度の指示を、その無人機２００に送信するようにしてもよい。そして、指示を受けた無人機２００以外の無人機２００の動作量算出部１０５が、指示を受けた無人機２００との位置関係および速度の関係に基づいて、フォーメーションを形成するための動作量を算出するようにしてもよい。
（制御装置の配置の第１例）
　図３は、制御装置１００の配置の第１例を示す図である。図３は、図２に示す無人機システム１の構成で、複数の無人機２００の各々に対応する複数の制御装置１００を纏めた中央管理システム２を、クラウド内に配置した例を示している。
　図３の配置例で、無人機２００として、例えば、空中を自律動作し、レーダーで探索対象を探索する、Unmanned Air Vehicle（ＵＡＶ）と呼ばれる無人機を用いるようにしてもよい。
　図３の配置例の場合、個々の制御装置１００が、実態を有する個々の装置としてなくクラウド上の機能として構成されていてもよい。いわば、制御装置１００がバーチャルにクラウド上に配備されていてもよい。そして、あたかも無人機２００が近隣の無人機２００と情報交換するように、バーチャルな制御装置１００が、制御対象の無人機２００の近隣の無人機２００を制御するバーチャルな制御装置１００と情報交換しながら、制御対象の無人機２００に制御指示を出していくようにしてもよい。
　図３の配置例で使用する評価関数等は、上述した式（１）から式（４）までの関数と同じものとすることができる。ここで、各ＵＡＶは非同期に動作しており、ＵＡＶからアップロードされる情報も非同期となる。従って、クラウド上に中央管理システム２が配置されていても、情報が同期的には集まらない。このため、探索確率に関する通常の最適化計算を行うことはできない。そこで、中央管理システム２は、上述の評価関数を用いた自律型アルゴリズムを使用してＵＡＶを制御し、ＵＡＶ群全体としての動作の最適化を図る。
　図４は、無人機システム１の動作結果の第１例を示す図である。図４は、制御装置１００が無人機２００を制御して形成されたフォーメーションの概略をスナップショットで示している。
　線Ｌ１１は、無人機２００のフォーメーションを示している。図４の例では円のフォーメーションとなっている。
　矢印Ｂ１１からＢ１４の各々は、フォーメーションの変化の情報を示している。矢印の向きはフォーメーションが変化する向きを示す。矢印の大きさ（長さ）は、フォーメーションの変化の速度を示す。図４の例では、フォーメーションは、円の形状を保ったまま小さくなっていく。すなわち、フォーメーション内の領域を狭めていく。
　領域Ａ１１内の濃淡は、対象物の存在確率分布を示している。表示が濃いほど（図４では黒っぽいほど）存在確率が高い。
　図４では、無人機２００が、円のフォーメーションで、対象物の存在確率分布に合わせてフォーメーションを組めている様子が示されている。図４の状態から、無人機２００が円のフォーメーションを保って包囲網を狭めていき、対象物を囲い込んで捕獲する。
　このように、無人機システム１を用いると、対象物の捕獲オペレーションを複数の無人機２００でより効果的、かつ、より効率的に実施することができる。
　図５は、無人機システム１の動作結果の第２例を示す図である。図５は、制御装置１００が無人機２００を制御して形成されたフォーメーションの概略をスナップショットで示している。図５は、制御装置１００が無人機２００を制御し、さらには手動命令入力部３００からの指示によって形成されたフォーメーションの概略をスナップショットで示している。
　線Ｌ２１およびＬ２２は、無人機２００のフォーメーションを示している。図５の例では、手動命令入力部を介して、フォーメーションの形状が円から二重円に変更されている。
　矢印Ｂ２１からＢ２４の各々は、線Ｌ２１で示されるフォーメーションの変化の情報を示している。矢印Ｂ２１からＢ２４の各々は、線Ｌ２１で示されるフォーメーションの変化の情報を示している。矢印Ｂ２５からＢ２８の各々は、線Ｌ２２で示されるフォーメーションの変化の情報を示している。矢印Ｂ１１の向きはフォーメーションが変化する向きを示す。矢印Ｂ１１の大きさ（長さ）は、フォーメーションの変化の速度を示す。図５の例では、フォーメーションは、二重の円の形状を保ったまま小さくなっていく。すなわち、フォーメーション内の領域を狭めていく。
　領域Ａ２１内の濃淡は、対象物の存在確率分布を示している。表示が濃いほど（図５では黒っぽいほど）存在確率が高い。
　図５では、無人機２００が、二重円のフォーメーションで、対象物の存在確率分布に合わせてフォーメーションを組めている様子が示されている。図５の状態から、無人機２００が二重円のフォーメーションを保って包囲網を狭めていき、対象物を囲い込んで捕獲する。
（制御装置の配置の第２例）
　図６は、制御装置１００の配置の第１例を示す図である。図６は、図２に示す無人機システム１の構成で、制御装置１００が、それぞれ制御対象の無人機２００に搭載された例を示している。
　図６の配置の場合、各無人機２００が近隣の通信可能な無人機２００と情報交換し、無人機２００自らに搭載された制御装置１００の指示を受けて自律分散的に行動する。無人機群が動作するフィールドから情報を取りにくく、無人機群に自律分散的な動作を期待しなくてはならないケースに、図６のように無人機２００に制御装置１００を搭載する配置が有効である。こういうケースは実際の応用局面では非常に多いと考えられる。また、中央管理システムを想定するのが難しいケース、あるいは中央管理システムが機能しなくなってしまったケースなどでも、図６のように無人機２００に制御装置１００を搭載する配置が有効である。
　図６の配置の場合、使用する無人機２００、および、評価関数などの条件はすべて、図３の配置の場合と同様とすることができる。図６の場合の、図３の場合との一番の違いは、中央管理システム２（図３）に情報を上げるか否かである。図６の例では、中央管理システムに情報を上げない。ターゲット位置取得部は無人機２００に搭載されており、探索対象に関する情報も近隣の無人機２００と交換される。
　図７は、無人機システム１の動作結果の第３例を示す図である。
　図６の配置で、無人機２００のフォーメーションの形状を任意形状とし、対象物の存在確率が不定形の形になった場合の動作を、シミュレーションで確認した。図７は、その動作結果をスナップショットで示す。
　領域Ａ３１内の濃淡は、対象物の存在確率分布を示している。表示が濃いほど（図７では黒っぽいほど）存在確率が高い。
　矢印Ｂ３１から３４は、無人機２００の配置の変化の情報を示している。矢印の向きはフォーメーションが変化する向きを示す。矢印の大きさ（長さ）は、フォーメーションの変化の速度を示す。
　図７の例では、無人機２００のフォーメーションを任意としているので、図７にはフォーメーションを示す線は表示されていないが、無人機２００は、対象物の存在確率分布の等高線と相似形で、存在確率分布が高くなっている領域Ａ３１を囲んでいる。無人機２００は、矢印Ｂ３１から３４が示す向きおよび速さで移動することで、対象物の存在確率分布の等高線との相似形を維持して、囲む範囲を狭めていく。これにより、無人機２００は、包囲網を破綻させないように移動しながら包囲網を狭めていき、対象物を囲い込んで捕獲する。
　このように、無人機２００のそれぞれに制御装置１００を搭載し制御を行っても有効に動作する。
（その他の例）
　図３では、クラウド内に中央管理システム２を実装するケースを示した。この中央管理システムを特別なシステムとして構築しても良い。例えば、中央管理システムを構築して海岸に設営し、中央管理システム２から複数のＵＡＶに指示を出すようにしてもよい。あるいは、中央管理システムを、複数のＵＡＶを取りまとめる母船に設営してもよい。
　無人機２００として、上述したＵＡＶ以外のものを用いるようにしてもよい。例えば、無人機２００として、空を飛ぶ飛行機型の無人機を用いるようにしてもよいし、陸上を走行する無人機を用いるようにしてもよい。
　無人機システム１が、手動命令入力部３００を複数備え、複数人のユーザが別々の無人機２００を手動操作するようにしてもよい。
　以上のように、情報取得展開部１０１は、制御対象の無人機２００の位置情報、および、制御対象以外の無人機２００の位置情報を取得する。対象物検知部１０２は、無人機２００に搭載されたセンサ２０１からのセンサ信号を用いて対象物の検知を試みる。存在確率算出部１０３は、対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する。パラメータ設定部１０４は、パラメータ値の設定により、複数の無人機２００のフォーメーションを決定する。動作量算出部１０５は、設定されたフォーメーションに基づいて、制御対象の無人機の動作量を算出する。動作設定部１０６は、算出された動作量に従って、制御対象の無人機に対する動作設定を行う。
　これにより、制御装置１００では、対象物の捕獲をより効率的に行うことができる。具体的には、制御装置１００によれば、無人機２００を用いて対象物を捕獲することができ、マンパワーを削減できる点で、効率的に捕獲を行うことができる。
　また、制御装置１００によれば、無人機２００がフォーメーションを維持して対象物を囲みながら対象物に近付くことができる。制御装置１００によればこの点で、効果的に対象物を検出し捕獲することができる。
　また、動作量算出部１０５は、制御対象の無人機２００の位置情報と、制御対象以外の無人機２００の位置情報とに基づいて、制御対象の無人機２００の動作量を算出する。
　これにより、動作量算出部１０５は、制御対象の無人機２００の位置と、制御対象以外の無人機２００の位置との位置関係に基づいて制御対象の無人機２００の動作を算出することができ、無人機２００の相対的な位置関係を調整することができる。例えば、動作量算出部１０５は、無人機２００同士の間隔を適切な間隔に保つことができる。
　また、手動命令入力部３００は、ユーザ操作を受け付ける。動作量算出部１０５は、フォーメーションに加えてユーザ操作に基づいて、前記動作量を算出する。
　制御装置１００では、ユーザ操作に基づいて無人機２００を動作させる点で、
ユーザの意図を反映して無人機２００を動作させることができる。
　また、手動命令入力部３００は、無人２００機の制御の手動設定と自動設定とを切り替えるユーザ操作、および、手動に設定された無人機２００についての制御設定を行うユーザ操作を受け付ける。動作量算出部１０５は、フォーメーションに加えて、手動に設定された無人機２００の位置及び速度に基づいて、動作量を算出する。
　制御装置１００によれば、ユーザが一部の無人機２００を手動で操作する場合に、他の無人機２００の動作を自動的に制御することができ、この点で、制御装置１００では、対象物の捕獲をより効率的に行うことができる。具体的には、制御装置１００によれば、一部の無人機２００を自動的に動作させて対象物を捕獲することができ、マンパワーを削減できる点で、効率的に捕獲を行うことができる。
　また、存在確率算出部１０３は、対象物検知部１０２が対象物の検知に成功してから時間が経過しているほど、空間的な広がりが大きい、対象物の存在確率分布を算出する。
　対象物検知部１０２が対象物の検知に成功してから時間が経過しているほど、対象物が移動している可能性が高くなり、また、対象物が移動している可能性がある距離が長くなる。存在確率算出部１０３は、対象物検知部１０２が対象物の検知に成功してから時間が経過しているほど、空間的な広がりが大きい、対象物の存在確率分布を算出することで、対象物が移動している可能性、および、対象物が移動している可能性がある距離に応じた存在確率分布を算出することができる。この点で、存在確率算出部１０３は、対象物の存在確率分布を高精度に算出することができる。
　また、動作量算出部１０５は、フォーメーションの形状に関しての制御対象の無人機２００の評価値、および、他の無人機２００との関係に関しての制御対象の無人機２００の評価値とに基づいて、評価をより高くするように、動作量を算出する。
　これにより、動作量算出部１０５は、無人機２００がフォーメーションを形成し、かつ、無人機２００同士が適切な距離で位置するように、動作量を算出することができる。
　また、動作量算出部１０５は、対象物の存在確率分布と制御対象の無人機２００の位置との関係に基づいて、動作量を算出する。例えば、動作量算出部１０５は、対象物の存在確率分布の等高線と、制御対象の無人機２００との位置関係に基づいて、動作量を算出する。
　これにより、動作量算出部１０５は、制御対象の無人機２００が、対象物の存在確率分布に基づくフォーメーションを形成するように、動作量を算出することができる。
　次に、図８および図９を参照して本発明の実施形態の構成について説明する。
　図８は、実施形態に係る制御装置の構成の例を示す図である。図８に示す制御装置４００は、情報取得展開部４０１と、対象物検知部４０２と、存在確率算出部４０３と、フォーメーション決定部４０４と、動作量算出部４０５と、動作設定部４０６とを備える。
　かかる構成で、情報取得展開部４０１は、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する。対象物検知部４０２は、無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる。存在確率算出部４０３は、対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する。フォーメーション決定部４０４は、対象物の存在確率分布に基づいて複数の無人機のフォーメーションを決定するパラメータ値を設定する。フォーメーション決定部４０４は、上述したようなパラメータ設定部１０４と同様の機能を有している。動作量算出部４０５は、設定されたフォーメーションに基づいて、制御対象の無人機の動作量を算出する。動作設定部４０６は、算出された動作量に従って、制御対象の無人機に対する動作設定を行う。
　これにより、制御装置４００では、対象物の捕獲を、より効率的に行うことができる。
　図９は、実施形態に係るフォーメーション決定装置の構成の例を示す図である。図９に示すフォーメーション決定装置４１０は、情報取得展開部４１１と、対象物検知部４１２と、存在確率算出部４１３と、フォーメーション決定部４１４とを備える。
　かかる構成で、情報取得展開部４１１は、制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する。対象物検知部４１２は、無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる。存在確率算出部４１３は、対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する。フォーメーション決定部４１４は、対象物の存在確率分布に基づいて複数の無人機のフォーメーションを決定するパラメータ値を設定する。フォーメーション決定部４１４は、上述したようなパラメータ設定部１０４と同様の機能を有している。
　これにより、フォーメーション決定装置４１０では、対象物の存在確率分布に応じて無人機のフォーメーションを決定することができる。フォーメーション決定装置４１０が決定するフォーメーションを用いることで、対象物の捕獲を、より効率的に行うことができる。
　図１０は、少なくとも１つの実施形態に係るコンピュータの構成を示す概略ブロック図である。
　図１０に示す構成で、コンピュータ７００は、ＣＰＵ（Central Processing Unit）７１０と、主記憶装置７２０と、補助記憶装置７３０と、インタフェース７４０とを備える。
　上記の制御装置１００および４００のうち何れか１つ以上が、コンピュータ７００に実装されてもよい。その場合、上述した各処理部の動作は、プログラムの形式で補助記憶装置７３０に記憶されている。ＣＰＵ７１０は、プログラムを補助記憶装置７３０から読み出して主記憶装置７２０に展開し、当該プログラムに従って上記処理を実行する。また、ＣＰＵ７１０は、プログラムに従って、上述した各記憶部に対応する記憶領域を主記憶装置７２０に確保する。無人機制御装置または移動体制御装置と他の装置との通信は、インタフェース７４０が通信機能を有し、ＣＰＵ７１０の制御に従って通信を行うことで実行される。
　制御装置１００がコンピュータ７００に実装される場合、情報取得展開部１０１と、対象物検知部１０２と、存在確率算出部１０３と、パラメータ設定部１０４と、動作量算出部１０５と、動作設定部１０６との動作は、プログラムの形式で補助記憶装置７３０に記憶されている。ＣＰＵ７１０は、プログラムを補助記憶装置７３０から読み出して主記憶装置７２０に展開し、当該プログラムに従って上記処理を実行する。
　制御装置１００と無人機２００など他の機器との通信は、インタフェース７４０が通信機能を有し、ＣＰＵ７１０の制御に従って通信を行うことで実行される。
　制御装置４００がコンピュータ７００に実装される場合、情報取得展開部４０１と、対象物検知部４０２と、存在確率算出部４０３と、フォーメーション決定部４０４と、動作量算出部４０５と、動作設定部４０６との動作は、プログラムの形式で補助記憶装置７３０に記憶されている。ＣＰＵ７１０は、プログラムを補助記憶装置７３０から読み出して主記憶装置７２０に展開し、当該プログラムに従って上記処理を実行する。
　制御装置４００と無人機との通信は、インタフェース７４０が通信機能を有し、ＣＰＵ７１０の制御に従って通信を行うことで実行される。
　なお、制御装置１００および４００の全部または一部の機能を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することにより各部の処理を行ってもよい。ここでいう「コンピュータシステム」とは、ＯＳ（オペレーティングシステム）や周辺機器等のハードウェアを含む。
　「コンピュータ読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ＲＯＭ（Read Only Memory）、ＣＤ－ＲＯＭ（Compact Disc Read Only Memory）等の可搬媒体、コンピュータシステムに内蔵されるハードディスク等の記憶装置のことをいう。また上記プログラムは、前述した機能の一部を実現するためのものであっても良く、さらに前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるものであっても良い。
　以上、本発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の設計変更等も含まれる。
　本発明の実施形態は、制御装置、制御方法およびプログラムに適用してもよい。
　１　無人機システム
　２　中央管理システム
　１００、４００　制御装置
　１０１、４０１、４１１　情報取得展開部
　１０２、４０２、４１２　対象物検知部
　１０３、４０３、４１３　存在確率算出部
　１０４　パラメータ設定部
　１０５、４０５　動作量算出部
　１０６、４０６　動作設定部
　２００　無人機
　３００　手動命令入力部
　４０４、４１４　フォーメーション決定部
　４１０　フォーメーション決定装置

Claims (10)

  1. 　制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する情報取得展開部と、
    　前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる対象物検知部と、
    　前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する存在確率算出部と、
    　前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するフォーメーション決定部と、
    　前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する動作量算出部と、
    　算出された動作量に従って、制御対象の無人機に対する動作設定を行う動作設定部と、
    　を備える制御装置。
  2. 　前記動作量算出部は、制御対象の無人機の位置情報と、制御対象以外の無人機の位置情報とに基づいて、制御対象の無人機の動作量を算出する
    　請求項１に記載の制御装置。
  3. 　前記動作量算出部は、前記フォーメーションに加えて、ユーザ操作を受け付ける手動命令入力部でのユーザ操作に基づいて、前記動作量を算出する。
    　請求項２に記載の制御装置。
  4. 　前記手動命令入力部は、前記無人機の制御の手動設定と自動設定とを切り替えるユーザ操作、および、手動に設定された前記無人機についての制御設定を行うユーザ操作を受け付け、
    　前記動作量算出部は、前記フォーメーションに加えて、手動に設定された前記無人機の位置及び速度に基づいて、前記動作量を算出する、
    　請求項３に記載の制御装置。
  5. 　前記存在確率算出部は、前記対象物検知部が前記対象物の検知に成功してから時間が経過しているほど、空間的な広がりが大きい、前記対象物の存在確率分布を算出する、
    　請求項１から４の何れか一項に記載の制御装置。
  6. 　前記動作量算出部は、前記フォーメーションの形状に関しての前記制御対象の無人機の評価値、および、他の無人機との関係に関しての前記制御対象の無人機の評価値とに基づいて、評価をより高くするように、前記動作量を算出する、
    　請求項１から５の何れか一項に記載の制御装置。
  7. 　前記動作量算出部は、前記対象物の存在確率分布と制御対象の無人機の位置との関係に基づいて、前記動作量を算出する、
    　請求項１から６の何れか一項に記載の制御装置。
  8. 　複数の無人機の位置情報を取得する情報取得展開部と、
    　前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる対象物検知部と、
    　前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する存在確率算出部と、
    　前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するフォーメーション決定部と、
    　を備えるフォーメーション決定装置。
  9. 　制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する工程と、
    　前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる工程と、
    　前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する工程と、
    　前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するパラメータ値を設定する工程と、
    　前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する工程と、
    　算出された動作量に従って、制御対象の無人機に対する動作設定を行う工程と、
    　を含む制御方法。
  10. 　コンピュータに、
    　制御対象の無人機の位置情報、および、制御対象以外の無人機の位置情報を取得する工程と、
    　前記無人機に搭載されたセンサからのセンサ信号を用いて対象物の検知を試みる工程と、
    　前記対象物の検知に成功した位置および時刻の情報に基づいて、対象物の存在確率分布を算出する工程と、
    　前記対象物の存在確率分布に基づいて、複数の前記無人機のフォーメーションを決定するパラメータ値を設定する工程と、
    　前記フォーメーションに基づいて、制御対象の無人機の動作量を算出する工程と、
    　算出された動作量に従って、制御対象の無人機に対する動作設定を行う工程と、
    　を実行させるためのプログラム。
PCT/JP2018/048355 2018-12-27 2018-12-27 制御装置、フォーメーション決定装置、制御方法およびプログラム WO2020136850A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2020562252A JPWO2020136850A1 (ja) 2018-12-27 2018-12-27 制御装置、フォーメーション決定装置、制御方法およびプログラム
PCT/JP2018/048355 WO2020136850A1 (ja) 2018-12-27 2018-12-27 制御装置、フォーメーション決定装置、制御方法およびプログラム
US17/417,220 US11853066B2 (en) 2018-12-27 2018-12-27 Control device, formation determination device, control method, and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2018/048355 WO2020136850A1 (ja) 2018-12-27 2018-12-27 制御装置、フォーメーション決定装置、制御方法およびプログラム

Publications (1)

Publication Number Publication Date
WO2020136850A1 true WO2020136850A1 (ja) 2020-07-02

Family

ID=71127886

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2018/048355 WO2020136850A1 (ja) 2018-12-27 2018-12-27 制御装置、フォーメーション決定装置、制御方法およびプログラム

Country Status (3)

Country Link
US (1) US11853066B2 (ja)
JP (1) JPWO2020136850A1 (ja)
WO (1) WO2020136850A1 (ja)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004017743A (ja) * 2002-06-14 2004-01-22 Kumamoto Technology & Industry Foundation 自律飛行カイトプレーンシステムおよびカイトプレーン制御装置
WO2018105599A1 (ja) * 2016-12-07 2018-06-14 日本電気株式会社 制御装置、制御方法およびプログラム記録媒体

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07234721A (ja) 1994-02-24 1995-09-05 Hitachi Zosen Corp 衝突回避方法
DE602004028701D1 (de) 2003-02-03 2010-09-30 Kiva Sys Inc Materialhandhabungssystem und verfahren mit selbständigen mobilen antriebseinheiten und beweglichen lagerbehältern
US7908040B2 (en) 2004-07-15 2011-03-15 Raytheon Company System and method for automated search by distributed elements
JP5271772B2 (ja) 2009-03-30 2013-08-21 株式会社日立製作所 列車運行制御方法および車上制御装置
JP5559671B2 (ja) 2010-12-13 2014-07-23 公益財団法人鉄道総合技術研究所 走行制御支援方法及び走行制御支援装置
US9371622B2 (en) * 2013-10-22 2016-06-21 James Connor Buckley System and method to automatically determine irregular polygon for environmental hazard containment modules
EP3140084A4 (en) 2014-05-05 2018-04-04 Georgia Tech Research Corporation Control of swarming robots
JP6316146B2 (ja) 2014-09-03 2018-04-25 株式会社デンソーアイティーラボラトリ 移動物体位置予測装置、移動物体位置予測方法及び移動物体位置予測用コンピュータプログラム
US10310518B2 (en) * 2015-09-09 2019-06-04 Apium Inc. Swarm autopilot
US9952591B2 (en) * 2015-11-24 2018-04-24 Northrop Grumman Systems Corporation Spatial-temporal forecasting for predictive situational awareness
CN108801266B (zh) * 2018-06-21 2020-06-26 河南大学 一种多无人机对不确定环境搜索的航迹规划方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004017743A (ja) * 2002-06-14 2004-01-22 Kumamoto Technology & Industry Foundation 自律飛行カイトプレーンシステムおよびカイトプレーン制御装置
WO2018105599A1 (ja) * 2016-12-07 2018-06-14 日本電気株式会社 制御装置、制御方法およびプログラム記録媒体

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
KAWAKAMI, KOHEI ET AL.,: ""Self-Organization of Action Control Architecture for Multi-Agent System"", LECTUREPREPRINTS OF THE 25TH ANNUAL CONFERENCE OF THE ROBOTICS SOCIETY OF JAPAN, September 2007 (2007-09-01), XP009515274 *

Also Published As

Publication number Publication date
US20220075379A1 (en) 2022-03-10
JPWO2020136850A1 (ja) 2021-09-27
US11853066B2 (en) 2023-12-26

Similar Documents

Publication Publication Date Title
Khan et al. Cooperative robots to observe moving targets
JP7301851B2 (ja) 自動化された適応型三次元ロボット現地調査
JP6750615B2 (ja) 制御装置、機器、情報処理システム、制御方法、および、制御プログラム
Islam et al. A path planning algorithm for collective monitoring using autonomous drones
CN106781187B (zh) 基于多维系统fm模型的火灾现场火源区域定位方法
Tang et al. A joint global and local path planning optimization for UAV task scheduling towards crowd air monitoring
CN107807671B (zh) 无人机集群危险规避方法
CN110162035A (zh) 一种集群机器人在有障碍物场景中的协同运动方法
Negrello et al. Humanoids at work: The walk-man robot in a postearthquake scenario
Khan et al. Multiscale observation of multiple moving targets using micro aerial vehicles
Brandtner et al. Coherent swarming of unmanned micro aerial vehicles with minimum computational and communication requirements
JP7089926B2 (ja) 管制装置
JP7069632B2 (ja) 制御装置、移動体、及び移動体の分散制御プログラム
Hu et al. Visual camouflage and online trajectory planning for unmanned aerial vehicle-based disguised video surveillance: Recent advances and a case study
Muller et al. A probabilistic sonar sensor model for robust localization of a small-size blimp in indoor environments using a particle filter
WO2020136850A1 (ja) 制御装置、フォーメーション決定装置、制御方法およびプログラム
US11740629B2 (en) Control device for autonomous operating machines, control method for autonomous operating machines, and recording medium having control program for autonomous operating machines stored thereon
Chalmers et al. Cooperating unmanned vehicles
Mahamud et al. ALW drone: A new design and efficient approach
Cakmak et al. Thermal based exploration for search and rescue robots
Krishna et al. Autonomous observation of multiple USVs from UAV while prioritizing camera tilt and yaw over UAV motion
Wisniewski et al. Reinforcement Learning for Pan-Tilt-Zoom Camera Control, with Focus on Drone Tracking
Durdevic et al. Uav visual servoing navigation in sparsely populated environments
Singh et al. Gyro-stabilized camera control in drones for military applications
JP2019179529A (ja) 管制装置

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: 18944519

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2020562252

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: 18944519

Country of ref document: EP

Kind code of ref document: A1