linux_osl.c 48 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974
  1. /*
  2. * Linux OS Independent Layer
  3. *
  4. * Portions of this code are copyright (c) 2020 Cypress Semiconductor Corporation
  5. *
  6. * Copyright (C) 1999-2020, Broadcom Corporation
  7. *
  8. * Unless you and Broadcom execute a separate written software license
  9. * agreement governing use of this software, this software is licensed to you
  10. * under the terms of the GNU General Public License version 2 (the "GPL"),
  11. * available at http://www.broadcom.com/licenses/GPLv2.php, with the
  12. * following added to such license:
  13. *
  14. * As a special exception, the copyright holders of this software give you
  15. * permission to link this software with independent modules, and to copy and
  16. * distribute the resulting executable under terms of your choice, provided that
  17. * you also meet, for each linked independent module, the terms and conditions of
  18. * the license of that module. An independent module is a module which is not
  19. * derived from this software. The special exception does not apply to any
  20. * modifications of the software.
  21. *
  22. * Notwithstanding the above, under no circumstances may you combine this
  23. * software in any way with any other Broadcom software provided under a license
  24. * other than the GPL, without Broadcom's express prior written consent.
  25. *
  26. *
  27. * <<Broadcom-WL-IPTag/Open:>>
  28. *
  29. * $Id: linux_osl.c 697654 2017-05-04 11:59:40Z $
  30. */
  31. #define LINUX_PORT
  32. #include <typedefs.h>
  33. #include <bcmendian.h>
  34. #include <linuxver.h>
  35. #include <bcmdefs.h>
  36. #if defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)
  37. #include <asm/cacheflush.h>
  38. #endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
  39. #include <linux/random.h>
  40. #include <osl.h>
  41. #include <bcmutils.h>
  42. #include <linux/delay.h>
  43. #include <linux/vmalloc.h>
  44. #include <pcicfg.h>
  45. #if defined(BCMASSERT_LOG) && !defined(OEM_ANDROID)
  46. #include <bcm_assert_log.h>
  47. #endif // endif
  48. #ifdef BCM_SECURE_DMA
  49. #include <linux/module.h>
  50. #include <linux/kernel.h>
  51. #include <linux/io.h>
  52. #include <linux/printk.h>
  53. #include <linux/errno.h>
  54. #include <linux/mm.h>
  55. #include <linux/moduleparam.h>
  56. #include <asm/io.h>
  57. #include <linux/skbuff.h>
  58. #include <stbutils.h>
  59. #include <linux/highmem.h>
  60. #include <linux/dma-mapping.h>
  61. #include <asm/memory.h>
  62. #endif /* BCM_SECURE_DMA */
  63. #include <linux/fs.h>
  64. #if defined(STB)
  65. #include <linux/spinlock.h>
  66. extern spinlock_t l2x0_reg_lock;
  67. #endif // endif
  68. #ifdef BCM_OBJECT_TRACE
  69. #include <bcmutils.h>
  70. #endif /* BCM_OBJECT_TRACE */
  71. #include "linux_osl_priv.h"
  72. #define PCI_CFG_RETRY 10
  73. #define DUMPBUFSZ 1024
  74. #ifdef BCM_SECURE_DMA
  75. static void * osl_sec_dma_ioremap(osl_t *osh, struct page *page, size_t size,
  76. bool iscache, bool isdecr);
  77. static void osl_sec_dma_iounmap(osl_t *osh, void *contig_base_va, size_t size);
  78. static int osl_sec_dma_init_elem_mem_block(osl_t *osh, size_t mbsize, int max,
  79. sec_mem_elem_t **list);
  80. static void osl_sec_dma_deinit_elem_mem_block(osl_t *osh, size_t mbsize, int max,
  81. void *sec_list_base);
  82. static sec_mem_elem_t * osl_sec_dma_alloc_mem_elem(osl_t *osh, void *va, uint size,
  83. int direction, struct sec_cma_info *ptr_cma_info, uint offset);
  84. static void osl_sec_dma_free_mem_elem(osl_t *osh, sec_mem_elem_t *sec_mem_elem);
  85. static void osl_sec_dma_init_consistent(osl_t *osh);
  86. static void *osl_sec_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits,
  87. ulong *pap);
  88. static void osl_sec_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa);
  89. #endif /* BCM_SECURE_DMA */
  90. /* PCMCIA attribute space access macros */
  91. #ifdef CUSTOMER_HW4_DEBUG
  92. uint32 g_assert_type = 1; /* By Default not cause Kernel Panic */
  93. #else
  94. uint32 g_assert_type = 0; /* By Default Kernel Panic */
  95. #endif /* CUSTOMER_HW4_DEBUG */
  96. module_param(g_assert_type, int, 0);
  97. #ifdef BCM_SECURE_DMA
  98. #define SECDMA_MODULE_PARAMS 0
  99. #define SECDMA_EXT_FILE 1
  100. unsigned long secdma_addr = 0;
  101. unsigned long secdma_addr2 = 0;
  102. u32 secdma_size = 0;
  103. u32 secdma_size2 = 0;
  104. module_param(secdma_addr, ulong, 0);
  105. module_param(secdma_size, int, 0);
  106. module_param(secdma_addr2, ulong, 0);
  107. module_param(secdma_size2, int, 0);
  108. static int secdma_found = 0;
  109. #endif /* BCM_SECURE_DMA */
  110. #ifdef USE_DMA_LOCK
  111. static void osl_dma_lock(osl_t *osh);
  112. static void osl_dma_unlock(osl_t *osh);
  113. static void osl_dma_lock_init(osl_t *osh);
  114. #define DMA_LOCK(osh) osl_dma_lock(osh)
  115. #define DMA_UNLOCK(osh) osl_dma_unlock(osh)
  116. #define DMA_LOCK_INIT(osh) osl_dma_lock_init(osh);
  117. #else
  118. #define DMA_LOCK(osh) do { /* noop */ } while(0)
  119. #define DMA_UNLOCK(osh) do { /* noop */ } while(0)
  120. #define DMA_LOCK_INIT(osh) do { /* noop */ } while(0)
  121. #endif /* USE_DMA_LOCK */
  122. static int16 linuxbcmerrormap[] =
  123. { 0, /* 0 */
  124. -EINVAL, /* BCME_ERROR */
  125. -EINVAL, /* BCME_BADARG */
  126. -EINVAL, /* BCME_BADOPTION */
  127. -EINVAL, /* BCME_NOTUP */
  128. -EINVAL, /* BCME_NOTDOWN */
  129. -EINVAL, /* BCME_NOTAP */
  130. -EINVAL, /* BCME_NOTSTA */
  131. -EINVAL, /* BCME_BADKEYIDX */
  132. -EINVAL, /* BCME_RADIOOFF */
  133. -EINVAL, /* BCME_NOTBANDLOCKED */
  134. -EINVAL, /* BCME_NOCLK */
  135. -EINVAL, /* BCME_BADRATESET */
  136. -EINVAL, /* BCME_BADBAND */
  137. -E2BIG, /* BCME_BUFTOOSHORT */
  138. -E2BIG, /* BCME_BUFTOOLONG */
  139. -EBUSY, /* BCME_BUSY */
  140. -EINVAL, /* BCME_NOTASSOCIATED */
  141. -EINVAL, /* BCME_BADSSIDLEN */
  142. -EINVAL, /* BCME_OUTOFRANGECHAN */
  143. -EINVAL, /* BCME_BADCHAN */
  144. -EFAULT, /* BCME_BADADDR */
  145. -ENOMEM, /* BCME_NORESOURCE */
  146. -EOPNOTSUPP, /* BCME_UNSUPPORTED */
  147. -EMSGSIZE, /* BCME_BADLENGTH */
  148. -EINVAL, /* BCME_NOTREADY */
  149. -EPERM, /* BCME_EPERM */
  150. -ENOMEM, /* BCME_NOMEM */
  151. -EINVAL, /* BCME_ASSOCIATED */
  152. -ERANGE, /* BCME_RANGE */
  153. -EINVAL, /* BCME_NOTFOUND */
  154. -EINVAL, /* BCME_WME_NOT_ENABLED */
  155. -EINVAL, /* BCME_TSPEC_NOTFOUND */
  156. -EINVAL, /* BCME_ACM_NOTSUPPORTED */
  157. -EINVAL, /* BCME_NOT_WME_ASSOCIATION */
  158. -EIO, /* BCME_SDIO_ERROR */
  159. -ENODEV, /* BCME_DONGLE_DOWN */
  160. -EINVAL, /* BCME_VERSION */
  161. -EIO, /* BCME_TXFAIL */
  162. -EIO, /* BCME_RXFAIL */
  163. -ENODEV, /* BCME_NODEVICE */
  164. -EINVAL, /* BCME_NMODE_DISABLED */
  165. -ENODATA, /* BCME_NONRESIDENT */
  166. -EINVAL, /* BCME_SCANREJECT */
  167. -EINVAL, /* BCME_USAGE_ERROR */
  168. -EIO, /* BCME_IOCTL_ERROR */
  169. -EIO, /* BCME_SERIAL_PORT_ERR */
  170. -EOPNOTSUPP, /* BCME_DISABLED, BCME_NOTENABLED */
  171. -EIO, /* BCME_DECERR */
  172. -EIO, /* BCME_ENCERR */
  173. -EIO, /* BCME_MICERR */
  174. -ERANGE, /* BCME_REPLAY */
  175. -EINVAL, /* BCME_IE_NOTFOUND */
  176. -EINVAL, /* BCME_DATA_NOTFOUND */
  177. -EINVAL, /* BCME_NOT_GC */
  178. -EINVAL, /* BCME_PRS_REQ_FAILED */
  179. -EINVAL, /* BCME_NO_P2P_SE */
  180. -EINVAL, /* BCME_NOA_PND */
  181. -EINVAL, /* BCME_FRAG_Q_FAILED */
  182. -EINVAL, /* BCME_GET_AF_FAILED */
  183. -EINVAL, /* BCME_MSCH_NOTREADY */
  184. -EINVAL, /* BCME_IOV_LAST_CMD */
  185. -EINVAL, /* BCME_MINIPMU_CAL_FAIL */
  186. -EINVAL, /* BCME_RCAL_FAIL */
  187. -EINVAL, /* BCME_LPF_RCCAL_FAIL */
  188. -EINVAL, /* BCME_DACBUF_RCCAL_FAIL */
  189. -EINVAL, /* BCME_VCOCAL_FAIL */
  190. -EINVAL, /* BCME_BANDLOCKED */
  191. -EINVAL, /* BCME_DNGL_DEVRESET */
  192. /* When an new error code is added to bcmutils.h, add os
  193. * specific error translation here as well
  194. */
  195. /* check if BCME_LAST changed since the last time this function was updated */
  196. #if BCME_LAST != -68
  197. #error "You need to add a OS error translation in the linuxbcmerrormap \
  198. for new error code defined in bcmutils.h"
  199. #endif // endif
  200. };
  201. uint lmtest = FALSE;
  202. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 1))
  203. void do_gettimeofday(struct timeval *tv)
  204. {
  205. struct timespec64 ts;
  206. ktime_get_real_ts64(&ts);
  207. tv->tv_sec = ts.tv_sec;
  208. tv->tv_usec = ts.tv_nsec;
  209. }
  210. #endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 1) */
  211. #ifdef DHD_MAP_LOGGING
  212. #define DHD_MAP_LOG_SIZE 2048
  213. typedef struct dhd_map_item {
  214. dmaaddr_t pa; /* DMA address (physical) */
  215. uint64 ts_nsec; /* timestamp: nsec */
  216. uint32 size; /* mapping size */
  217. uint8 rsvd[4]; /* reserved for future use */
  218. } dhd_map_item_t;
  219. typedef struct dhd_map_record {
  220. uint32 items; /* number of total items */
  221. uint32 idx; /* current index of metadata */
  222. dhd_map_item_t map[0]; /* metadata storage */
  223. } dhd_map_log_t;
  224. void
  225. osl_dma_map_dump(osl_t *osh)
  226. {
  227. dhd_map_log_t *map_log, *unmap_log;
  228. uint64 ts_sec, ts_usec;
  229. map_log = (dhd_map_log_t *)(osh->dhd_map_log);
  230. unmap_log = (dhd_map_log_t *)(osh->dhd_unmap_log);
  231. osl_get_localtime(&ts_sec, &ts_usec);
  232. if (map_log && unmap_log) {
  233. printk("%s: map_idx=%d unmap_idx=%d "
  234. "current time=[%5lu.%06lu]\n", __FUNCTION__,
  235. map_log->idx, unmap_log->idx, (unsigned long)ts_sec,
  236. (unsigned long)ts_usec);
  237. printk("%s: dhd_map_log(pa)=0x%llx size=%d,"
  238. " dma_unmap_log(pa)=0x%llx size=%d\n", __FUNCTION__,
  239. (uint64)__virt_to_phys((ulong)(map_log->map)),
  240. (uint32)(sizeof(dhd_map_item_t) * map_log->items),
  241. (uint64)__virt_to_phys((ulong)(unmap_log->map)),
  242. (uint32)(sizeof(dhd_map_item_t) * unmap_log->items));
  243. }
  244. }
  245. static void *
  246. osl_dma_map_log_init(uint32 item_len)
  247. {
  248. dhd_map_log_t *map_log;
  249. gfp_t flags;
  250. uint32 alloc_size = (uint32)(sizeof(dhd_map_log_t) +
  251. (item_len * sizeof(dhd_map_item_t)));
  252. flags = CAN_SLEEP() ? GFP_KERNEL : GFP_ATOMIC;
  253. map_log = (dhd_map_log_t *)kmalloc(alloc_size, flags);
  254. if (map_log) {
  255. memset(map_log, 0, alloc_size);
  256. map_log->items = item_len;
  257. map_log->idx = 0;
  258. }
  259. return (void *)map_log;
  260. }
  261. static void
  262. osl_dma_map_log_deinit(osl_t *osh)
  263. {
  264. if (osh->dhd_map_log) {
  265. kfree(osh->dhd_map_log);
  266. osh->dhd_map_log = NULL;
  267. }
  268. if (osh->dhd_unmap_log) {
  269. kfree(osh->dhd_unmap_log);
  270. osh->dhd_unmap_log = NULL;
  271. }
  272. }
  273. static void
  274. osl_dma_map_logging(osl_t *osh, void *handle, dmaaddr_t pa, uint32 len)
  275. {
  276. dhd_map_log_t *log = (dhd_map_log_t *)handle;
  277. uint32 idx;
  278. if (log == NULL) {
  279. printk("%s: log is NULL\n", __FUNCTION__);
  280. return;
  281. }
  282. idx = log->idx;
  283. log->map[idx].ts_nsec = osl_localtime_ns();
  284. log->map[idx].pa = pa;
  285. log->map[idx].size = len;
  286. log->idx = (idx + 1) % log->items;
  287. }
  288. #endif /* DHD_MAP_LOGGING */
  289. /* translate bcmerrors into linux errors */
  290. int
  291. osl_error(int bcmerror)
  292. {
  293. if (bcmerror > 0)
  294. bcmerror = 0;
  295. else if (bcmerror < BCME_LAST)
  296. bcmerror = BCME_ERROR;
  297. /* Array bounds covered by ASSERT in osl_attach */
  298. return linuxbcmerrormap[-bcmerror];
  299. }
  300. osl_t *
  301. osl_attach(void *pdev, uint bustype, bool pkttag)
  302. {
  303. void **osl_cmn = NULL;
  304. osl_t *osh;
  305. gfp_t flags;
  306. #ifdef BCM_SECURE_DMA
  307. u32 secdma_memsize;
  308. #endif // endif
  309. flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
  310. if (!(osh = kmalloc(sizeof(osl_t), flags)))
  311. return osh;
  312. ASSERT(osh);
  313. bzero(osh, sizeof(osl_t));
  314. if (osl_cmn == NULL || *osl_cmn == NULL) {
  315. if (!(osh->cmn = kmalloc(sizeof(osl_cmn_t), flags))) {
  316. kfree(osh);
  317. return NULL;
  318. }
  319. bzero(osh->cmn, sizeof(osl_cmn_t));
  320. if (osl_cmn)
  321. *osl_cmn = osh->cmn;
  322. atomic_set(&osh->cmn->malloced, 0);
  323. osh->cmn->dbgmem_list = NULL;
  324. spin_lock_init(&(osh->cmn->dbgmem_lock));
  325. spin_lock_init(&(osh->cmn->pktalloc_lock));
  326. } else {
  327. osh->cmn = *osl_cmn;
  328. }
  329. atomic_add(1, &osh->cmn->refcount);
  330. bcm_object_trace_init();
  331. /* Check that error map has the right number of entries in it */
  332. ASSERT(ABS(BCME_LAST) == (ARRAYSIZE(linuxbcmerrormap) - 1));
  333. osh->failed = 0;
  334. osh->pdev = pdev;
  335. osh->pub.pkttag = pkttag;
  336. osh->bustype = bustype;
  337. osh->magic = OS_HANDLE_MAGIC;
  338. #ifdef BCM_SECURE_DMA
  339. if ((secdma_addr != 0) && (secdma_size != 0)) {
  340. printk("linux_osl.c: Buffer info passed via module params, using it.\n");
  341. if (secdma_found == 0) {
  342. osh->contig_base_alloc = (phys_addr_t)secdma_addr;
  343. secdma_memsize = secdma_size;
  344. } else if (secdma_found == 1) {
  345. osh->contig_base_alloc = (phys_addr_t)secdma_addr2;
  346. secdma_memsize = secdma_size2;
  347. } else {
  348. printk("linux_osl.c secdma: secDMA instances %d \n", secdma_found);
  349. kfree(osh);
  350. return NULL;
  351. }
  352. osh->contig_base = (phys_addr_t)osh->contig_base_alloc;
  353. printf("linux_osl.c: secdma_cma_size = 0x%x\n", secdma_memsize);
  354. printf("linux_osl.c: secdma_cma_addr = 0x%x \n",
  355. (unsigned int)osh->contig_base_alloc);
  356. osh->stb_ext_params = SECDMA_MODULE_PARAMS;
  357. }
  358. else if (stbpriv_init(osh) == 0) {
  359. printk("linux_osl.c: stbpriv.txt found. Get buffer info.\n");
  360. if (secdma_found == 0) {
  361. osh->contig_base_alloc =
  362. (phys_addr_t)bcm_strtoul(stbparam_get("secdma_cma_addr"), NULL, 0);
  363. secdma_memsize = bcm_strtoul(stbparam_get("secdma_cma_size"), NULL, 0);
  364. } else if (secdma_found == 1) {
  365. osh->contig_base_alloc =
  366. (phys_addr_t)bcm_strtoul(stbparam_get("secdma_cma_addr2"), NULL, 0);
  367. secdma_memsize = bcm_strtoul(stbparam_get("secdma_cma_size2"), NULL, 0);
  368. } else {
  369. printk("linux_osl.c secdma: secDMA instances %d \n", secdma_found);
  370. kfree(osh);
  371. return NULL;
  372. }
  373. osh->contig_base = (phys_addr_t)osh->contig_base_alloc;
  374. printf("linux_osl.c: secdma_cma_size = 0x%x\n", secdma_memsize);
  375. printf("linux_osl.c: secdma_cma_addr = 0x%x \n",
  376. (unsigned int)osh->contig_base_alloc);
  377. osh->stb_ext_params = SECDMA_EXT_FILE;
  378. }
  379. else {
  380. printk("linux_osl.c: secDMA no longer supports internal buffer allocation.\n");
  381. kfree(osh);
  382. return NULL;
  383. }
  384. secdma_found++;
  385. osh->contig_base_alloc_coherent_va = osl_sec_dma_ioremap(osh,
  386. phys_to_page((u32)osh->contig_base_alloc),
  387. CMA_DMA_DESC_MEMBLOCK, FALSE, TRUE);
  388. if (osh->contig_base_alloc_coherent_va == NULL) {
  389. if (osh->cmn)
  390. kfree(osh->cmn);
  391. kfree(osh);
  392. return NULL;
  393. }
  394. osh->contig_base_coherent_va = osh->contig_base_alloc_coherent_va;
  395. osh->contig_base_alloc_coherent = osh->contig_base_alloc;
  396. osl_sec_dma_init_consistent(osh);
  397. osh->contig_base_alloc += CMA_DMA_DESC_MEMBLOCK;
  398. osh->contig_base_alloc_va = osl_sec_dma_ioremap(osh,
  399. phys_to_page((u32)osh->contig_base_alloc), CMA_DMA_DATA_MEMBLOCK, TRUE, FALSE);
  400. if (osh->contig_base_alloc_va == NULL) {
  401. osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
  402. if (osh->cmn)
  403. kfree(osh->cmn);
  404. kfree(osh);
  405. return NULL;
  406. }
  407. osh->contig_base_va = osh->contig_base_alloc_va;
  408. if (BCME_OK != osl_sec_dma_init_elem_mem_block(osh,
  409. CMA_BUFSIZE_4K, CMA_BUFNUM, &osh->sec_list_4096)) {
  410. osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
  411. osl_sec_dma_iounmap(osh, osh->contig_base_va, CMA_DMA_DATA_MEMBLOCK);
  412. if (osh->cmn)
  413. kfree(osh->cmn);
  414. kfree(osh);
  415. return NULL;
  416. }
  417. osh->sec_list_base_4096 = osh->sec_list_4096;
  418. #endif /* BCM_SECURE_DMA */
  419. switch (bustype) {
  420. case PCI_BUS:
  421. case SI_BUS:
  422. case PCMCIA_BUS:
  423. osh->pub.mmbus = TRUE;
  424. break;
  425. case JTAG_BUS:
  426. case SDIO_BUS:
  427. case USB_BUS:
  428. case SPI_BUS:
  429. case RPC_BUS:
  430. osh->pub.mmbus = FALSE;
  431. break;
  432. default:
  433. ASSERT(FALSE);
  434. break;
  435. }
  436. DMA_LOCK_INIT(osh);
  437. #ifdef DHD_MAP_LOGGING
  438. osh->dhd_map_log = osl_dma_map_log_init(DHD_MAP_LOG_SIZE);
  439. if (osh->dhd_map_log == NULL) {
  440. printk("%s: Failed to alloc dhd_map_log\n", __FUNCTION__);
  441. }
  442. osh->dhd_unmap_log = osl_dma_map_log_init(DHD_MAP_LOG_SIZE);
  443. if (osh->dhd_unmap_log == NULL) {
  444. printk("%s: Failed to alloc dhd_unmap_log\n", __FUNCTION__);
  445. }
  446. #endif /* DHD_MAP_LOGGING */
  447. return osh;
  448. }
  449. void osl_set_bus_handle(osl_t *osh, void *bus_handle)
  450. {
  451. osh->bus_handle = bus_handle;
  452. }
  453. void* osl_get_bus_handle(osl_t *osh)
  454. {
  455. return osh->bus_handle;
  456. }
  457. #if defined(BCM_BACKPLANE_TIMEOUT)
  458. void osl_set_bpt_cb(osl_t *osh, void *bpt_cb, void *bpt_ctx)
  459. {
  460. if (osh) {
  461. osh->bpt_cb = (bpt_cb_fn)bpt_cb;
  462. osh->sih = bpt_ctx;
  463. }
  464. }
  465. #endif /* BCM_BACKPLANE_TIMEOUT */
  466. void
  467. osl_detach(osl_t *osh)
  468. {
  469. if (osh == NULL)
  470. return;
  471. #ifdef BCM_SECURE_DMA
  472. if (osh->stb_ext_params == SECDMA_EXT_FILE)
  473. stbpriv_exit(osh);
  474. osl_sec_dma_deinit_elem_mem_block(osh, CMA_BUFSIZE_4K, CMA_BUFNUM, osh->sec_list_base_4096);
  475. osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
  476. osl_sec_dma_iounmap(osh, osh->contig_base_va, CMA_DMA_DATA_MEMBLOCK);
  477. secdma_found--;
  478. #endif /* BCM_SECURE_DMA */
  479. bcm_object_trace_deinit();
  480. #ifdef DHD_MAP_LOGGING
  481. osl_dma_map_log_deinit(osh->dhd_map_log);
  482. osl_dma_map_log_deinit(osh->dhd_unmap_log);
  483. #endif /* DHD_MAP_LOGGING */
  484. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  485. atomic_sub(1, &osh->cmn->refcount);
  486. if (atomic_read(&osh->cmn->refcount) == 0) {
  487. kfree(osh->cmn);
  488. }
  489. kfree(osh);
  490. }
  491. /* APIs to set/get specific quirks in OSL layer */
  492. void BCMFASTPATH
  493. osl_flag_set(osl_t *osh, uint32 mask)
  494. {
  495. osh->flags |= mask;
  496. }
  497. void
  498. osl_flag_clr(osl_t *osh, uint32 mask)
  499. {
  500. osh->flags &= ~mask;
  501. }
  502. #if defined(STB)
  503. inline bool BCMFASTPATH
  504. #else
  505. bool
  506. #endif // endif
  507. osl_is_flag_set(osl_t *osh, uint32 mask)
  508. {
  509. return (osh->flags & mask);
  510. }
  511. #if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
  512. defined(STB_SOC_WIFI)
  513. inline int BCMFASTPATH
  514. osl_arch_is_coherent(void)
  515. {
  516. return 0;
  517. }
  518. inline int BCMFASTPATH
  519. osl_acp_war_enab(void)
  520. {
  521. return 0;
  522. }
  523. inline void BCMFASTPATH
  524. osl_cache_flush(void *va, uint size)
  525. {
  526. if (size > 0)
  527. #ifdef STB_SOC_WIFI
  528. dma_sync_single_for_device(OSH_NULL, virt_to_phys(va), size, DMA_TX);
  529. #else /* STB_SOC_WIFI */
  530. dma_sync_single_for_device(OSH_NULL, virt_to_dma(OSH_NULL, va), size,
  531. DMA_TO_DEVICE);
  532. #endif /* STB_SOC_WIFI */
  533. }
  534. inline void BCMFASTPATH
  535. osl_cache_inv(void *va, uint size)
  536. {
  537. #ifdef STB_SOC_WIFI
  538. dma_sync_single_for_cpu(OSH_NULL, virt_to_phys(va), size, DMA_RX);
  539. #else /* STB_SOC_WIFI */
  540. dma_sync_single_for_cpu(OSH_NULL, virt_to_dma(OSH_NULL, va), size, DMA_FROM_DEVICE);
  541. #endif /* STB_SOC_WIFI */
  542. }
  543. inline void BCMFASTPATH
  544. osl_prefetch(const void *ptr)
  545. {
  546. #if !defined(STB_SOC_WIFI)
  547. __asm__ __volatile__("pld\t%0" :: "o"(*(const char *)ptr) : "cc");
  548. #endif // endif
  549. }
  550. #endif // endif
  551. uint32
  552. osl_pci_read_config(osl_t *osh, uint offset, uint size)
  553. {
  554. uint val = 0;
  555. uint retry = PCI_CFG_RETRY;
  556. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  557. /* only 4byte access supported */
  558. ASSERT(size == 4);
  559. do {
  560. pci_read_config_dword(osh->pdev, offset, &val);
  561. if (val != 0xffffffff)
  562. break;
  563. } while (retry--);
  564. return (val);
  565. }
  566. void
  567. osl_pci_write_config(osl_t *osh, uint offset, uint size, uint val)
  568. {
  569. uint retry = PCI_CFG_RETRY;
  570. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  571. /* only 4byte access supported */
  572. ASSERT(size == 4);
  573. do {
  574. pci_write_config_dword(osh->pdev, offset, val);
  575. if (offset != PCI_BAR0_WIN)
  576. break;
  577. if (osl_pci_read_config(osh, offset, size) == val)
  578. break;
  579. } while (retry--);
  580. }
  581. /* return bus # for the pci device pointed by osh->pdev */
  582. uint
  583. osl_pci_bus(osl_t *osh)
  584. {
  585. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  586. #if defined(__ARM_ARCH_7A__)
  587. return pci_domain_nr(((struct pci_dev *)osh->pdev)->bus);
  588. #else
  589. return ((struct pci_dev *)osh->pdev)->bus->number;
  590. #endif // endif
  591. }
  592. /* return slot # for the pci device pointed by osh->pdev */
  593. uint
  594. osl_pci_slot(osl_t *osh)
  595. {
  596. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  597. #if defined(__ARM_ARCH_7A__)
  598. return PCI_SLOT(((struct pci_dev *)osh->pdev)->devfn) + 1;
  599. #else
  600. return PCI_SLOT(((struct pci_dev *)osh->pdev)->devfn);
  601. #endif // endif
  602. }
  603. /* return domain # for the pci device pointed by osh->pdev */
  604. uint
  605. osl_pcie_domain(osl_t *osh)
  606. {
  607. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  608. return pci_domain_nr(((struct pci_dev *)osh->pdev)->bus);
  609. }
  610. /* return bus # for the pci device pointed by osh->pdev */
  611. uint
  612. osl_pcie_bus(osl_t *osh)
  613. {
  614. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  615. return ((struct pci_dev *)osh->pdev)->bus->number;
  616. }
  617. /* return the pci device pointed by osh->pdev */
  618. struct pci_dev *
  619. osl_pci_device(osl_t *osh)
  620. {
  621. ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
  622. return osh->pdev;
  623. }
  624. static void
  625. osl_pcmcia_attr(osl_t *osh, uint offset, char *buf, int size, bool write)
  626. {
  627. }
  628. void
  629. osl_pcmcia_read_attr(osl_t *osh, uint offset, void *buf, int size)
  630. {
  631. osl_pcmcia_attr(osh, offset, (char *) buf, size, FALSE);
  632. }
  633. void
  634. osl_pcmcia_write_attr(osl_t *osh, uint offset, void *buf, int size)
  635. {
  636. osl_pcmcia_attr(osh, offset, (char *) buf, size, TRUE);
  637. }
  638. void *
  639. osl_malloc(osl_t *osh, uint size)
  640. {
  641. void *addr;
  642. gfp_t flags;
  643. /* only ASSERT if osh is defined */
  644. if (osh)
  645. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  646. #ifdef CONFIG_DHD_USE_STATIC_BUF
  647. if (bcm_static_buf)
  648. {
  649. unsigned long irq_flags;
  650. int i = 0;
  651. if ((size >= PAGE_SIZE)&&(size <= STATIC_BUF_SIZE))
  652. {
  653. spin_lock_irqsave(&bcm_static_buf->static_lock, irq_flags);
  654. for (i = 0; i < STATIC_BUF_MAX_NUM; i++)
  655. {
  656. if (bcm_static_buf->buf_use[i] == 0)
  657. break;
  658. }
  659. if (i == STATIC_BUF_MAX_NUM)
  660. {
  661. spin_unlock_irqrestore(&bcm_static_buf->static_lock, irq_flags);
  662. printk("all static buff in use!\n");
  663. goto original;
  664. }
  665. bcm_static_buf->buf_use[i] = 1;
  666. spin_unlock_irqrestore(&bcm_static_buf->static_lock, irq_flags);
  667. bzero(bcm_static_buf->buf_ptr+STATIC_BUF_SIZE*i, size);
  668. if (osh)
  669. atomic_add(size, &osh->cmn->malloced);
  670. return ((void *)(bcm_static_buf->buf_ptr+STATIC_BUF_SIZE*i));
  671. }
  672. }
  673. original:
  674. #endif /* CONFIG_DHD_USE_STATIC_BUF */
  675. flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
  676. if ((addr = kmalloc(size, flags)) == NULL) {
  677. if (osh)
  678. osh->failed++;
  679. return (NULL);
  680. }
  681. if (osh && osh->cmn)
  682. atomic_add(size, &osh->cmn->malloced);
  683. return (addr);
  684. }
  685. void *
  686. osl_mallocz(osl_t *osh, uint size)
  687. {
  688. void *ptr;
  689. ptr = osl_malloc(osh, size);
  690. if (ptr != NULL) {
  691. bzero(ptr, size);
  692. }
  693. return ptr;
  694. }
  695. void
  696. osl_mfree(osl_t *osh, void *addr, uint size)
  697. {
  698. #ifdef CONFIG_DHD_USE_STATIC_BUF
  699. unsigned long flags;
  700. if (bcm_static_buf)
  701. {
  702. if ((addr > (void *)bcm_static_buf) && ((unsigned char *)addr
  703. <= ((unsigned char *)bcm_static_buf + STATIC_BUF_TOTAL_LEN)))
  704. {
  705. int buf_idx = 0;
  706. buf_idx = ((unsigned char *)addr - bcm_static_buf->buf_ptr)/STATIC_BUF_SIZE;
  707. spin_lock_irqsave(&bcm_static_buf->static_lock, flags);
  708. bcm_static_buf->buf_use[buf_idx] = 0;
  709. spin_unlock_irqrestore(&bcm_static_buf->static_lock, flags);
  710. if (osh && osh->cmn) {
  711. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  712. atomic_sub(size, &osh->cmn->malloced);
  713. }
  714. return;
  715. }
  716. }
  717. #endif /* CONFIG_DHD_USE_STATIC_BUF */
  718. if (osh && osh->cmn) {
  719. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  720. ASSERT(size <= osl_malloced(osh));
  721. atomic_sub(size, &osh->cmn->malloced);
  722. }
  723. kfree(addr);
  724. }
  725. void *
  726. osl_vmalloc(osl_t *osh, uint size)
  727. {
  728. void *addr;
  729. /* only ASSERT if osh is defined */
  730. if (osh)
  731. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  732. if ((addr = vmalloc(size)) == NULL) {
  733. if (osh)
  734. osh->failed++;
  735. return (NULL);
  736. }
  737. if (osh && osh->cmn)
  738. atomic_add(size, &osh->cmn->malloced);
  739. return (addr);
  740. }
  741. void *
  742. osl_vmallocz(osl_t *osh, uint size)
  743. {
  744. void *ptr;
  745. ptr = osl_vmalloc(osh, size);
  746. if (ptr != NULL) {
  747. bzero(ptr, size);
  748. }
  749. return ptr;
  750. }
  751. void
  752. osl_vmfree(osl_t *osh, void *addr, uint size)
  753. {
  754. if (osh && osh->cmn) {
  755. ASSERT(osh->magic == OS_HANDLE_MAGIC);
  756. ASSERT(size <= osl_malloced(osh));
  757. atomic_sub(size, &osh->cmn->malloced);
  758. }
  759. vfree(addr);
  760. }
  761. uint
  762. osl_check_memleak(osl_t *osh)
  763. {
  764. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  765. if (atomic_read(&osh->cmn->refcount) == 1)
  766. return (atomic_read(&osh->cmn->malloced));
  767. else
  768. return 0;
  769. }
  770. uint
  771. osl_malloced(osl_t *osh)
  772. {
  773. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  774. return (atomic_read(&osh->cmn->malloced));
  775. }
  776. uint
  777. osl_malloc_failed(osl_t *osh)
  778. {
  779. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  780. return (osh->failed);
  781. }
  782. uint
  783. osl_dma_consistent_align(void)
  784. {
  785. return (PAGE_SIZE);
  786. }
  787. void*
  788. osl_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits, uint *alloced, dmaaddr_t *pap)
  789. {
  790. void *va;
  791. uint16 align = (1 << align_bits);
  792. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  793. if (!ISALIGNED(DMA_CONSISTENT_ALIGN, align))
  794. size += align;
  795. *alloced = size;
  796. #ifndef BCM_SECURE_DMA
  797. #if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
  798. defined(STB_SOC_WIFI)
  799. va = kmalloc(size, GFP_ATOMIC | __GFP_ZERO);
  800. if (va)
  801. *pap = (ulong)__virt_to_phys((ulong)va);
  802. #else
  803. {
  804. dma_addr_t pap_lin;
  805. struct pci_dev *hwdev = osh->pdev;
  806. gfp_t flags;
  807. #ifdef DHD_ALLOC_COHERENT_MEM_FROM_ATOMIC_POOL
  808. flags = GFP_ATOMIC;
  809. #else
  810. flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
  811. #endif /* DHD_ALLOC_COHERENT_MEM_FROM_ATOMIC_POOL */
  812. va = dma_alloc_coherent(&hwdev->dev, size, &pap_lin, flags);
  813. #ifdef BCMDMA64OSL
  814. PHYSADDRLOSET(*pap, pap_lin & 0xffffffff);
  815. PHYSADDRHISET(*pap, (pap_lin >> 32) & 0xffffffff);
  816. #else
  817. *pap = (dmaaddr_t)pap_lin;
  818. #endif /* BCMDMA64OSL */
  819. }
  820. #endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
  821. #else
  822. va = osl_sec_dma_alloc_consistent(osh, size, align_bits, pap);
  823. #endif /* BCM_SECURE_DMA */
  824. return va;
  825. }
  826. void
  827. osl_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa)
  828. {
  829. #ifdef BCMDMA64OSL
  830. dma_addr_t paddr;
  831. #endif /* BCMDMA64OSL */
  832. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  833. #ifndef BCM_SECURE_DMA
  834. #if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
  835. defined(STB_SOC_WIFI)
  836. kfree(va);
  837. #else
  838. #ifdef BCMDMA64OSL
  839. PHYSADDRTOULONG(pa, paddr);
  840. pci_free_consistent(osh->pdev, size, va, paddr);
  841. #else
  842. pci_free_consistent(osh->pdev, size, va, (dma_addr_t)pa);
  843. #endif /* BCMDMA64OSL */
  844. #endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
  845. #else
  846. osl_sec_dma_free_consistent(osh, va, size, pa);
  847. #endif /* BCM_SECURE_DMA */
  848. }
  849. void *
  850. osl_virt_to_phys(void *va)
  851. {
  852. return (void *)(uintptr)virt_to_phys(va);
  853. }
  854. #include <asm/cacheflush.h>
  855. void BCMFASTPATH
  856. osl_dma_flush(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *dmah)
  857. {
  858. return;
  859. }
  860. dmaaddr_t BCMFASTPATH
  861. osl_dma_map(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *dmah)
  862. {
  863. int dir;
  864. dmaaddr_t ret_addr;
  865. dma_addr_t map_addr;
  866. int ret;
  867. DMA_LOCK(osh);
  868. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  869. dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
  870. #ifdef STB_SOC_WIFI
  871. #if (__LINUX_ARM_ARCH__ == 8)
  872. /* need to flush or invalidate the cache here */
  873. if (dir == DMA_TX) { /* to device */
  874. osl_cache_flush(va, size);
  875. } else if (dir == DMA_RX) { /* from device */
  876. osl_cache_inv(va, size);
  877. } else { /* both */
  878. osl_cache_flush(va, size);
  879. osl_cache_inv(va, size);
  880. }
  881. DMA_UNLOCK(osh);
  882. return virt_to_phys(va);
  883. #else /* (__LINUX_ARM_ARCH__ == 8) */
  884. map_addr = dma_map_single(osh->pdev, va, size, dir);
  885. DMA_UNLOCK(osh);
  886. return map_addr;
  887. #endif /* (__LINUX_ARM_ARCH__ == 8) */
  888. #else /* ! STB_SOC_WIFI */
  889. map_addr = pci_map_single(osh->pdev, va, size, dir);
  890. #endif /* ! STB_SOC_WIFI */
  891. ret = pci_dma_mapping_error(osh->pdev, map_addr);
  892. if (ret) {
  893. printk("%s: Failed to map memory\n", __FUNCTION__);
  894. PHYSADDRLOSET(ret_addr, 0);
  895. PHYSADDRHISET(ret_addr, 0);
  896. } else {
  897. PHYSADDRLOSET(ret_addr, map_addr & 0xffffffff);
  898. PHYSADDRHISET(ret_addr, (map_addr >> 32) & 0xffffffff);
  899. }
  900. #ifdef DHD_MAP_LOGGING
  901. osl_dma_map_logging(osh, osh->dhd_map_log, ret_addr, size);
  902. #endif /* DHD_MAP_LOGGING */
  903. DMA_UNLOCK(osh);
  904. return ret_addr;
  905. }
  906. void BCMFASTPATH
  907. osl_dma_unmap(osl_t *osh, dmaaddr_t pa, uint size, int direction)
  908. {
  909. int dir;
  910. #ifdef BCMDMA64OSL
  911. dma_addr_t paddr;
  912. #endif /* BCMDMA64OSL */
  913. ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
  914. DMA_LOCK(osh);
  915. dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
  916. #ifdef DHD_MAP_LOGGING
  917. osl_dma_map_logging(osh, osh->dhd_unmap_log, pa, size);
  918. #endif /* DHD_MAP_LOGGING */
  919. #ifdef BCMDMA64OSL
  920. PHYSADDRTOULONG(pa, paddr);
  921. pci_unmap_single(osh->pdev, paddr, size, dir);
  922. #else /* BCMDMA64OSL */
  923. #ifdef STB_SOC_WIFI
  924. #if (__LINUX_ARM_ARCH__ == 8)
  925. if (dir == DMA_TX) { /* to device */
  926. dma_sync_single_for_device(OSH_NULL, pa, size, DMA_TX);
  927. } else if (dir == DMA_RX) { /* from device */
  928. dma_sync_single_for_cpu(OSH_NULL, pa, size, DMA_RX);
  929. } else { /* both */
  930. dma_sync_single_for_device(OSH_NULL, pa, size, DMA_TX);
  931. dma_sync_single_for_cpu(OSH_NULL, pa, size, DMA_RX);
  932. }
  933. #else /* (__LINUX_ARM_ARCH__ == 8) */
  934. dma_unmap_single(osh->pdev, (uintptr)pa, size, dir);
  935. #endif /* (__LINUX_ARM_ARCH__ == 8) */
  936. #else /* STB_SOC_WIFI */
  937. pci_unmap_single(osh->pdev, (uint32)pa, size, dir);
  938. #endif /* STB_SOC_WIFI */
  939. #endif /* BCMDMA64OSL */
  940. DMA_UNLOCK(osh);
  941. }
  942. /* OSL function for CPU relax */
  943. inline void BCMFASTPATH
  944. osl_cpu_relax(void)
  945. {
  946. cpu_relax();
  947. }
  948. extern void osl_preempt_disable(osl_t *osh)
  949. {
  950. preempt_disable();
  951. }
  952. extern void osl_preempt_enable(osl_t *osh)
  953. {
  954. preempt_enable();
  955. }
  956. #if defined(BCMASSERT_LOG)
  957. void
  958. osl_assert(const char *exp, const char *file, int line)
  959. {
  960. char tempbuf[256];
  961. const char *basename;
  962. basename = strrchr(file, '/');
  963. /* skip the '/' */
  964. if (basename)
  965. basename++;
  966. if (!basename)
  967. basename = file;
  968. #ifdef BCMASSERT_LOG
  969. snprintf(tempbuf, 64, "\"%s\": file \"%s\", line %d\n",
  970. exp, basename, line);
  971. #ifndef OEM_ANDROID
  972. bcm_assert_log(tempbuf);
  973. #endif /* OEM_ANDROID */
  974. #endif /* BCMASSERT_LOG */
  975. switch (g_assert_type) {
  976. case 0:
  977. panic("%s", tempbuf);
  978. break;
  979. case 1:
  980. /* fall through */
  981. case 3:
  982. printk("%s", tempbuf);
  983. break;
  984. case 2:
  985. printk("%s", tempbuf);
  986. BUG();
  987. break;
  988. default:
  989. break;
  990. }
  991. }
  992. #endif // endif
  993. void
  994. osl_delay(uint usec)
  995. {
  996. uint d;
  997. while (usec > 0) {
  998. d = MIN(usec, 1000);
  999. udelay(d);
  1000. usec -= d;
  1001. }
  1002. }
  1003. void
  1004. osl_sleep(uint ms)
  1005. {
  1006. if (ms < 20)
  1007. usleep_range(ms*1000, ms*1000 + 1000);
  1008. else
  1009. msleep(ms);
  1010. }
  1011. uint64
  1012. osl_sysuptime_us(void)
  1013. {
  1014. struct timeval tv;
  1015. uint64 usec;
  1016. do_gettimeofday(&tv);
  1017. /* tv_usec content is fraction of a second */
  1018. usec = (uint64)tv.tv_sec * 1000000ul + tv.tv_usec;
  1019. return usec;
  1020. }
  1021. uint64
  1022. osl_localtime_ns(void)
  1023. {
  1024. uint64 ts_nsec = 0;
  1025. ts_nsec = local_clock();
  1026. return ts_nsec;
  1027. }
  1028. void
  1029. osl_get_localtime(uint64 *sec, uint64 *usec)
  1030. {
  1031. uint64 ts_nsec = 0;
  1032. unsigned long rem_nsec = 0;
  1033. ts_nsec = local_clock();
  1034. rem_nsec = do_div(ts_nsec, NSEC_PER_SEC);
  1035. *sec = (uint64)ts_nsec;
  1036. *usec = (uint64)(rem_nsec / MSEC_PER_SEC);
  1037. }
  1038. uint64
  1039. osl_systztime_us(void)
  1040. {
  1041. struct timeval tv;
  1042. uint64 tzusec;
  1043. do_gettimeofday(&tv);
  1044. /* apply timezone */
  1045. tzusec = (uint64)((tv.tv_sec - (sys_tz.tz_minuteswest * 60)) *
  1046. USEC_PER_SEC);
  1047. tzusec += tv.tv_usec;
  1048. return tzusec;
  1049. }
  1050. /*
  1051. * OSLREGOPS specifies the use of osl_XXX routines to be used for register access
  1052. */
  1053. /*
  1054. * BINOSL selects the slightly slower function-call-based binary compatible osl.
  1055. */
  1056. uint32
  1057. osl_rand(void)
  1058. {
  1059. uint32 rand;
  1060. get_random_bytes(&rand, sizeof(rand));
  1061. return rand;
  1062. }
  1063. /* Linux Kernel: File Operations: start */
  1064. void *
  1065. osl_os_open_image(char *filename)
  1066. {
  1067. struct file *fp;
  1068. fp = filp_open(filename, O_RDONLY, 0);
  1069. /*
  1070. * 2.6.11 (FC4) supports filp_open() but later revs don't?
  1071. * Alternative:
  1072. * fp = open_namei(AT_FDCWD, filename, O_RD, 0);
  1073. * ???
  1074. */
  1075. if (IS_ERR(fp))
  1076. fp = NULL;
  1077. return fp;
  1078. }
  1079. int
  1080. osl_os_get_image_block(char *buf, int len, void *image)
  1081. {
  1082. struct file *fp = (struct file *)image;
  1083. int rdlen;
  1084. if (!image)
  1085. return 0;
  1086. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0))
  1087. rdlen = kernel_read(fp, buf, len, &fp->f_pos);
  1088. #else
  1089. rdlen = kernel_read(fp, fp->f_pos, buf, len);
  1090. #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) */
  1091. if (rdlen > 0)
  1092. fp->f_pos += rdlen;
  1093. return rdlen;
  1094. }
  1095. void
  1096. osl_os_close_image(void *image)
  1097. {
  1098. if (image)
  1099. filp_close((struct file *)image, NULL);
  1100. }
  1101. int
  1102. osl_os_image_size(void *image)
  1103. {
  1104. int len = 0, curroffset;
  1105. if (image) {
  1106. /* store the current offset */
  1107. curroffset = generic_file_llseek(image, 0, 1);
  1108. /* goto end of file to get length */
  1109. len = generic_file_llseek(image, 0, 2);
  1110. /* restore back the offset */
  1111. generic_file_llseek(image, curroffset, 0);
  1112. }
  1113. return len;
  1114. }
  1115. /* Linux Kernel: File Operations: end */
  1116. #if (defined(STB) && defined(__arm__))
  1117. inline void osl_pcie_rreg(osl_t *osh, ulong addr, volatile void *v, uint size)
  1118. {
  1119. unsigned long flags = 0;
  1120. int pci_access = 0;
  1121. int acp_war_enab = ACP_WAR_ENAB();
  1122. if (osh && BUSTYPE(osh->bustype) == PCI_BUS)
  1123. pci_access = 1;
  1124. if (pci_access && acp_war_enab)
  1125. spin_lock_irqsave(&l2x0_reg_lock, flags);
  1126. switch (size) {
  1127. case sizeof(uint8):
  1128. *(volatile uint8*)v = readb((volatile uint8*)(addr));
  1129. break;
  1130. case sizeof(uint16):
  1131. *(volatile uint16*)v = readw((volatile uint16*)(addr));
  1132. break;
  1133. case sizeof(uint32):
  1134. *(volatile uint32*)v = readl((volatile uint32*)(addr));
  1135. break;
  1136. case sizeof(uint64):
  1137. *(volatile uint64*)v = *((volatile uint64*)(addr));
  1138. break;
  1139. }
  1140. if (pci_access && acp_war_enab)
  1141. spin_unlock_irqrestore(&l2x0_reg_lock, flags);
  1142. }
  1143. #endif // endif
  1144. #if defined(BCM_BACKPLANE_TIMEOUT)
  1145. inline void osl_bpt_rreg(osl_t *osh, ulong addr, volatile void *v, uint size)
  1146. {
  1147. bool poll_timeout = FALSE;
  1148. static int in_si_clear = FALSE;
  1149. switch (size) {
  1150. case sizeof(uint8):
  1151. *(volatile uint8*)v = readb((volatile uint8*)(addr));
  1152. if (*(volatile uint8*)v == 0xff)
  1153. poll_timeout = TRUE;
  1154. break;
  1155. case sizeof(uint16):
  1156. *(volatile uint16*)v = readw((volatile uint16*)(addr));
  1157. if (*(volatile uint16*)v == 0xffff)
  1158. poll_timeout = TRUE;
  1159. break;
  1160. case sizeof(uint32):
  1161. *(volatile uint32*)v = readl((volatile uint32*)(addr));
  1162. if (*(volatile uint32*)v == 0xffffffff)
  1163. poll_timeout = TRUE;
  1164. break;
  1165. case sizeof(uint64):
  1166. *(volatile uint64*)v = *((volatile uint64*)(addr));
  1167. if (*(volatile uint64*)v == 0xffffffffffffffff)
  1168. poll_timeout = TRUE;
  1169. break;
  1170. }
  1171. if (osh && osh->sih && (in_si_clear == FALSE) && poll_timeout && osh->bpt_cb) {
  1172. in_si_clear = TRUE;
  1173. osh->bpt_cb((void *)osh->sih, (void *)addr);
  1174. in_si_clear = FALSE;
  1175. }
  1176. }
  1177. #endif /* BCM_BACKPLANE_TIMEOUT */
  1178. #ifdef BCM_SECURE_DMA
  1179. static void *
  1180. osl_sec_dma_ioremap(osl_t *osh, struct page *page, size_t size, bool iscache, bool isdecr)
  1181. {
  1182. struct page **map;
  1183. int order, i;
  1184. void *addr = NULL;
  1185. size = PAGE_ALIGN(size);
  1186. order = get_order(size);
  1187. map = kmalloc(sizeof(struct page *) << order, GFP_ATOMIC);
  1188. if (map == NULL)
  1189. return NULL;
  1190. for (i = 0; i < (size >> PAGE_SHIFT); i++)
  1191. map[i] = page + i;
  1192. if (iscache) {
  1193. addr = vmap(map, size >> PAGE_SHIFT, VM_MAP, __pgprot(PAGE_KERNEL));
  1194. if (isdecr) {
  1195. osh->contig_delta_va_pa = ((uint8 *)addr - page_to_phys(page));
  1196. }
  1197. } else {
  1198. #if defined(__ARM_ARCH_7A__)
  1199. addr = vmap(map, size >> PAGE_SHIFT, VM_MAP,
  1200. pgprot_noncached(__pgprot(PAGE_KERNEL)));
  1201. #endif // endif
  1202. if (isdecr) {
  1203. osh->contig_delta_va_pa = ((uint8 *)addr - page_to_phys(page));
  1204. }
  1205. }
  1206. kfree(map);
  1207. return (void *)addr;
  1208. }
  1209. static void
  1210. osl_sec_dma_iounmap(osl_t *osh, void *contig_base_va, size_t size)
  1211. {
  1212. vunmap(contig_base_va);
  1213. }
  1214. static int
  1215. osl_sec_dma_init_elem_mem_block(osl_t *osh, size_t mbsize, int max, sec_mem_elem_t **list)
  1216. {
  1217. int i;
  1218. int ret = BCME_OK;
  1219. sec_mem_elem_t *sec_mem_elem;
  1220. if ((sec_mem_elem = kmalloc(sizeof(sec_mem_elem_t)*(max), GFP_ATOMIC)) != NULL) {
  1221. *list = sec_mem_elem;
  1222. bzero(sec_mem_elem, sizeof(sec_mem_elem_t)*(max));
  1223. for (i = 0; i < max-1; i++) {
  1224. sec_mem_elem->next = (sec_mem_elem + 1);
  1225. sec_mem_elem->size = mbsize;
  1226. sec_mem_elem->pa_cma = osh->contig_base_alloc;
  1227. sec_mem_elem->vac = osh->contig_base_alloc_va;
  1228. sec_mem_elem->pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
  1229. osh->contig_base_alloc += mbsize;
  1230. osh->contig_base_alloc_va = ((uint8 *)osh->contig_base_alloc_va + mbsize);
  1231. sec_mem_elem = sec_mem_elem + 1;
  1232. }
  1233. sec_mem_elem->next = NULL;
  1234. sec_mem_elem->size = mbsize;
  1235. sec_mem_elem->pa_cma = osh->contig_base_alloc;
  1236. sec_mem_elem->vac = osh->contig_base_alloc_va;
  1237. sec_mem_elem->pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
  1238. osh->contig_base_alloc += mbsize;
  1239. osh->contig_base_alloc_va = ((uint8 *)osh->contig_base_alloc_va + mbsize);
  1240. } else {
  1241. printf("%s sec mem elem kmalloc failed\n", __FUNCTION__);
  1242. ret = BCME_ERROR;
  1243. }
  1244. return ret;
  1245. }
  1246. static void
  1247. osl_sec_dma_deinit_elem_mem_block(osl_t *osh, size_t mbsize, int max, void *sec_list_base)
  1248. {
  1249. if (sec_list_base)
  1250. kfree(sec_list_base);
  1251. }
  1252. static sec_mem_elem_t * BCMFASTPATH
  1253. osl_sec_dma_alloc_mem_elem(osl_t *osh, void *va, uint size, int direction,
  1254. struct sec_cma_info *ptr_cma_info, uint offset)
  1255. {
  1256. sec_mem_elem_t *sec_mem_elem = NULL;
  1257. ASSERT(osh->sec_list_4096);
  1258. sec_mem_elem = osh->sec_list_4096;
  1259. osh->sec_list_4096 = sec_mem_elem->next;
  1260. sec_mem_elem->next = NULL;
  1261. if (ptr_cma_info->sec_alloc_list_tail) {
  1262. ptr_cma_info->sec_alloc_list_tail->next = sec_mem_elem;
  1263. ptr_cma_info->sec_alloc_list_tail = sec_mem_elem;
  1264. }
  1265. else {
  1266. /* First allocation: If tail is NULL, sec_alloc_list MUST also be NULL */
  1267. ASSERT(ptr_cma_info->sec_alloc_list == NULL);
  1268. ptr_cma_info->sec_alloc_list = sec_mem_elem;
  1269. ptr_cma_info->sec_alloc_list_tail = sec_mem_elem;
  1270. }
  1271. return sec_mem_elem;
  1272. }
  1273. static void BCMFASTPATH
  1274. osl_sec_dma_free_mem_elem(osl_t *osh, sec_mem_elem_t *sec_mem_elem)
  1275. {
  1276. sec_mem_elem->dma_handle = 0x0;
  1277. sec_mem_elem->va = NULL;
  1278. sec_mem_elem->next = osh->sec_list_4096;
  1279. osh->sec_list_4096 = sec_mem_elem;
  1280. }
  1281. static sec_mem_elem_t * BCMFASTPATH
  1282. osl_sec_dma_find_rem_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info, dma_addr_t dma_handle)
  1283. {
  1284. sec_mem_elem_t *sec_mem_elem = ptr_cma_info->sec_alloc_list;
  1285. sec_mem_elem_t *sec_prv_elem = ptr_cma_info->sec_alloc_list;
  1286. if (sec_mem_elem->dma_handle == dma_handle) {
  1287. ptr_cma_info->sec_alloc_list = sec_mem_elem->next;
  1288. if (sec_mem_elem == ptr_cma_info->sec_alloc_list_tail) {
  1289. ptr_cma_info->sec_alloc_list_tail = NULL;
  1290. ASSERT(ptr_cma_info->sec_alloc_list == NULL);
  1291. }
  1292. return sec_mem_elem;
  1293. }
  1294. sec_mem_elem = sec_mem_elem->next;
  1295. while (sec_mem_elem != NULL) {
  1296. if (sec_mem_elem->dma_handle == dma_handle) {
  1297. sec_prv_elem->next = sec_mem_elem->next;
  1298. if (sec_mem_elem == ptr_cma_info->sec_alloc_list_tail)
  1299. ptr_cma_info->sec_alloc_list_tail = sec_prv_elem;
  1300. return sec_mem_elem;
  1301. }
  1302. sec_prv_elem = sec_mem_elem;
  1303. sec_mem_elem = sec_mem_elem->next;
  1304. }
  1305. return NULL;
  1306. }
  1307. static sec_mem_elem_t *
  1308. osl_sec_dma_rem_first_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info)
  1309. {
  1310. sec_mem_elem_t *sec_mem_elem = ptr_cma_info->sec_alloc_list;
  1311. if (sec_mem_elem) {
  1312. ptr_cma_info->sec_alloc_list = sec_mem_elem->next;
  1313. if (ptr_cma_info->sec_alloc_list == NULL)
  1314. ptr_cma_info->sec_alloc_list_tail = NULL;
  1315. return sec_mem_elem;
  1316. } else
  1317. return NULL;
  1318. }
  1319. static void * BCMFASTPATH
  1320. osl_sec_dma_last_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info)
  1321. {
  1322. return ptr_cma_info->sec_alloc_list_tail;
  1323. }
  1324. dma_addr_t BCMFASTPATH
  1325. osl_sec_dma_map_txmeta(osl_t *osh, void *va, uint size, int direction, void *p,
  1326. hnddma_seg_map_t *dmah, void *ptr_cma_info)
  1327. {
  1328. sec_mem_elem_t *sec_mem_elem;
  1329. struct page *pa_cma_page;
  1330. uint loffset;
  1331. void *vaorig = ((uint8 *)va + size);
  1332. dma_addr_t dma_handle = 0x0;
  1333. /* packet will be the one added with osl_sec_dma_map() just before this call */
  1334. sec_mem_elem = osl_sec_dma_last_elem(osh, ptr_cma_info);
  1335. if (sec_mem_elem && sec_mem_elem->va == vaorig) {
  1336. pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
  1337. loffset = sec_mem_elem->pa_cma -(sec_mem_elem->pa_cma & ~(PAGE_SIZE-1));
  1338. dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset, size,
  1339. (direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
  1340. } else {
  1341. printf("%s: error orig va not found va = 0x%p \n",
  1342. __FUNCTION__, vaorig);
  1343. }
  1344. return dma_handle;
  1345. }
  1346. dma_addr_t BCMFASTPATH
  1347. osl_sec_dma_map(osl_t *osh, void *va, uint size, int direction, void *p,
  1348. hnddma_seg_map_t *dmah, void *ptr_cma_info, uint offset)
  1349. {
  1350. sec_mem_elem_t *sec_mem_elem;
  1351. struct page *pa_cma_page;
  1352. void *pa_cma_kmap_va = NULL;
  1353. uint buflen = 0;
  1354. dma_addr_t dma_handle = 0x0;
  1355. uint loffset;
  1356. ASSERT((direction == DMA_RX) || (direction == DMA_TX));
  1357. sec_mem_elem = osl_sec_dma_alloc_mem_elem(osh, va, size, direction, ptr_cma_info, offset);
  1358. sec_mem_elem->va = va;
  1359. sec_mem_elem->direction = direction;
  1360. pa_cma_page = sec_mem_elem->pa_cma_page;
  1361. loffset = sec_mem_elem->pa_cma -(sec_mem_elem->pa_cma & ~(PAGE_SIZE-1));
  1362. /* pa_cma_kmap_va = kmap_atomic(pa_cma_page);
  1363. * pa_cma_kmap_va += loffset;
  1364. */
  1365. pa_cma_kmap_va = sec_mem_elem->vac;
  1366. pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + offset);
  1367. buflen = size;
  1368. if (direction == DMA_TX) {
  1369. memcpy((uint8*)pa_cma_kmap_va+offset, va, size);
  1370. if (dmah) {
  1371. dmah->nsegs = 1;
  1372. dmah->origsize = buflen;
  1373. }
  1374. }
  1375. else
  1376. {
  1377. if ((p != NULL) && (dmah != NULL)) {
  1378. dmah->nsegs = 1;
  1379. dmah->origsize = buflen;
  1380. }
  1381. *(uint32 *)(pa_cma_kmap_va) = 0x0;
  1382. }
  1383. if (direction == DMA_RX) {
  1384. flush_kernel_vmap_range(pa_cma_kmap_va, sizeof(int));
  1385. }
  1386. dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset+offset, buflen,
  1387. (direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
  1388. if (dmah) {
  1389. dmah->segs[0].addr = dma_handle;
  1390. dmah->segs[0].length = buflen;
  1391. }
  1392. sec_mem_elem->dma_handle = dma_handle;
  1393. /* kunmap_atomic(pa_cma_kmap_va-loffset); */
  1394. return dma_handle;
  1395. }
  1396. dma_addr_t BCMFASTPATH
  1397. osl_sec_dma_dd_map(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *map)
  1398. {
  1399. struct page *pa_cma_page;
  1400. phys_addr_t pa_cma;
  1401. dma_addr_t dma_handle = 0x0;
  1402. uint loffset;
  1403. pa_cma = ((uint8 *)va - (uint8 *)osh->contig_delta_va_pa);
  1404. pa_cma_page = phys_to_page(pa_cma);
  1405. loffset = pa_cma -(pa_cma & ~(PAGE_SIZE-1));
  1406. dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset, size,
  1407. (direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
  1408. return dma_handle;
  1409. }
  1410. void BCMFASTPATH
  1411. osl_sec_dma_unmap(osl_t *osh, dma_addr_t dma_handle, uint size, int direction,
  1412. void *p, hnddma_seg_map_t *map, void *ptr_cma_info, uint offset)
  1413. {
  1414. sec_mem_elem_t *sec_mem_elem;
  1415. void *pa_cma_kmap_va = NULL;
  1416. uint buflen = 0;
  1417. dma_addr_t pa_cma;
  1418. void *va;
  1419. int read_count = 0;
  1420. BCM_REFERENCE(buflen);
  1421. BCM_REFERENCE(read_count);
  1422. sec_mem_elem = osl_sec_dma_find_rem_elem(osh, ptr_cma_info, dma_handle);
  1423. ASSERT(sec_mem_elem);
  1424. va = sec_mem_elem->va;
  1425. va = (uint8 *)va - offset;
  1426. pa_cma = sec_mem_elem->pa_cma;
  1427. if (direction == DMA_RX) {
  1428. if (p == NULL) {
  1429. /* pa_cma_kmap_va = kmap_atomic(pa_cma_page);
  1430. * pa_cma_kmap_va += loffset;
  1431. */
  1432. pa_cma_kmap_va = sec_mem_elem->vac;
  1433. do {
  1434. invalidate_kernel_vmap_range(pa_cma_kmap_va, sizeof(int));
  1435. buflen = *(uint *)(pa_cma_kmap_va);
  1436. if (buflen)
  1437. break;
  1438. OSL_DELAY(1);
  1439. read_count++;
  1440. } while (read_count < 200);
  1441. dma_unmap_page(OSH_NULL, pa_cma, size, DMA_FROM_DEVICE);
  1442. memcpy(va, pa_cma_kmap_va, size);
  1443. /* kunmap_atomic(pa_cma_kmap_va); */
  1444. }
  1445. } else {
  1446. dma_unmap_page(OSH_NULL, pa_cma, size+offset, DMA_TO_DEVICE);
  1447. }
  1448. osl_sec_dma_free_mem_elem(osh, sec_mem_elem);
  1449. }
  1450. void
  1451. osl_sec_dma_unmap_all(osl_t *osh, void *ptr_cma_info)
  1452. {
  1453. sec_mem_elem_t *sec_mem_elem;
  1454. sec_mem_elem = osl_sec_dma_rem_first_elem(osh, ptr_cma_info);
  1455. while (sec_mem_elem != NULL) {
  1456. dma_unmap_page(OSH_NULL, sec_mem_elem->pa_cma, sec_mem_elem->size,
  1457. sec_mem_elem->direction == DMA_TX ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
  1458. osl_sec_dma_free_mem_elem(osh, sec_mem_elem);
  1459. sec_mem_elem = osl_sec_dma_rem_first_elem(osh, ptr_cma_info);
  1460. }
  1461. }
  1462. static void
  1463. osl_sec_dma_init_consistent(osl_t *osh)
  1464. {
  1465. int i;
  1466. void *temp_va = osh->contig_base_alloc_coherent_va;
  1467. phys_addr_t temp_pa = osh->contig_base_alloc_coherent;
  1468. for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
  1469. osh->sec_cma_coherent[i].avail = TRUE;
  1470. osh->sec_cma_coherent[i].va = temp_va;
  1471. osh->sec_cma_coherent[i].pa = temp_pa;
  1472. temp_va = ((uint8 *)temp_va)+SEC_CMA_COHERENT_BLK;
  1473. temp_pa += SEC_CMA_COHERENT_BLK;
  1474. }
  1475. }
  1476. static void *
  1477. osl_sec_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits, ulong *pap)
  1478. {
  1479. void *temp_va = NULL;
  1480. ulong temp_pa = 0;
  1481. int i;
  1482. if (size > SEC_CMA_COHERENT_BLK) {
  1483. printf("%s unsupported size\n", __FUNCTION__);
  1484. return NULL;
  1485. }
  1486. for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
  1487. if (osh->sec_cma_coherent[i].avail == TRUE) {
  1488. temp_va = osh->sec_cma_coherent[i].va;
  1489. temp_pa = osh->sec_cma_coherent[i].pa;
  1490. osh->sec_cma_coherent[i].avail = FALSE;
  1491. break;
  1492. }
  1493. }
  1494. if (i == SEC_CMA_COHERENT_MAX)
  1495. printf("%s:No coherent mem: va = 0x%p pa = 0x%lx size = %d\n", __FUNCTION__,
  1496. temp_va, (ulong)temp_pa, size);
  1497. *pap = (unsigned long)temp_pa;
  1498. return temp_va;
  1499. }
  1500. static void
  1501. osl_sec_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa)
  1502. {
  1503. int i = 0;
  1504. for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
  1505. if (osh->sec_cma_coherent[i].va == va) {
  1506. osh->sec_cma_coherent[i].avail = TRUE;
  1507. break;
  1508. }
  1509. }
  1510. if (i == SEC_CMA_COHERENT_MAX)
  1511. printf("%s:Error: va = 0x%p pa = 0x%lx size = %d\n", __FUNCTION__,
  1512. va, (ulong)pa, size);
  1513. }
  1514. #endif /* BCM_SECURE_DMA */
  1515. /* timer apis */
  1516. /* Note: All timer api's are thread unsafe and should be protected with locks by caller */
  1517. #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 15, 0)
  1518. void
  1519. timer_cb_compat(struct timer_list *tl)
  1520. {
  1521. timer_list_compat_t *t = container_of(tl, timer_list_compat_t, timer);
  1522. t->callback((ulong)t->arg);
  1523. }
  1524. #endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(4, 15, 0) */
  1525. osl_timer_t *
  1526. osl_timer_init(osl_t *osh, const char *name, void (*fn)(void *arg), void *arg)
  1527. {
  1528. osl_timer_t *t;
  1529. BCM_REFERENCE(fn);
  1530. if ((t = MALLOCZ(NULL, sizeof(osl_timer_t))) == NULL) {
  1531. printk(KERN_ERR "osl_timer_init: out of memory, malloced %d bytes\n",
  1532. (int)sizeof(osl_timer_t));
  1533. return (NULL);
  1534. }
  1535. bzero(t, sizeof(osl_timer_t));
  1536. if ((t->timer = MALLOCZ(NULL, sizeof(struct timer_list))) == NULL) {
  1537. printf("osl_timer_init: malloc failed\n");
  1538. MFREE(NULL, t, sizeof(osl_timer_t));
  1539. return (NULL);
  1540. }
  1541. t->set = TRUE;
  1542. init_timer_compat(t->timer, (linux_timer_fn)fn, arg);
  1543. return (t);
  1544. }
  1545. void
  1546. osl_timer_add(osl_t *osh, osl_timer_t *t, uint32 ms, bool periodic)
  1547. {
  1548. if (t == NULL) {
  1549. printf("%s: Timer handle is NULL\n", __FUNCTION__);
  1550. return;
  1551. }
  1552. ASSERT(!t->set);
  1553. t->set = TRUE;
  1554. if (periodic) {
  1555. printf("Periodic timers are not supported by Linux timer apis\n");
  1556. }
  1557. timer_expires(t->timer) = jiffies + ms*HZ/1000;
  1558. add_timer(t->timer);
  1559. return;
  1560. }
  1561. void
  1562. osl_timer_update(osl_t *osh, osl_timer_t *t, uint32 ms, bool periodic)
  1563. {
  1564. if (t == NULL) {
  1565. printf("%s: Timer handle is NULL\n", __FUNCTION__);
  1566. return;
  1567. }
  1568. if (periodic) {
  1569. printf("Periodic timers are not supported by Linux timer apis\n");
  1570. }
  1571. t->set = TRUE;
  1572. timer_expires(t->timer) = jiffies + ms*HZ/1000;
  1573. mod_timer(t->timer, timer_expires(t->timer));
  1574. return;
  1575. }
  1576. /*
  1577. * Return TRUE if timer successfully deleted, FALSE if still pending
  1578. */
  1579. bool
  1580. osl_timer_del(osl_t *osh, osl_timer_t *t)
  1581. {
  1582. if (t == NULL) {
  1583. printf("%s: Timer handle is NULL\n", __FUNCTION__);
  1584. return (FALSE);
  1585. }
  1586. if (t->set) {
  1587. t->set = FALSE;
  1588. if (t->timer) {
  1589. del_timer(t->timer);
  1590. MFREE(NULL, t->timer, sizeof(struct timer_list));
  1591. }
  1592. MFREE(NULL, t, sizeof(osl_timer_t));
  1593. }
  1594. return (TRUE);
  1595. }
  1596. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0))
  1597. int
  1598. kernel_read_compat(struct file *file, loff_t offset, char *addr, unsigned long count)
  1599. {
  1600. return (int)kernel_read(file, addr, (size_t)count, &offset);
  1601. }
  1602. #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) */
  1603. void *
  1604. osl_spin_lock_init(osl_t *osh)
  1605. {
  1606. /* Adding 4 bytes since the sizeof(spinlock_t) could be 0 */
  1607. /* if CONFIG_SMP and CONFIG_DEBUG_SPINLOCK are not defined */
  1608. /* and this results in kernel asserts in internal builds */
  1609. spinlock_t * lock = MALLOC(osh, sizeof(spinlock_t) + 4);
  1610. if (lock)
  1611. spin_lock_init(lock);
  1612. return ((void *)lock);
  1613. }
  1614. void
  1615. osl_spin_lock_deinit(osl_t *osh, void *lock)
  1616. {
  1617. if (lock)
  1618. MFREE(osh, lock, sizeof(spinlock_t) + 4);
  1619. }
  1620. unsigned long
  1621. osl_spin_lock(void *lock)
  1622. {
  1623. unsigned long flags = 0;
  1624. if (lock)
  1625. spin_lock_irqsave((spinlock_t *)lock, flags);
  1626. return flags;
  1627. }
  1628. void
  1629. osl_spin_unlock(void *lock, unsigned long flags)
  1630. {
  1631. if (lock)
  1632. spin_unlock_irqrestore((spinlock_t *)lock, flags);
  1633. }
  1634. #ifdef USE_DMA_LOCK
  1635. static void
  1636. osl_dma_lock(osl_t *osh)
  1637. {
  1638. if (likely(in_irq() || irqs_disabled())) {
  1639. spin_lock(&osh->dma_lock);
  1640. } else {
  1641. spin_lock_bh(&osh->dma_lock);
  1642. osh->dma_lock_bh = TRUE;
  1643. }
  1644. }
  1645. static void
  1646. osl_dma_unlock(osl_t *osh)
  1647. {
  1648. if (unlikely(osh->dma_lock_bh)) {
  1649. osh->dma_lock_bh = FALSE;
  1650. spin_unlock_bh(&osh->dma_lock);
  1651. } else {
  1652. spin_unlock(&osh->dma_lock);
  1653. }
  1654. }
  1655. static void
  1656. osl_dma_lock_init(osl_t *osh)
  1657. {
  1658. spin_lock_init(&osh->dma_lock);
  1659. osh->dma_lock_bh = FALSE;
  1660. }
  1661. #endif /* USE_DMA_LOCK */