Update quaternion shapes to be a constant shape function
Fixed and simplified stiffness equations