I've checked and run the codes and it works so far. However, I've also gotten an problem about the linearized dyanmics.
In lineardynTSOeul.m where the Jocabian and Hessian is obtained, two of three the second order derivative of dynamics, he f{xu} and f_{uu} are all set to be zero. To further confirm, I printed out those variables and they are indeed all zeros.
Are you sure this is the right way, or is it a unfinished version of code? For me, it seems a bit wierd that they are all zero, seemingly saying the changes of the input doesn't affect the dyanmics at all. If I'm wrong, can you explain a bit about that?
I've checked and run the codes and it works so far. However, I've also gotten an problem about the linearized dyanmics.
In lineardynTSOeul.m where the Jocabian and Hessian is obtained, two of three the second order derivative of dynamics, he f{xu} and f_{uu} are all set to be zero. To further confirm, I printed out those variables and they are indeed all zeros.
Are you sure this is the right way, or is it a unfinished version of code? For me, it seems a bit wierd that they are all zero, seemingly saying the changes of the input doesn't affect the dyanmics at all. If I'm wrong, can you explain a bit about that?