anchor.diff:           ! --- Guyan (rigid body) motion in global coordinates
            rIP0(1:3)   = p%DP0(1:3, iSDNode)
            rIP(1:3)    = matmul(Rb2g, rIP0)
  -         duP(1:3)    = rIP - rIP0 + m%u_TP(1:3)
  +         duP(1:3)    = rIP - rIP0 ! NOTE: without m%u_TP(1:3)
            !U_full(DOFList(1:3)) = U_full(DOFList(1:3)) + duP(1:3)       
            ! >>> New
  -         U_full(DOFList(1:3)) = matmul(Rb2g, U_full(DOFList(1:3))) + duP(1:3)       
  -         U_full(DOFList(4:6)) = matmul(Rb2g, U_full(DOFList(4:6))) + rotations(1:3)
  +         DU_full(DOFList(1:3)) = matmul(Rb2g, DU_full(DOFList(1:3))) + duP(1:3)       
  +         DU_full(DOFList(4:6)) = matmul(Rb2g, DU_full(DOFList(4:6))) + rotations(1:3)
         enddo
      endif 
  -END SUBROUTINE Displacements
  +END SUBROUTINE LeverArm
   
   !------------------------------------------------------------------------------------------------------
   !> Construct force vector on internal DOF (L) from the values on the input mesh 
  
positive.code:    m%U_red       (p%IDC_Rb)= 0    ! NOTE: for now we don't have leader DOF at "C" (bottom)
     m%U_red       (p%ID__F) = 0
     if (p%reduced) then
        U_full        = matmul(p%T_red, m%U_red)
     else
        U_full        = m%U_red
     endif
     ! --- Adding Guyan contribution for rigid body
     if (bGuyan .and. p%Floating) then
  
negative.code:          Y1_CB_L = - (matmul(p%D1_141, m%F_L)) ! Uses non rotated loads
        endif
        if (p%Floating) then
           Y1_CB_L = matmul(RRb2g, Y1_CB_L) !>>> New
        endif
  
        Y1 = Y1_CB + Y1_Utp + Y1_CB_L+ Y1_Guy_L + Y1_Guy_R 
  