static BT_ERROR i2c_cleanup(BT_HANDLE hI2C) { const BT_RESOURCE *pResource = BT_GetIntegratedResource(hI2C->pDevice, BT_RESOURCE_IRQ, 0); if(!pResource) { return BT_ERR_GENERIC; } BT_ERROR Error = BT_UnregisterInterrupt(pResource->ulStart, i2c_irq_handler, hI2C); BT_kMutexDestroy(hI2C->pMutex); return Error; }
BT_HANDLE gpio_probe(const BT_INTEGRATED_DEVICE *pDevice, BT_ERROR *pError) { BT_ERROR Error; if(pError) { *pError = BT_ERR_NONE; } BT_HANDLE hGPIO = BT_CreateHandle(&oHandleInterface, sizeof(struct _BT_OPAQUE_HANDLE), pError); if(!hGPIO) { goto err_out; } const BT_RESOURCE *pResource; pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IO, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } BT_u32 base, total; base = pResource->ulStart; total = (pResource->ulEnd - pResource->ulStart) + 1; pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_MEM, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } hGPIO->pRegs = (STM32_GPIO_REGS *) pResource->ulStart; pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IRQ, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } /*Error = BT_RegisterInterrupt(pResource->ulStart, gpio_irq_handler, hGPIO); if(Error) { goto err_free_out; }*/ //Error = BT_EnableInterrupt(pResource->ulStart); Error = BT_RegisterGpioController(base, total, hGPIO); if(Error) { goto err_free_irq; } return hGPIO; err_free_irq: BT_UnregisterInterrupt(pResource->ulStart, gpio_irq_handler, hGPIO); err_free_out: BT_DestroyHandle(hGPIO); if(pError) { *pError = Error; } err_out: return NULL; }
static BT_HANDLE gpio_probe(const BT_INTEGRATED_DEVICE *pDevice, BT_ERROR *pError) { BT_u32 i; BT_ERROR Error; if(pError) { *pError = BT_ERR_NONE; } BT_HANDLE hGPIO = BT_CreateHandle(&oHandleInterface, sizeof(struct _BT_OPAQUE_HANDLE), pError); if(!hGPIO) { goto err_out; } const BT_RESOURCE *pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IO, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } BT_u32 base = pResource->ulStart; BT_u32 total = (pResource->ulEnd - pResource->ulStart) + 1; pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_MEM, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } hGPIO->pRegs = (ZYNQ_GPIO_REGS *) pResource->ulStart; pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IRQ, 0); if(!pResource) { Error = BT_ERR_GENERIC; goto err_free_out; } Error = BT_RegisterInterrupt(pResource->ulStart, gpio_irq_handler, hGPIO); if(Error) { goto err_free_out; } // Prevent Pending Interrupts for(i = 0; i < total; i += 32) { hGPIO->pRegs->bank[i/32].INT_DIS = 0xFFFFFFFF; } Error = BT_EnableInterrupt(pResource->ulStart); Error = BT_RegisterGpioController(base, total, hGPIO); if(Error) { goto err_free_irq; } return hGPIO; err_free_irq: BT_UnregisterInterrupt(pResource->ulStart, gpio_irq_handler, hGPIO); err_free_out: BT_DestroyHandle(hGPIO); if(pError) { *pError = Error; } err_out: return NULL; }
static BT_HANDLE i2c_probe(const BT_INTEGRATED_DEVICE *pDevice, BT_ERROR *pError) { BT_ERROR Error = BT_ERR_NONE; BT_HANDLE hI2C = NULL; const BT_RESOURCE *pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_MEM, 0); if(!pResource) { Error = BT_ERR_INVALID_RESOURCE; goto err_out; } hI2C = BT_CreateHandle(&oHandleInterface, sizeof(struct _BT_OPAQUE_HANDLE), pError); if(!hI2C) { Error = BT_ERR_NO_MEMORY; goto err_out; } hI2C->pRegs = (ZYNQ_I2C_REGS *) bt_ioremap((void *)pResource->ulStart, BT_SIZE_4K); pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IRQ, 0); if(!pResource) { Error = BT_ERR_INVALID_RESOURCE; goto err_free_out; } BT_u32 ulIRQ = pResource->ulStart; Error = BT_RegisterInterrupt(ulIRQ, i2c_irq_handler, hI2C); if(Error) { Error = BT_ERR_GENERIC; // Device already in use! goto err_free_out; } BT_EnableInterrupt(ulIRQ); hI2C->pDevice = pDevice; i2c_set_clock_rate(hI2C, BT_I2C_CLOCKRATE_400kHz); hI2C->pMutex = BT_kMutexCreate(); if(!hI2C->pMutex) { Error = BT_ERR_NO_MEMORY; goto err_free_int_out; } BT_kMutexPend(hI2C->pMutex, 0); pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_BUSID, 0); if(!pResource) { Error = BT_ERR_INVALID_RESOURCE; goto err_free_int_out; } BT_u32 ulBusID = pResource->ulStart; hI2C->pRegs->CONTROL |= 0x0000000E; BT_I2C_RegisterBusWithID(hI2C, ulBusID); if(pError) { *pError = Error; } return hI2C; err_free_int_out: BT_UnregisterInterrupt(ulIRQ, i2c_irq_handler, hI2C); err_free_out: BT_DestroyHandle(hI2C); err_out: if(pError) { *pError = Error; } return NULL; }