public CserState(AgcTuple radius, AgcTuple velocity, double dtcp, double xcp, double a, double d, double e, CserState previous)
{
Radius = radius;
Velocity = velocity;
Dtcp = dtcp;
Xcp = xcp;
A = a;
D = d;
E = e;
Previous = previous;
}
public UpfgState(CserState cser, AgcTuple rbias, AgcTuple rd, AgcTuple rgrav, double time, double velocity, AgcTuple vgo, double tb, double tgo, double dt)
{
Cser = cser;
Rbias = rbias;
Rd = rd;
Rgrav = rgrav;
Time = time;
Velocity = velocity;
Vgo = vgo;
Tb = tb;
Tgo = tgo;
Dt = dt;
}