Patent Application
20190196476
The present invention relates to a flying device that flies autonomously, a method of controlling the flying device, and a storage medium.
Small unmanned flying devices that fly autonomously using a driving propulsion device constituted by rotor blades driven by a motor are generally referred to as so-called drones or multicopters (hereinafter, “drones”) and are a known technology (Patent Documents 1 and 2, for example).
One known form of motion control for when such flying devices fly autonomously is performing a type of feedback control known as proportional-integral-derivative control (PID control) on position. PID control is a method of feedback control which combines proportional action, integral action, and derivative action related to error corresponding to the difference between a control target value and a current process variable. As illustrated in
Another known form of motion control is performing PID control on velocity. As illustrated in
Patent Document 1: Japanese Patent No. 5432277
Patent Document 2: Japanese Patent Application Laid-Open Publication No. 2013-129301
Accordingly, the present invention is directed to a scheme that substantially obviates one or more of the problems due to limitations and disadvantages of the related art.
Additional or separate features and advantages of the invention will be set forth in the descriptions that follow and in part will be apparent from the description, or may be learned by practice of the invention. The objectives and other advantages of the invention will be realized and attained by the structure particularly pointed out in the written description and claims thereof as well as the appended drawings.
To achieve these and other advantages and in accordance with the purpose of the present invention, as embodied and broadly described, in one aspect, the present disclosure provides a flying device, including: a propulsion unit; a sensor unit that detects at least a current position and a current velocity of the flying device; and a processor configured to receive a target position and calculate or receive a target velocity corresponding to the target position, the processor being further configured to perform: a velocity feedback control in which the current velocity is taken as a process variable and the target velocity is taken as a setpoint so as to generate a velocity-feedback manipulated variable for controlling the propulsion unit, and a position feedback control in which the current position is taken as a process variable and the target position is taken as a setpoint so as to generate a position-feedback manipulated variable for controlling the propulsion unit, wherein in at least a prescribed distance range of the flying device with respect to the target position, the processor calculates a weighted average of the velocity-feedback manipulated variable and the position-feedback manipulated variable and controls the proposition unit in accordance with the weighted averaged manipulated variable, thereby performing velocity-position hybrid feedback control, and wherein in the at least the prescribed distance range, the larger a current distance of the current position of the flying device from the target position is, the more weight the processor assigns to the velocity-feedback manipulated variable in the weighted average, and the smaller the current distance becomes, the more weight the processor assigns to the position-feedback manipulated variable in the weighted average, so that as the flying device approaches the target position, the position feedback control becomes more dominant relative to the velocity feedback control.
In the above-mentioned flying device, the prescribed distance range may be within a prescribed distance from the target position inclusive of the target position, and when the current position of the flying vehicle is beyond the distance range, the processor may perform only the velocity feedback control without performing the position feedback control in controlling the propulsion unit.
In the above-mentioned flying device, in the prescribed distance range, the weight the processor assigns to the velocity-feedback manipulated variable and the weight the processor assigns to the position-feedback manipulated variable in the weighted average may be both linear functions of the current distance of the current position of the flying device from the target position as detected by the detection unit.
In the above-mentioned flying device, in the prescribed distance range, the weight the processor assigns to the velocity-feedback manipulated variable may be a ratio of the current distance of the current position of the flying device from the target position as detected by the detection unit relative to an initial distance, the initial distance being either the prescribed distance or a distance of the flying device from the target position when the processor initially determines that the flying device is within the prescribed distance range and starts performing the velocity-position hybrid feedback control, a remaining weight being assigned to the position-feedback manipulated variable in the weighted average.
In the above-mentioned flying device, each of the velocity feedback control and the position feedback control may be proportional-integral-derivative (PID) feedback control.
In another aspect, the present disclosure provides a method to be performed by a processor in a flying device for controlling the flying device, the flying device further including a propulsion unit and a sensor unit that detects at least a current position and a current velocity of the flying device, the processor in the flying device being configured to: receive a target position and calculate or receive a target velocity corresponding to the target position: perform a velocity feedback control in which the current velocity is taken as a process variable and the target velocity is taken as a setpoint so as to generate a velocity-feedback manipulated variable for controlling the propulsion unit, and perform a position feedback control in which the current position is taken as a process variable and the target position is taken as a setpoint so as to generate a position-feedback manipulated variable for controlling the propulsion unit, the method including: in at least a prescribed distance range of the flying device with respect to the target position, causing the processor to calculate a weighted average of the velocity-feedback manipulated variable and the position-feedback manipulated variable; and controlling the proposition unit in accordance with the weighted averaged manipulated variable, thereby performing velocity-position hybrid feedback control, and wherein in the at least the prescribed distance range, the larger a current distance of the current position of the flying device from the target position is, the more weight the processor assigns to the velocity-feedback manipulated variable in the weighted average, and the smaller the current distance becomes, the more weight the processor assigns to the position-feedback manipulated variable in the weighted average, so that as the flying device approaches the target position, the position feedback control becomes more dominant relative to the velocity feedback control.
In another aspect, the present disclosure provides a non-transitory computer-readable storage medium having stored thereon a program executable by a processor in a flying device that further includes a propulsion unit and sensor unit that detects at least a current position and a current velocity of the flying device, the program configuring the processor to: receive a target position and calculate or receive a target velocity corresponding to the target position, perform a velocity feedback control in which the current velocity is taken as a process variable and the target velocity is taken as a setpoint so as to generate a velocity-feedback manipulated variable for controlling the propulsion unit, and perform a position feedback control in which the current position is taken as a process variable and the target position is taken as a setpoint so as to generate a position-feedback manipulated variable for controlling the propulsion unit, wherein in at least a prescribed distance range of the flying device with respect to the target position, the program causes the processor to calculate a weighted average of the velocity-feedback manipulated variable and the position-feedback manipulated variable and control the proposition unit in accordance with the weighted averaged manipulated variable, thereby performing velocity-position hybrid feedback control, and wherein in the at least the prescribed distance range, the larger a current distance of the current position of the flying device from the target position is, the more weight the processor assigns to the velocity-feedback manipulated variable in the weighted average, and the smaller the current distance becomes, the more weight the processor assigns to the position-feedback manipulated variable in the weighted average, so that as the flying device approaches the target position, the position feedback control becomes more dominant relative to the velocity feedback control.
An example of one aspect is a flying device including a propulsion unit, the flying device including: a sensor unit that detects at least a current position and a current velocity; and a controller that performs feedback control in which the larger a current distance between the current position detected by the sensor unit and a target position is, the more strongly velocity feedback control based on the current velocity detected by the sensor unit and on a target velocity corresponding to the target position is applied, and the smaller the current distance becomes, the more strongly position feedback control based on the current position detected by the sensor unit and on the target position is applied.
It is to be understood that both the foregoing general description and the following detailed description are exemplary and explanatory, and are intended to provide further explanation of the invention as claimed.
An embodiment of the present invention will be described in detail below with reference to figures. In the present embodiment, in motion control of a flying device including a flight propulsion unit and a sensor unit that detects at least a current position and a current velocity, the flying device includes a controller that, with respect to a manipulated variable for the flight propulsion unit, performs feedback control in which the larger a current distance between the current position detected by the sensor unit and a target position is, the more strongly velocity PID control, for example, based on the current velocity detected by the sensor unit and on a target velocity corresponding to the target position is applied, and the smaller the current distance becomes, the more strongly position PID control, for example, based on the current position and on the target position is applied. Here, the controller inputs as an instruction to the flight propulsion unit a manipulated variable obtained by adding together manipulated variables obtained by respectively performing weighting on the velocity PID control and the position PID control in accordance with the current distance. More specifically, when the current distance is large in comparison to a prescribed distance threshold, the controller inputs as an instruction to the flight propulsion unit a manipulated variable output by the velocity PID control. Moreover, when the current distance becomes small in comparison to the prescribed distance threshold, the controller inputs as an instruction to the flight propulsion unit a manipulated variable obtained by setting a distance between the current position at a current moment and the target position as a remaining travel distance, performing weighting of a magnitude proportional to a ratio of the current distance to the remaining travel distance on the output of the velocity PID control, performing weighting of a magnitude inversely proportional to the above-mentioned ratio on the output of the position PID control, and adding together a manipulated variable obtained by weighting the output of the velocity PID control and a manipulated variable obtained by weighting the output of the position PID control. Due to this type of control, the present embodiment makes it possible to, when the current position of the flying device is far away from the target position, perform control that applies the velocity PID control-only feedback control and thereby keeps the speed of the flying device as constant as possible, and, when the flying device gets close to the target position, perform control that applies feedback control which gradually transitions from velocity PID control to position PID control and thereby makes the flying device smoothly arrive and stop (hover) at the target position.
A cylindrical frame 101 which is a body member has openings respectively on the upper side (sky side) and the lower side (ground side). As illustrated in
As illustrated in
As illustrated in
A digital camera unit 110 which is part of an information acquisition device and a circuit box 111 which is a control unit are mounted on the outer surface of the frame 101. The digital camera unit 110 captures images. The circuit box 111 stores circuit groups for controlling the rotor motor 102, the #1 to #4 vane motors 106, the flight sensor 109, the digital camera unit 110, and the battery 104 illustrated in
The rotor motor driver 302 drives the rotor motor 102 illustrated in
The power sensor 304 supplies power to the rotor motor driver 302 and the #1 to #4 vane motor drivers 303 while monitoring the voltage of the battery 104. Moreover, although this is not explicitly illustrated in the figure, some of the power from the battery 104 is also supplied to the controller 301 as well as to the flight sensor 109 and the digital camera unit 110 illustrated in
The controller 301 obtains information related to the position, velocity, and the like of the airframe of the flying device 100 from the flight sensor 109 in real time. Moreover, the controller 301 respectively sends power instruction signals with pulse-width modulated duty cycles to the rotor motor driver 302 and the #1 to #4 vane motor drivers 303 while monitoring the voltage of the battery 104 via the power sensor 304. In this way, the rotor motor driver 302 controls the rotation speed of the rotor motor 102, and the #1 to #4 vane motor drivers 303 respectively control the rotation angles of the #1 to #4 vane motors 106. Moreover, the controller 301 controls the image-capturing operation of the digital camera unit 110 (
Next, the basic principle of control utilized by the controller 301 to control the rotor motor driver 302 and the #1 to #4 vane motor drivers 303 in the present embodiment will be described. The present embodiment uses a form of PID control expressed by equation (1) below.
In equation (1) above, e(t) is the error obtained at time t by subtracting a current process variable obtained by the flight sensor 109 from a target value calculated by a control process of the controller 301 (described later). Moreover, u(t) is a manipulated variable that should be input to the rotor motor driver 302 or the #1 to #4 vane motor drivers 303 at time t.
The form of PID control given by equation (1) above is a method of feedback control that combines proportional action, integral action, and derivative action related to the error described above. In other words, the first term on the right side of equation (1) implements proportional control (P control), in which the manipulated variable u(t) is controlled where the manipulated variable is regarded as a linear function of the error e(t) between the process variable and the target value. The coefficient Kp that is multiplied with this first term is known as the proportional gain (P gain). This proportional control causes the manipulated variable u(t) to be gradually adjusted by an amount proportional to the error e(t) between the target value and the current process variable, thereby making it possible to precisely bring the process variable u(t) closer to the target value.
Moreover, the second term on the right side of equation (1) implements integral control (I control), in which the manipulated variable u(t) is controlled proportionally to the time integral of the error e(t). The coefficient Ki that is multiplied with this second term is known as the integral gain (I gain). With P control alone, as the current process variable approaches the target value, the manipulated variable u(t) becomes too small, which creates a state in which it is impossible to achieve any finer level of control and the current process variable reaches a stable state that is extremely close to the target value. This small amount of error is known as “residual error”. Therefore, PI control, which adds the I control described above to the P control, makes it possible to achieve an action in which once the residual error reaches a certain magnitude after accumulating over time, the manipulated variable u(t) is increased in order to eliminate that residual error.
Furthermore, the third term on the right side of equation (1) implements derivative control (D control), in which the manipulated variable u(t) is controlled proportionally to the derivative of the error e(t). The coefficient Kd that is multiplied with this third term is known as the derivative gain (D gain). The PI control described above achieves a control scheme in which the current process variable is brought closer to the target value. However, this type of control requires a prescribed period of time (time constant), and if this time constant is large, responsiveness when a disturbance occurs becomes worse, and states in which it is impossible to quickly return to the original target value can occur. Therefore, in PID control, which adds the D control described above to PI control, when the difference in the error e(t) relative to previous error (that is, the derivative) is large, the manipulated variable is increased, thereby making it possible to achieve feedback control that responds quickly to sudden disturbances.
Thus, PID control, in which the manipulated variable u(t) is controlled as the sum of three terms including the proportional term, the integral term, and the derivative term which are related to the error e(t), makes it possible to smoothly bring the respective process variables to the target values in the rotor motor driver 302 and the #1 to #4 vane motor drivers 303 and thereby makes it possible to achieve control with high precision and good responsiveness.
The controller 301 implements the PID control described above using programed control, for example. In this case, at each discrete moment that occurs at a prescribed time interval, the controller 301 uses error calculated from a discrete value of the process variable as obtained from the flight sensor 109 to calculate the manipulated variable for the current discrete moment in accordance with equations (2) and (3) below. Then, the controller 301 inputs the manipulated variables calculated using this PID control-based feedback control process to the rotor motor driver 302 and the #1 to #4 vane motor drivers 303 in order to drive the rotor motor 102 and the #1 to #4 vane motors 106.
<Equation (2)>
u(n)=u(n−1)+Δu(n) (2)
<Equation (3)>
Δu(n)=Kp}e(n)−e(n−1)}+Kie(n)+Kd[{e(n)−e(n−1)}−{e(n−1)−e(n−2)}] (3)
In equation (2) above, u(n) is the manipulated variable to be calculated at the current discrete moment n, u(n−1) is the manipulated variable that was calculated at the previous discrete moment n−1, and Au(n) is a manipulated variable difference to be calculated at the current discrete moment n. Moreover, in equation (3), which gives the operation for calculating this manipulated variable difference Δu(n), e(n) is the error at the current discrete moment n as obtained by subtracting the process variable at the current discrete moment n from the target value, e(n−1) is the error at the previous discrete moment n−1 as obtained by subtracting the process variable at that previous discrete moment n−1 from the target value, and e(n−2) is the error at a further previous discrete moment n−2 as obtained by subtracting the process variable at that further previous discrete moment n−2 from the target value.
In equation (3), the proportional control operation given by the first term on the right side can be calculated by the simple operation of subtracting the error e(n−1) calculated at the previous discrete moment n−1 from the error e(n) at the current discrete moment n as obtained by subtracting the process variable at the current discrete moment n from the target value, and then multiplying the result by the P gain Kp. Moreover, the integral control operation given by the second term on the right side can be calculated by the simple operation of multiplying the error e(n) at the current discrete moment n by the I gain Ki. Furthermore, the derivative control operation given by the third term on the right side can be calculated by the simple operation of subtracting the result of subtracting the error e(n−2) calculated at the further previous discrete moment n−2 from the error e(n−1) calculated at the previous discrete moment n−1 from the result of subtracting the error e(n−1) calculated at the previous discrete moment n−1 from the error e(n) calculated at the current discrete moment n, and then multiplying the obtained result by the D gain Kd. In this way, the controller 301 can rapidly execute the discrete moment operations for PID control by using the error e(n) obtained by subtracting the process variable as obtained from the flight sensor 109 at the current discrete moment n from the target value; the errors e(n−1) and e(n−2) respectively calculated at the previous and the further previous discrete moments n−1 and n−2; and the P gain Kp, the I gain Ki, and the D gain Kd, which are calculated in advance.
In an algorithm 401, which is the operation of the controller 301 executing a control process (described later), when a request to change the position of the flying device 100 is issued, first, a target position 411 is determined in the algorithm 401. The target position 411 is, for example, the position which the flying device 100 should attain after a user throws the flying device 100 up into the air, for example. The target position 411 is constituted by latitude data, longitude data, and altitude data. Meanwhile, after the user throws the flying device 100 up into the air, for example, a current position 412 that indicates the current position is sequentially input to the algorithm 401 from the GPS sensor and the atmospheric pressure sensor, for example, in the flight sensor 109. The current position 412 is constituted by latitude data and longitude data obtained from the GPS sensor as well as altitude data obtained from the atmospheric pressure sensor.
Upon determining to perform velocity PID control, the algorithm 401 converts the latitude data and longitude data for the target position 411 into a target two-dimensional velocity 413 and outputs this target two-dimensional velocity 413, which is vector data constituted by a component in the direction of an axis (hereinafter, a “horizontal axis”) going from the current position as obtained from the GPS sensor in the flight sensor 109, for example, towards the target position 411 within a plane level to the ground, as well as a component in the direction of an axis (hereinafter, an “orthogonal axis”) that is orthogonal to the horizontal axis (see the prior description of
In regards to subtractors 402 and 406, PID controllers 403 and 407, and a manipulated variable mixer 404, which will be described below, there are actually two channels corresponding to the two components of the target two-dimensional velocity 413 and to the two components of a target two-dimensional position 419 (described later). However, in
One of the components of the target two-dimensional velocity 413 output by the algorithm 401 is input to the subtractor 402. Moreover, a component corresponding to either a component of a current velocity 414 in the horizontal axis direction or a component in the orthogonal axis direction (respectively corresponding to 706 and 707 in previously described
This component of the two-dimensional velocity error 415 calculated at each discrete moment n is input to the PID controller 403 as the error e(n) at the discrete moment n in previously described equation (3). The PID controller 403 is a function implemented in the form of the controller 301 executing the PID control operations of previously described equations (3) and (2) within the control program. Using, as described above, the error e(n) which is the horizontal axis or orthogonal axis component of the two-dimensional velocity error 415 calculated by the subtractor 402 at the discrete moment n; the errors e(n−1) and e(n−2) which are the horizontal axis or orthogonal axis components of the two-dimensional velocity error 415 respectively calculated at the previous and further previous discrete moments n−1 and n−2; the P gain Kp, the I gain Ki, and the D gain Kd that are calculated in advance; and a manipulated variable u(n−1) which is the horizontal axis or orthogonal axis component of a two-dimensional velocity manipulated variable 416 calculated at the previous discrete moment n−1, the PID controller 403 executes the operations given by previously described equations (3) and (2) in order to calculate the horizontal axis or orthogonal axis component of the two-dimensional velocity manipulated variable 416 as the manipulated variable u(n) at the current discrete moment n. The PID controller 403 calculates the horizontal axis component or orthogonal axis component of the two-dimensional velocity manipulated variable 416 for each channel and outputs it to the manipulated variable mixers 404.
Upon determining to perform position PID control in parallel with the velocity PID control described above, the algorithm 401 converts the latitude data and longitude data for the target position 411 into a target two-dimensional position 419, which is vector data constituted by a component in the horizontal axis direction and a component in the orthogonal axis direction, and the algorithm 401 outputs this target two-dimensional position 419. This process of executing position PID control in parallel with velocity PID control is known as a hybrid PID control process.
One of the components of the target two-dimensional position 419 output by the algorithm 401 is input to the subtractor 406. Moreover, a component corresponding to either a component of the current position 412 in the horizontal axis direction or a component in the orthogonal axis direction is also input to the subtractor 406. This current position 412 is data obtained by converting the latitude data and longitude data detected by the GPS sensor in the flight sensor 109 into components in the horizontal axis direction and the orthogonal axis direction. Similar to the subtractor 402, the subtractor 406 is a function implemented in the form of the controller 301 executing a subtraction process within the control program. At each abovementioned discrete moment n, the subtractor 406 subtracts the component of the current position 412 from the component of the target two-dimensional position 419 in order to calculate a component of a two-dimensional position error 420 corresponding to the horizontal axis or the orthogonal axis.
This component of the two-dimensional position error 420 calculated at each discrete moment n is input to the PID controller 407 as the error e(n) at the discrete moment n in previously described equation (3). Similar to the PID controller 403, the PID controller 407 is a function implemented in the form of the controller 301 executing the PID control operations of previously described equations (3) and (2) within the control program. Using, as described above, the error e(n) which is the horizontal axis or orthogonal axis component of the two-dimensional position error 420 calculated by the subtractor 402 at the discrete moment n; the errors e(n−1) and e(n−2) which are the horizontal axis or orthogonal axis components of the two-dimensional position error 420 respectively calculated at the previous and further previous discrete moments n−1 and n−2; the P gain Kp, the I gain Ki, and the D gain Kd that are calculated in advance; and a manipulated variable u(n−1) which is the horizontal axis or orthogonal axis component of a two-dimensional position manipulated variable 421 calculated at the previous discrete moment n−1, the PID controller 407 executes the operations given by previously described equations (3) and (2) in order to calculate the horizontal axis or orthogonal axis component of the two-dimensional position manipulated variable 421 which is the manipulated variable u(n) at the current discrete moment n. The PID controller 408 calculates the horizontal axis component or orthogonal axis component of the two-dimensional position manipulated variable 421 for each channel and outputs it to the manipulated variable mixers 404.
When the algorithm 401 determines to perform only velocity PID control, the manipulated variable mixer 404 for each channel corresponding to the horizontal axis or the orthogonal axis outputs the horizontal axis or orthogonal axis component of the two-dimensional velocity manipulated variable 416 output from the PID controllers 403 to a manipulated variable converter 405 as-is as the horizontal axis or orthogonal axis component of a final manipulated variable 417. Meanwhile, when the algorithm 401 determines to perform position PID control in addition to velocity PID control, the manipulated variable mixer 404 for each channel corresponding to the horizontal axis or the orthogonal axis respectively multiplies the corresponding horizontal axis or orthogonal axis component of the two-dimensional velocity manipulated variable 416 output from the PID controllers 403 and the horizontal axis or orthogonal axis component of the two-dimensional position manipulated variable 421 output from the PID controllers 407 by respective weighting values determined in a control process executed by the controller 301 (described later). Then, the manipulated variable mixer 404 adds together these multiplication results, and then outputs the addition result to the manipulated variable converter 405 as the horizontal axis or orthogonal axis component of the final manipulated variable 417.
On the basis of the horizontal axis and orthogonal axis components of the final manipulated variables 417 respectively input from the manipulated variable mixers 404 for the respective channels corresponding to the horizontal axis and the orthogonal axis, the manipulated variable converter 405 generates #1 to #4 vane motor rotation angles 418 for driving the #1 to #4 vane motors 106 (see
Meanwhile, a target height 422 output from the algorithm 401 is input to a subtractor 408. A current height 423 is also input to the subtractor 408. This current height 423 is output data from the atmospheric pressure sensor of the flight sensor 109, for example. Similar to the subtractors 402 and the like, the subtractor 408 is a function implemented in the form of the controller 301 executing a subtraction process within the control program. At each abovementioned discrete moment n, the subtractor 408 subtracts the current height 423 from the target height 422 in order to calculate a height error 424. This height error 424 calculated at each discrete moment n is input to a PID controller 409 as the error e(n) at the discrete moment n in previously described equation (3). Similar to the PID controllers 403 and the like, the PID controller 409 is a function implemented in the form of the controller 301 executing the PID control operations of previously described equations (3) and (2) within the control program. Using, as described above, the error e(n) which is the height error 424 calculated by the subtractor 408 at the discrete moment n; the errors e(n−1) and e(n−2) which are the height errors 424 respectively calculated at the previous and further previous discrete moments n−1 and n−2; the P gain Kp, the I gain Ki, and the D gain Kd that are calculated in advance; and a manipulated variable u(n−1) which is a height manipulated variable 425 calculated at the previous discrete moment n−1, the PID controller 409 executes the operations given by previously described equations (3) and (2) in order to calculate the height manipulated variable 425 which is the manipulated variable u(n) at the current discrete moment n.
A manipulated variable converter 410, on the basis of the height manipulated variable 425 input from the PID controller 409, generates a rotor motor rotation speed 426 for driving the rotor motor 102 (see
If further changes to the target position 411 become necessary in the algorithm 401, the same PID control-based feedback control process described above is performed repeatedly.
After a user performs a process of throwing the flying device 100 up into the air, for example (not illustrated), the controller 301 sets the target position 411 illustrated in
Next, as described above in the description of
Then, the controller 301 repeatedly executes the following sequence of processes from step S503 to S506. First, the controller 301 detects the current position 412 from the GPS sensor and the atmospheric pressure sensor, for example, in the flight sensor 109 (step S503). The current position 412 is constituted by latitude data and longitude data obtained from the GPS sensor as well as altitude data obtained from the atmospheric pressure sensor.
Next, the controller 301 calculates the linear distance from the current position 412 detected in step S503 to the target position 411 set in step S501 as a current distance (step S504).
The controller 301 then determines whether the current distance calculated in step S504 is greater than a prescribed distance threshold (step S505).
If the determination in step S505 yields YES, the controller 301 executes, with respect to the target two-dimensional velocity 413, only the velocity PID control process described with reference to the subtractors 402 and the PID controllers 403 in
When, as a result of the repeating process described above, the flying device 100 gets close to the target position 411 and the current distance becomes less than or equal to the prescribed distance threshold (the determination in step S505 yields NO), the controller 301 executes the hybrid PID control process described below, which is a process in which velocity PID control and position PID control are performed in parallel. In the hybrid PID control process, first, the controller 301 sets the distance between the target position 411 and the current position 412 (the current distance) as a remaining travel distance (step S507).
Next, the controller 301 executes the sequence of control processes from step S508 to S512 until it is determined in step S512 that the flying device 100 has reached the target position 411. First, the controller 301 detects the current position 412 similarly to in step S503 (step S508) and executes the same process of calculating the current distance as in step S504 (step S509).
Then, the controller 301 calculates the result of dividing the current distance calculated in step S509 by the remaining travel distance calculated in step S507 (that is, the ratio of the current distance to the remaining travel distance) as a weighting value (step S510).
Next, the controller 301 executes, with respect to the target two-dimensional velocity 413, the velocity PID control process described with reference to the subtractors 402 and the PID controllers 403 in
<Equation (4)>
Component of Manipulated Variable 417=Component of Two-Dimensional Velocity Manipulated Variable 416×Weighting Value+Component of Two-Dimensional Position Manipulated Variable 421×(1-Weighting Value) (4)
As the process of the manipulated variable converter 405, the controller 301, on the basis of the components of the manipulated variable 417 respectively input as a result of the processes performed according to the above equation (4) by the manipulated variable mixers 404 for each channel, generates #1 to #4 vane motor rotation angles 418 for driving the #1 to #4 vane motors 106 (see
Then, by determining whether the current distance calculated in step S509 has become substantially equal to zero, the controller 301 determines whether the flying device 100 has reached the target position 411 set in step S501 (step S512).
If the determination in step S512 yields NO, the controller 301 returns to the process of step S508 and repeatedly executes the processes of steps S508 to S512.
Although in the embodiment described above the hybrid PID control process is executed when the current distance becomes small in comparison to the prescribed distance threshold, the hybrid PID control process may be executed immediately after flight begins, or the hybrid PID control process may be executed in response to various other conditions.
Moreover, although in the embodiment described above the strengths of the velocity PID control and the position PID control change gradually, these strengths may be switched between two levels or between a plurality of levels.
Although the embodiment above describes an example in which the flying device is equipped with a digital camera unit, the flying device may be equipped with various other types of sensor devices such as a measurement device including a sensor that collects a temperature distribution or an atmospheric composition distribution, for example, or these types of devices may be omitted.
Although the embodiment described above is a so-called ducted-fan device that includes the single rotor motor 102 and the four #1 to #4 vane motors 106, the flying device may also be a multicopter device that includes a plurality (such as four or six) of the rotor motors 102. Alternatively, the flight propulsion unit may be implemented in the form of a mechanism that is propelled by air pressure or engine output.
It will be apparent to those skilled in the art that various modifications and variations can be made in the present invention without departing from the spirit or scope of the invention.
Thus, it is intended that the present invention cover modifications and variations that come within the scope of the appended claims and their equivalents. In particular, it is explicitly contemplated that any part or whole of any two or more of the embodiments and their modifications described above can be combined and regarded within the scope of the present invention.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2017-246112 | Dec 2017 | JP | national |
