Fixed the sinusoid motion for the cooperative flex carry case. Added the sinusoid motion as default in the existing 2D gen_data file, although it may work badly depending on the feature placement.

In both cases, the estimator seems to work but the 3sigma bounds are smaller than the errors are typically - not sure why this is.