SimulationCore2/CSharp/OperationScenarios/UnitySignals/CTdsSwingEnum.f90

module CTdsSwingEnum
    use COperationScenariosVariables
    implicit none
    contains
    
    subroutine Evaluate_TdsSwing()
        implicit none
        
        if (DriveType == TopDrive_DriveType) then
#ifdef OST
            print*, 'Evaluate_TdsSwing=TopDrive'
#endif


            !TOPDRIVE-CODE=37
            if (Get_SwingDrillPermission() .and.&
                Get_TdsSwing() == TDS_SWING_OFF_END .and.&
                Get_FillMouseHoleLed() == .false. .and.&
                TopDriveLinkTiltState == TdsLinkTilt_DRILL) then
            
                call Set_TdsSwing(TDS_SWING_DRILL_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if
            
                
                
            !TOPDRIVE-CODE=38
            if (Get_SwingTiltPermission() .and.&
                Get_TdsSwing() == TDS_SWING_TILT_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_TILT) then
            
                call Set_TdsSwing(TDS_SWING_TILT_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if    
                
                
                
            !TOPDRIVE-CODE=39
            if (Get_SwingOffPermission() .and.&
                Get_TdsConnectionModes() == TDS_CONNECTION_NOTHING .and.&
                Get_TdsSwing() == TDS_SWING_OFF_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_OFF) then
            
                call Set_TdsSwing(TDS_SWING_OFF_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if     
                
                
                
               
                
            !TOPDRIVE-CODE=40
            if (Get_SwingTiltPermission() .and.&
                Get_TdsElevatorModes() == TDS_ELEVATOR_CONNECTION_NOTHING .and.&
                Get_TdsSwing() == TDS_SWING_OFF_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_TILT) then
            
                call Set_TdsSwing(TDS_SWING_TILT_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if    
                
                
                
                
                
            !TOPDRIVE-CODE=41
            if (Get_SwingOffPermission() .and.&
                Get_TdsElevatorModes() == TDS_ELEVATOR_CONNECTION_NOTHING .and.&
                Get_TdsSwing() == TDS_SWING_TILT_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_OFF) then
            
                call Set_TdsSwing(TDS_SWING_OFF_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if  
                
                
                
                
                
            !TOPDRIVE-CODE=42
            if (Get_HookHeight() > (TL() + NFC() + PL - ECG) .and.&
                Get_SwingTiltPermission() .and.&
                Get_TdsElevatorModes() == TDS_ELEVATOR_CONNECTION_SINGLE .and.&
                Get_TdsSwing() == TDS_SWING_OFF_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_TILT) then
            
                call Set_TdsSwing(TDS_SWING_TILT_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if     
                
                
                
                
            !TOPDRIVE-CODE=43
            if (Get_HookHeight() > (TL() + NFC() + PL - ECG) .and.&
                Get_SwingOffPermission() .and.&
                Get_TdsElevatorModes() == TDS_ELEVATOR_CONNECTION_SINGLE .and.&
                Get_TdsSwing() == TDS_SWING_TILT_END .and.&
                TopDriveLinkTiltState == TdsLinkTilt_OFF) then
            
                call Set_TdsSwing(TDS_SWING_OFF_BEGIN)
                TopDriveLinkTiltLed = LED_ON
                return
            end if    
                
                

        endif
        
        
        
        
        
        
        
        
        
        
        
        
!        if (DriveType == Kelly_DriveType) then
!#ifdef OST
!            print*, 'Evaluate_TdsSwing=Kelly'
!#endif
!        endif
        
    end subroutine
    
    subroutine Subscribe_TdsSwing()
        use CDrillingConsoleVariables
        implicit none
    end subroutine
    
end module CTdsSwingEnum