Hello all,
I have some difficulties defining a periodicity constraint in YALMIP. My problem is schmatically:
q = sdpvar(4, N)
u = sdpvar(2, N-1)
Objective: J = sum_{k=1}^{N} q{k}’ Q q{k} + u{k}’ R u{k} ;
Dynamic constraint for k = 1...N : q{k+1} = A*q{k}+B*u{k}
Suppose the state q{k} comprises two angles and two angular velocities
q{k} = [phi1, phi2, omega_1, omega_2].
I am looking for a way to implement a 2pi-periodic constraints in the angles, something like
q{N}(1:2) % 2*pi = q_end(1:2)
The modulo operator does not seem to work with YALMIP decision variables. I'm using IPOPT solver for my optimization problem. Is there a possibility to define such a constraint in YALMIP?
Thank you in advance!