Fix MotionConstrCommon A_ matrix computation.