Update GenerateEquationsOptCal.m

Correct error in observation model and use quaternions to define body orientation rather than direction cosines to make implementation simpler