anchor.diff:        REAL(ReKi)                   :: Y1_Guy_R(6)
         REAL(ReKi)                   :: Y1_Guy_L(6)
         REAL(ReKi)                   :: Y1_Utp(6)
  +      REAL(ReKi)                   :: udotdot_TP(6)
         REAL(ReKi)                   :: Y1_ExtraMoment(3) ! Lever arm moment contributions due to interface displacement
         INTEGER(IntKi), pointer      :: DOFList(:)
         INTEGER(IntKi)               :: startDOF
  
positive.code:    END SUBROUTINE CleanUp
  END SUBROUTINE OutSummary
  
  SUBROUTINE StateMatrices(p, ErrStat, ErrMsg, AA, BB, CC, DD)
     type(SD_ParameterType),                 intent(in)  :: p       !< Parameters
     integer(IntKi),                         intent(out) :: ErrStat !< Error status of the operation
     character(*),                           intent(out) :: ErrMsg  !< Error message if ErrStat /= ErrID_None
  
negative.code:       DD(1:nY,7:12  ) = - p%CBB
        DD(1:nY,13:18 ) = - p%MBB
        if (p%nDOFM>0) then
           if (p%Floating .and. present(u)) then
              ! TODO TODO rotate it A MBmmB A^t
              !DD(1:3,:) = DD(1:3,:) + matmul(transpose(u%TPMesh%Orientation(:,:,1)), p%MBmmB(1:3,:) !>>> New 
              DD(1:nY,13:18 ) = DD(1:nY,13:18 )+ p%MBmmB
           else
              DD(1:nY,13:18 ) = DD(1:nY,13:18 )+ p%MBmmB
           endif
        endif
     endif
     
  