linux_osl.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925
  1. /*
  2. * Linux OS Independent Layer
  3. *
  4. * Copyright (C) 1999-2011, Broadcom Corporation
  5. *
  6. * Unless you and Broadcom execute a separate written software license
  7. * agreement governing use of this software, this software is licensed to you
  8. * under the terms of the GNU General Public License version 2 (the "GPL"),
  9. * available at http://www.broadcom.com/licenses/GPLv2.php, with the
  10. * following added to such license:
  11. *
  12. * As a special exception, the copyright holders of this software give you
  13. * permission to link this software with independent modules, and to copy and
  14. * distribute the resulting executable under terms of your choice, provided that
  15. * you also meet, for each linked independent module, the terms and conditions of
  16. * the license of that module. An independent module is a module which is not
  17. * derived from this software. The special exception does not apply to any
  18. * modifications of the software.
  19. *
  20. * Notwithstanding the above, under no circumstances may you combine this
  21. * software in any way with any other Broadcom software provided under a license
  22. * other than the GPL, without Broadcom's express prior written consent.
  23. *
  24. * $Id: linux_osl.c,v 1.168.2.7 2011-01-27 17:01:13 $
  25. */
  26. #define LINUX_PORT
  27. #include <typedefs.h>
  28. #include <bcmendian.h>
  29. #include <linuxver.h>
  30. #include <bcmdefs.h>
  31. #include <osl.h>
  32. #include <bcmutils.h>
  33. #include <linux/delay.h>
  34. #include <pcicfg.h>
  35. #ifdef BCMASSERT_LOG
  36. #include <bcm_assert_log.h>
  37. #endif
  38. #include <linux/fs.h>
  39. #define PCI_CFG_RETRY 10
  40. #define OS_HANDLE_MAGIC 0x1234abcd
  41. #define BCM_MEM_FILENAME_LEN 24
  42. #ifdef CONFIG_DHD_USE_STATIC_BUF
  43. #define STATIC_BUF_MAX_NUM 16
  44. #define STATIC_BUF_SIZE (PAGE_SIZE * 2)
  45. #define STATIC_BUF_TOTAL_LEN (STATIC_BUF_MAX_NUM * STATIC_BUF_SIZE)
  46. typedef struct bcm_static_buf {
  47. struct semaphore static_sem;
  48. unsigned char *buf_ptr;
  49. unsigned char buf_use[STATIC_BUF_MAX_NUM];
  50. } bcm_static_buf_t;
  51. static bcm_static_buf_t *bcm_static_buf = 0;
  52. #define STATIC_PKT_MAX_NUM 8
  53. typedef struct bcm_static_pkt {
  54. struct sk_buff *skb_4k[STATIC_PKT_MAX_NUM];
  55. struct sk_buff *skb_8k[STATIC_PKT_MAX_NUM];
  56. struct semaphore osl_pkt_sem;
  57. unsigned char pkt_use[STATIC_PKT_MAX_NUM * 2];
  58. } bcm_static_pkt_t;
  59. static bcm_static_pkt_t *bcm_static_skb = 0;
  60. #endif
  61. typedef struct bcm_mem_link {
  62. struct bcm_mem_link *prev;
  63. struct bcm_mem_link *next;
  64. uint size;
  65. int line;
  66. char file[BCM_MEM_FILENAME_LEN];
  67. } bcm_mem_link_t;
  68. struct osl_info {
  69. osl_pubinfo_t pub;
  70. #ifdef CTFPOOL
  71. ctfpool_t *ctfpool;
  72. #endif
  73. uint magic;
  74. void *pdev;
  75. atomic_t malloced;
  76. uint failed;
  77. uint bustype;
  78. bcm_mem_link_t *dbgmem_list;
  79. };
  80. uint32 g_assert_type = FALSE;
  81. static int16 linuxbcmerrormap[] =
  82. { 0,
  83. -EINVAL,
  84. -EINVAL,
  85. -EINVAL,
  86. -EINVAL,
  87. -EINVAL,
  88. -EINVAL,
  89. -EINVAL,
  90. -EINVAL,
  91. -EINVAL,
  92. -EINVAL,
  93. -EINVAL,
  94. -EINVAL,
  95. -EINVAL,
  96. -E2BIG,
  97. -E2BIG,
  98. -EBUSY,
  99. -EINVAL,
  100. -EINVAL,
  101. -EINVAL,
  102. -EINVAL,
  103. -EFAULT,
  104. -ENOMEM,
  105. -EOPNOTSUPP,
  106. -EMSGSIZE,
  107. -EINVAL,
  108. -EPERM,
  109. -ENOMEM,
  110. -EINVAL,
  111. -ERANGE,
  112. -EINVAL,
  113. -EINVAL,
  114. -EINVAL,
  115. -EINVAL,
  116. -EINVAL,
  117. -EIO,
  118. -ENODEV,
  119. -EINVAL,
  120. -EIO,
  121. -EIO,
  122. -ENODEV,
  123. -EINVAL,
  124. -ENODATA,
  125. #if BCME_LAST != -42
  126. #error "You need to add a OS error translation in the linuxbcmerrormap \
  127. for new error code defined in bcmutils.h"
  128. #endif
  129. };
  130. int
  131. osl_error(int bcmerror)
  132. {
  133. if (bcmerror > 0)
  134. bcmerror = 0;
  135. else if (bcmerror < BCME_LAST)
  136. bcmerror = BCME_ERROR;
  137. return linuxbcmerrormap[-bcmerror];
  138. }
  139. extern uint8* dhd_os_prealloc(void *osh, int section, int size);
  140. osl_t *
  141. osl_attach(void *pdev, uint bustype, bool pkttag)
  142. {
  143. osl_t *osh;
  144. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25))
  145. gfp_t flags;
  146. flags = (in_atomic()) ? GFP_ATOMIC : GFP_KERNEL;
  147. osh = kmalloc(sizeof(osl_t), flags);
  148. #else
  149. osh = kmalloc(sizeof(osl_t), GFP_ATOMIC);
  150. #endif
  151. ASSERT(osh);
  152. bzero(osh, sizeof(osl_t));
  153. ASSERT(ABS(BCME_LAST) == (ARRAYSIZE(linuxbcmerrormap) - 1));
  154. osh->magic = OS_HANDLE_MAGIC;
  155. atomic_set(&osh->malloced, 0);
  156. osh->failed = 0;
  157. osh->dbgmem_list = NULL;
  158. osh->pdev = pdev;
  159. osh->pub.pkttag = pkttag;
  160. osh->bustype = bustype;
  161. switch (bustype) {
  162. case PCI_BUS:
  163. case SI_BUS:
  164. case PCMCIA_BUS:
  165. osh->pub.mmbus = TRUE;
  166. break;
  167. case JTAG_BUS:
  168. case SDIO_BUS:
  169. case USB_BUS:
  170. case SPI_BUS:
  171. case RPC_BUS:
  172. osh->pub.mmbus = FALSE;
  173. break;
  174. default:
  175. ASSERT(FALSE);
  176. break;
  177. }
  178. #if defined(CONFIG_DHD_USE_STATIC_BUF)
  179. if (!bcm_static_buf) {
  180. if (!(bcm_static_buf = (bcm_static_buf_t *)dhd_os_prealloc(osh, 3, STATIC_BUF_SIZE+
  181. STATIC_BUF_TOTAL_LEN))) {
  182. printk("can not alloc static buf!\n");
  183. }
  184. else
  185. printk("alloc static buf at %x!\n", (unsigned int)bcm_static_buf);
  186. sema_init(&bcm_static_buf->static_sem, 1);
  187. bcm_static_buf->buf_ptr = (unsigned char *)bcm_static_buf + STATIC_BUF_SIZE;
  188. }
  189. if (!bcm_static_skb) {
  190. int i;
  191. void *skb_buff_ptr = 0;
  192. bcm_static_skb = (bcm_static_pkt_t *)((char *)bcm_static_buf + 2048);
  193. skb_buff_ptr = dhd_os_prealloc(osh, 4, 0);
  194. bcopy(skb_buff_ptr, bcm_static_skb, sizeof(struct sk_buff *) * 16);
  195. for (i = 0; i < STATIC_PKT_MAX_NUM * 2; i++)
  196. bcm_static_skb->pkt_use[i] = 0;
  197. sema_init(&bcm_static_skb->osl_pkt_sem, 1);
  198. }
  199. #endif
  200. return osh;
  201. }
  202. void
  203. osl_detach(osl_t *osh)
  204. {
  205. if (osh == NULL)
  206. return;
  207. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  208. kfree(osh);
  209. }
  210. static struct sk_buff *osl_alloc_skb(unsigned int len)
  211. {
  212. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)
  213. gfp_t flags = (in_atomic()) ? GFP_ATOMIC : GFP_KERNEL;
  214. return __dev_alloc_skb(len, flags);
  215. #else
  216. return dev_alloc_skb(len);
  217. #endif
  218. }
  219. #ifdef CTFPOOL
  220. void *
  221. osl_ctfpool_add(osl_t *osh)
  222. {
  223. struct sk_buff *skb;
  224. if ((osh == NULL) || (osh->ctfpool == NULL))
  225. return NULL;
  226. spin_lock_bh(&osh->ctfpool->lock);
  227. ASSERT(osh->ctfpool->curr_obj <= osh->ctfpool->max_obj);
  228. if (osh->ctfpool->curr_obj == osh->ctfpool->max_obj) {
  229. spin_unlock_bh(&osh->ctfpool->lock);
  230. return NULL;
  231. }
  232. skb = osl_alloc_skb(osh->ctfpool->obj_size);
  233. if (skb == NULL) {
  234. printf("%s: skb alloc of len %d failed\n", __FUNCTION__,
  235. osh->ctfpool->obj_size);
  236. spin_unlock_bh(&osh->ctfpool->lock);
  237. return NULL;
  238. }
  239. skb->next = (struct sk_buff *)osh->ctfpool->head;
  240. osh->ctfpool->head = skb;
  241. osh->ctfpool->fast_frees++;
  242. osh->ctfpool->curr_obj++;
  243. CTFPOOLPTR(osh, skb) = (void *)osh->ctfpool;
  244. PKTFAST(osh, skb) = FASTBUF;
  245. spin_unlock_bh(&osh->ctfpool->lock);
  246. return skb;
  247. }
  248. void
  249. osl_ctfpool_replenish(osl_t *osh, uint thresh)
  250. {
  251. if ((osh == NULL) || (osh->ctfpool == NULL))
  252. return;
  253. while ((osh->ctfpool->refills > 0) && (thresh--)) {
  254. osl_ctfpool_add(osh);
  255. osh->ctfpool->refills--;
  256. }
  257. }
  258. int32
  259. osl_ctfpool_init(osl_t *osh, uint numobj, uint size)
  260. {
  261. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25))
  262. gfp_t flags;
  263. flags = (in_atomic()) ? GFP_ATOMIC : GFP_KERNEL;
  264. osh->ctfpool = kmalloc(sizeof(ctfpool_t), flags);
  265. #else
  266. osh->ctfpool = kmalloc(sizeof(ctfpool_t), GFP_ATOMIC);
  267. #endif
  268. ASSERT(osh->ctfpool);
  269. bzero(osh->ctfpool, sizeof(ctfpool_t));
  270. osh->ctfpool->max_obj = numobj;
  271. osh->ctfpool->obj_size = size;
  272. spin_lock_init(&osh->ctfpool->lock);
  273. while (numobj--) {
  274. if (!osl_ctfpool_add(osh))
  275. return -1;
  276. osh->ctfpool->fast_frees--;
  277. }
  278. return 0;
  279. }
  280. void
  281. osl_ctfpool_cleanup(osl_t *osh)
  282. {
  283. struct sk_buff *skb, *nskb;
  284. if ((osh == NULL) || (osh->ctfpool == NULL))
  285. return;
  286. spin_lock_bh(&osh->ctfpool->lock);
  287. skb = osh->ctfpool->head;
  288. while (skb != NULL) {
  289. nskb = skb->next;
  290. dev_kfree_skb(skb);
  291. skb = nskb;
  292. osh->ctfpool->curr_obj--;
  293. }
  294. ASSERT(osh->ctfpool->curr_obj == 0);
  295. osh->ctfpool->head = NULL;
  296. spin_unlock_bh(&osh->ctfpool->lock);
  297. kfree(osh->ctfpool);
  298. osh->ctfpool = NULL;
  299. }
  300. void
  301. osl_ctfpool_stats(osl_t *osh, void *b)
  302. {
  303. struct bcmstrbuf *bb;
  304. if ((osh == NULL) || (osh->ctfpool == NULL))
  305. return;
  306. #ifdef CONFIG_DHD_USE_STATIC_BUF
  307. if (bcm_static_buf) {
  308. bcm_static_buf = 0;
  309. }
  310. if (bcm_static_skb) {
  311. bcm_static_skb = 0;
  312. }
  313. #endif
  314. bb = b;
  315. ASSERT((osh != NULL) && (bb != NULL));
  316. bcm_bprintf(bb, "max_obj %d obj_size %d curr_obj %d refills %d\n",
  317. osh->ctfpool->max_obj, osh->ctfpool->obj_size,
  318. osh->ctfpool->curr_obj, osh->ctfpool->refills);
  319. bcm_bprintf(bb, "fast_allocs %d fast_frees %d slow_allocs %d\n",
  320. osh->ctfpool->fast_allocs, osh->ctfpool->fast_frees,
  321. osh->ctfpool->slow_allocs);
  322. }
  323. static inline struct sk_buff *
  324. osl_pktfastget(osl_t *osh, uint len)
  325. {
  326. struct sk_buff *skb;
  327. if (osh->ctfpool == NULL)
  328. return NULL;
  329. spin_lock_bh(&osh->ctfpool->lock);
  330. if (osh->ctfpool->head == NULL) {
  331. ASSERT(osh->ctfpool->curr_obj == 0);
  332. osh->ctfpool->slow_allocs++;
  333. spin_unlock_bh(&osh->ctfpool->lock);
  334. return NULL;
  335. }
  336. ASSERT(len <= osh->ctfpool->obj_size);
  337. skb = (struct sk_buff *)osh->ctfpool->head;
  338. osh->ctfpool->head = (void *)skb->next;
  339. osh->ctfpool->fast_allocs++;
  340. osh->ctfpool->curr_obj--;
  341. ASSERT(CTFPOOLHEAD(osh, skb) == (struct sock *)osh->ctfpool->head);
  342. spin_unlock_bh(&osh->ctfpool->lock);
  343. skb->next = skb->prev = NULL;
  344. skb->data = skb->head + 16;
  345. skb->tail = skb->head + 16;
  346. skb->len = 0;
  347. skb->cloned = 0;
  348. #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 14)
  349. skb->list = NULL;
  350. #endif
  351. atomic_set(&skb->users, 1);
  352. return skb;
  353. }
  354. #endif
  355. void * BCMFASTPATH
  356. osl_pktget(osl_t *osh, uint len)
  357. {
  358. struct sk_buff *skb;
  359. #ifdef CTFPOOL
  360. skb = osl_pktfastget(osh, len);
  361. if ((skb != NULL) || ((skb = osl_alloc_skb(len)) != NULL)) {
  362. #else
  363. if ((skb = osl_alloc_skb(len))) {
  364. #endif
  365. skb_put(skb, len);
  366. skb->priority = 0;
  367. osh->pub.pktalloced++;
  368. }
  369. return ((void*) skb);
  370. }
  371. #ifdef CTFPOOL
  372. static inline void
  373. osl_pktfastfree(osl_t *osh, struct sk_buff *skb)
  374. {
  375. ctfpool_t *ctfpool;
  376. ctfpool = (ctfpool_t *)CTFPOOLPTR(osh, skb);
  377. ASSERT(ctfpool != NULL);
  378. spin_lock_bh(&ctfpool->lock);
  379. skb->next = (struct sk_buff *)ctfpool->head;
  380. ctfpool->head = (void *)skb;
  381. ctfpool->fast_frees++;
  382. ctfpool->curr_obj++;
  383. ASSERT(ctfpool->curr_obj <= ctfpool->max_obj);
  384. spin_unlock_bh(&ctfpool->lock);
  385. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14)
  386. skb->tstamp.tv.sec = 0;
  387. #else
  388. skb->stamp.tv_sec = 0;
  389. #endif
  390. skb->dev = NULL;
  391. skb->dst = NULL;
  392. memset(skb->cb, 0, sizeof(skb->cb));
  393. skb->ip_summed = 0;
  394. skb->destructor = NULL;
  395. }
  396. #endif
  397. void BCMFASTPATH
  398. osl_pktfree(osl_t *osh, void *p, bool send)
  399. {
  400. struct sk_buff *skb, *nskb;
  401. skb = (struct sk_buff*) p;
  402. if (send && osh->pub.tx_fn)
  403. osh->pub.tx_fn(osh->pub.tx_ctx, p, 0);
  404. while (skb) {
  405. nskb = skb->next;
  406. skb->next = NULL;
  407. #ifdef CTFPOOL
  408. if (PKTISFAST(osh, skb))
  409. osl_pktfastfree(osh, skb);
  410. else {
  411. #else
  412. {
  413. #endif
  414. if (skb->destructor)
  415. dev_kfree_skb_any(skb);
  416. else
  417. dev_kfree_skb(skb);
  418. }
  419. osh->pub.pktalloced--;
  420. skb = nskb;
  421. }
  422. }
  423. #ifdef CONFIG_DHD_USE_STATIC_BUF
  424. void *
  425. osl_pktget_static(osl_t *osh, uint len)
  426. {
  427. int i;
  428. struct sk_buff *skb;
  429. if (!bcm_static_skb || (len > (PAGE_SIZE * 2))) {
  430. printk("%s: attempt to allocate huge packet (0x%x)\n", __FUNCTION__, len);
  431. return osl_pktget(osh, len);
  432. }
  433. down(&bcm_static_skb->osl_pkt_sem);
  434. if (len <= PAGE_SIZE) {
  435. for (i = 0; i < STATIC_PKT_MAX_NUM; i++) {
  436. if (bcm_static_skb->pkt_use[i] == 0)
  437. break;
  438. }
  439. if (i != STATIC_PKT_MAX_NUM) {
  440. bcm_static_skb->pkt_use[i] = 1;
  441. skb = bcm_static_skb->skb_4k[i];
  442. skb->tail = skb->data + len;
  443. skb->len = len;
  444. up(&bcm_static_skb->osl_pkt_sem);
  445. return skb;
  446. }
  447. }
  448. for (i = 0; i < STATIC_PKT_MAX_NUM; i++) {
  449. if (bcm_static_skb->pkt_use[i+STATIC_PKT_MAX_NUM] == 0)
  450. break;
  451. }
  452. if (i != STATIC_PKT_MAX_NUM) {
  453. bcm_static_skb->pkt_use[i+STATIC_PKT_MAX_NUM] = 1;
  454. skb = bcm_static_skb->skb_8k[i];
  455. skb->tail = skb->data + len;
  456. skb->len = len;
  457. up(&bcm_static_skb->osl_pkt_sem);
  458. return skb;
  459. }
  460. up(&bcm_static_skb->osl_pkt_sem);
  461. printk("%s: all static pkt in use!\n", __FUNCTION__);
  462. return osl_pktget(osh, len);
  463. }
  464. void
  465. osl_pktfree_static(osl_t *osh, void *p, bool send)
  466. {
  467. int i;
  468. if (!bcm_static_skb) {
  469. osl_pktfree(osh, p, send);
  470. return;
  471. }
  472. down(&bcm_static_skb->osl_pkt_sem);
  473. for (i = 0; i < STATIC_PKT_MAX_NUM; i++) {
  474. if (p == bcm_static_skb->skb_4k[i]) {
  475. bcm_static_skb->pkt_use[i] = 0;
  476. up(&bcm_static_skb->osl_pkt_sem);
  477. return;
  478. }
  479. }
  480. for (i = 0; i < STATIC_PKT_MAX_NUM; i++) {
  481. if (p == bcm_static_skb->skb_8k[i]) {
  482. bcm_static_skb->pkt_use[i + STATIC_PKT_MAX_NUM] = 0;
  483. up(&bcm_static_skb->osl_pkt_sem);
  484. return;
  485. }
  486. }
  487. up(&bcm_static_skb->osl_pkt_sem);
  488. osl_pktfree(osh, p, send);
  489. return;
  490. }
  491. #endif
  492. uint32
  493. osl_pci_read_config(osl_t *osh, uint offset, uint size)
  494. {
  495. uint val = 0;
  496. uint retry = PCI_CFG_RETRY;
  497. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  498. ASSERT(size == 4);
  499. do {
  500. pci_read_config_dword(osh->pdev, offset, &val);
  501. if (val != 0xffffffff)
  502. break;
  503. } while (retry--);
  504. return (val);
  505. }
  506. void
  507. osl_pci_write_config(osl_t *osh, uint offset, uint size, uint val)
  508. {
  509. uint retry = PCI_CFG_RETRY;
  510. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  511. ASSERT(size == 4);
  512. do {
  513. pci_write_config_dword(osh->pdev, offset, val);
  514. if (offset != PCI_BAR0_WIN)
  515. break;
  516. if (osl_pci_read_config(osh, offset, size) == val)
  517. break;
  518. } while (retry--);
  519. }
  520. uint
  521. osl_pci_bus(osl_t *osh)
  522. {
  523. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  524. return ((struct pci_dev *)osh->pdev)->bus->number;
  525. }
  526. uint
  527. osl_pci_slot(osl_t *osh)
  528. {
  529. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  530. return PCI_SLOT(((struct pci_dev *)osh->pdev)->devfn);
  531. }
  532. static void
  533. osl_pcmcia_attr(osl_t *osh, uint offset, char *buf, int size, bool write)
  534. {
  535. }
  536. void
  537. osl_pcmcia_read_attr(osl_t *osh, uint offset, void *buf, int size)
  538. {
  539. osl_pcmcia_attr(osh, offset, (char *) buf, size, FALSE);
  540. }
  541. void
  542. osl_pcmcia_write_attr(osl_t *osh, uint offset, void *buf, int size)
  543. {
  544. osl_pcmcia_attr(osh, offset, (char *) buf, size, TRUE);
  545. }
  546. void *
  547. osl_malloc(osl_t *osh, uint size)
  548. {
  549. void *addr;
  550. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25))
  551. gfp_t flags;
  552. if (osh)
  553. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  554. flags = (in_atomic()) ? GFP_ATOMIC : GFP_KERNEL;
  555. if ((addr = kmalloc(size, flags)) == NULL) {
  556. #else
  557. if ((addr = kmalloc(size, GFP_ATOMIC)) == NULL) {
  558. #endif
  559. if (osh)
  560. osh->failed++;
  561. return (NULL);
  562. }
  563. if (osh)
  564. atomic_add(size, &osh->malloced);
  565. return (addr);
  566. }
  567. void
  568. osl_mfree(osl_t *osh, void *addr, uint size)
  569. {
  570. if (osh) {
  571. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  572. atomic_sub(size, &osh->malloced);
  573. }
  574. kfree(addr);
  575. }
  576. uint
  577. osl_malloced(osl_t *osh)
  578. {
  579. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  580. return (atomic_read(&osh->malloced));
  581. }
  582. uint
  583. osl_malloc_failed(osl_t *osh)
  584. {
  585. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  586. return (osh->failed);
  587. }
  588. uint
  589. osl_dma_consistent_align(void)
  590. {
  591. return (PAGE_SIZE);
  592. }
  593. void*
  594. osl_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits, uint *alloced, ulong *pap)
  595. {
  596. uint16 align = (1 << align_bits);
  597. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  598. if (!ISALIGNED(DMA_CONSISTENT_ALIGN, align))
  599. size += align;
  600. *alloced = size;
  601. return (pci_alloc_consistent(osh->pdev, size, (dma_addr_t*)pap));
  602. }
  603. void
  604. osl_dma_free_consistent(osl_t *osh, void *va, uint size, ulong pa)
  605. {
  606. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  607. pci_free_consistent(osh->pdev, size, va, (dma_addr_t)pa);
  608. }
  609. uint BCMFASTPATH
  610. osl_dma_map(osl_t *osh, void *va, uint size, int direction)
  611. {
  612. int dir;
  613. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  614. dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
  615. return (pci_map_single(osh->pdev, va, size, dir));
  616. }
  617. void BCMFASTPATH
  618. osl_dma_unmap(osl_t *osh, uint pa, uint size, int direction)
  619. {
  620. int dir;
  621. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  622. dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
  623. pci_unmap_single(osh->pdev, (uint32)pa, size, dir);
  624. }
  625. #if defined(BCMASSERT_LOG)
  626. void
  627. osl_assert(char *exp, char *file, int line)
  628. {
  629. char tempbuf[256];
  630. char *basename;
  631. basename = strrchr(file, '/');
  632. if (basename)
  633. basename++;
  634. if (!basename)
  635. basename = file;
  636. #ifdef BCMASSERT_LOG
  637. snprintf(tempbuf, 64, "\"%s\": file \"%s\", line %d\n",
  638. exp, basename, line);
  639. bcm_assert_log(tempbuf);
  640. #endif
  641. }
  642. #endif
  643. void
  644. osl_delay(uint usec)
  645. {
  646. uint d;
  647. while (usec > 0) {
  648. d = MIN(usec, 1000);
  649. udelay(d);
  650. usec -= d;
  651. }
  652. }
  653. void *
  654. osl_pktdup(osl_t *osh, void *skb)
  655. {
  656. void * p;
  657. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25))
  658. gfp_t flags;
  659. flags = (in_atomic()) ? GFP_ATOMIC : GFP_KERNEL;
  660. if ((p = skb_clone((struct sk_buff *)skb, flags)) == NULL)
  661. #else
  662. if ((p = skb_clone((struct sk_buff*)skb, GFP_ATOMIC)) == NULL)
  663. #endif
  664. return NULL;
  665. #ifdef CTFPOOL
  666. if (PKTISFAST(osh, skb)) {
  667. ctfpool_t *ctfpool;
  668. ctfpool = (ctfpool_t *)CTFPOOLPTR(osh, skb);
  669. ASSERT(ctfpool != NULL);
  670. PKTCLRFAST(osh, p);
  671. PKTCLRFAST(osh, skb);
  672. ctfpool->refills++;
  673. }
  674. #endif
  675. if (osh->pub.pkttag)
  676. bzero((void*)((struct sk_buff *)p)->cb, OSL_PKTTAG_SZ);
  677. osh->pub.pktalloced++;
  678. return (p);
  679. }
  680. void *
  681. osl_os_open_image(char *filename)
  682. {
  683. struct file *fp;
  684. fp = filp_open(filename, O_RDONLY, 0);
  685. if (IS_ERR(fp))
  686. fp = NULL;
  687. return fp;
  688. }
  689. int
  690. osl_os_get_image_block(char *buf, int len, void *image)
  691. {
  692. struct file *fp = (struct file *)image;
  693. int rdlen;
  694. if (!image)
  695. return 0;
  696. rdlen = kernel_read(fp, fp->f_pos, buf, len);
  697. if (rdlen > 0)
  698. fp->f_pos += rdlen;
  699. return rdlen;
  700. }
  701. void
  702. osl_os_close_image(void *image)
  703. {
  704. if (image)
  705. filp_close((struct file *)image, NULL);
  706. }