\ddot{\mathbf{q}}+\left[\mathbf{A}^T\mathbf{M}^{-1}\mathbf{C}\mathbf{A}\right]\dot{\mathbf{q}}+