osdep_service.rar_the code

/****************************************************************************** * * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * * You should have received a copy of the GNU General Public License along with * this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA * * ******************************************************************************/ #define _OSDEP_SERVICE_C_ #include <osdep_service.h> #include <osdep_intf.h> #include <drv_types.h> #include <recv_osdep.h> #include <linux/vmalloc.h> #include <rtw_ioctl_set.h> /* * Translate the OS dependent @param error_code to OS independent RTW_STATUS_CODE * @return: one of RTW_STATUS_CODE */ inline int RTW_STATUS_CODE(int error_code) { if (error_code >= 0) return _SUCCESS; return _FAIL; } u8 *_rtw_malloc(u32 sz) { u8 *pbuf = NULL; pbuf = kmalloc(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); return pbuf; } void *rtw_malloc2d(int h, int w, int size) { int j; void **a = kzalloc(h*sizeof(void *) + h*w*size, GFP_KERNEL); if (a == NULL) { pr_info("%s: alloc memory fail!\n", __func__); return NULL; } for (j = 0; j < h; j++) a[j] = ((char *)(a+h)) + j*w*size; return a; } u32 _rtw_down_sema(struct semaphore *sema) { if (down_interruptible(sema)) return _FAIL; else return _SUCCESS; } void _rtw_init_queue(struct __queue *pqueue) { INIT_LIST_HEAD(&(pqueue->queue)); spin_lock_init(&(pqueue->lock)); } /* the input parameter start must be in jiffies */ inline s32 rtw_get_passing_time_ms(u32 start) { return jiffies_to_msecs(jiffies-start); } struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv) { struct net_device *pnetdev; struct rtw_netdev_priv_indicator *pnpi; pnetdev = alloc_etherdev_mq(sizeof(struct rtw_netdev_priv_indicator), 4); if (!pnetdev) goto RETURN; pnpi = netdev_priv(pnetdev); pnpi->priv = old_priv; pnpi->sizeof_priv = sizeof_priv; RETURN: return pnetdev; } void rtw_free_netdev(struct net_device *netdev) { struct rtw_netdev_priv_indicator *pnpi; if (!netdev) goto RETURN; pnpi = netdev_priv(netdev); if (!pnpi->priv) goto RETURN; vfree(pnpi->priv); free_netdev(netdev); RETURN: return; } u64 rtw_modular64(u64 x, u64 y) { return do_div(x, y); } void rtw_buf_free(u8 **buf, u32 *buf_len) { *buf_len = 0; kfree(*buf); *buf = NULL; } void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len) { u32 ori_len = 0, dup_len = 0; u8 *ori = NULL; u8 *dup = NULL; if (!buf || !buf_len) return; if (!src || !src_len) goto keep_ori; /* duplicate src */ dup = rtw_malloc(src_len); if (dup) { dup_len = src_len; memcpy(dup, src, dup_len); } keep_ori: ori = *buf; ori_len = *buf_len; /* replace buf with dup */ *buf_len = 0; *buf = dup; *buf_len = dup_len; /* free ori */ kfree(ori); }