Removed phi generalised coordinate from Q3. Replaced fullsimplify with simplify for performance reasons