In SDRE survey we must first make nonlinear system into a linearized shape that matrix A & B are state dependent matrices. The question that arises here is that I am manipulating a system in which there are lot's of zeros in matrices A & B and these zeros coerce system to violate Controllability condition.
My nonlinear system is :
Xdot = V.cos(theta)
Ydot = V.sin(theta )
thetadot=V/2.tan(Phi)
Vdot= a
Phidot=omega
inputs are a and omega
outputs are x,y
my SDC form is :
A=
[0 0 0 cos(theta) 0]
[0 0 0 sin(theta) 0]
[0 0 0 (1/2)tan(phi) 0]
[0 0 0 0 0]
[0 0 0 0 0]
B=[0 0;0 0; 0 0;1 0;0 1]