Why there are two clamping function for control limits? about mppi_numba

[xiaoyi-cai-acl]

@brilianputraa I am not sure if the optimality is preserved due to clipping. Perhaps the simplest sanity check is to run MPPI on optimal controls problems with known solutions given bounded control inputs. Then see if the solution matches the optimal.

I do think it is an interesting direction to design an MPPI algorithm that has theoretical guarantees given control constraints (where the simplest one being the bounded norm).

[xiaoyi-cai-acl]

Hi @brilianputraa :

• In the rollout_numba function, we crop the perturbed control sequence because we want the state rollouts to be consistent with the bounded control.
• If you look at this code segment we crop again because the update to the current best control u_cur_d is based on the unmodified Gaussian noise values. Therefore, there is no guarantee that the updated control will satisfy the control bound without cropping again.

An alternative approach is probably to keep track of how each sampled Gaussian noise gets cropped and do a weighted sum of the cropped Gaussian noise directly, but I did not do that and I wasn't sure if one would see much performance difference

Hope this helps.

[brilianputraa]

Thank you for your explanation @xiaoyi-cai-acl, I got it now. My other question is, if we add that kind of clamping function for the control rate (lets say angular velocity rate and linear velocity rate (acceleration)) as well in the u_cur_d does it affects the optimality of the control sequence?

[brilianputraa]

@brilianputraa I am not sure if the optimality is preserved due to clipping. Perhaps the simplest sanity check is to run MPPI on optimal controls problems with known solutions given bounded control inputs. Then see if the solution matches the optimal.

I do think it is an interesting direction to design an MPPI algorithm that has theoretical guarantees given control constraints (where the simplest one being the bounded norm).

Okay I take your point, thank you for sharing your opinions on that. I will close the issues, thanks again for your detailed and super helpful answer!