LoadControl Custom Task

A custom task run a load control simulation based on calculations contact or reaction forces. .

Introduction

A LoadControl custom task needs either global contact or global reaction for the specified Rigid material depending on if contact for that material is enabled.

This CustomTask tries to achieve the load requested from the user defined function by adjusting the velocity of that material. It does that by dynamically estimating the relationship between the displacement and load and then uses a PID control algorithm to adjust the velocity.

Task Scheduling

In scripted files, a LoadControl custom task is scheduled with the following block:

CustomTask LoadControl
Parameter velocity, (velocity)
Parameter material, (int)
Parameter direction, (int)
Parameter MaxVelocity,(number)
Parameter Load_Function (user-inputted function)
Parameter Kp,(number)
Parameter Ki,(number)
Parameter smooth,(number)

In XML files, these task options are scheduled using <Schedule> elements, which must be within the single <CustomTasks> block:

<Schedule name='LoadControl'>
   <Parameter name='velocity'>(number)</Parameter>
   <Parameter name='material'>(int)</Parameter>
   <Parameter name='direction'>(int)</Parameter>
   <Parameter name='MaxVelocity'>(number)</Parameter>
   <Parameter name='Load_Function (function)'/>
   <Parameter name='Kp'>(number)</Parameter>
   <Parameter name='Ki'>(number)</Parameter>
   <Parameter name='smooth'>(number)</Parameter>
</Schedule>

These are the parameters that this custom task needs to operate:

• velocity - This is the starting velocity of the simulation for the specified Rigid material. The sign of this parameter is probably more important than its value, as long as it is something reasonable. It is needed for initializing the load control.
• material - The material number of the Rigid material to be controlled.
• direction - An integer [1,2,3] to choose the direction to consider for velocity and load.
• MaxVelocity - A positive number that limits the velocity of the controlled material - defaults to 5 m/s.
• Load_Function - A user defined function that gives the desired load. This task doesn't work well with discontinuous functions.

These parameters are for the control algorithm :

• Kp - Proportional gain factor for PID algorithm. The default value of 0.1 seems to work well.
• Ki - Integral and Derivative gain factors for PID algorithm. (Note: Kd = 0.25Ki) The default value of 0.001 seems to work well.
• smooth - Exponential smoothing parameter in (0,1). Controls how fast the dynamic relationship between distance and load is updated and also how much smoothing is done on the load values. The default value of 0.95 works well.

Task Action

This custom task tries to dynamically estimate the relationship between load and displacement of the rigid material using the following equation:

[math]\displaystyle{ K_t = \text{arg}\min_{K}  \left[ \alpha \frac{(L-Kx)^2}{0.5(L^2+(K_{t-1}x)^2)}+(1-\alpha)\frac{(K-K_{t-1})^2}{K_{t-1}^2}\right] }[/math]

where [math]\displaystyle{ K_t }[/math] is the estimate the relationship between load and displacement at time t, x is the displacement, L is the recorded load and [math]\displaystyle{ \alpha = smooth }[/math].

This gives:

[math]\displaystyle{ K_t =\frac{\lambda L x + \gamma K_{t-1}}{\lambda x^2 +\gamma} }[/math]  where   [math]\displaystyle{ \lambda =\frac{2(1-\alpha)}{L^2+(K_{t-1}x)^2} }[/math]  and  [math]\displaystyle{ \gamma =\frac{\alpha}{K_{t-1}^2} }[/math].

Then the error between requested load L(t) and recorded load L is smoothed and converted to velocity as:

[math]\displaystyle{ e_t =(1-\alpha)\frac{L(t)-L}{K_t}+\alpha e_{t-1} }[/math]

The integrated error is calculated as:

[math]\displaystyle{ Ie_t =\frac{L(t)-L}{K_t}+ Ie_{t-1} }[/math]

The derivative error is calculated with Brown's double exponential smoothing as:

[math]\displaystyle{ e2_t =(1-\alpha)e_t+ \alpha e2_{t-1} }[/math]

and

[math]\displaystyle{  De_t = \frac{1-\alpha}{\alpha}(e_t-e2_t)  }[/math]

then finally the velocity is set using the PID algorithm:

[math]\displaystyle{ V_t  = K_p e_t + K_i Ie_t + 0.25K_i De_t }[/math]

Note: If the velocity has a magnitude larger than MaxVelocity than it is given that magnitude and the integrated error for that time step is not accrued.

To be developed

Contact forces are corrupted with fat tail noise. A median filter would help reduce the effect of this noise.