出错回滚的方法

不念不忘少年蓝@ 2022-02-13 13:19 213阅读 0赞

BOOL GPIO_Set(HANDLE Sam)
    {
    #if InterruptReadPSAM
    
        enum errorType{ERR_GPIOOPEN, ERR_SETMODE, ERR_GETIRQ, ERR_KIOREQUEST, ERR_CREATEEVENT, 
                       ERR_ITRINIT, ERR_SUCCESS};           //错误代号枚举值
        errorType err = ERR_SUCCESS;                        //错误代号存储变量
    #define SET_ERROR(err_code) do{err = err_code;}while(0) //设置错误存储变量
    
        PSAM_CONTROL_STRUCT *pSam_s = (PSAM_CONTROL_STRUCT *)Sam;
        pSam_s->gpioID = GPIO_22;   
        /*
        PHYSICAL_ADDRESS pa;
        pa.QuadPart=OMAP_SYSC_PADCONFS_REGS_PA;
        OMAP_SYSC_PADCONFS_REGS   *pConfig = (OMAP_SYSC_PADCONFS_REGS *)MmMapIoSpace(pa, sizeof(OMAP_SYSC_PADCONFS_REGS), FALSE);
        OUTREG16(&pConfig->CONTROL_PADCONF_MCBSP3_DR, (INPUT_ENABLE | PULL_UP | MUX_MODE_4));
        */
        do {
            pSam_s->hGpio = GPIOOpen();//打开GPIO
            DEL RETAILMSG(TRUE,(TEXT("pDevice->hGpio = %d\r\n"), pSam_s->hGpio));
            if(NULL == pSam_s->hGpio)
            {
                DEL RETAILMSG(TRUE,(TEXT("[PSM]:GPIOOpen() failed\r\n")));
                SET_ERROR(ERR_GPIOOPEN);
                break;
            }
    
            GPIOSetMode(pSam_s->hGpio, pSam_s->gpioID, GPIO_DIR_INPUT|GPIO_INT_HIGH_LOW);//设置模式
    
            pSam_s->irq = GPIOGetSystemIrq(pSam_s->hGpio, pSam_s->gpioID);//获得物理中断号
            DEL RETAILMSG(TRUE,(TEXT("pDevice->irq = %d\r\n"), pSam_s->irq));
            if(0 == pSam_s->irq)
            {
                DEL RETAILMSG(TRUE,(TEXT("[PSM]:GPIOGetSystemIrq() failed\r\n")));
                SET_ERROR(ERR_GETIRQ);
                break;
            }
    
            BOOL ret = KernelIoControl(IOCTL_HAL_REQUEST_SYSINTR, &pSam_s->irq, sizeof(pSam_s->irq),
                &pSam_s->sysIntr, sizeof(pSam_s->sysIntr), NULL);//映射到系统中断号
            if(0 == ret)
            {
                DEL RETAILMSG(TRUE,(TEXT("[PSM]:KernelIoControl() failed\r\n")));
                SET_ERROR(ERR_KIOREQUEST);
                break;
            }
    
            pSam_s->hIntrEvent = CreateEvent(NULL, FALSE, FALSE, NULL);//创建事件
            DEL RETAILMSG(TRUE,(TEXT("pDevice->hIntrEvent = %d\r\n"), pSam_s->hIntrEvent));
            if(NULL == pSam_s->hIntrEvent)
            {
                DEL RETAILMSG(TRUE,(TEXT("[PSM]:CreateEvent() failed\r\n")));
                SET_ERROR(ERR_CREATEEVENT);
                break;
            }
    
            ret = GPIOInterruptInitialize(pSam_s->hGpio, pSam_s->gpioID, 
                pSam_s->sysIntr, pSam_s->hIntrEvent);//初始化中断
            if(0 == ret)
            {
                DEL RETAILMSG(TRUE,(TEXT("[PSM]:GPIOInterruptInitialize() failed\r\n")));
                SET_ERROR(ERR_ITRINIT);
                break;
            }
        }while(0);
    
        return TRUE;//正确情况下的返回
    
        DEL RETAILMSG(TRUE,(TEXT("[PSM]:GPIO_Set() fail\r\n")));
    
        int errCode = err - 1;  //每种情况的首条回滚操作是多余的,本条使之跳过
        switch(errCode)         //中途出错情况下的回滚操作
        {
        case ERR_SUCCESS:
            break;
        case ERR_ITRINIT:
            GPIOInterruptDisable(pSam_s->hGpio, pSam_s->gpioID, pSam_s->sysIntr);
        case ERR_CREATEEVENT:
            CloseHandle(pSam_s->hIntrEvent);
        case ERR_KIOREQUEST:
            KernelIoControl(IOCTL_HAL_RELEASE_SYSINTR, &pSam_s->sysIntr, sizeof(pSam_s->sysIntr),
                            NULL, 0, NULL);//释放系统中断号
        case ERR_GETIRQ:
        case ERR_SETMODE:
        case ERR_GPIOOPEN:
            GPIOClose(pSam_s->hGpio);
        }
    
        return FALSE;//错误情况下的返回
    #else
        return TRUE;
    #endif
    }