anchor.diff:  
      END SUBROUTINE BD_StaticElementMatrixForce
   
  -   SUBROUTINE BD_GA2(t,n,u,utimes,p,x,xd,z,OtherState,ErrStat,ErrMsg)
  +SUBROUTINE BD_GA2(t,n,u,utimes,p,x,xd,z,OtherState,ErrStat,ErrMsg)
   
      REAL(DbKi),                        INTENT(IN   )  :: t           ! Current simulation time in seconds
      INTEGER(IntKi),                    INTENT(IN   )  :: n           ! time step number
  
positive.code:    INTEGER(IntKi)                  :: temp_id
  !   INTEGER(IntKi)                  :: temp_count
  
     Eref = 0.0D0
     DO i=1,niter
         StifK(:,:) = 0.0D0
  
negative.code:       CALL SetErrStat( ErrStat2, ErrMsg2, ErrStat, ErrMsg, RoutineName )
     temp_cc(:) = MATMUL(p%GlbRot,p%uuN0(4:6,1))
     CALL BD_CrvCompose(x%q(4:6),x%q(4:6),temp_cc,2,ErrStat2,ErrMsg2)
        CALL SetErrStat( ErrStat2, ErrMsg2, ErrStat, ErrMsg, RoutineName )
     x%q(4:6) = MATMUL(TRANSPOSE(p%GlbRot),x%q(4:6))
     ! Root velocities/angular velocities and accelerations/angular accelerations
     x%dqdt(1:3) = u%RootMotion%TranslationVel(1:3,1)
  