Further debugging of ofreq.  Motion model and motion solver now debugged.