X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?p=o-du%2Fphy.git;a=blobdiff_plain;f=wls_lib%2Fwls_drv.c;fp=wls_lib%2Fwls_drv.c;h=0000000000000000000000000000000000000000;hp=8b7543c82a8145fd7c1e810fb104626b823d07e4;hb=607bc01527a8cec5c0afabcb8ba6a4f16338877c;hpb=d3aa1ac58a0b3fbe279790f7d14827a84a56d8e0 diff --git a/wls_lib/wls_drv.c b/wls_lib/wls_drv.c deleted file mode 100644 index 8b7543c..0000000 --- a/wls_lib/wls_drv.c +++ /dev/null @@ -1,856 +0,0 @@ -/****************************************************************************** -* -* Copyright (c) 2019 Intel. -* -* Licensed under the Apache License, Version 2.0 (the "License"); -* you may not use this file except in compliance with the License. -* You may obtain a copy of the License at -* -* http://www.apache.org/licenses/LICENSE-2.0 -* -* Unless required by applicable law or agreed to in writing, software -* distributed under the License is distributed on an "AS IS" BASIS, -* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. -* See the License for the specific language governing permissions and -* limitations under the License. -* -*******************************************************************************/ - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include "wls.h" -#include "wls_drv.h" -#include "wls_debug.h" - -#if defined(_MLOG_TRACE_) -#include "mlog.h" -#endif - -#define WLS_VERSION_X 0 -#define WLS_VERSION_Y 0 -#define WLS_VERSION_Z 3 -#define WLS_VERSION_RESERVED 0 -#define WLS_DRV_VERSION ((WLS_VERSION_X << 24) | (WLS_VERSION_Y << 16) | (WLS_VERSION_Z << 8) | WLS_VERSION_RESERVED) - -#define WLS_DRV_VERSION_FORMAT "%d.%d.%d" -#define WLS_DEV_DEVICE_FORMAT "wls%d" - - -#define WLS_SEMA_COUNT 32 -#define WLS_MAX_CLIENTS 8 - - -typedef struct wls_us_priv_s -{ - wls_sema_priv_t sema; - - U8 NeedToWakeUp; - U8 isWait; - - U32 pid; -} wls_us_priv_t; - -char wls_driver_name[] = "wls"; -char wls_driver_version[10]; -char wls_dev_device_name[10]; - -static long wls_ioctl(struct file * filp, unsigned int cmd, unsigned long arg); -static int wls_open(struct inode * inode, struct file * filp); -static int wls_release(struct inode * inode, struct file * filp); -static int wls_mmap(struct file * filp, struct vm_area_struct * vma); -static int wls_wait(wls_sema_priv_t *priv, unsigned long arg); -static int wls_wake_up_user_thread(char *buf, wls_sema_priv_t *semap); - -static struct file_operations wls_fops = { - .owner = THIS_MODULE, - .open = wls_open, - .release = wls_release, - .unlocked_ioctl = wls_ioctl, - .compat_ioctl = wls_ioctl, - .mmap = wls_mmap, -}; - -static struct wls_dev_t* wls_dev[WLS_MAX_CLIENTS]; -static wls_drv_ctx_t wls_drv_ctx[WLS_MAX_CLIENTS]; - -static struct class * wls_class; - -/********************************************************************** -* Module Parameters * -**********************************************************************/ -int wlsMaxClients = 1; - - -/**********************************************************************/ -module_param(wlsMaxClients, int, S_IRUSR); - -/**********************************************************************/ - -static wls_drv_ctx_t * wls_get_ctx(unsigned int id) -{ - if(id < WLS_MAX_CLIENTS) - return &wls_drv_ctx[id]; - else - return NULL; -} - -int wls_wake_up_user_thread(char *buf, wls_sema_priv_t *semap) -{ - if (likely(atomic_read(&semap->is_irq) < FIFO_LEN)) { - unsigned int put = semap->drv_block_put + 1; - if (put >= FIFO_LEN) - put = 0; - //copy data from user - memcpy(&semap->drv_block[put], buf, sizeof(wls_wait_req_t)); - - semap->drv_block_put = put; - atomic_inc(&semap->is_irq); -#ifdef DEBUG - printk(KERN_INFO "[wls]:PUT: put=%d get=%d T=%lu is_irq=%d\n", - semap->drv_block_put, semap->drv_block_get, - semap->drv_block[put].start_time , atomic_read(&semap->is_irq)); -#endif /* DEBUG */ - wake_up_interruptible(&semap->queue); - } - - return 0; -} - -void wls_show_data(void* ptr, unsigned int size) -{ - unsigned char *d = ptr; - int i; - - for(i = 0; i < size; i++) - { - if ( !(i & 0xf) ) - printk("\n"); - printk("%02x ", d[i]); - } - printk("\n"); -} - -static int wls_open(struct inode * inode, struct file * filp) -{ - if((MINOR(inode->i_rdev ) >= 0) && (MINOR(inode->i_rdev) < wlsMaxClients) && (MINOR(inode->i_rdev ) < WLS_MAX_CLIENTS)){ - filp->private_data = (void *)wls_dev[MINOR(inode->i_rdev)]; - WLS_DEBUG("wls_open [%d] priv: 0x%p",MINOR(inode->i_rdev), filp->private_data); - WLS_DEBUG("wls_open PID [%d] ", current->pid); - } else { - WLS_ERROR("wls_open PID [%d] incorrect inode->i_rdev %d", current->pid, MINOR(inode->i_rdev)); - } - - return 0; -} - -static int wls_release(struct inode * inode, struct file * filp) -{ - struct wls_dev_t* wls_loc = NULL; - wls_us_ctx_t* pUsCtx = NULL; - wls_us_priv_t* pUs_priv = NULL; - wls_drv_ctx_t* pDrv_ctx = NULL; - int i = 0; - - WLS_DEBUG("priv: 0x%p", filp->private_data); - WLS_DEBUG("wls_release PID [%d] ",current->pid); - - if((MINOR(inode->i_rdev ) >= 0) && (MINOR(inode->i_rdev) < wlsMaxClients) && (MINOR(inode->i_rdev ) < WLS_MAX_CLIENTS)){ - if (filp->private_data != NULL) { - wls_loc = (struct wls_dev_t*)filp->private_data; - if((void *)wls_dev[MINOR(inode->i_rdev)] == (void *)wls_loc){ - pDrv_ctx = (wls_drv_ctx_t*)wls_loc->pWlsDrvCtx; - if(pDrv_ctx){ - for(i = 0; i < 2; i++ ){ - pUsCtx = (wls_us_ctx_t*)pDrv_ctx->p_wls_us_ctx[i]; - if(pUsCtx){ - wls_us_ctx_t* dst = (wls_us_ctx_t*)pUsCtx->dst_kernel_va; - wls_wait_req_t drv_block; - if(dst){ - wls_us_priv_t* pDstPriv = (wls_us_priv_t*)dst->wls_us_private; - if(pDstPriv){ - drv_block.start_time = wls_rdtsc(); - pDstPriv->NeedToWakeUp = 1; - wls_wake_up_user_thread((char *)&drv_block, &pDstPriv->sema); - } - } - //un-link ctx - pDrv_ctx->p_wls_us_ctx[i]->dst_kernel_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[i]->dst_user_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[i]->dst_pa = (uint64_t)0; - } - } - - for(i = 0; i < 2; i++ ){ - pUsCtx = (wls_us_ctx_t*)pDrv_ctx->p_wls_us_ctx[i]; - - if(pUsCtx){ - pUs_priv = (wls_us_priv_t*)pUsCtx->wls_us_private; - if(pUs_priv){ - if(pUs_priv->pid == current->pid){ - if (pUs_priv->isWait == 0){ - pUsCtx->wls_us_private = NULL; - kfree(pUs_priv); - pDrv_ctx->p_wls_us_ctx[i] = NULL; - dma_free_coherent(wls_loc->device, sizeof(wls_us_ctx_t),(void*)pUsCtx, (long)pDrv_ctx->p_wls_us_pa_ctx[i]); - pDrv_ctx->p_wls_us_pa_ctx[i] = NULL; - pDrv_ctx->nWlsClients--; - } else { - WLS_PRINT("Wait is in process\n"); - } - } - } - } - } - } - } - filp->private_data = NULL; - } - } else { - WLS_ERROR("wls_release PID [%d] incorrect inode->i_rdev %d", current->pid, MINOR(inode->i_rdev)); - } - - return 0; -} - -static int wls_wait(wls_sema_priv_t *priv, unsigned long arg) -{ - char __user *buf = (char __user *)arg; - - if (!likely(atomic_read(&priv->is_irq))) { - if (unlikely(wait_event_interruptible(priv->queue, atomic_read(&priv->is_irq)))) { - return -ERESTARTSYS; - } - } - - atomic_dec(&priv->is_irq); - - if (priv->drv_block_put != priv->drv_block_get) { - unsigned int get = priv->drv_block_get + 1; - - if (get >= FIFO_LEN) - get = 0; - - if (copy_to_user(buf, &priv->drv_block[get], sizeof(wls_wait_req_t))) { - return -EFAULT; - } - - priv->drv_block_get = get; - -#ifdef DEBUG - printk(KERN_INFO "[wls]:GET: put=%d get=%d T=%lu is_irq=%d\n", - priv->drv_block_put, priv->drv_block_get, - priv->drv_block[get].start_time, atomic_read(&priv->is_irq)); -#endif /* DEBUG */ - - } else { -#ifdef DEBUG - printk(KERN_ERR "[wls]: wrong computation of queueing\n"); -#endif /* DEBUG */ - } - - return 0; -} - -static unsigned wls_is_us_opened(wls_open_req_t *param) -{ - // TODO: add check - - return 0; -} - -wls_us_ctx_t *wls_create_us_ctx(wls_open_req_t *param, struct wls_dev_t * wls_loc) -{ - wls_us_ctx_t* pUsCtx = NULL; - wls_drv_ctx_t* pDrv_ctx = wls_loc->pWlsDrvCtx; - - // check if instance already registered - if(wls_is_us_opened(param)) - goto err0; - - // allocate memory for shared portion - pUsCtx = (wls_us_ctx_t*)dma_alloc_coherent(NULL, param->size, (dma_addr_t *)¶m->ctx_pa, GFP_KERNEL); - WLS_DEBUG("wls_create_us_ctx: pUsCtx 0x%016lx\n", (unsigned long)pUsCtx); - if (pUsCtx){ - // allocate memory for private - wls_us_priv_t *pUs_priv = kmalloc(sizeof(wls_us_priv_t), GFP_KERNEL); - - if(pUs_priv == NULL) - goto err1; - // init shared - memset (pUsCtx, 0, sizeof(wls_us_ctx_t)); - - SFL_DefQueue(&pUsCtx->ul_free_block_pq, pUsCtx->ul_free_block_storage, UL_FREE_BLOCK_QUEUE_SIZE * sizeof(void*)); - WLS_PRINT("ul free: off %lx\n",((U64) &pUsCtx->ul_free_block_pq -(U64)pUsCtx)); - - WLS_MsgDefineQueue(&pUsCtx->get_queue, pUsCtx->get_storage, WLS_GET_QUEUE_N_ELEMENTS, 0); - WLS_PRINT("get_queue: off %lx\n",((U64) &pUsCtx->get_queue -(U64)pUsCtx)); - - WLS_MsgDefineQueue(&pUsCtx->put_queue, pUsCtx->put_storage, WLS_PUT_QUEUE_N_ELEMENTS, 0); - WLS_PRINT("put_queue: off %lx\n",((U64) &pUsCtx->put_queue -(U64)pUsCtx)); - - // init private - memset (pUs_priv, 0, sizeof(wls_us_priv_t)); - init_waitqueue_head(&pUs_priv->sema.queue); - atomic_set(&pUs_priv->sema.is_irq, 0); - - pUs_priv->pid = current->pid; - - pUsCtx->wls_us_private = pUs_priv; - WLS_DEBUG("wls_create_us_ctx: pUsCtx->wls_us_private 0x%016lx\n", (unsigned long)pUsCtx->wls_us_private); - } else - goto err0; - - pDrv_ctx->p_wls_us_ctx[pDrv_ctx->nWlsClients] = pUsCtx; - pDrv_ctx->p_wls_us_pa_ctx[pDrv_ctx->nWlsClients++] = (wls_us_ctx_t*)param->ctx_pa; - - if(pDrv_ctx->p_wls_us_ctx[0] && pDrv_ctx->p_wls_us_ctx[1]) - { - //link ctx - pDrv_ctx->p_wls_us_ctx[0]->dst_kernel_va = (uint64_t)pDrv_ctx->p_wls_us_ctx[1]; - pDrv_ctx->p_wls_us_ctx[0]->dst_pa = (uint64_t) pDrv_ctx->p_wls_us_pa_ctx[1]; - - pDrv_ctx->p_wls_us_ctx[1]->dst_kernel_va = (uint64_t)pDrv_ctx->p_wls_us_ctx[0]; - pDrv_ctx->p_wls_us_ctx[1]->dst_pa = (uint64_t) pDrv_ctx->p_wls_us_pa_ctx[0]; - - pDrv_ctx->p_wls_us_ctx[0]->dst_kernel_va = (uint64_t)pDrv_ctx->p_wls_us_ctx[1]; - pDrv_ctx->p_wls_us_ctx[0]->dst_pa = (uint64_t) pDrv_ctx->p_wls_us_pa_ctx[1]; - pDrv_ctx->p_wls_us_ctx[1]->dst_kernel_va = (uint64_t)pDrv_ctx->p_wls_us_ctx[0]; - pDrv_ctx->p_wls_us_ctx[1]->dst_pa = (uint64_t) pDrv_ctx->p_wls_us_pa_ctx[0]; - - WLS_DEBUG("link: 0 <-> 1: 0: 0x%016lx 1: 0x%016lx\n", (long unsigned int)pDrv_ctx->p_wls_us_ctx[0]->dst_kernel_va, - (long unsigned int)pDrv_ctx->p_wls_us_ctx[1]->dst_kernel_va); - } - - return pUsCtx; - -//err2: - kfree(pUsCtx->wls_us_private); -err1: - dma_free_coherent(wls_loc->device, param->size, pUsCtx, param->ctx_pa); -err0: - return NULL; -} - - -int wls_destroy_us_ctx(wls_close_req_t *param, struct wls_dev_t * wls_prv) -{ - wls_us_ctx_t* pUsCtx = NULL; - wls_us_priv_t* pUs_priv = NULL; - - wls_drv_ctx_t* pDrv_ctx = wls_prv->pWlsDrvCtx; - - if(pDrv_ctx->p_wls_us_ctx[0] && pDrv_ctx->p_wls_us_ctx[1]) - { - //link ctx - pDrv_ctx->p_wls_us_ctx[0]->dst_kernel_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[1]->dst_kernel_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[0]->dst_user_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[1]->dst_user_va = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[0]->dst_pa = (uint64_t)0; - pDrv_ctx->p_wls_us_ctx[1]->dst_pa = (uint64_t)0; - - WLS_DEBUG("un-link: 0 <-> 1: 0: 0x%016lx 1: 0x%016lx\n", (long unsigned int)pDrv_ctx->p_wls_us_ctx[0]->dst_kernel_va, - (long unsigned int)pDrv_ctx->p_wls_us_ctx[1]->dst_kernel_va); - } - - pUsCtx = (wls_us_ctx_t*)param->ctx; - - if(pUsCtx){ - pUs_priv = (wls_us_priv_t*)pUsCtx->wls_us_private; - if(pUs_priv){ - if (pUs_priv->isWait == 0){ - - pUsCtx->wls_us_private = NULL; - kfree(pUs_priv); - if(param->ctx_pa){ - if( pDrv_ctx->p_wls_us_ctx[0] == pUsCtx){ - pDrv_ctx->p_wls_us_ctx[0] = NULL; - pDrv_ctx->p_wls_us_pa_ctx[0] = NULL; - } else { - pDrv_ctx->p_wls_us_ctx[1] = NULL; - pDrv_ctx->p_wls_us_pa_ctx[1] = NULL; - } - pDrv_ctx->nWlsClients--; - dma_free_coherent(wls_prv->device, param->size, pUsCtx, param->ctx_pa); - }else{ - WLS_ERROR("param->ctx_pa is NULL\n"); - } - } else - WLS_PRINT("Wait is in process\n"); - } - } - - return 0; -} - -static int wls_process_wait(wls_us_ctx_t* pUsCtx) -{ - int n = WLS_GetNumItemsInTheQueue(&pUsCtx->get_queue); - - return n; -} - -static int wls_process_put(wls_us_ctx_t *src, wls_us_ctx_t *dst) -{ - int ret = 0; - WLS_MSG_HANDLE hMsg; - int n = 0; - - wls_us_priv_t* pDstPriv = NULL; - wls_wait_req_t drv_block; - - WLS_DEBUG("offset get_queue %lx\n",(U64)&src->get_queue - (U64)src); - - n = WLS_GetNumItemsInTheQueue(&src->put_queue); - - while(n--) - { - if (WLS_MsgDequeue(&src->put_queue, &hMsg, NULL, (void*)src)) - { - WLS_DEBUG("WLS_Get %lx %d type %d\n",(U64) hMsg.pIaPaMsg, hMsg.MsgSize, hMsg.TypeID); - if(WLS_MsgEnqueue(&dst->get_queue, hMsg.pIaPaMsg, hMsg.MsgSize, hMsg.TypeID, hMsg.flags, NULL, (void*)dst) == FALSE){ // try to send - if(WLS_MsgEnqueue(&src->put_queue, hMsg.pIaPaMsg, hMsg.MsgSize, hMsg.TypeID, hMsg.flags, NULL, (void*)src) == FALSE){ // return back - WLS_ERROR("wls_process_put: Cannot return block to back to queue \n"); - ret = -1; - } - break; - } - } - else{ - ret = -1; - break; - } - - } - - if(dst->wls_us_private){ - pDstPriv = (wls_us_priv_t*)dst->wls_us_private; - - drv_block.start_time = wls_rdtsc(); - pDstPriv->NeedToWakeUp = 1; - wls_wake_up_user_thread((char *)&drv_block, &pDstPriv->sema); - } - else - ret = -1; - - return ret; -} - -static long wls_ioctl(struct file * filp, unsigned int cmd, unsigned long arg) -{ - struct wls_dev_t * wls_prv = (struct wls_dev_t *)filp->private_data; - void __user * to = (void __user *)arg; - const void __user * from = (const void __user *)arg; - long ret = 0; - - WLS_DEBUG("wls_ioctl PID [%d] ", current->pid); - - if (_IOC_TYPE(cmd) != WLS_IOC_MAGIC) { - return -ENOTTY; - } - - if (_IOC_NR(cmd) >= WLS_IOC_COUNT) { - return -ENOTTY; - } - - switch (cmd) { - case WLS_IOC_OPEN: { - wls_open_req_t param; - - WLS_DEBUG("WLS_IOC_OPEN wls_us_ctx_t %ld\n", sizeof(wls_us_ctx_t)); - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes from user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - - if (sizeof(wls_drv_ctx_t) >= param.size){ - WLS_ERROR("incorrect size %lu > %u\n", sizeof(wls_drv_ctx_t), param.size); - ret = -1; - break; - } - - param.ctx = (uint64_t)wls_create_us_ctx(¶m, wls_prv); - if (param.ctx == 0) { - WLS_ERROR("could not copy %lu bytes to user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - - WLS_DEBUG("WLS_IOC_OPEN: kva %lx pa %lx sz [%d]\n", (long unsigned int)param.ctx, (long unsigned int)param.ctx_pa, param.size); - - ret = copy_to_user(to, (const void *)¶m, sizeof(wls_open_req_t)); - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes to user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - } break; - case WLS_IOC_CLOSE: { - wls_close_req_t param; - - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes from user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - WLS_DEBUG("WLS_IOC_CLOSE: kva %lx pa %lx sz [%d]\n", (long unsigned int)param.ctx, (long unsigned int)param.ctx_pa, param.size); - - ret = wls_destroy_us_ctx(¶m, wls_prv); - - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes from user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - } break; - case WLS_IOC_PUT: { - wls_put_req_t param; - wls_us_ctx_t* pUsCtx = NULL; - -#if defined(_MLOG_TRACE_) - unsigned long t = MLOG_GETTICK(); -#endif - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes from user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } - - pUsCtx = (wls_us_ctx_t*)param.wls_us_kernel_va; - if (pUsCtx == NULL) { - WLS_ERROR("Transaction failed %ld\n", (unsigned long)ret); - break; - } - - if(pUsCtx->dst_kernel_va) - ret = wls_process_put(pUsCtx, (wls_us_ctx_t*)pUsCtx->dst_kernel_va); - - if (ret != 0) { - WLS_ERROR("Transaction failed %ld\n", (unsigned long)ret); - break; - } - - /* clean up for next time */ -#if defined(_MLOG_TRACE_) - MLogTask(PID_WLS_DRV_IOC_PUT, t, MLOG_GETTICK()); -#endif - } break; - case WLS_IOC_EVENT: { - wls_event_req_t param; - - ret = copy_from_user((void *)¶m, from, sizeof(param)); - - if (ret != 0) { - WLS_ERROR("Event %ld failed %ld\n", (unsigned long)param.event_to_wls, - (unsigned long)ret); - break; - } - }break; - case WLS_IOC_WAIT: { - wls_wait_req_t param; - wls_us_ctx_t* pUsCtx = NULL; - wls_us_priv_t* pUsPriv = NULL; -#if defined(_MLOG_TRACE_) - unsigned long t = MLOG_GETTICK(); - MLogTask(PID_WLS_DRV_IOC_WAIT_WAKE_ENTRY, t, 1250+t); -#endif - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("Wait failed %ld\n", (unsigned long)ret); - break; - } - - WLS_DEBUG("Wait pUsCtx 0x%016lx\n", (unsigned long)param.wls_us_kernel_va); - pUsCtx = (wls_us_ctx_t*) param.wls_us_kernel_va; - if(pUsCtx == NULL) { - ret = -EINVAL; - WLS_ERROR("Wait failed on User context %ld\n", (unsigned long)ret); - break; - } - - pUsPriv = (wls_us_priv_t*) pUsCtx->wls_us_private; - WLS_DEBUG("Wait pUsPriv 0x%016lx\n", (unsigned long)pUsPriv); - - if(pUsPriv == NULL) { - ret = -EINVAL; - WLS_ERROR("Wait failed %ld\n", (unsigned long)ret); - break; - } - pUsPriv->isWait = 1; - wls_wait(&pUsPriv->sema, (unsigned long)from); - pUsPriv->isWait = 0; - memset(¶m, 0, sizeof(wls_wait_req_t)); - param.nMsg = wls_process_wait(pUsCtx); - -#if defined(_MLOG_TRACE_) - t = MLOG_GETTICK(); -#endif - ret = copy_to_user(to, (const void *)¶m, sizeof(wls_wait_req_t)); - if (ret != 0) { - WLS_ERROR("could not copy %lu bytes to user 0x%08lx", - (unsigned long)ret, (unsigned long)from); - break; - } -#if defined(_MLOG_TRACE_) - MLogTask(PID_WLS_DRV_IOC_WAIT_WAKE_UP, t, MLOG_GETTICK()); -#endif - } break; - case WLS_IOC_WAKE_UP: { - wls_wait_req_t param; - wls_us_ctx_t* pUsCtx = NULL; - wls_us_priv_t* pUsPriv = NULL; - wls_wait_req_t drv_block; - - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("WLS_IOC_WAKE_UP failed %ld\n", - (unsigned long)ret); - break; - } - - WLS_DEBUG("Wait pUsCtx 0x%016lx\n", (unsigned long)param.wls_us_kernel_va); - pUsCtx = (wls_us_ctx_t*) param.wls_us_kernel_va; - if(pUsCtx == NULL) { - ret = -EINVAL; - WLS_ERROR("Wait failed on User context %ld\n", (unsigned long)ret); - break; - } - - pUsPriv = (wls_us_priv_t*) pUsCtx->wls_us_private; - WLS_DEBUG("Wait pUsPriv 0x%016lx\n", (unsigned long)pUsPriv); - - if(pUsPriv == NULL) { - ret = -EINVAL; - WLS_ERROR("Wait failed %ld\n", (unsigned long)ret); - break; - } - - drv_block.start_time = wls_rdtsc(); - wls_wake_up_user_thread((char *)&drv_block, &pUsPriv->sema); - } break; - case WLS_IOC_CONNECT: { - wls_connect_req_t param; - wls_us_priv_t* pUsPriv = NULL; - wls_wait_req_t drv_block; - - ret = copy_from_user((void *)¶m, from, sizeof(param)); - if (ret != 0) { - WLS_ERROR("WLS_IOC_WAKE_UP failed %ld\n", - (unsigned long)ret); - break; - } - - pUsPriv = (wls_us_priv_t*)param.wls_us_kernel_va; - drv_block.start_time = wls_rdtsc(); - wls_wake_up_user_thread((char *)&drv_block, &pUsPriv->sema); - } break; - default:{ - WLS_ERROR("unknown ioctl cmd: '0x%08x'", cmd); - BUG(); - } break; - } - - if (ret != 0) { - WLS_ERROR("cmd_%x failed: %ld", cmd, ret); - } - - return ret; -} - -static int wls_mmap(struct file * filp, struct vm_area_struct * vma) -{ - struct wls_dev_t * wls = (struct wls_dev_t *)filp->private_data; - - WLS_DEBUG("priv: 0x%p", filp->private_data); - WLS_DEBUG("WLS_mmap : mmap function called \n"); - WLS_DEBUG("vma->start =%lx\n",vma->vm_start); - WLS_DEBUG("vma->end =%lx\n",vma->vm_end); - - // non cached -// vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); - - WLS_DEBUG("vma->pgoff =%lx\n",vma->vm_pgoff); - - if (wls == NULL) { - WLS_ERROR("WLS is NULL"); - return -EIO; - } - - return remap_pfn_range(vma,vma->vm_start,vma->vm_pgoff,vma->vm_end-vma->vm_start,\ - vma->vm_page_prot); -} - -static int __init wls_init(void) -{ - struct wls_dev_t* wls_dev_loc = NULL; - int res = 0; - dev_t dev_no = 0; - int minor_no = 0; - int dev_cnt = 0; - - memset(&wls_dev[0], 0, sizeof(struct wls_dev_t*) * WLS_MAX_CLIENTS); - - snprintf(wls_driver_version, 10, WLS_DRV_VERSION_FORMAT, WLS_VERSION_X, WLS_VERSION_Y, WLS_VERSION_Z); - - WLS_PRINT("Intel(R) Wireless Subsystem Communication interface - %s\n", wls_driver_version); - WLS_PRINT("Copyright(c) 2014 Intel Corporation.\n"); - //WLS_PRINT("Build: Date: %s Time: %s\n", __DATE__, __TIME__); - - if ((wlsMaxClients > WLS_MAX_CLIENTS) || (wlsMaxClients < 1)) - { - WLS_ERROR("Invalid wlsMaxClients %d\n", wlsMaxClients); - wlsMaxClients = 1; - } - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - wls_dev_loc = (struct wls_dev_t *)kzalloc(sizeof(struct wls_dev_t), GFP_KERNEL); - WLS_DEBUG("wls_dev_loc %d %p", dev_cnt, wls_dev_loc); - - if (wls_dev_loc == NULL) { - WLS_ERROR("no free memory (wanted %ld bytes)", sizeof(struct wls_dev_t)); - res = -ENOMEM; - goto err0; - } - wls_dev[dev_cnt] = wls_dev_loc; - WLS_DEBUG("wls_init [%d]: 0x%p",dev_cnt, wls_dev[dev_cnt]); - } - - res = alloc_chrdev_region(&dev_no, minor_no, wlsMaxClients, MODNAME); - if (res < 0) { - WLS_ERROR("failed alloc char dev region: %d", res); - goto err0; - } - - wls_class = class_create(THIS_MODULE, wls_driver_name); - - wls_dev_loc = wls_dev[0]; - wls_dev_loc->dev_no = dev_no; - - cdev_init(&wls_dev_loc->cdev, &wls_fops); - wls_dev_loc->cdev.owner = THIS_MODULE; - wls_dev_loc->cdev.ops = &wls_fops; - res = cdev_add(&wls_dev_loc->cdev, dev_no, wlsMaxClients); - - if (res) { - WLS_ERROR("failed add char dev: %d", res); - res = -1; - goto err2; - } - - if (IS_ERR((void *)wls_class)) { - WLS_ERROR("failed create class"); - res = -EIO; - goto err1; - } - - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - wls_dev_loc = wls_dev[dev_cnt]; - if (wls_dev_loc == NULL ) { - WLS_ERROR("wls_dev_loc is NULL"); - goto err2; - } - - if(wlsMaxClients > 1){ - snprintf(wls_dev_device_name, 10, WLS_DEV_DEVICE_FORMAT, dev_cnt); - } else { - snprintf(wls_dev_device_name, 10, "%s", MODNAME); - } - - wls_dev_loc->dev_no = MKDEV(MAJOR(dev_no), dev_cnt); - wls_dev_loc->device = device_create(wls_class, NULL, wls_dev_loc->dev_no, NULL, wls_dev_device_name); - - if (IS_ERR((void *)wls_dev_loc->device)) { - WLS_ERROR("failed create / device"); - res = -2; - goto err2; - } - - dev_info(wls_dev_loc->device, "Device: %s\n", wls_dev_device_name); - mutex_init(&wls_dev_loc->lock); - - wls_dev_loc->pWlsDrvCtx = wls_get_ctx(dev_cnt); - - if (wls_dev_loc->pWlsDrvCtx == NULL) { - WLS_ERROR("failed wls_get_ctx(%d)", dev_cnt); - res = -3; - goto err2; - } - - //return res; -// dev_no++; - continue; - } - WLS_PRINT("init %d /dev/wlsX communication devices [0-%d]\n", dev_cnt, dev_cnt-1); - return res; - - err2: - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - wls_dev_loc = wls_dev[dev_cnt]; - if(wls_dev_loc){ - device_destroy(wls_class, wls_dev_loc->dev_no); - cdev_del(&wls_dev_loc->cdev); - } - } - class_destroy(wls_class); - err1: - unregister_chrdev_region(wls_dev[0]->dev_no, wlsMaxClients); - err0: - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - if(wls_dev[dev_cnt]){ - kfree(wls_dev[dev_cnt]); - wls_dev[dev_cnt] = NULL; - } - } - - WLS_ERROR("init failed"); - return -1; -} - -static void __exit wls_exit(void) -{ - struct wls_dev_t* wls_dev_loc = NULL; - int dev_cnt = 0; - - if (wls_dev[0]) { - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - wls_dev_loc = wls_dev[dev_cnt]; - device_destroy(wls_class, wls_dev_loc->dev_no); - } - wls_dev_loc = wls_dev[0]; - - cdev_del(&wls_dev_loc->cdev); - class_destroy(wls_class); - - unregister_chrdev_region(wls_dev[0]->dev_no, wlsMaxClients); - - for (dev_cnt = 0; dev_cnt < wlsMaxClients; dev_cnt++){ - if(wls_dev[dev_cnt]){ - kfree(wls_dev[dev_cnt]); - wls_dev[dev_cnt] = NULL; - } - } - } - - WLS_PRINT("Intel(R) Wireless Subsystem Communication interface - %s was removed\n", wls_driver_version); -} - -MODULE_DESCRIPTION("Wirelsess Sybsytem Communication interface"); -MODULE_AUTHOR("Intel Corporation"); -MODULE_LICENSE("GPL v2"); -MODULE_VERSION("WLS_DRV_VERSION_FORMAT"); - -module_init(wls_init); -module_exit(wls_exit);