BT_HANDLE BT_CreateMutex(BT_ERROR *pError) {
BT_HANDLE hMutex = BT_CreateHandle(&oHandleInterface, sizeof(struct _BT_OPAQUE_HANDLE), pError);
if(!hMutex) {
return NULL;
}
hMutex->pMutex = BT_kMutexCreate();
return hMutex;
}
void bt_initialise_slab_second_stage() {
BT_u32 i = BT_CACHE_GENERIC_MIN;
while(i <= BT_CACHE_GENERIC_MAX) {
BT_CACHE *pCache = BT_GetSuitableCache(i);
if(!pCache) {
break;
}
pCache->slab_mutex = BT_kMutexCreate();
i = i << 1;
}
}
static BT_ERROR bt_softirq_init() {
BT_ERROR Error;
BT_THREAD_CONFIG oConfig;
oConfig.ulStackDepth = 256;
oConfig.ulPriority = BT_CONFIG_INTERRUPTS_SOFTIRQ_PRIORITY;
g_pvMutex = BT_kMutexCreate();
if(!g_pvMutex) {
return BT_ERR_GENERIC;
}
BT_kMutexPend(g_pvMutex, BT_INFINITE_TIMEOUT);
BT_CreateThread(softirq_dispatcher, &oConfig, &Error);
return BT_ERR_NONE;
}
BT_ERROR BT_CacheInit(BT_CACHE *pCache, BT_u32 ulObjectSize) {
pCache->slab_mutex = BT_kMutexCreate();
return init_cache(pCache, ulObjectSize);
}
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;
}
