Control device for moving body, moving body, control method for moving body, and program
Patent Information
- Application Number
- JP2023133460
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-08-18
- Publication Date
- 2025-03-03
AI Technical Summary
【0015】 上記態様によれば、移動体に搭載された磁気ギヤードモータの脱調を抑制することができる。
Smart Images

Figure 2025028560000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a control device for a moving body, a moving body, a control method for a moving body, and a program. [Background technology]
[0002] 2. Description of the Related Art Moving bodies such as ships and vehicles are equipped with propulsion systems that move the moving bodies in any direction at any speed (see, for example, Patent Document 1).
[0003] In recent years, the propulsion systems of moving bodies such as ships and vehicles are increasingly being electrified. For example, in the case of ships, electric motors offer greater freedom in layout compared to existing diesel engines and steam turbines, and are expected to improve efficiency and reliability when combined with storage batteries.
[0004] To use an electric motor, it is necessary to use a mechanical reducer in conjunction with it or to use an electric motor specially designed to have a low rated speed in order to match the rotation speed to the range required by the propulsion device. However, using a mechanical reducer in conjunction with it has disadvantages such as the generation of vibration and noise, and the need for regular maintenance. In addition, when using a low-speed electric motor with a low rated speed, the size (diameter) of the electric motor increases in order to increase the number of poles, which has the disadvantage that it is difficult to install it on a moving body with limited installation space.
[0005] For this reason, it has been considered to use a magnetic geared motor as an electric motor. A magnetic geared motor has a magnetic gear section consisting of a high-speed rotor and a low-speed rotor. The high-speed rotor and the low-speed rotor transmit torque in a non-contact manner using a magnetic spring. This magnetic spring causes the low-speed rotor to rotate synchronously with the high-speed rotor at a predetermined reduction ratio. In other words, a magnetic geared motor can adjust the rotation speed to match the propulsion device without a mechanical reducer. Furthermore, since a magnetic geared motor can output the rotation speed required by the propulsion device without having to make the diameter as large as that of a general electric motor (for example, a synchronous motor), it can also be applied to moving bodies with limited installation space. [Prior art documents] [Patent documents]
[0006] [Patent Document 1] JP 2022-99788 A Summary of the Invention [Problem to be solved by the invention]
[0007] On the other hand, when a magnetic gear motor is overloaded due to foreign objects being caught in it, or when a sudden reversal operation such as a ship's crash astern occurs, torque that exceeds the maximum transmission torque of the magnetic spring is generated in the magnetic gear, and the high-speed rotor and low-speed rotor may step out and lose their torque transmission function. The step-out is naturally resolved when the input energy is cut off, but until the step-out is resolved, an alternating torque is generated that has the maximum transmission torque as an amplitude and fluctuates at a frequency proportional to the electrical speed difference between the high-speed rotor and the low-speed rotor. This alternating torque may excite the natural vibration mode of the rotating shaft system of the magnetic gear motor. If the natural vibration mode is excited, noise may be generated from the rotating shaft system, and the rotating shaft and surrounding equipment may be damaged.
[0008] One method to suppress step-out is to increase the maximum transmission torque. This is an essential and reliable method, but in order to increase the maximum transmission torque, it is necessary to increase the amount of magnets in the magnetic gear section. This leads to an increase in the size, weight, and cost of the magnetic geared motor, reducing its superiority over mechanical reducers and low-speed large-diameter electric motors.
[0009] An object of the present disclosure is to provide a control device for a moving body, a moving body, a control method for a moving body, and a program that can suppress loss of synchronization of a magnetic geared motor mounted on the moving body. [Means for solving the problem]
[0010] According to one aspect of the present disclosure, a control device for a moving body is a control device for a moving body having a propeller that is rotationally driven by a magnetic geared motor, and includes a switching unit that switches between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor, and an auto mode in which the torque limit value is automatically set, a manual setting unit that, when switched to the manual mode, sets the torque limit value to a value specified by the operator, an automatic setting unit that, when switched to the auto mode, sets the torque limit value based on at least one of the load torque transmitted from the propeller to the magnetic geared motor and measurement data representing the state of the moving body, and a limiter that limits a torque command that adjusts the electric torque of the magnetic geared motor based on the difference between a rotation speed command that specifies the rotation speed of the propeller and measurement data for the rotation speed of the propeller, by the torque limit value.
[0011] According to one aspect of the present disclosure, a control device for a moving body is a control device for a moving body having a propeller that is rotationally driven by a magnetic geared motor, and includes a switching unit that switches between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor, and an auto mode in which the torque limit value is automatically set, a manual setting unit that sets the torque limit value to a value specified by the operator when switched to the manual mode, an automatic setting unit that sets the torque limit value based on at least one of a load torque transmitted from the propeller to the magnetic geared motor and measurement data representing a state of the moving body when switched to the auto mode, a limit value calculation unit that calculates a limit value that limits at least one of a rotation speed command that specifies the rotation speed of the propeller and a steering angle command that specifies the steering angle of the moving body based on the torque limit value, and a limiter that limits at least one of the rotation speed command and the steering angle command by the limit value.
[0012] According to one aspect of the present disclosure, a moving body includes a magnetic geared motor having a low-speed rotor and a high-speed rotor, a propulsion device rotated and driven by the magnetic geared motor, a steering gear that changes the direction of travel, and a control device according to the above-mentioned aspect.
[0013] According to one aspect of the present disclosure, a method for controlling a moving body is a method for controlling a moving body having a propeller that is rotationally driven by a magnetic geared motor, and includes the steps of switching between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor, and an auto mode in which the torque limit value is automatically set, a step of setting the torque limit value to a value specified by the operator when switched to the manual mode, a step of setting the torque limit value based on at least one of a load torque transmitted from the propeller to the magnetic geared motor and measurement data representing a state of the moving body when switched to the auto mode, and a step of limiting a torque command that adjusts the electric torque of the magnetic geared motor based on a difference between a rotation speed command that specifies the rotation speed of the propeller and measurement data for the rotation speed of the propeller, with the torque limit value.
[0014] According to one aspect of the present disclosure, a program causes a control device of a moving body having a propeller driven by a magnetic geared motor to execute the following steps: switching between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor, and an auto mode in which the torque limit value is automatically set; when switched to the manual mode, setting the torque limit value to a value specified by the operator; when switched to the auto mode, setting the torque limit value based on at least one of the load torque transmitted from the propeller to the magnetic geared motor and measurement data representing the state of the moving body; and limiting, with the torque limit value, a torque command that adjusts the electric torque of the magnetic geared motor based on the difference between a rotation speed command that specifies the rotation speed of the propeller and the measurement data for the rotation speed of the propeller. Effect of the Invention
[0015] According to the above aspect, it is possible to prevent loss of synchronism of the magnetic geared motor mounted on the moving body. [Brief description of the drawings]
[0016] [Figure 1] 1 is a diagram showing an overall configuration of a moving body according to a first embodiment. [Diagram 2] 2 is a block diagram showing a functional configuration of a control device according to the first embodiment. FIG. [Diagram 3] FIG. 2 is a schematic diagram of a magnetic gear unit according to the first embodiment. [Figure 4] 2 is a block diagram showing a control example of the control device according to the first embodiment. FIG. [Diagram 5] FIG. 4 is a diagram for explaining a function of a switching unit according to the first embodiment. [Figure 6] 4 is a block diagram showing an example of processing in an auto mode according to the first embodiment. FIG. [Figure 7] FIG. 11 is a block diagram showing an example of processing in an auto mode according to the second embodiment. [Figure 8] FIG. 11 is a block diagram showing a functional configuration of a control device according to a third embodiment. [Figure 9] FIG. 11 is a block diagram showing a control example of a control device according to a third embodiment. [Figure 10] FIG. 11 is a first diagram showing the configuration of a magnetic geared motor according to a fourth embodiment. [Figure 11] FIG. 13 is a second diagram showing the configuration of the magnetic geared motor according to the fourth embodiment. [Figure 12] FIG. 13 is a diagram showing the effect of the magnetic geared motor according to the fourth embodiment. [Figure 13] FIG. 13 is a third diagram showing the configuration of the magnetic geared motor according to the fourth embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0017] <First embodiment> Hereinafter, the embodiments will be described in detail with reference to the drawings.
[0018] (Overall configuration of the vehicle) FIG. 1 is a diagram showing the overall configuration of a moving object according to the first embodiment. The moving body 1 is, for example, a ship. In other embodiments, the moving body 1 may be an airplane, an automobile, a railroad car, etc. As shown in FIG. 1, the moving body 1 includes a main body 3, a propulsion system 4, a steering system 5, an operation unit 10, and a control device 2.
[0019] The main body 3 is the body (hull, aircraft body, vehicle body) of the moving object 1. In addition, a plurality of sensors 31 are provided in each part of the main body 3. Each sensor 31 detects the speed of the moving object 1 (main body 3), Measures attitude angles (roll angle, pitch angle, yaw angle), acceleration (up / down, left / right, forward / backward acceleration), etc.
[0020] The propulsion system 4 is a mechanism that provides thrust to the moving body 1 (main body 3). The propulsion system 4 has an inverter control device 40, an inverter 41, a magnetic geared motor 42, a rotating shaft 43, a thruster 44, a current sensor 45, and a rotation angle sensor 46.
[0021] The inverter 41 supplies electric power to a magnetic geared motor 42 in accordance with commands (voltage and current commands) from an inverter control device 40 .
[0022] The magnetic geared motor 42 has a magnetic gear unit 42A consisting of a high-speed rotor HSR and a low-speed rotor PPR. When a current supplied from an inverter 41 flows through a stator winding (not shown), the high-speed rotor HSR rotates due to the magnetomotive force of the winding. The electric torque (motor torque) applied to the high-speed rotor HSR is transmitted to the low-speed rotor PPR via a magnetic spring. As a result, the low-speed rotor PPR rotates in synchronization with the high-speed rotor HSR at a predetermined reduction ratio.
[0023] The rotating shaft 43 is the output shaft of the magnetic geared motor 42, and connects the low-speed rotor PPR and the propeller 44 via a joint JT.
[0024] The propulsion device 44 is rotationally driven by the torque transmitted from the magnetic geared motor 42, and applies a thrust to the moving body 1 (main body 3). The propulsion device 44 is, for example, a propeller. In other embodiments, the propulsion device 44 may be a wheel of an automobile or a railroad car.
[0025] A current sensor 45 is provided on the power line connecting the inverter 41 and the magnetic geared motor 42. The current sensor 45 measures the current (motor current) supplied from the inverter 41 to the magnetic geared motor 42. In addition, a rotation angle sensor 46 is provided on the magnetic geared motor 42. The rotation angle sensor 46 includes a high-speed side rotation angle sensor 46A that measures the rotation angle and rotation speed of the high-speed rotor HSR, and a low-speed side rotation angle sensor 46B that measures the rotation angle and rotation speed of the low-speed rotor PPR (rotating shaft 43).
[0026] The inverter control device 40 feedback controls the voltage and current applied by the inverter 41 to the magnetic geared motor 42 based on measurement data such as the motor current and the rotation speed of the rotating shaft 43 so that the torque of the magnetic geared motor 42 matches the torque command requested by the control device 2 described later.
[0027] The steering system 5 has a steering gear 51 capable of changing the traveling direction of the moving body 1 (main body portion 3).
[0028] The operation unit 10 accepts inputs such as operation commands from an operator.
[0029] The control device 2 controls the propulsion system 4 and the steering system 5 based on operation commands from an operator. In this embodiment, in particular, the state of the moving body 1 and meteorological and sea conditions are monitored, and the torque of the magnetic geared motor 42 of the propulsion system 4 is adjusted so as to suppress loss of synchronism of the magnetic geared motor 42. Note that the control of the steering system 5 (such as calculation of a rudder angle command) is similar to the conventional technology, and therefore a detailed description thereof will be omitted.
[0030] (Functional configuration of the control device) FIG. 2 is a block diagram showing a functional configuration of the control device. As shown in FIG. 2, the control device 2 includes a processor 20, a memory 21, a storage 22, and a communication interface .
[0031] The processor 20 operates according to a predetermined program to thereby fulfill the functions of a control unit 201, a switching unit 202, a manual setting unit 203, an automatic setting unit 204, an estimation unit 205, and a limiter 206.
[0032] The control unit 201 performs feedback control to adjust the electric torque (motor torque) of the magnetic geared motor 42 based on the difference between the measurement data of the rotation speed of the propeller 44 (rotary shaft 43) and the rotation speed command.
[0033] The switching unit 202 switches the setting mode of the torque limit value that limits the electric torque of the magnetic geared motor 42. The setting modes include a manual mode in which the operator manually sets the torque limit value, and an auto mode in which the torque limit value is automatically set.
[0034] When the mode is switched to the manual mode, the manual setting unit 203 sets the torque limit value to a value designated by the operator.
[0035] When switched to the auto mode, the automatic setting unit 204 sets the torque limit value based on at least one of the load torque transmitted from the propulsion unit 44 to the magnetic geared motor 42 and the measurement data representing the state of the moving body 1.
[0036] The estimation unit 205 estimates the load torque based on state variables including measurement data representing the state of the moving body 1.
[0037] The limiter 206 outputs a final torque command to the inverter control device 40 , which is obtained by limiting the torque limit value calculated by the control unit 201 with the torque limit value set by the manual setting unit 203 or the automatic setting unit 204 .
[0038] The predetermined program executed by the processor 20 is stored in a computer-readable recording medium. The computer-readable recording medium refers to a magnetic disk, a magneto-optical disk, a CD-ROM, a DVD-ROM, a semiconductor memory, etc. The computer program may be distributed to a computer via a communication line, and the computer that receives the program may execute the program. The program may be for implementing part of the above-mentioned functions. The program may be a so-called difference file (difference program) that can realize the above-mentioned functions in combination with a program already recorded in the computer system.
[0039] The memory 21 has a memory area necessary for the operation of the processor 20 .
[0040] The storage 22 is a so-called auxiliary storage device, such as a hard disk drive (HDD), a solid state drive (SSD), etc. The storage 22 stores data that each part of the processor 20 acquires, generates, and refers to during processing.
[0041] The communication interface 23 transmits and receives signals (operation commands, measurement data, etc.) to and from each device.
[0042] (Control unit processing) Next, a detailed description will be given of the processing of the control device 2. The control device 2 according to this embodiment reduces the torsional torque generated in the magnetic gear portion 42A instead of increasing the maximum transmission torque of the magnetic geared motor 42. By reducing the torsional torque, step-out is suppressed without increasing the size of the magnetic geared motor 42.
[0043] FIG. 3 is a schematic diagram of the magnetic gear unit according to the first embodiment. When the magnetic gear portion 42A is represented by a simplified model as shown in Fig. 3, the torsional torque generated in the magnetic gear portion 42A can be reduced by controlling the electric torque generated by applying a current to the stator winding (not shown) of the magnetic geared motor 42 or the torque of the thruster 44 in accordance with the load torque. From Fig. 4, the following equations (1) to (4) are established.
[0044]
number
[0045]
number
[0046]
number
[0047]
number
[0048] θ in Equation (1) e is the torsion angle (electrical angle) that indicates the difference in rotation angle between the high-speed rotor HSR and the low-speed rotor PPR, and ω e is the torsional angular velocity (electrical angle) that indicates the rotational speed difference. e , ω e is obtained from equation (2). p in equation (2) h , θ0, and ω0 are the number of pole pairs, rotation angle (mechanical angle), and angular velocity (mechanical angle) of the high-speed rotor HSR, respectively. s , θ1, and ω1 are the number of poles of the pole pieces of the low-speed rotor PPR, the rotation angle (mechanical angle), and the angular speed (mechanical angle) in degrees, respectively.
[0049] The second term on the right side of equation (3) is the torque (magnetic spring torque) of the magnetic gear portion 42A, and its maximum value is the maximum transmission torque T max In equation (3), J r , T ris obtained from equation (4). In equation (4), J0 is the moment of inertia of the high speed rotor HSR, J1 is the moment of inertia of the low speed rotor PPR, T0 is the electric torque, and T1 is the load torque. Therefore, the first term T on the right side of equation (3) r is the maximum transmission torque T max If this is exceeded, the stable operating point disappears and step-out occurs.
[0050] If we ignore losses, in a steady state, the first and second terms on the right side of equation (3) are balanced, and the left side is 0, meaning the rotational speed difference is 0, and the high-speed rotor HSR and low-speed rotor PPR rotate in perfect synchronization. If the load torque T1 increases by ΔT1 from this state, then T r increases, the balance of equation (3) is lost, the left side of the equation becomes ≠ 0, and the rotation angle difference θ e At this time, suppose that the electric torque T0 is changed by ΔT0 shown in the following equation (5) at exactly the same timing as the change in the load torque T1.
[0051]
number
[0052] Then, T r The change in the rotation angle and speed of the high-speed rotor HSR and the low-speed rotor PPR is zero, and no electrical difference in rotation angle or rotation speed occurs. max Therefore, loss of synchronization can be suppressed without increasing the number of magnets to provide a margin for the maximum transmission torque.
[0053] However, in reality, it is not possible to know exactly when and what load will act, and it is not possible to control the electric torque with zero delay.
[0054] A simple and reliable method is to reduce (or limit) the electric torque before an overload occurs. However, if the electric torque is always reduced (limited), the output torque of the magnetic geared motor 42 decreases, and it takes time for the moving body 1 to move (navigate). For this reason, the amount of reduction (limitation) of the electric torque and its duration must be appropriately adjusted.
[0055] Therefore, the control device 2 according to this embodiment executes a process of limiting the electric torque in the manual setting unit 203 or the automatic setting unit 204.
[0056] FIG. 4 is a block diagram showing a control example of the control device according to the first embodiment. The control process of the control device 2 will be described in detail with reference to FIG.
[0057] First, as shown in FIG. 4, the switching unit 202 switches the setting mode to either the manual mode or the auto mode.
[0058] FIG. 5 is a diagram for explaining the function of the switching unit according to the first embodiment. 5, the switching unit 202 switches the setting mode to the manual mode when any one of the conditions M1 to M3 is satisfied, and switches the setting mode to the auto mode when all of the conditions A1 to A3 are satisfied.
[0059] The setting mode switching conditions M1 to M3 and A1 to A3 are as follows. (M1) When the operator performs an operation to select the manual mode via the operation unit 10. (M2) When the measurement data is not sufficiently reliable. (M3) When environmental conditions are predicted to be poor. (A1) When the operator performs an operation to select the auto mode via the operation unit 10. (A2) When the measurement data is sufficiently reliable. (A3) When environmental conditions are predicted to be favorable.
[0060] Regarding conditions M1 and A1, the operator switches the setting mode depending on, for example, an operation plan for the moving body 1. For example, if it is known in advance that severe operation such as crash astern or sharp turns will be performed during sea trials (i.e., overload of the magnetic geared motor 42 will occur), the operator selects the manual mode (condition M1). On the other hand, if it is known in advance that such severe operation will not be performed, the operator selects the auto mode (condition A1).
[0061] The measurement data for conditions M2 and A2 are measurement data of the number of rotations of the propeller 44 (rotating shaft 43) used by the automatic setting unit 204 to set the torque limit value, and measurement data such as the speed, attitude angle, and acceleration of the moving body 1 (main body unit 3) measured by the sensor 31. For example, if any of the sensors fails or a data transmission abnormality occurs, the reliability of the measurement data is determined to be insufficient (condition M2). On the other hand, if all the sensors are operating normally or no data transmission abnormality occurs, the reliability of the measurement data is determined to be sufficient (condition A2).
[0062] The environmental conditions of conditions M3 and A3 include information indicating whether meteorological conditions such as wind and rain and oceanographic conditions such as waves are good or bad. The control device 2 acquires the current and future environmental conditions (good / bad) on the movement route of the moving object 1 from the operation unit 10 or an external server (not shown), etc. Note that the environmental conditions may include predicted values such as wind speed, rainfall, and wave height, and the switching unit 202 may determine whether the environmental conditions are good or bad based on whether any of these predicted values exceed a threshold value.
[0063] That is, the manual mode is set when it is difficult for the estimating unit 205 to estimate the load torque, such as in stormy weather, and the judgment of an experienced operator is important. The auto mode is set when the weather and sea conditions are calm, such as in fine weather, and the load torque can be estimated relatively accurately. In order to minimize the travel time (navigation time) of the moving body 1 and maximize fuel efficiency, it is necessary to finely adjust the torque limit value. Therefore, when conditions A2 to A3 are satisfied, it is desirable to set the auto mode and adjust the torque limit value according to the state of the moving body 1, etc.
[0064] When the setting mode is the manual mode, the manual setting unit 203 sets the value input by the operator via the operation unit 10 as the torque limit value.
[0065] FIG. 6 is a block diagram showing an example of processing in the auto mode according to the first embodiment. When the setting mode is the auto mode, the automatic setting unit 204 sets the torque limit value according to the torque determination logic shown in Fig. 6. In the auto mode, attention is focused on factors that increase the load torque, and the state of those factors is determined from measurement data measured by sensors, operation commands, etc.
[0066] The automatic setting unit 204 determines the first torque limit value according to the state (measurement data) of the moving body 1 by referring to the first limit value information D1 that predetermines the relationship between the measurement data indicating the state of the moving body 1 and the torque limit value. The measurement data indicating the state of the moving body is, for example, the attitude angle of the main body 3 of the moving body 1 measured by the sensor 31. If the moving body 1 is a ship, the hull motion (pitching) increases in rough weather, and the thruster 44 (propeller) provided at the rear of the hull may be temporarily exposed above the water surface and spin freely (propeller racing). In this case, the load torque varies greatly depending on whether the propeller is exposed or not, and the magnetic geared motor 42 may lose synchronism.
[0067] In this way, when it is known that a particular state of the moving body 1 affects the fluctuation of the load torque, first limit value information D1 is prepared that defines the relationship between the particular state of the moving body 1 (the pitch angle in the above example) and the torque limit value that is the maximum electric torque that does not cause step-out (the electric torque that becomes the step-out limit). The first limit value information D1 may be a table created based on a database of simulations, model tests, and actual measurement data of the moving body 1 itself or other similar moving bodies, or it may be a mathematical model constructed based on a database. The automatic setting unit 204 uses the first limit value information D1 to determine the first torque limit value according to the pitch angle of the main body unit 3, which changes from moment to moment.
[0068] Also, from the model of the magnetic gear unit 42A in FIG. 3, it can be seen that step-out can occur not only due to a sudden change in the load torque but also due to a sudden change in the electric torque. For example, a crash-astern operation can cause a sudden change in the electric torque, resulting in step-out. In other words, operation commands related to maneuvering the ship (rotation speed commands to the propulsion system 4, rudder angle commands to the steering system 5, etc.) and actual values (rotation speed of the low-speed rotor PPR, and measurement data of attitude and acceleration) are also considered to be effective in determining the torque limit value. Therefore, the first limit value information D1 may be information that defines the relationship between these operation commands and actual values and the torque limit value.
[0069] Furthermore, the automatic setting unit 204 may set the torque limit value based on the load torque estimated from various states of the moving body 1 and operation commands. First, the estimation unit 205 estimates the load torque, for example, as follows. With reference to the schematic diagram of the magnetic gear unit 42A in FIG. 3 and the above formulas (1) to (4), the propulsion system 4 driven by the magnetic geared motor 42 is modeled as follows. Here, an extremely simplified model is used for ease of understanding. Also, it is assumed here that the moving body 1 is a ship and the propeller 44 is a propeller.
[0070]
number
[0071]
number
[0072]
number
[0073]
number
[0074]
number
[0075]
number
[0076]
number
[0077]
number
[0078] Q in equations (6) to (9) motor0 is the electric torque of the magnetic geared motor 42, Q motor1 is the output torque of the magnetic geared motor (magnetic spring torque), Q p is the load torque (propeller torque), τ e is the response time constant of the electric torque, Q motor0 * is the command value of the electric torque (torque command). p is the inflow speed of the propeller expressed as a linear function of time t, and can be expressed as a homogeneous differential equation as equations (11) and (12). From these equations, the load torque Qp is expressed as the model in equation (13). Note that C1, C2, and C3 in equation (13) are coefficients determined by the propeller characteristics.
[0079] Moreover, the state variable x of the moving object 1 is set as shown in equation (14).
[0080]
number
[0081] The load torque is estimated as shown in equation (15) by using the state variable x̂ estimated every moment by the method described later.
[0082]
number
[0083] To construct the estimation algorithm, the state equation is given by Equation (16).
[0084]
number
[0085] The continuous system state equation (16) above is discretized with a calculation period ΔT. For example, when it is approximated by the forward Euler method, it becomes a discrete system state equation as shown in the following equation (17).
[0086]
number
[0087] Here, k is the calculation step. Next, we define the signals that can be observed (measured). For example, if only the angular velocities of the high-speed rotor HSR and the low-speed rotor PPR can be measured, the observation equation is given by the following equation (18). H is a function that converts state variables into observation variables.
[0088]
number
[0089] The state variables are estimated using the state equation of equation (17) and the observation equation of equation (18). For example, in this embodiment, the state variables are estimated using an unscented Kalman filter (UKF). Note that in other embodiments, the state variables may be estimated using other methods. In estimating the state using the unscented Kalman filter, three steps are performed: "1. Sigma point calculation step", "2. Prediction step", and "3. Update step". These steps will be explained in order below.
[0090] 1. Sigma point calculation steps The sigma point is calculated using the state variables. Note that in the first calculation step, the state variables with initial values set are used. If the dimension of the state variable is n, then 2n+1 sigma points are set for each state variable. Note that in this example, n=6. The method for setting the sigma point is shown below for a state variable (e.g. x1[k]) at a certain calculation point k. The symbol [k] indicating the calculation point has been omitted to make the formula easier to read.
[0091] The weighting coefficient W for calculating the average value of the sigma points is calculated using the following formulas (19) to (22). α, β, and κ are parameters, and it is generally considered best to set them as 0≦α≦1, κ=3-n, and β=2. α is a parameter that adjusts the dispersion of the sigma points (the distance from the average value), and the larger it is, the greater the dispersion.
[0092]
number
[0093]
number
[0094]
number
[0095]
number
[0096] As shown in equations (23) and (24), one of the sigma points (X0) is set to the weighted average value μ.
[0097]
number
[0098]
number
[0099] The remaining 2n sigma points are calculated using the average value μ calculated above and the following equations (25) to (27).
[0100]
number
[0101]
number
[0102]
number
[0103] Taking all state variables into consideration, the set of sigma points can be expressed as a matrix as shown in the following equation (28). As mentioned above, n=6 in this example.
[0104]
number
[0105] Element X of formula (28) i,j The subscript i = 0, ..., 2n is the number of the sigma point, and j = 1, ..., n is the number of the state variable.
[0106] 2. Prediction step The unscented transformation of the sigma points is performed using the following equation (29). The transformed set can be expressed as a matrix as equation (30).
[0107]
number
[0108]
number
[0109] X and Y are (2n+1)×n matrices. The mean value x and covariance matrix P are calculated using the following equations (31) to (34).
[0110]
number
[0111]
number
[0112]
number
[0113]
number
[0114] Q in equation (34) is a model of process noise.
[0115] 3. Update steps Transform the sigma points into the observation space using the observation equation.
[0116]
number
[0117] In equation (35), the subscript i = 0, ..., 2n is the number of the sigma point, j = 1, ..., n is the number of the state variable, and k = 1, ..., l is the number of the observation point. l is the number of the observation points. In addition, from equations (36) to (38), the average value μ Z and the covariance matrix P Z In equation (38), R is an l × l matrix, which is the model (covariance matrix) of the observation noise.
[0118]
number
[0119]
number
[0120]
number
[0121] In equations (35) to (38), the subscripts i = 0, ..., 2n are the sigma point numbers, j = 1, ..., n are the state variable numbers, and k = 1, ..., l are the observation point numbers. Also, l is the number of observation points.
[0122] Furthermore, the observed value z = [ω 0,meas ω 1,meas ] T Calculate the residual y of
[0123]
number
[0124] Next, the Kalman gain K is calculated using the following equations (40) and (41).
[0125]
number
[0126]
number
[0127] Using the calculated Kalman gain, the estimated values of the state variables are updated using the following equation (42).
[0128]
number
[0129] In addition, the calculated Kalman gain is used to update the covariance matrix using the following equation (43).
[0130]
number
[0131] The estimation unit 205 repeats the above-mentioned "2. prediction step" and "3. update step". That is, in the prediction step, the state estimation value X k-1 From the current state k, the prior distribution X k In addition, in the update step, the predicted prior distribution X t The residual y of the value z transferred to the observation space is calculated, and the posterior distribution X ̄ k +Ky is obtained. The estimation unit 205 obtains the estimated value x^ of the state variable in this manner, and calculates the estimated value Qp^ of the load torque every moment using the above equation (15).
[0132] Next, the automatic setting unit 204 determines the second torque limit value based on the load torque estimated value Qp^ at the current time. For example, the automatic setting unit 204 prepares second limit value information D2 that defines the relationship between the load torque and the torque limit value that is the maximum electric torque that does not cause step-out (electric torque that becomes the step-out limit). The second limit value information D2 may be a table created based on a database of simulations, model tests, actual measurement data of the moving body 1 itself or other similar moving bodies, or may be a mathematical model constructed based on a database. The automatic setting unit 204 determines the second torque limit value according to the estimated load torque based on the second limit value information D2.
[0133] Furthermore, the automatic setting unit 204 selects the smaller of the first torque limit value and the second torque limit value by the selector 204A, and sets this as the final torque limit value.
[0134] For example, if the torque limit value suddenly increases, the electric torque may become excessive, which may cause step-out. Therefore, when the torque limit value selected by the selector 204A increases from the previous value (is on the higher side), the automatic setting unit 204 limits the amount or rate of change of the torque limit value per time by the rate limiting unit 204B.
[0135] The automatic setting unit 204 repeatedly executes the process shown in FIG. 6 from time to time to set an appropriate torque limit value according to the state of the moving body 1.
[0136] Returning to FIG. 4, the control unit 201 calculates a torque command for the magnetic geared motor 42 based on the difference between the measurement data of the rotation speed of the propeller 44 and the rotation speed command given by the operation unit 10.
[0137] Furthermore, limiter 206 determines a final torque command by limiting the torque limit value calculated by control unit 201 with the torque limit value. In manual mode, the torque limit value set by manual setting unit 203 is given to limiter 206, and in auto mode, the torque limit value set by automatic setting unit 204 is given to limiter 206. The final torque command is output to inverter control device 40. Inverter control device 40 adjusts the voltage and current of inverter 41 so that the electric torque of magnetic geared motor 42 matches the final torque command.
[0138] The control device 2 repeatedly executes the processes shown in FIGS.
[0139] In the above example, for the sake of simplicity, the load model was estimated by considering only a model that represents a state in which the propeller is completely submerged. In reality, a large load torque acts from the propeller when the propeller is exposed above the water surface (propeller racing) and then submerged again. Such a movement is considered to be highly correlated with the hull motion such as the inclination and up-down movement (heave) of the hull. Therefore, the estimation unit 205 may estimate the load torque by adding measurement data (attitude angle, acceleration, etc.) related to the hull motion of the hull to the above-mentioned state equation (17) and observation equation (18). Furthermore, load fluctuations caused by the propeller may occur not only when propeller racing, but also when the rudder is turned to make a sharp turn. In other words, operation commands related to maneuvering (rotation speed command to the propulsion system 4, rudder angle command to the steering system 5, etc.) and actual values (measurement data of the rotation speed, attitude, and acceleration of the low-speed rotor PPR) are also considered to be effective in determining the torque limit value. Therefore, the estimation unit 205 may estimate the load torque by adding these operation commands and actual values to the above-mentioned state equation (17) and observation equation (18), thereby improving the estimation accuracy of the load torque.
[0140] 6 shows an example in which the automatic setting unit 204 selects the smaller of the first torque limit value and the second torque limit value using the selector 204A, but this is not limited to this. In another embodiment, the automatic setting unit 204 may determine only the first torque limit value or only the second torque limit value as the torque limit value. In this case, the selector 204A is omitted.
[0141] (Action, effect) As described above, the control device 2 of the moving body 1 in this embodiment is equipped with a switching unit 202 that switches between a manual mode in which the operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor 42, and an auto mode in which the torque limit value is automatically set, a manual setting unit 203 that sets the torque limit value to a value specified by the operator when switched to the manual mode, and an automatic setting unit 204 that sets the torque limit value according to the load torque transmitted from the propulsion unit 44 to the magnetic geared motor 42 or the state of the moving body 1 when switched to the auto mode.
[0142] In this way, in the manual mode, the control device 2 allows the operator to adjust the torque limit value according to the situation and suppresses step-out of the magnetic geared motor 42. On the other hand, in the auto mode, the control device 2 can operate the magnetic geared motor 42 at maximum efficiency while suppressing step-out by finely adjusting the electric torque according to the load torque and the state of the moving object 1. Therefore, it is possible to minimize the travel time of the moving object 1 and maximize fuel efficiency.
[0143] Furthermore, the automatic setting unit 204 references first limit value information D1 that defines a relationship between the state of the moving body 1 and the torque limit value in advance, and sets a first torque limit value according to the state of the moving body 1 as the torque limit value.
[0144] For example, if the moving body 1 is a ship and propeller racing occurs due to a change in the state (tilt) of the hull, the load torque on the magnetic geared motor 42 may fluctuate significantly. By setting the torque limit value according to the state of the moving body 1 as described above, the control device 2 can appropriately adjust the electric torque according to the fluctuation in the load torque caused by the change in the state of the moving body 1, thereby suppressing loss of synchronism.
[0145] The control device 2 further includes an estimation unit 205 that estimates the load torque based on state variables including measurement data representing the state of the moving object 1. The automatic setting unit 204 sets the second torque limit value according to the estimated load torque as the torque limit value, with reference to second limit value information D2 that predetermines the relationship between the load torque and the torque limit value.
[0146] In this way, the control device 2 can estimate the load torque acting on the magnetic geared motor 42 from moment to moment, and appropriately adjust the electric torque in accordance with the fluctuations in the load torque, thereby suppressing loss of synchronization.
[0147] Furthermore, the automatic setting unit 204 determines a first torque limit value and a second torque limit value, and sets the smaller of these values as the torque limit value.
[0148] For example, when the moving body 1 is not tilted and propeller racing is not occurring, the state of the moving body 1 is stable, so the first torque limit value may be a value that relaxes the limit on the electric torque. On the other hand, when the load torque is increasing due to acceleration or turning of the moving body 1, the second torque limit value may be a value that further restricts the electric torque. Even in such a case, the control device 2 can adjust the electric torque to the safe side by setting the smaller value as the final torque limit value. This makes it possible to more reliably suppress loss of synchronism.
[0149] <Second embodiment> Next, a second embodiment will be described with reference to Fig. 7. Components common to the above-mentioned embodiment will be given the same reference numerals and detailed description will be omitted.
[0150] In the first embodiment, in the auto mode, the estimation unit 205 of the control device 2 obtains an estimated value Qp^ of the current load torque. In contrast, the estimation unit 205 according to the present embodiment uses a model M to predict the behavior of the load torque and electric torque (motor torque) a predetermined number of steps ahead.
[0151] FIG. 7 is a block diagram showing an example of processing in the auto mode according to the second embodiment. Specifically, as shown in FIG. 7, the estimation unit 205 performs a process of estimating future load torque and electric torque using a model M, instead of the process of the first embodiment (FIG. 6). The model M receives measurement data for several past steps as an input x, and outputs an estimated value y of the future load torque and electric torque. The measurement data includes measurement data such as an attitude angle and acceleration representing the inclination and sway of the moving body 1 (main body 3), and a rotation angle and a rotation speed of each rotor. The model M may be, for example, an auto-regressive (AR) model such as a Radial Base Function (RBF)-ARX model. In another embodiment, the model M may be a learning model learned from past measurement data.
[0152] Further, instead of the processing of the first embodiment (FIG. 6), the automatic setting unit 204 performs processing to set the torque limit value so as to limit the current electric torque for a certain period based on the predicted future load torque and electric torque. For example, as shown in FIG. 7, the automatic setting unit 204 performs a simulation of out-of-step using the predicted future load torque and electric torque as input, and when it is predicted that out-of-step will occur in the future, determines the torque limit value (second torque limit value) based on the estimated load torque and second limit value information D2. The method of determining the second torque limit value is the same as in the first embodiment. Furthermore, the automatic setting unit 204 may limit the amount of change or rate of change of the torque limit value for each time period by the rate limiting unit 204B only when the torque limit value is on the increasing side, as in the first embodiment.
[0153] The subsequent processing of the control device 2 is the same as that in the first embodiment. That is, the control unit 201 outputs a final torque command, which is the calculated torque command limited by the torque limit value set by the automatic setting unit 204, to the inverter control device 40. The inverter control device 40 adjusts the voltage and current of the inverter 41 so that the electric torque of the magnetic geared motor 42 matches the final torque command.
[0154] In this way, the control device 2 according to the present embodiment limits the electric torque in advance when a loss of synchronism is predicted in the future. In this way, the control device 2 can more reliably suppress loss of synchronism of the magnetic geared motor 42.
[0155] <Third embodiment> Next, a third embodiment will be described with reference to Figures 8 and 9. Components common to the above-described embodiment will be given the same reference numerals and detailed description will be omitted.
[0156] FIG. 8 is a block diagram showing a functional configuration of a control device according to the third embodiment. FIG. 9 is a block diagram showing a control example of the control device according to the third embodiment. In the above embodiment, an example has been described in which the control device 2 limits the electric torque (motor torque) of the magnetic geared motor 42 in order to suppress loss of synchronism of the magnetic geared motor 42. In contrast, the control device 2 according to the present embodiment suppresses loss of synchronism of the magnetic geared motor 42 by controlling the load torque by limiting at least one of the rudder angle of the steering system 5 and the rotation speed of the propeller 44.
[0157] Specifically, as shown in Fig. 8 and Fig. 9, the control device 2 according to this embodiment further includes a limit value calculation unit 207. The limit value calculation unit 207 calculates a rotation speed limit value and a steering angle limit value for limiting a rotation speed command and a steering angle command, based on the torque limit value set by the manual setting unit 203 or the automatic setting unit 204. The limit value calculation unit 207 may further use the load torque estimation value estimated by the estimation unit 205 according to the first or second embodiment, or the estimation values of the future load torque and electric torque estimated by the estimation unit 205 according to the second embodiment to calculate the rotation speed limit value and the steering angle limit value.
[0158] As shown in FIG. 9, the limiter 206 has a first limiter 206A and a second limiter 206B. The first limiter 206A limits the rudder angle command specified by the operation unit 10 with the rudder angle limit value calculated by the limit value calculation unit 207. The final rudder angle command corrected by the first limiter 206A is output to the steering gear 51. The second limiter 206B limits the rotation speed command specified by the operation unit 10 with the rotation speed limit value calculated by the limit value calculation unit 207. The final rotation speed command corrected by the second limiter 206B is output to the control unit 201. The control unit 201 performs feedback control based on the difference between the final rotation speed command and the rotation speed of the propeller 44, and generates a torque command to be output to the inverter control device 40.
[0159] In the example of FIG. 9, the limit value calculation unit 207 calculates both the rotation speed limit value and the steering angle limit value, but this is not limited to this. In another embodiment, the limit value calculation unit 207 may calculate only the rotation speed limit value. In this case, the first limiter 206A may be omitted. In yet another embodiment, the limit value calculation unit 207 may calculate only the steering angle limit value. In this case, the second limiter 206B may be omitted.
[0160] In order to suppress step-out of the magnetic geared motor 42, it is effective to limit not only the electric torque (motor torque) but also the load torque. Therefore, as described above, the control device 2 according to this embodiment limits the load torque by limiting the rudder angle of the steering system 5 and the rotation speed of the propeller 44 instead of the electric torque of the magnetic geared motor 42. For example, if the moving body 1 is a ship, when propeller racing or the like occurs, the rotation speed command of the propeller (propeller 44) can be forcibly reduced to reduce the load torque acting on the magnetic geared motor 42 from the propeller when the propeller is submerged again. Therefore, step-out can be avoided more reliably.
[0161] <Fourth embodiment> Next, a fourth embodiment will be described with reference to Figures 10 to 13. Components common to the above-mentioned embodiments are given the same reference numerals and detailed description will be omitted.
[0162] FIG. 10 is a first diagram showing the configuration of a magnetic geared motor according to the fourth embodiment. As shown in FIG. 10, the magnetic geared motor 42 may further include a torque limiting mechanism 42B provided between the magnetic geared motor 42 and the propeller 44.
[0163] The torque limiting mechanism 42B is a so-called torque limiter, such as a torque limiter that utilizes frictional force (such as a clutch) or a torque limiter that utilizes a spring restoring force. The torque limiting mechanism 42B transmits torque while causing the low-speed rotor PPR and the propeller 44 to slide. In other words, the torque limiting mechanism 42B limits the torque transmitted between the low-speed rotor PPR and the propeller 44 so as not to exceed the maximum transmission torque of the magnetic gear unit 42A.
[0164] FIG. 11 is a second diagram showing the configuration of the magnetic geared motor according to the fourth embodiment. 11, the joint JT connecting the rotating shaft 43 and the thruster 44 may be an elastic joint. The rigidity of the elastic joint JT is set to be lower than the magnetic torsional rigidity of the magnetic geared motor 42. By providing the elastic joint JT with damping against axial torsion, the change in the load torque input to the low-speed rotor PPR of the magnetic geared motor 42 can be buffered, and loss of synchronism can be more reliably suppressed.
[0165] FIG. 12 is a diagram showing the effect of the magnetic geared motor according to the fourth embodiment. The graph in FIG. 12 shows the simulation results when an overload (load torque of 120% of the maximum transmission torque) acts. For example, the maximum transmission torque is 1 pu. Case 0 shows the simulation results of a configuration (conventional technology) that does not have either the torque limiting mechanism 42B or the elastic coupling JT, Case 1 shows the simulation results of a configuration that has the torque limiting mechanism 42B of FIG. 10, and Case 2 shows the simulation results of a configuration that has the torque limiting mechanism 42B and the elastic coupling JT of FIG. 11. According to the upper graph of Case 0, an overload occurs at a certain time, and the load torque is input as it is to the low-speed rotor PPR. As a result, as shown in the middle graph of Case 0, the rotation speeds of the high-speed rotor and the low-speed rotor are not synchronized, and step-out occurs. Also, according to the lower graph of Case 0, it can be seen that an alternating torque is generated due to step-out. On the other hand, in both Case 1 and Case 2, as shown in the upper graph, the load torque input to the low-speed rotor PPR is limited by the torque limiting mechanism 42B and the elastic coupling JT. This causes slippage between the low-speed rotor PPR and the propeller 44, so that the rotational speeds of the high-speed rotor HSR and the low-speed rotor PPR do not diverge as much as in Case 0, as shown in the middle graph, and a synchronized state can be maintained. In other words, loss of synchronization can be suppressed in Cases 1 and 2. Also, as shown in the bottom graphs of Cases 1 and 2, the fluctuations in the magnetic spring torque are significantly suppressed compared to Case 0.
[0166] FIG. 13 is a third diagram showing the configuration of the magnetic geared motor according to the fourth embodiment. The magnetic geared motor 42 may have a flywheel 42C instead of or in addition to the torque limiting mechanism 42B. Fig. 13 shows an example in which the magnetic geared motor 42 has both the torque limiting mechanism 42B and the flywheel 42C. The flywheel 42C, together with the elastic couplings JT1 and JT2 arranged on both sides, constitutes a Tuned Mass Damper (TMD). This allows the flywheel 42C to provide appropriate damping to the torsion angle fluctuations of the low-speed rotor PPR and the high-speed rotor HSR, thereby more reliably suppressing loss of synchronism.
[0167] <Other embodiments> Although the embodiment has been described in detail above with reference to the drawings, the specific configuration is not limited to the above, and various design changes are possible. That is, in other embodiments, the order of the above-mentioned processes may be changed as appropriate. Also, some of the processes may be executed in parallel.
[0168] <Additional Notes> The mobile body control device, the mobile body, the mobile body control method, and the program described in the above-described embodiments can be understood, for example, as follows.
[0169] (1) According to the first aspect, the control device 2 of the moving body 1 is a control device 2 of the moving body 1 having a propeller 44 that is rotationally driven by a magnetic geared motor 42, and includes a switching unit 202 that switches between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor 42, and an auto mode in which the torque limit value is automatically set, a manual setting unit 203 that sets the torque limit value to a value specified by the operator when switched to the manual mode, an automatic setting unit 204 that sets the torque limit value based on at least one of the load torque transmitted from the propeller 33 to the magnetic geared motor 42 and measurement data representing the state of the moving body 1 when switched to the auto mode, and a limiter 206 that limits a torque command that adjusts the electric torque of the magnetic geared motor 42 based on the difference between a rotation speed command that specifies the rotation speed of the propeller 44 and the measurement data of the rotation speed of the propeller 44, by the torque limit value.
[0170] In this way, in the manual mode, the control device 2 allows the operator to adjust the torque limit value according to the situation and suppresses step-out of the magnetic geared motor 42. On the other hand, in the auto mode, the control device 2 can operate the magnetic geared motor 42 at maximum efficiency while suppressing step-out by finely adjusting the electric torque according to the load torque and the state of the moving object 1. Therefore, it is possible to minimize the travel time of the moving object 1 and maximize fuel efficiency.
[0171] (2) According to the second aspect, in the control device 2 of the moving body 1 relating to the first aspect, the automatic setting unit 204 refers to first limit value information D1 that predetermines the relationship between the state of the moving body 1 and the torque limit value, and sets the first torque limit value according to the state of the moving body 1 as the torque limit value.
[0172] By setting the torque limit value in this manner in accordance with the state of the moving body 1, the control device 2 can appropriately adjust the electric torque in accordance with fluctuations in the load torque that accompany changes in the state of the moving body 1, thereby suppressing loss of synchronization.
[0173] (3) According to the third aspect, the control device 2 of the moving body 1 related to the first aspect further includes an estimation unit 205 that estimates the load torque based on state variables including measurement data representing the state of the moving body 1, and the automatic setting unit 204 sets the second torque limit value corresponding to the estimated load torque as the torque limit value by referring to second limit value information D2 that predetermines the relationship between the load torque and the torque limit value.
[0174] In this way, the control device 2 can estimate the load torque acting on the magnetic geared motor 42 from moment to moment, and appropriately adjust the electric torque in accordance with the fluctuations in the load torque, thereby suppressing loss of synchronization.
[0175] (4) According to the fourth aspect, the control device 2 of the moving body 1 relating to the first aspect further includes an estimation unit 205 that estimates the load torque based on a state variable including measurement data representing the state of the moving body 1, and the automatic setting unit 204 determines a first torque limit value corresponding to the state of the moving body 1 by referring to first limit value information D1 that predetermines the relationship between the state of the moving body 1 and the torque limit value, determines a second torque limit value corresponding to the estimated load torque by referring to second limit value information D2 that predetermines the relationship between the load torque and the torque limit value, and sets the smaller of the first torque limit value and the second torque limit value as the torque limit value.
[0176] For example, even if the state of the moving object 1 is stable, the load torque may actually be increasing due to the operating state of the moving object 1. Even in such a case, the control device 2 can adjust the electric torque to the safe side by comparing the first torque limit value determined based on the state of the moving object with the second torque limit value determined based on the estimated load torque and selecting a final torque limit value. This makes it possible to more reliably suppress loss of synchronism.
[0177] (5) According to the fifth aspect, in the control device 2 of the moving body 1 relating to the third aspect, the estimation unit 205 estimates future load torque and electric torque for a predetermined time ahead based on the state variables, and the automatic setting unit 204 sets a torque limit value based on the estimated future load torque and electric torque.
[0178] In this way, the control device 2 can limit the electric torque in advance when a loss of synchronism is predicted in the future, thereby enabling the control device 2 to more reliably suppress loss of synchronism of the magnetic geared motor 42.
[0179] (6) According to the sixth aspect, in the control device 2 of the moving body 1 relating to the fourth aspect, the estimation unit 205 estimates future load torque and electric torque for a predetermined time ahead based on the state variables, and the automatic setting unit 204 sets a torque limit value based on the estimated future load torque and electric torque.
[0180] In this way, the control device 2 can limit the electric torque in advance when a loss of synchronism is predicted in the future, thereby enabling the control device 2 to more reliably suppress loss of synchronism of the magnetic geared motor 42.
[0181] (7) According to a seventh aspect, the control device 2 of the moving body 1 is a control device 2 of the moving body 1 having a propeller 44 that is rotationally driven by a magnetic geared motor 42, and includes a switching unit 202 that switches between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor 42, and an auto mode in which the torque limit value is automatically set, a manual setting unit 203 that sets the torque limit value to a value specified by the operator when switched to the manual mode, an automatic setting unit 204 that sets the torque limit value based on at least one of the load torque transmitted from the propeller 44 to the magnetic geared motor 42 and measurement data representing the state of the moving body 1 when switched to the auto mode, a limit value calculation unit 207 that calculates a limit value that limits at least one of a rotation speed command that specifies the rotation speed of the propeller 44 and a steering angle command that specifies the steering angle of the moving body 1 based on the torque limit value, and a limiter 206 that limits at least one of the rotation speed command and the steering angle command by the limit value.
[0182] In this way, the control device 2 can limit the load torque by limiting the rotation speed of the thruster 44. As a result, loss of synchronism can be more reliably avoided.
[0183] (8) According to the eighth aspect, the moving body 1 includes a magnetic geared motor 42 having a low-speed rotor PPR and a high-speed rotor HSR, a propeller 44 rotated and driven by the magnetic geared motor 42, a steering gear 51 that changes the direction of travel, and a control device 2 relating to any one of the first to seventh aspects.
[0184] (9) According to a ninth aspect, the moving body 1 according to the eighth aspect further includes a torque limiting mechanism 42B provided between the low-speed rotor PPR and the propeller 44 for limiting the torque transmitted between the propeller 44 and the low-speed rotor so as not to exceed the maximum transmission torque of the high-speed rotor HSR and the low-speed rotor PPR.
[0185] In this way, the moving body 1 can more reliably prevent the magnetic geared motor 42 from losing synchronization.
[0186] (10) According to a tenth aspect, the movable body 1 according to the eighth or ninth aspect further includes a flywheel 42C provided between the low speed rotor PPR and the propeller 44 to damp the torsion angle fluctuations of the high speed rotor HSR and the low speed rotor PPR.
[0187] By doing so, the movable body 1 can provide appropriate damping to the torsion angle fluctuations of the low-speed rotor PPR and the high-speed rotor HSR, so that loss of synchronization can be more reliably suppressed.
[0188] (11) According to a first aspect, a control method for a moving body 1 is a control method for a moving body 1 having a propeller 44 that is rotationally driven by a magnetic geared motor 42, and includes the steps of switching between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor 42, and an auto mode in which the torque limit value is automatically set, a step of setting the torque limit value to a value specified by the operator when switched to the manual mode, a step of setting the torque limit value based on at least one of the load torque transmitted from the propeller 33 to the magnetic geared motor 42 and measurement data representing the state of the moving body 1 when switched to the auto mode, and a step of limiting a torque command that adjusts the electric torque of the magnetic geared motor 42 based on the difference between a rotation speed command that specifies the rotation speed of the propeller 44 and the measurement data of the rotation speed of the propeller 44, with the torque limit value.
[0189] (12) According to the twelfth aspect, the program causes the control device 2 of the moving body 1 having a propeller 44 rotated by a magnetic geared motor 42 to execute the following steps: switching between a manual mode in which an operator manually sets a torque limit value that limits the electric torque of the magnetic geared motor 42, and an auto mode in which the torque limit value is automatically set; setting the torque limit value to a value specified by the operator when switched to the manual mode; setting the torque limit value based on at least one of the load torque transmitted from the propeller 33 to the magnetic geared motor 42 and measurement data representing the state of the moving body 1 when switched to the auto mode; and limiting, with the torque limit value, a torque command that adjusts the electric torque of the magnetic geared motor 42 based on the difference between a rotation speed command that specifies the rotation speed of the propeller 44 and the measurement data for the rotation speed of the propeller 44. [Explanation of symbols]
[0190] 1. Mobile 2. Control device 20 processors 201 Control section 202 Switching section 203 Manual setting section 204 Automatic setting section 204A Selector 204B Rate Limiter 205 Estimation section 206 Limiter 206A First Limiter 206B Second Limiter 207 Limit value calculation unit 21 Memory 22 Storage 23 Communication Interface 3 Main body 31 Sensors 33 Propulsion device 4 Propulsion system 40 Inverter control device 41 Inverter 42 Magnetic geared motor 42A Magnetic gear part 42B Torque limiting mechanism 42C Flywheel HSR High Speed Rotor PPR Low Speed Rotor JT, JT1, JT2 joints (elastic joints) 43 Rotational Axis 44 Propulsion device 45 Current Sensor 46 Rotational angle sensor 5 Steering system 51 Steering gear 10 Control section
Claims
1. A control device for a moving body having a propeller that is rotationally driven by a magnetic geared motor, a switching unit that switches between a manual mode in which an operator manually sets a torque limit value that limits an electric torque of the magnetic geared motor and an auto mode in which the torque limit value is automatically set; a manual setting unit that sets the torque limit value to a value designated by the operator when the manual mode is switched to; an automatic setting unit that sets the torque limit value based on at least one of a load torque transmitted from the propulsion unit to the magnetic geared motor and measurement data representing a state of the moving body when the automatic mode is switched to; a limiter that limits, by the torque limit value, a torque command that adjusts the electric torque of the magnetic geared motor based on a difference between a rotation speed command that specifies a rotation speed of the thruster and measurement data of the rotation speed of the thruster; A control device for a moving object comprising:
2. the automatic setting unit refers to first limit value information that defines a relationship between a state of the moving body and the torque limit value in advance, and sets a first torque limit value according to the state of the moving body as the torque limit value. The control device for a moving body according to claim 1 .
3. an estimation unit that estimates the load torque based on a state variable including measurement data representing a state of the moving object; the automatic setting unit refers to second limit value information that defines a relationship between the load torque and the torque limit value in advance, and sets a second torque limit value corresponding to the estimated load torque as the torque limit value. The control device for a moving body according to claim 1 .
4. an estimation unit that estimates the load torque based on a state variable including measurement data representing a state of the moving object; The automatic setting unit is determining a first torque limit value according to the state of the moving body by referring to first limit value information that defines a relationship between the state of the moving body and the torque limit value in advance; determining a second torque limit value corresponding to the estimated load torque by referring to second limit value information that defines a relationship between the load torque and the torque limit value in advance; setting the smaller of the first torque limit value and the second torque limit value as the torque limit value; The control device for a moving body according to claim 1 .
5. The estimation unit estimates the load torque and the electric torque at a predetermined time ahead based on the state variables, The automatic setting unit sets the torque limit value based on the estimated future load torque and the estimated future electric torque. The control device for a moving body according to claim 3.
6. The estimation unit estimates the load torque and the electric torque at a predetermined time ahead based on the state variables, The automatic setting unit sets the torque limit value based on the estimated future load torque and the estimated future electric torque. The control device for a moving body according to claim 4.
7. A control device for a moving body having a propeller that is rotationally driven by a magnetic geared motor, a switching unit that switches between a manual mode in which an operator manually sets a torque limit value that limits an electric torque of the magnetic geared motor and an auto mode in which the torque limit value is automatically set; a manual setting unit that sets the torque limit value to a value designated by the operator when the manual mode is switched to; an automatic setting unit that sets the torque limit value based on at least one of a load torque transmitted from the propulsion unit to the magnetic geared motor and measurement data representing a state of the moving body when the automatic mode is switched to; a limit value calculation unit that calculates a limit value to limit at least one of a rotation speed command that specifies a rotation speed of the propeller and a steering angle command that specifies a steering angle of the moving body based on the torque limit value; a limiter that limits at least one of the rotation speed command and the steering angle command to the limit value; A control device for a moving object comprising:
8. a magnetic geared motor having a low speed rotor and a high speed rotor; A propulsion unit that is rotationally driven by the magnetic geared motor; A steering gear for changing the direction of travel; A control device according to any one of claims 1 to 7; A mobile body comprising:
9. a torque limiting mechanism provided between the low-speed rotor and the propeller to limit a torque transmitted between the propeller and the low-speed rotor so as not to exceed a maximum transmission torque of the high-speed rotor and the low-speed rotor; The moving body according to claim 8.
10. a flywheel provided between the low-speed rotor and the propeller to damp fluctuations in the twist angle of the high-speed rotor and the low-speed rotor; The moving body according to claim 8.
11. A method for controlling a moving body having a propulsion unit that is rotationally driven by a magnetic geared motor, comprising the steps of: A step of switching between a manual mode in which an operator manually sets a torque limit value that limits an electric torque of the magnetic geared motor and an auto mode in which the torque limit value is automatically set; When the manual mode is selected, the torque limit value is set to a value designated by the operator. setting the torque limit value based on at least one of a load torque transmitted from the propulsion unit to the magnetic gear motor and measurement data representing a state of the moving body when the automatic mode is selected; a step of limiting, by the torque limit value, a torque command for adjusting an electric torque of the magnetic geared motor based on a difference between a rotation speed command specifying a rotation speed of the propulsion unit and measurement data of the rotation speed of the propulsion unit; A method for controlling a moving object comprising the steps of:
12. A control device for a moving body having a propeller driven by a magnetic gear motor, A step of switching between a manual mode in which an operator manually sets a torque limit value that limits an electric torque of the magnetic geared motor and an auto mode in which the torque limit value is automatically set; When the manual mode is selected, the torque limit value is set to a value designated by the operator. setting the torque limit value based on at least one of a load torque transmitted from the propulsion unit to the magnetic gear motor and measurement data representing a state of the moving body when the automatic mode is selected; a step of limiting, by the torque limit value, a torque command for adjusting an electric torque of the magnetic geared motor based on a difference between a rotation speed command specifying a rotation speed of the propulsion unit and measurement data of the rotation speed of the propulsion unit; A program that executes the following.
Citation Information
Patent Citations
System and method for controlling vessel
JP2022099788A