This application claims priority to German Patent Application No. 10 2012 004 803.3, entitled “Crane Controller with Drive Constraint,” filed Mar. 9, 2012, which is hereby incorporated by reference in its entirety for all purposes.
The present disclosure relates to a crane controller for a crane which includes a hoisting gear for lifting a load hanging on a cable. The crane controller comprises an active heave compensation which by actuating the hoisting gear at least partly compensates the movement of the cable suspension point and/or a load deposition point due to the heave.
Such crane controller is known from DE 10 2008 024513 A1. There is provided a prediction device which predicts a future movement of the cable suspension point with reference to the determined current heave movement and a model of the heave movement, wherein a path controller of the load at least partly compensates the predicted movement of the cable suspension point.
For actuating the hoisting gear, DE 10 2008 024513 A1 creates a dynamic model of the hydraulically operated winch and the load hanging on the cable and creates a sequence control unit therefrom by inversion. For realizing a state control, unknown states of the load are reconstructed form a force measurement via an observer.
It is the object of the present disclosure to provide an improved crane controller.
According to the present disclosure, this object is solved in a first aspect by a crane controller according to claim 1 and in a second aspect by a crane controller according to claim 4.
In a first aspect, the present disclosure shows a crane controller for a crane which includes a hoisting gear for lifting a load hanging on a cable. The crane controller includes an active heave compensation which by actuating the hoisting gear at least partly compensates the movement of the cable suspension point and/or a load deposition point due to the heave. According to the present disclosure, it is provided that the heave compensation takes account of at least one constraint of the hoisting gear when calculating the actuation of the hoisting gear. By taking account of the constraint of the hoisting gear it is ensured that the hoisting gear actually can follow the control commands calculated due to the heave compensation and/or that the hoisting gear or the crane is not damaged by the actuation.
According to the present disclosure, the heave compensation can take account of a maximum admissible jerk. It thereby is ensured that the hoisting gear or the structure of the crane is not damaged by the actuation of the hoisting gear due to the heave compensation. Beside a maximum admissible jerk, a steady course of the jerk furthermore can be requested.
Alternatively or in addition, the heave compensation can take account of a maximum available power.
Alternatively or in addition, the heave compensation can take account of a maximum available acceleration. Such maximum available acceleration for example can result from the maximum power of the drive of the hoisting gear and/or the length of the cable unwound already and the weight force of the cable thereby acting on the hoisting gear and/or due to the load of the hoisting gear caused by the weight force to be lifted.
Furthermore alternatively or in addition, the heave compensation can take account of a maximum available velocity. The maximum available velocity for the heave compensation also can be obtained as described above with regard to the maximum available acceleration.
Furthermore, the crane controller can include a calculation operation which calculates the at least one constraint of the hoisting gear. For this purpose, the calculation operation can evaluate in particular sensor data and/or actuation signals. By the calculation operation, the currently applicable constraints of the hoisting gear can each be communicated to the heave compensation.
In particular, the constraints of the hoisting gear can change during a lift, which can be taken into account by the heave compensation according to the present disclosure.
The calculation operation each can exactly calculate a currently available at least one kinematically constrained quantity of the hoisting gear, in particular the maximum available power and/or velocity and/or acceleration of the hoisting gear. Advantageously, the calculation operation takes account of the length of the unwound cable and/or the cable force and/or the power available for driving the hoisting gear.
According to the present disclosure, the crane controller can be used for actuating a hoisting gear whose drive is connected with an energy accumulator. The amount of energy stored in the energy accumulator influences the power available for driving the hoisting gear. Advantageously, the amount of energy stored in the energy accumulator or the power available for driving the hoisting gear therefore is included in the calculation operation according to the present disclosure.
In particular, the hoisting gear according to the present disclosure can be actuated hydraulically, wherein a hydraulic energy accumulator is provided in the hydraulic circuit for driving the hoisting winch of the hoisting gear.
Alternatively, an electric drive can be used. The same can also be connected with an energy accumulator.
Advantageously, the crane controller furthermore comprises a path planning module which determines a trajectory with reference to the predicted movement of the cable suspension point and/or a load deposition point and by taking account of the constraints of the hoisting gear. According to the present disclosure the drive constraints, in particular the drive constraints with regard to the power, the velocity, the acceleration and/or the jerk can explicitly be taken into account when planning the trajectories. The trajectory in particular can be a trajectory of the position and/or velocity and/or acceleration of the hoisting gear.
Advantageously, the path planning module includes an optimization operation which with reference to the predicted movement of the cable suspension point and/or a load deposition point and by taking account of the constraint of the hoisting gear determines a trajectory which minimizes the residual movement of the load due to the movement of the cable suspension point and/or the differential movement between the load and the load deposition point due to the movement of the load deposition point. According to the present disclosure, the at least one drive constraint thus can be taken into account within the optimal control problem. Within the optimal control problem, the constraint of the drive in particular is taken into account with regard to power and/or velocity and/or acceleration and/or jerk.
The optimization operation advantageously calculates an optimal path with reference to a predicted vertical position and/or vertical velocity of the cable suspension point and/or a load deposition point, which by taking account of the kinematic constraints minimizes the residual movement and/or differential movement of the load.
In a second aspect, the present disclosure comprises a crane controller for a crane which includes a hoisting gear for lifting a load hanging on a cable. The crane controller comprises an active heave compensation which by actuating the hoisting gear at least partly compensates the movement of the cable suspension point and/or a load deposition point due to the heave. According to the present disclosure, the heave compensation includes a path planning module which with reference to a predicted movement of the cable suspension point and/or a load deposition point calculates a trajectory of the position and/or velocity and/or acceleration of the hoisting gear, which is included in a setpoint value for a subsequent control of the hoisting gear. Due to this structure of the heave compensation a particularly stable and easily realizable actuation of the hoisting gear is obtained. In particular, the unknown load position no longer must be reconstructed with great effort.
According to the present disclosure, the controller of the hoisting gear can feed back measured values to position and/or velocity of the hoisting winch. The path planning module hence specifies a position and/or velocity of the hoisting winch as setpoint value, which in the subsequent controller is matched with actual values.
Furthermore, it can be provided that the controller of the hoisting gear takes account of the dynamics of the drive of the hoisting winch by a pilot control. In particular, the pilot control can be based on an inversion of a physical model which describes the dynamics of the drive of the hoisting winch. In particular, the hoisting winch can be a hydraulically operated hoisting winch.
The first and the second aspect of the present disclosure each are protected separately by the present application and can each be realized separately and without the respective other aspect.
Particularly, however, the two aspects according to the present disclosure are combined with each other. In particular, it can be provided that the path planning module according to the second aspect of the present disclosure takes account of at least one constraint of the hoisting gear when determining the trajectory.
The crane controller according to the present disclosure furthermore can include an operator control which actuates the hoisting gear with reference to specifications of the operator.
Advantageously, the controller therefore includes two separate path planning modules via which trajectories for the heave compensation and for the operator control are calculated separate from each other. In particular, these trajectories can be trajectories for the position and/or velocity and/or acceleration of the hoisting gear.
Furthermore, the trajectories specified by the two separate path planning modules can be added up and serve as setpoint values for the control and/or regulation of the hoisting gear.
Furthermore, it can be provided according to the present disclosure that the division of at least one kinematically constrained quantity between heave compensation and operator control is adjustable, wherein the adjustment for example can be effected by a weighting factor by which the maximum available power and/or velocity and/or acceleration of the hoisting gear is split up between the heave compensation and the operator control.
Such division is easily possible in the heave compensation according to the present disclosure, which anyway takes account of constraints of the hoisting gear. In particular, the division of the at least one kinematically constrained quantity is taken into account as constraint of the hoisting gear. Advantageously, the operator control also takes account of at least one constraint of the drive, and in particular of the maximum admissible jerk and/or a maximum available power and/or a maximum available acceleration and/or a maximum available velocity.
According to the present disclosure, the optimization operation of the heave compensation can determine a target trajectory which is included in the control and/or regulation of the hoisting gear. In particular, as described above, the optimization operation can calculate a target trajectory of the position and/or velocity and/or acceleration of the hoisting gear, which is included in a setpoint value for a subsequent control of the hoisting gear. The optimization can be effected via a discretization.
According to the present disclosure, the optimization can be effected at each time step on the basis of an updated prediction of the movement of the load lifting point.
According to the present disclosure, the first value of the target trajectory each can be used for controlling the hoisting gear. When an updated target trajectory then is available, only the first value thereof will in turn be used for the control.
According to the present disclosure, the optimization operation can work with a lower scan rate than the control. This provides for choosing greater scan times for the calculation-intensive optimization operation, for the less calculation-intensive control, on the other hand, a greater accuracy due to lower scan times.
Furthermore, it can be provided that the optimization operation makes use of an emergency trajectory planning when no valid solution can be found. In this way, a proper operation also is ensured when a valid solution cannot be found.
The crane controller according to the present disclosure can comprise a measuring device which determines a current heave movement from the sensor data. For example, gyroscopes and/or tilt angle sensors can be employed as sensors. The sensors can be arranged at the crane or at a pontoon on which the crane is arranged, for example on the crane base and/or on a pontoon on which the load deposition position is arranged.
The crane controller furthermore can comprise a prediction device which predicts a future movement of the cable suspension point and/or a load deposition point with reference to the determined current heave movement and a model of the heave movement.
Advantageously, the model of the heave movement as used in the prediction device is independent of the properties, and in particular independent of the dynamics of the pontoon. The crane controller thereby can be used independent of the pontoon on which the crane and/or the load deposition position is arranged.
The prediction device can determine the prevailing modes of the heave movement from the data of the measuring device. In particular, this can be effected via a frequency analysis.
Furthermore, the prediction device can create a model of the heave with reference to the determined prevailing modes. With reference to this model, the future heave movement then can be predicted.
Advantageously, the prediction device continuously parameterizes the model with reference to the data of the measuring device. In particular an observer can be used, which is parameterized continuously. Particularly, the amplitude and the phase of the modes can be parameterized.
Furthermore, it can be provided that in the case of a change of the prevailing modes of the heave the model is updated.
Particularly, the prediction device as well as the measuring device can be configured such as is described in DE 10 2008 024513 A1, whose contents are fully made the subject-matter of the present application.
In the control concept according to the present disclosure, the dynamics of the load furthermore advantageously can be neglected due to the extendability of the cable. This results in a distinctly simpler structure of the controller.
The present disclosure furthermore comprises a crane with a crane controller as it has been described above.
In particular, the crane can be arranged on a pontoon. In particular, the crane can be a deck crane. Alternatively, it can also be an offshore crane, a harbor crane or a cable excavator.
The present disclosure furthermore comprises a pontoon with a crane according to the present disclosure, in particular a ship with a crane according to the present disclosure.
Furthermore, the present disclosure comprises the use of a crane according to the present disclosure and a crane controller according to the present disclosure for lifting and/or lowering a load located in water and/or the use of a crane according to the present disclosure and a crane controller according to the present disclosure for lifting and/or lowering a load from and/or to a load deposition position located in water, for example on a ship. In particular, the present disclosure comprises the use of the crane according to the present disclosure and the crane controller according to the present disclosure for deep-sea lifts and/or for loading and/or unloading ships.
The present disclosure furthermore comprises a method for controlling a crane which includes a hoisting gear for lifting a load hanging on a cable. A heave compensation at least partly compensates the movement of the cable suspension point and/or a load deposition point due to the heave by an automatic actuation of the hoisting gear. According to the present disclosure, it is provided in accordance with a first aspect that the heave compensation takes account of at least one constraint of the hoisting gear when calculating the actuation of the hoisting gear. In accordance with a second aspect, on the other hand, it is provided that the heave compensation calculates a trajectory of the position and/or velocity and/or acceleration of the hoisting gear with reference to a predicted movement of the cable suspension point, which is included in a setpoint value for a subsequent control of the hoisting gear. The method according to the present disclosure has the same advantages which have already been described with regard to the crane controller.
Furthermore, the method can be carried out such as has also been described above. In particular, the two aspects according to the present disclosure also can be combined in the method.
Furthermore, the method according to the present disclosure can be effected by a crane controller as it has been described above.
The present disclosure furthermore comprises software with code for execution as method according to the present disclosure. In particular, the software can be stored on a machine-readable data carrier. Advantageously, a crane controller according to the present disclosure can be implemented by installing the software on a crane controller.
Advantageously, the crane controller according to the present disclosure is realized electronically, in particular by an electronic control computer. The control computer advantageously is connected with sensors. In particular, the control computer can be connected with the measuring device. Advantageously, the control computer generates control signals for actuating the hoisting gear.
The hoisting gear can be a hydraulically driven hoisting gear. In accordance with the present disclosure, the control computer of the crane controller according to the present disclosure can actuate the swivel angle of at least one hydraulic displacement machine of the hydraulic drive system and/or at least one valve of the hydraulic drive system.
In one example, a hydraulic accumulator is provided in the hydraulic drive system, via which energy can be stored when lowering the load, which then is available as additional power when lifting the load.
Advantageously, the actuation of the hydraulic accumulator is effected separate from the actuation of the hoisting gear according to the present disclosure.
Alternatively, an electric drive can also be used. The same can also comprise an energy accumulator.
The present disclosure will now be explained in detail with reference to exemplary embodiments and drawings.
There can be provided at least one sensor which measures the position and/or velocity of the hoisting gear and transmits corresponding signals to the crane controller.
Furthermore, at least one sensor can be provided, which measures the cable force and transmits corresponding signals to the crane controller. The sensor can be arranged in the region of the crane body, in particular in a mount of the winch 5 and/or in a mount of the cable pulley 2.
In the exemplary embodiment, the crane 1 is arranged on a pontoon 6, here a ship. As is likewise shown in
The crane controller according to the present disclosure can include an active heave compensation which by actuating the hoisting gear at least partly compensates the movement of the cable suspension point 2 due to the heave. In particular, the vertical movement of the cable suspension point due to the heave is at least partly compensated.
The heave compensation can comprise a measuring device which determines a current heave movement from sensor data. The measuring device can comprise sensors which are arranged at the crane foundation. In particular, this can be gyroscopes and/or tilt angle sensors. Particularly, three gyroscopes and three tilt angle sensors are provided.
Furthermore a prediction device can be provided, which predicts a future movement of the cable suspension point 2 with reference to the determined heave movement and a model of the heave movement. In particular, the prediction device solely predicts the vertical movement of the cable suspension point. In connection with the measuring and/or prediction device, a movement of the ship at the point of the sensors of the measuring device possibly can be converted into a movement of the cable suspension point.
The prediction device and the measuring device advantageously are configured such as is described in more detail in DE 10 2008 024513 A1.
Alternatively, the crane according to the present disclosure also might be a crane which is used for lifting and/or lowering a load from or to a load deposition point arranged on a pontoon, which therefore moves with the heave. In this case, the prediction device must predict the future movement of the load deposition point. This can be effected analogous to the procedure described above, wherein the sensors of the measuring device are arranged on the pontoon of the load deposition point. The crane for example can be a harbor crane, an offshore crane or a cable excavator.
In the exemplary embodiment, the hoisting winch of the hoisting gear 5 is driven hydraulically. In particular, a hydraulic circuit of hydraulic pump and hydraulic motor is provided, via which the hoisting winch is driven. In one example, a hydraulic accumulator can be provided, via which energy is stored on lowering the load, so that this energy is available when lifting the load.
Alternatively, an electric drive might be used. The same might also be connected with an energy accumulator.
In the following, an exemplary embodiment of the present disclosure will now be shown, in which a multitude of aspects of the present disclosure are jointly realized. The individual aspects can, however, also each be used separately for developing the embodiment of the present disclosure as described in the general part of the present application.
The crane controller may be a microcomputer including: a microprocessor unit, input/output ports, read-only memory, random access memory, keep alive memory, and a data bus. As noted above, software with code for carrying out the methods according to the present disclosure may be stored on a machine-readable data carrier in the controller. Advantageously, a crane controller according to the present disclosure can be implemented by installing the software according to the present disclosure on a crane controller. The crane controller may receive various signals from sensors coupled to the crane and/or pontoon. In one example, the software may include various programs (including control and estimation routines, operating in real-time), such as heave compensation, as described herein. The specific routines described herein may represent one or more of any number of processing strategies such as event-driven, interrupt-driven, multi-tasking, multi-threading, and the like. Thus, the described methods may represent code to be programmed into the computer readable storage medium in the crane control system.
Additionally, the present disclosure describes various operations, each of which may be formed via instructions stored in non-transitory memory in the controller.
Planning of Reference Trajectories
For implementing the required predictive behavior of the active heave compensation, a sequential control consisting of a pilot control and a feedback in the form of a structure of two degrees of freedom is employed. The pilot control is calculated by a differential parameterization and requires reference trajectories steadily differentiable two times.
For planning it is decisive that the drive can follow the specified trajectories. Thus, constraints of the hoisting gear must also be taken into account. Starting point for the consideration are the vertical position and/or velocity of the cable suspension point {tilde over (z)}ah and {tilde over (ż)}ah, which are predicted e.g. by the algorithm described in DE 10 2008 024 513 over a fixed time horizon. In addition, the hand lever signal of the crane operator, by which he moves the load in the inertial coordinate system, also is included in the trajectory planning as an operator input.
For safety reasons it is necessary that the winch also can still be moved via the hand lever signal in the case of a failure of the active heave compensation. With the used concept for trajectory planning, a separation between the planning of the reference trajectories for the compensation movement and those as a result of a hand lever signal therefore is effected, as is shown in
In the Figure, ya*, {dot over (y)}a* and ÿa* designate the position, velocity and acceleration planned for the compensation, and yl*, {dot over (y)}l* and ÿl* the position, velocity and acceleration for the superimposed unwinding or winding of the cable as planned on the basis of the hand lever signal. In the further course of the execution, planned reference trajectories for the movement of the hoisting winch always are designated with y*, {dot over (y)}* and ÿ*, respectively, since they serve as reference for the system output of the drive dynamics.
Due to the separate trajectory planning it is possible to use the same trajectory planning and the same sequential controller with the heave compensation switched off or in the case of a complete failure of the heave compensation (e.g. due to failure of the IMU) for the hand lever control in manual operation and thereby generate an identical operating behavior with the heave compensation switched on.
In order not to violate the given constraints in velocity vmax and acceleration amax despite the completely independent planning, vmax and amax are split up by a weighting factor 0≦kl≦1 (cf.
A change of kl can be performed during operation. Since the maximum possible traveling speed and acceleration are dependent on the total mass of cable and load, vmax and amax also can change in operation. Therefore, the respectively applicable values likewise are handed over to the trajectory planning.
By splitting up the power, the control variable constraints possibly are not utilized completely, but the crane operator can easily and intuitively adjust the influence of the active heave compensation.
A weighting of kl=1 is equal to switching off the active heave compensation, whereby a smooth transition between a compensation switched on and switched off becomes possible.
The first part of the chapter initially explains the generation of the reference trajectories ya*, {dot over (y)}a* and ÿa* for compensating the vertical movement of the cable suspension point. The essential aspect here is that with the planned trajectories the vertical movement is compensated as far as is possible due to the given constraints set by kl.
Therefore, by the vertical positions and velocities of the cable suspension point {tilde over (z)}ah=[{tilde over (z)}ah(tk+Tp,1) . . . {tilde over (z)}ah(tk+Tp,K
The second part of the chapter deals with the planning of the trajectories yl*, {dot over (y)}i* and ÿl* for traveling the load. The same are generated directly from the hand lever signal of the crane operator whh. The calculation is effected by an addition of the maximum admissible jerk.
Reference Trajectories for the Compensation
In the trajectory planning for the compensation movement of the hoisting winch, sufficiently smooth trajectories must be generated from the predicted vertical positions and velocities of the cable suspension point taking into account the valid drive constraints. This task subsequently is regarded as constrained optimization problem, which can be solved online at each time step. Therefore, the approach resembles the draft of a model-predictive control, although in the sense of a model-predictive trajectory generation.
As references or setpoint values for the optimization the vertical positions and velocities of the cable suspension point {tilde over (z)}ah=[{tilde over (z)}ah(tk+Tp,1) . . . {tilde over (z)}ah(tk+Tp,K
Considering the constraints valid by kl, vmax, and amax, an optimum time sequence thereupon can be determined for the compensation movement.
However, analogous to the model-predictive control only the first value of the trajectory calculated thereby is used for the subsequent control. In the next time step, the optimization is repeated with an updated and therefore more accurate prediction of the vertical position and velocity of the cable suspension point.
The advantage of the model-predictive trajectory generation with successive control as compared to a classical model-predictive control on the one hand consists in that the control part and the related stabilization can be calculated with a higher scan time as compared to the trajectory generation. Therefore, the calculation-intensive optimization can be shifted into a slower task.
In this concept, on the other hand, an emergency operation can be realized independent of the control for the case that the optimization does not find a valid solution. It consists of a simplified trajectory planning which the control relies upon in such emergency situation and further actuates the winch.
System Model for Planning the Compensation Movement
To satisfy the requirements of the steadiness of the reference trajectories for the compensation movement, its third derivative at the earliest can be regarded as jump-capable. However, jumps in the jerk should be avoided in the compensation movement with regard to the winch life, whereby only the fourth derivative can be regarded as jump-capable.
Thus, the jerk must at least be planned steady and the trajectory generation for the compensation movement is effected with reference to the fourth order integrator chain illustrated in
in the state space. Here, the output ya[ya*,{dot over (y)}y*,ÿa*,]T includes the planned trajectories for the compensation movement. For formulating the optimal control problem and with regard to the future implementation, this time-continuous model initially is discretized on the lattice
τ0<τ1< . . . <τK
wherein Kp represents the number of the prediction steps for the prediction of the vertical movement of the cable suspension point. To distinguish the discrete time representation in the trajectory generation from the discrete system time tk, it is designated with τk=kΔτ, wherein k=0, . . . , Kp and Δτ is the discretization interval of the horizon Kp used for the trajectory generation.
The time-discrete system representation valid for this lattice can be calculated exactly with reference to the analytical solution
For the integrator chain from
wherein Δτk=τk+1−τk describes the discretization step width valid for the respective time step.
Formulation and Solution of the Optimal Control Problem
By solving the optimal control problem a trajectory will be planned, which as closely as possible follows the predicted vertical movement of the cable suspension point and at the same time satisfies the given constraints.
To satisfy this requirement, the merit operation reads as follows:
wherein wa(τk) designates the reference valid at the respective time step. Since only the predicted position {tilde over (z)}ah(tk+Tp,k) and velocity {tilde over (ż)}ah(tk+Tp,k) of the cable suspension point are available here, the associated acceleration and the jerk are set to zero. The influence of this inconsistent specification, however, can be kept small by a corresponding weighting of the acceleration and jerk deviation. Thus:
wa(τk)=[{tilde over (z)}ah(tk+Tp,k){tilde over (z)}ah(tk+Tp,k)0 0]T,k=1, . . . ,Kp. (1.6)
Over the Positively Semidefinite Diagonal Matrix
Qw(τk=diag(ηw,1(τk),qw,2(τk),qw,3,qw,4),k=1, . . . ,Kp (1.7)
deviations from the reference are weighted in the merit operation. The scalar factor ru evaluates the correction effort. While ru, qw,3 and qw,4 are constant over the entire prediction horizon, qw,r and qw,2 are chosen in dependence on the time step τk. Reference values at the beginning of the prediction horizon therefore can be weighted more strongly than those at the end. Hence, the accuracy of the vertical movement prediction decreasing with increasing prediction time can be depicted in the merit operation. Because of the non-existence of the references for the acceleration and the jerk, the weights qw,3 and qw,4 only punish deviations from zero, which is why they are chosen smaller than the weights for the position qw,1(τk) and velocity qw,2(τk).
The associated constraints for the optimal control problem follow from the available power of the drive and the currently chosen weighting factor kl (cf.
−δa(τk)(1−kl)vmax≦xa,2(τk≦δa(τk)(1−kl)vmax,
−δa(τk)(1−kl)amax≦xa,3(τk)≦δa(τk)(1−kl)amax,k=1, . . . ,Kp,
−δa(τk)jmax≦xa,4(τk)≦δa(τk)jmax (1.8)
and for the input:
Here, δa(τk) represents a reduction factor which is chosen such that the respective constraint at the end of the horizon amounts to 95% of that at the beginning of the horizon. For the intermediate time steps, δa(τk) follows from a linear interpolation. The reduction of the constraints along the horizon increases the robustness of the method with respect to the existence of admissible solutions.
While the velocity and acceleration constraints can change in operation, the constraints of the jerk jmax and the derivative of the jerk
are constant. To increase the useful life of the hoisting winch and the entire crane, they are chosen with regard to a maximum admissible shock load. For the positional state no constraints are applicable.
Since the maximum velocity vmax and acceleration amax as well as the weighting factor of the power kl in operation are determined externally, the velocity and acceleration constraints also are changed necessarily for the optimal control problem. The presented concept takes account of the related time-varying constraints as follows: As soon as a constraint is changed, the updated value first is taken into account only at the end of the prediction horizon for the time step τK
Thus, the optimal control problem is completely given by the quadratic merit operation (1.5) to be minimized, the system model (1.4) and the inequality constraints from (1.8) and (1.9) in the form of a linear-quadratic optimization problem (QP problem for Quadratic Programming Problem). When the optimization is carried out for the first time, the initial condition is chosen to be xa(τ0)=[0,0,0,0]T. Subsequently, the value xa(τ1) calculated for the time step τ1 in the last optimization step is used as initial condition.
At each time step, the calculation of the actual solution of the QP problem is effected via a numerical method which is referred to as QP solver.
Due to the calculation effort for the optimization, the scan time for the trajectory planning of the compensation movement is greater than the discretization time of all remaining components of the active heave compensation; thus: Δτ>Δt.
To ensure that the reference trajectories are available for the control at a faster rate, the simulation of the integrator chain from
Reference Trajectories for Moving the Load
Analogous to the compensation movement, two times steadily differentiable reference trajectories are necessary for the superimposed hand lever control (cf.
As shown in
The hand lever signal of the crane operator −100≦whh≦100 is interpreted as relative velocity specification with respect to the currently maximum admissible velocity klvmax. Thus, according to
As can be seen, the target velocity currently specified by the hand lever depends on the hand lever position whh, the variable weighting factor kl and the current maximum admissible winch speed vmax.
The task of trajectory planning for the hand lever control now can be indicated as follows: From the target velocity specified by the hand lever, a steadily differentiable velocity profile can be generated, so that the acceleration has a steady course. As procedure for this task a so-called jerk addition is recommendable.
The basic idea is that in a first phase the maximum admissible jerk jmax acts on the input of the integrator chain, until the maximum admissible acceleration is reached. In the second phase, the speed is increased with constant acceleration; and in the last phase the maximum admissible negative jerk is added such that the desired final speed is achieved.
Therefore, merely the switching times between the individual phases must be determined in the jerk addition.
As soon as a new situation occurs for the hand lever control, replanning of the generated trajectories takes place. A new situation occurs as soon as the target velocity vhh* or the currently valid maximum acceleration for the hand lever control klamax is changed. The target velocity can change due to a new hand lever position whh or due to a new specification of kl or vmax (cf.
When replanning the trajectories, that velocity initially is calculated from the currently planned velocity {dot over (y)}l*(T1,0) and the corresponding acceleration ÿl*(T1,0) which is obtained with a reduction of the acceleration to zero:
wherein the minimum necessary time is given by
and ũl,1 designates the input of the integrator chain, i.e. the added jerk (cf.
In dependence on the theoretically calculated velocity and the desired target velocity, the course of the input now can be indicated. If vhh*>{tilde over (v)}, {tilde over (v)} does not reach the desired value vhh* and the acceleration can be increased further. However, if vhh*<{tilde over (v)}, {tilde over (v)} is too fast and the acceleration must be reduced immediately.
From these considerations, the following switching sequences of the jerk can be derived for the three phases:
with ul=[ul,1, ul,2, ul,3] and the input signal ul,i added in the respective phase. The duration of a phase is found to be ΔTi=Tl,i−Tl,i-1 with i=1, 2, 3. Accordingly, the planned velocity and acceleration at the end of the first phase are:
and after the second phase:
{dot over (y)}l*(Tl,2)={dot over (y)}l*(Tl,1)+ΔT2ÿl*(Tl,1), (1.17)
ÿl*(Tl,2)=ÿl*(Tl,1), (1.18)
wherein ul,2 was assumed=0. After the third phase, finally, it follows:
For the exact calculation of the switching times Tl,i the acceleration constraint initially is neglected, whereby ΔT2=0. Due to this simplification, the lengths of the two remaining time intervals can be indicated as follows:
wherein ã stands for the maximum acceleration achieved. By inserting (1.21) and (1.22) into (1.15), (1.16) and (1.19) a system of equations is obtained, which can be resolved for ã. Considering {dot over (y)}l*(Tl,3)=vhh*, the following finally is obtained:
The sign of ã follows from the condition that ΔT1 and ΔT3 in (1.21) and (1.22) must be positive.
In a second step, ã and the maximum admissible acceleration klamax result in the actual maximum acceleration:
ā=ÿl*(Tl,1)=ÿl*(Tl,2)=min{klamax,max{−klamax,ā}}. (1.24)
With the same, the really occurring time intervals ΔT1 and ΔT3 finally can be calculated. They result from (1.21) and (1.22) with ã=ā. The yet unknown time interval ΔT2 now is determined from (1.17) and (1.19) with ΔT1 and ΔT3 from (1.21) and (1.22) to be
wherein {dot over (y)}l*(Tl,1) follows from (1.15). The switching times can directly be taken from the time intervals:
Tl,i=Tl,i−1+ΔTi,i=1,2,3. (1.26)
The velocity and acceleration profiles {dot over (y)}l* and ÿl* to be planned can be calculated analytically with the individual switching times. It should be mentioned that the trajectories planned by the switching times frequently are not traversed completely, since before reaching the switching time T1,3 a new situation occurs, replanning thereby takes place and new switching times must be calculated. As mentioned already, a new situation occurs by a change in whh, vmax, amax or kl.
Actuation Concept for the Hoisting Winch
In principle, the actuation consists of two different operating modes: the active heave compensation for decoupling the vertical load movement from the ship movement with free-hanging load and the constant tension control for avoiding a slack cable, as soon as the load is deposited on the sea bed. During a deep-sea lift, the heave compensation initially is active. With reference to a detection of the depositing operation, switching to the constant tension control is effected automatically.
Each of the two different operating modes however might also be implemented each without the other operating mode. Furthermore, a constant tension mode as it will be described below can also be used independent of the use of the crane on a ship and independent of an active heave compensation.
Due to the active heave compensation, the hoisting winch should be actuated such that the winch movement compensates the vertical movement of the cable suspension point zah and the crane operator moves the load by the hand lever in the h coordinate system regarded as inertial. To ensure that the actuation has the required predictive behavior for minimizing the compensation error, it is implemented by a pilot control and stabilization part in the form of a structure of two degrees of freedom. The pilot control is calculated from a differential parameterization by the flat output of the winch dynamics and results from the planned trajectories for moving the load yl*, {dot over (y)}l* and ÿl* as well as the negative trajectories for the compensation movement −ya*, −{dot over (y)}a* and −ÿa* (cf.
During the constant tension phase, the cable force at the load Fsl is to be controlled to a constant amount, in order to avoid a slack cable. The hand lever therefore is deactivated in this operating mode, and the trajectories planned on the basis of the hand lever signal no longer are added. The actuation of the winch in turn is effected by a structure of two degrees of freedom with pilot control and stabilization part.
The exact load position zl and the cable force at the load Fsl are not available as measured quantities for the control, since due to the long cable lengths and great depths the crane hook is not equipped with a sensor unit. Furthermore, no information exists on the kind and shape of the suspended load. Therefore, the individual load-specific parameters such as load mass ml, coefficient of the hydrodynamic increase in mass Ca, coefficient of resistance Cd and immersed volume ∇l, are not known in general, whereby a reliable estimation of the load position is almost impossible in practice.
Thus, merely the unwound cable length ls and the associated velocity {dot over (l)}s as well as the force at the cable suspension point Fc are available as measured quantities for the control. The length ls is obtained indirectly from the winch angle φh measured with an incremental encoder and the winch radius rh(jl) dependent on the winding layer jl. The associated cable velocity {dot over (l)}s can be calculated by numerical differentiation with suitable low-pass filtering. The cable force Fc applied to the cable suspension point is detected by a force measuring pin.
Actuation for the Active Heave Compensation
The transfer operation of the drive system from the correcting variable Uh(s) to the unwound cable length Yh(s) can be approximated as ITl system and results in
with the winch radius rh(jl). Since the system output Yh(s) at the same time represents a flat output, the inverting pilot control F(s) will be
and can be written in the time domain in the form of a differential parameterization as
(2.3) shows that the reference trajectory for the pilot control must be steadily differentiable at least two times.
The transfer operation of the closed circuit, consisting of the stabilization Ka(s) and the winch system Gh(s), can be taken from
By neglecting the compensation movement Ya*(s), the reference variable Yh*(s) can be approximated as ramp-shaped signal with a constant or stationary hand lever deflection, as in such a case a constant target velocity vhh* exists. To avoid a stationary control deviation in such reference variable, the open chain Ka(s)Gh(s) therefore must show a I2 behavior [9]. This can be achieved for example by a PID controller with
Hence it follows for the closed circuit:
wherein the exact values of ΛACH,i are chosen in dependence on the respective time constant Th.
Detection of the Depositing Operation
As soon as the load hits the sea bed, switching from the active heave compensation into the constant tension control should be effected. For this purpose, a detection of the depositing operation is necessary (cf.
Fc=kcΔlc, (2.7)
wherein kc and Δlc designate the spring constant equivalent to the elasticity of the cable and the deflection of the spring. For the latter, it applies:
The equivalent spring constant kc can be determined from the following stationary observation. For a spring loaded with the mass mf it applies in the stationary case:
kcΔlc=mfg. (2.9)
A transformation of (2.8) results in
With reference to a coefficient comparison between (2.9) and (2.10) the equivalent spring constant can be read as
In (2.9) it can also be seen that the deflection of the spring Δlc in the stationary case is influenced by the effective load mass me and half the cable mass ½μsls. This is due to the fact that in a spring the suspended mass mf is assumed to be concentrated in one point. The cable mass, however, is uniformly distributed along the cable length and therefore does not fully load the spring. Nevertheless, the full weight force of the cable μslsg is included in the force measurement at the cable suspension point.
With this approximation of the cable system, conditions for the detection of the depositing operation on the sea bed now can be derived. At rest, the force acting on the cable suspension point is composed of the weight force of the unwound cable μslsg and the effective weight force of the load mass meg. Therefore, the measured force Fc with a load located on the sea bed approximately is
Fc=(mc+μsls)g+ΔFc (2.12)
with
ΔFc=−kcΔls, (2.13)
wherein Δls designates the cable unwound after reaching the sea bed. From (2.13) it follows that Δls is proportional to the change of the measured force, since the load position is constant after reaching the ground. With reference to (2.12) and (2.13) the following conditions now can be derived for a detection, which must be satisfied at the same time:
The decrease of the negative spring force must be smaller than a threshold value:
ΔFc<Δ{circumflex over (F)}c. (2.14)
The time derivative of the spring force must be smaller than a threshold value:
{dot over (F)}c<{circumflex over ({dot over (F)}c. (2.15)
The crane operator must lower the load. This condition is checked with reference to the trajectory planned with the hand lever signal:
{dot over (y)}l*≧0. (2.16)
To avoid a wrong detection on immersion into the water, a minimum cable length must be unwound:
ls>ls,min. (2.17)
The decrease of the negative spring force ΔFc each is calculated with respect to the last high point
Since the conditions (2.14) and (2.15) must be satisfied at the same time, a wrong detection as a result of a dynamic inherent cable oscillation is excluded: As a result of the dynamic inherent cable oscillation, the force signal Fc oscillates, whereby the change of the spring force ΔFc with respect to the last high point
The threshold value for the change of the spring force is calculated in dependence on the last high point in the measured force signal as follows:
Δ{circumflex over (F)}c=min{−χ1
wherein χ1<1 and the maximum value Δ{circumflex over (F)}c,max were determined experimentally. The threshold value for the derivative of the force signal {circumflex over ({dot over (F)}c can be estimated from the time derivative of (2.7) and the maximum admissible hand lever velocity klvmax as follows
{circumflex over ({dot over (F)}=min{−χ2kcklvmax,{circumflex over ({dot over (F)}c,max} (2.19)
The two parameters χ2<1 and {circumflex over ({dot over (F)}c,max likewise were determined experimentally.
Since in the constant tension control a force control is applied instead of the position control, a target force Fc* is specified as reference variable in dependence on the sum of all static forces Fl,stat acting on the load. For this purpose Fl,stat is calculated in the phase of the heave compensation in consideration of the known cable mass μsls:
Fl,stat=Fc,stat−μslsg. (2.20)
Fc,stat designates the static force component of the measured force at the cable suspension point Fc. It originates from a corresponding low-pass filtering of the measured force signal. The group delay obtained on filtering is no problem, as merely the static force component is of interest and a time delay has no significant influence thereon. From the sum of all static forces acting on the load, the target force is derived taking into account the weight force of the cable additionally acting on the cable suspension point, as follows:
Fc*=psFl,stat+μslsg, (2.21)
wherein the resulting tension in the cable is specified by the crane operator with 0<ps<1. To avoid a setpoint jump in the reference variable, a ramp-shaped transition from the force currently measured on detection to the actual target force Fc* is effected after a detection of the depositing operation.
For picking up the load from the sea bed, the crane operator manually performs the change from the constant tension mode into the active heave compensation with free-hanging load.
Actuation for the Constant Tension Mode
The pilot control F(s) of the structure of two degrees of freedom is identical with the one for the active heave compensation and given by (2.2) and (2.3), respectively. In the constant tension mode, however, the hand lever signal is not added, which is why the reference trajectory only consists of the negative target velocity and acceleration −{dot over (y)}a* and ÿa* for the compensation movement. The pilot control part initially in turn compensates the vertical movement of the cable suspension point Zah(s). However, a direct stabilization of the winch position is not effected by a feedback of Yh(s). This is effected indirectly by the feedback of the measured force signal.
The measured output Fc(s) is obtained from
with the two transfer operations
wherein the transfer operation of the cable system for a load standing on the ground follows from (2.12):
Gs,F(s)=−kc. (2.25)
As can be taken from (2.22), the compensation error Ea(s) is corrected by a stable transfer operation GCT,l(s) and the winch position is stabilized indirectly. In this case, too, the requirement of the controller Ks(s) results from the expected reference signal Fc*(s), which after a transition phase is given by the constant target force Fc* from (2.21). To avoid a stationary control deviation with such constant reference variable, the open chain Ks(s)Gh(s)Gs,F(s) must have an I behavior. Since the transfer operation of the winch Gh(s) already implicitly has such behavior, this requirement can be realized with a P feedback; thus, it applies:
Number | Date | Country | Kind |
---|---|---|---|
10 2012 004 803 | Mar 2012 | DE | national |
Number | Name | Date | Kind |
---|---|---|---|
6216789 | Lorsignol et al. | Apr 2001 | B1 |
7793763 | Zhu et al. | Sep 2010 | B2 |
20040164041 | Sawodny et al. | Aug 2004 | A1 |
20100230370 | Schneider et al. | Sep 2010 | A1 |
Number | Date | Country |
---|---|---|
3418026 | Apr 1987 | DE |
3643114 | Aug 1987 | DE |
19645812 | Feb 1998 | DE |
102008024513 | Nov 2009 | DE |
102009032269 | Jan 2011 | DE |
0176832 | Apr 1986 | EP |
1757554 | Feb 2007 | EP |
2132972 | Jul 1984 | GB |
0227684 | Apr 2002 | WO |
2009038468 | Mar 2009 | WO |
Entry |
---|
Schneider, K. et al., “Crane Controller with Division of a Kinematically Constrained Quantity of the Hoisting Gear”, U.S. Appl. No. 13/788,828, 43 pages, filed Mar. 7, 2013. |
Langer, K. et al., “Crane Controller with Cable Force Mode”, U.S. Appl. No. 13/788,851, 40 pages, filed Mar. 7, 2013. |
Number | Date | Country | |
---|---|---|---|
20130245817 A1 | Sep 2013 | US |