ntb_transport.c 38 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493
  1. /*
  2. * This file is provided under a dual BSD/GPLv2 license. When using or
  3. * redistributing this file, you may do so under either license.
  4. *
  5. * GPL LICENSE SUMMARY
  6. *
  7. * Copyright(c) 2012 Intel Corporation. All rights reserved.
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of version 2 of the GNU General Public License as
  11. * published by the Free Software Foundation.
  12. *
  13. * BSD LICENSE
  14. *
  15. * Copyright(c) 2012 Intel Corporation. All rights reserved.
  16. *
  17. * Redistribution and use in source and binary forms, with or without
  18. * modification, are permitted provided that the following conditions
  19. * are met:
  20. *
  21. * * Redistributions of source code must retain the above copyright
  22. * notice, this list of conditions and the following disclaimer.
  23. * * Redistributions in binary form must reproduce the above copy
  24. * notice, this list of conditions and the following disclaimer in
  25. * the documentation and/or other materials provided with the
  26. * distribution.
  27. * * Neither the name of Intel Corporation nor the names of its
  28. * contributors may be used to endorse or promote products derived
  29. * from this software without specific prior written permission.
  30. *
  31. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  32. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  33. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  34. * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  35. * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  36. * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  37. * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  38. * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  39. * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  40. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  41. * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  42. *
  43. * Intel PCIe NTB Linux driver
  44. *
  45. * Contact Information:
  46. * Jon Mason <jon.mason@intel.com>
  47. */
  48. #include <linux/debugfs.h>
  49. #include <linux/delay.h>
  50. #include <linux/dma-mapping.h>
  51. #include <linux/errno.h>
  52. #include <linux/export.h>
  53. #include <linux/interrupt.h>
  54. #include <linux/module.h>
  55. #include <linux/pci.h>
  56. #include <linux/slab.h>
  57. #include <linux/types.h>
  58. #include <linux/ntb.h>
  59. #include "ntb_hw.h"
  60. #define NTB_TRANSPORT_VERSION 3
  61. static unsigned int transport_mtu = 0x401E;
  62. module_param(transport_mtu, uint, 0644);
  63. MODULE_PARM_DESC(transport_mtu, "Maximum size of NTB transport packets");
  64. static unsigned char max_num_clients = 2;
  65. module_param(max_num_clients, byte, 0644);
  66. MODULE_PARM_DESC(max_num_clients, "Maximum number of NTB transport clients");
  67. struct ntb_queue_entry {
  68. /* ntb_queue list reference */
  69. struct list_head entry;
  70. /* pointers to data to be transfered */
  71. void *cb_data;
  72. void *buf;
  73. unsigned int len;
  74. unsigned int flags;
  75. };
  76. struct ntb_rx_info {
  77. unsigned int entry;
  78. };
  79. struct ntb_transport_qp {
  80. struct ntb_transport *transport;
  81. struct ntb_device *ndev;
  82. void *cb_data;
  83. bool client_ready;
  84. bool qp_link;
  85. u8 qp_num; /* Only 64 QP's are allowed. 0-63 */
  86. struct ntb_rx_info __iomem *rx_info;
  87. struct ntb_rx_info *remote_rx_info;
  88. void (*tx_handler) (struct ntb_transport_qp *qp, void *qp_data,
  89. void *data, int len);
  90. struct list_head tx_free_q;
  91. spinlock_t ntb_tx_free_q_lock;
  92. void __iomem *tx_mw;
  93. unsigned int tx_index;
  94. unsigned int tx_max_entry;
  95. unsigned int tx_max_frame;
  96. void (*rx_handler) (struct ntb_transport_qp *qp, void *qp_data,
  97. void *data, int len);
  98. struct tasklet_struct rx_work;
  99. struct list_head rx_pend_q;
  100. struct list_head rx_free_q;
  101. spinlock_t ntb_rx_pend_q_lock;
  102. spinlock_t ntb_rx_free_q_lock;
  103. void *rx_buff;
  104. unsigned int rx_index;
  105. unsigned int rx_max_entry;
  106. unsigned int rx_max_frame;
  107. void (*event_handler) (void *data, int status);
  108. struct delayed_work link_work;
  109. struct work_struct link_cleanup;
  110. struct dentry *debugfs_dir;
  111. struct dentry *debugfs_stats;
  112. /* Stats */
  113. u64 rx_bytes;
  114. u64 rx_pkts;
  115. u64 rx_ring_empty;
  116. u64 rx_err_no_buf;
  117. u64 rx_err_oflow;
  118. u64 rx_err_ver;
  119. u64 tx_bytes;
  120. u64 tx_pkts;
  121. u64 tx_ring_full;
  122. };
  123. struct ntb_transport_mw {
  124. size_t size;
  125. void *virt_addr;
  126. dma_addr_t dma_addr;
  127. };
  128. struct ntb_transport_client_dev {
  129. struct list_head entry;
  130. struct device dev;
  131. };
  132. struct ntb_transport {
  133. struct list_head entry;
  134. struct list_head client_devs;
  135. struct ntb_device *ndev;
  136. struct ntb_transport_mw mw[NTB_NUM_MW];
  137. struct ntb_transport_qp *qps;
  138. unsigned int max_qps;
  139. unsigned long qp_bitmap;
  140. bool transport_link;
  141. struct delayed_work link_work;
  142. struct work_struct link_cleanup;
  143. struct dentry *debugfs_dir;
  144. };
  145. enum {
  146. DESC_DONE_FLAG = 1 << 0,
  147. LINK_DOWN_FLAG = 1 << 1,
  148. };
  149. struct ntb_payload_header {
  150. unsigned int ver;
  151. unsigned int len;
  152. unsigned int flags;
  153. };
  154. enum {
  155. VERSION = 0,
  156. QP_LINKS,
  157. NUM_QPS,
  158. NUM_MWS,
  159. MW0_SZ_HIGH,
  160. MW0_SZ_LOW,
  161. MW1_SZ_HIGH,
  162. MW1_SZ_LOW,
  163. MAX_SPAD,
  164. };
  165. #define QP_TO_MW(qp) ((qp) % NTB_NUM_MW)
  166. #define NTB_QP_DEF_NUM_ENTRIES 100
  167. #define NTB_LINK_DOWN_TIMEOUT 10
  168. static int ntb_match_bus(struct device *dev, struct device_driver *drv)
  169. {
  170. return !strncmp(dev_name(dev), drv->name, strlen(drv->name));
  171. }
  172. static int ntb_client_probe(struct device *dev)
  173. {
  174. const struct ntb_client *drv = container_of(dev->driver,
  175. struct ntb_client, driver);
  176. struct pci_dev *pdev = container_of(dev->parent, struct pci_dev, dev);
  177. int rc = -EINVAL;
  178. get_device(dev);
  179. if (drv && drv->probe)
  180. rc = drv->probe(pdev);
  181. if (rc)
  182. put_device(dev);
  183. return rc;
  184. }
  185. static int ntb_client_remove(struct device *dev)
  186. {
  187. const struct ntb_client *drv = container_of(dev->driver,
  188. struct ntb_client, driver);
  189. struct pci_dev *pdev = container_of(dev->parent, struct pci_dev, dev);
  190. if (drv && drv->remove)
  191. drv->remove(pdev);
  192. put_device(dev);
  193. return 0;
  194. }
  195. static struct bus_type ntb_bus_type = {
  196. .name = "ntb_bus",
  197. .match = ntb_match_bus,
  198. .probe = ntb_client_probe,
  199. .remove = ntb_client_remove,
  200. };
  201. static LIST_HEAD(ntb_transport_list);
  202. static int ntb_bus_init(struct ntb_transport *nt)
  203. {
  204. if (list_empty(&ntb_transport_list)) {
  205. int rc = bus_register(&ntb_bus_type);
  206. if (rc)
  207. return rc;
  208. }
  209. list_add(&nt->entry, &ntb_transport_list);
  210. return 0;
  211. }
  212. static void ntb_bus_remove(struct ntb_transport *nt)
  213. {
  214. struct ntb_transport_client_dev *client_dev, *cd;
  215. list_for_each_entry_safe(client_dev, cd, &nt->client_devs, entry) {
  216. dev_err(client_dev->dev.parent, "%s still attached to bus, removing\n",
  217. dev_name(&client_dev->dev));
  218. list_del(&client_dev->entry);
  219. device_unregister(&client_dev->dev);
  220. }
  221. list_del(&nt->entry);
  222. if (list_empty(&ntb_transport_list))
  223. bus_unregister(&ntb_bus_type);
  224. }
  225. static void ntb_client_release(struct device *dev)
  226. {
  227. struct ntb_transport_client_dev *client_dev;
  228. client_dev = container_of(dev, struct ntb_transport_client_dev, dev);
  229. kfree(client_dev);
  230. }
  231. /**
  232. * ntb_unregister_client_dev - Unregister NTB client device
  233. * @device_name: Name of NTB client device
  234. *
  235. * Unregister an NTB client device with the NTB transport layer
  236. */
  237. void ntb_unregister_client_dev(char *device_name)
  238. {
  239. struct ntb_transport_client_dev *client, *cd;
  240. struct ntb_transport *nt;
  241. list_for_each_entry(nt, &ntb_transport_list, entry)
  242. list_for_each_entry_safe(client, cd, &nt->client_devs, entry)
  243. if (!strncmp(dev_name(&client->dev), device_name,
  244. strlen(device_name))) {
  245. list_del(&client->entry);
  246. device_unregister(&client->dev);
  247. }
  248. }
  249. EXPORT_SYMBOL_GPL(ntb_unregister_client_dev);
  250. /**
  251. * ntb_register_client_dev - Register NTB client device
  252. * @device_name: Name of NTB client device
  253. *
  254. * Register an NTB client device with the NTB transport layer
  255. */
  256. int ntb_register_client_dev(char *device_name)
  257. {
  258. struct ntb_transport_client_dev *client_dev;
  259. struct ntb_transport *nt;
  260. int rc;
  261. if (list_empty(&ntb_transport_list))
  262. return -ENODEV;
  263. list_for_each_entry(nt, &ntb_transport_list, entry) {
  264. struct device *dev;
  265. client_dev = kzalloc(sizeof(struct ntb_transport_client_dev),
  266. GFP_KERNEL);
  267. if (!client_dev) {
  268. rc = -ENOMEM;
  269. goto err;
  270. }
  271. dev = &client_dev->dev;
  272. /* setup and register client devices */
  273. dev_set_name(dev, "%s", device_name);
  274. dev->bus = &ntb_bus_type;
  275. dev->release = ntb_client_release;
  276. dev->parent = &ntb_query_pdev(nt->ndev)->dev;
  277. rc = device_register(dev);
  278. if (rc) {
  279. kfree(client_dev);
  280. goto err;
  281. }
  282. list_add_tail(&client_dev->entry, &nt->client_devs);
  283. }
  284. return 0;
  285. err:
  286. ntb_unregister_client_dev(device_name);
  287. return rc;
  288. }
  289. EXPORT_SYMBOL_GPL(ntb_register_client_dev);
  290. /**
  291. * ntb_register_client - Register NTB client driver
  292. * @drv: NTB client driver to be registered
  293. *
  294. * Register an NTB client driver with the NTB transport layer
  295. *
  296. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  297. */
  298. int ntb_register_client(struct ntb_client *drv)
  299. {
  300. drv->driver.bus = &ntb_bus_type;
  301. if (list_empty(&ntb_transport_list))
  302. return -ENODEV;
  303. return driver_register(&drv->driver);
  304. }
  305. EXPORT_SYMBOL_GPL(ntb_register_client);
  306. /**
  307. * ntb_unregister_client - Unregister NTB client driver
  308. * @drv: NTB client driver to be unregistered
  309. *
  310. * Unregister an NTB client driver with the NTB transport layer
  311. *
  312. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  313. */
  314. void ntb_unregister_client(struct ntb_client *drv)
  315. {
  316. driver_unregister(&drv->driver);
  317. }
  318. EXPORT_SYMBOL_GPL(ntb_unregister_client);
  319. static ssize_t debugfs_read(struct file *filp, char __user *ubuf, size_t count,
  320. loff_t *offp)
  321. {
  322. struct ntb_transport_qp *qp;
  323. char *buf;
  324. ssize_t ret, out_offset, out_count;
  325. out_count = 600;
  326. buf = kmalloc(out_count, GFP_KERNEL);
  327. if (!buf)
  328. return -ENOMEM;
  329. qp = filp->private_data;
  330. out_offset = 0;
  331. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  332. "NTB QP stats\n");
  333. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  334. "rx_bytes - \t%llu\n", qp->rx_bytes);
  335. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  336. "rx_pkts - \t%llu\n", qp->rx_pkts);
  337. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  338. "rx_ring_empty - %llu\n", qp->rx_ring_empty);
  339. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  340. "rx_err_no_buf - %llu\n", qp->rx_err_no_buf);
  341. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  342. "rx_err_oflow - \t%llu\n", qp->rx_err_oflow);
  343. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  344. "rx_err_ver - \t%llu\n", qp->rx_err_ver);
  345. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  346. "rx_buff - \t%p\n", qp->rx_buff);
  347. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  348. "rx_index - \t%u\n", qp->rx_index);
  349. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  350. "rx_max_entry - \t%u\n", qp->rx_max_entry);
  351. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  352. "tx_bytes - \t%llu\n", qp->tx_bytes);
  353. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  354. "tx_pkts - \t%llu\n", qp->tx_pkts);
  355. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  356. "tx_ring_full - \t%llu\n", qp->tx_ring_full);
  357. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  358. "tx_mw - \t%p\n", qp->tx_mw);
  359. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  360. "tx_index - \t%u\n", qp->tx_index);
  361. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  362. "tx_max_entry - \t%u\n", qp->tx_max_entry);
  363. out_offset += snprintf(buf + out_offset, out_count - out_offset,
  364. "\nQP Link %s\n", (qp->qp_link == NTB_LINK_UP) ?
  365. "Up" : "Down");
  366. if (out_offset > out_count)
  367. out_offset = out_count;
  368. ret = simple_read_from_buffer(ubuf, count, offp, buf, out_offset);
  369. kfree(buf);
  370. return ret;
  371. }
  372. static const struct file_operations ntb_qp_debugfs_stats = {
  373. .owner = THIS_MODULE,
  374. .open = simple_open,
  375. .read = debugfs_read,
  376. };
  377. static void ntb_list_add(spinlock_t *lock, struct list_head *entry,
  378. struct list_head *list)
  379. {
  380. unsigned long flags;
  381. spin_lock_irqsave(lock, flags);
  382. list_add_tail(entry, list);
  383. spin_unlock_irqrestore(lock, flags);
  384. }
  385. static struct ntb_queue_entry *ntb_list_rm(spinlock_t *lock,
  386. struct list_head *list)
  387. {
  388. struct ntb_queue_entry *entry;
  389. unsigned long flags;
  390. spin_lock_irqsave(lock, flags);
  391. if (list_empty(list)) {
  392. entry = NULL;
  393. goto out;
  394. }
  395. entry = list_first_entry(list, struct ntb_queue_entry, entry);
  396. list_del(&entry->entry);
  397. out:
  398. spin_unlock_irqrestore(lock, flags);
  399. return entry;
  400. }
  401. static void ntb_transport_setup_qp_mw(struct ntb_transport *nt,
  402. unsigned int qp_num)
  403. {
  404. struct ntb_transport_qp *qp = &nt->qps[qp_num];
  405. unsigned int rx_size, num_qps_mw;
  406. u8 mw_num = QP_TO_MW(qp_num);
  407. unsigned int i;
  408. WARN_ON(nt->mw[mw_num].virt_addr == NULL);
  409. if (nt->max_qps % NTB_NUM_MW && mw_num < nt->max_qps % NTB_NUM_MW)
  410. num_qps_mw = nt->max_qps / NTB_NUM_MW + 1;
  411. else
  412. num_qps_mw = nt->max_qps / NTB_NUM_MW;
  413. rx_size = (unsigned int) nt->mw[mw_num].size / num_qps_mw;
  414. qp->remote_rx_info = nt->mw[mw_num].virt_addr +
  415. (qp_num / NTB_NUM_MW * rx_size);
  416. rx_size -= sizeof(struct ntb_rx_info);
  417. qp->rx_buff = qp->remote_rx_info + 1;
  418. /* Due to housekeeping, there must be atleast 2 buffs */
  419. qp->rx_max_frame = min(transport_mtu, rx_size / 2);
  420. qp->rx_max_entry = rx_size / qp->rx_max_frame;
  421. qp->rx_index = 0;
  422. qp->remote_rx_info->entry = qp->rx_max_entry - 1;
  423. /* setup the hdr offsets with 0's */
  424. for (i = 0; i < qp->rx_max_entry; i++) {
  425. void *offset = qp->rx_buff + qp->rx_max_frame * (i + 1) -
  426. sizeof(struct ntb_payload_header);
  427. memset(offset, 0, sizeof(struct ntb_payload_header));
  428. }
  429. qp->rx_pkts = 0;
  430. qp->tx_pkts = 0;
  431. qp->tx_index = 0;
  432. }
  433. static void ntb_free_mw(struct ntb_transport *nt, int num_mw)
  434. {
  435. struct ntb_transport_mw *mw = &nt->mw[num_mw];
  436. struct pci_dev *pdev = ntb_query_pdev(nt->ndev);
  437. if (!mw->virt_addr)
  438. return;
  439. dma_free_coherent(&pdev->dev, mw->size, mw->virt_addr, mw->dma_addr);
  440. mw->virt_addr = NULL;
  441. }
  442. static int ntb_set_mw(struct ntb_transport *nt, int num_mw, unsigned int size)
  443. {
  444. struct ntb_transport_mw *mw = &nt->mw[num_mw];
  445. struct pci_dev *pdev = ntb_query_pdev(nt->ndev);
  446. /* No need to re-setup */
  447. if (mw->size == ALIGN(size, 4096))
  448. return 0;
  449. if (mw->size != 0)
  450. ntb_free_mw(nt, num_mw);
  451. /* Alloc memory for receiving data. Must be 4k aligned */
  452. mw->size = ALIGN(size, 4096);
  453. mw->virt_addr = dma_alloc_coherent(&pdev->dev, mw->size, &mw->dma_addr,
  454. GFP_KERNEL);
  455. if (!mw->virt_addr) {
  456. mw->size = 0;
  457. dev_err(&pdev->dev, "Unable to allocate MW buffer of size %d\n",
  458. (int) mw->size);
  459. return -ENOMEM;
  460. }
  461. /* Notify HW the memory location of the receive buffer */
  462. ntb_set_mw_addr(nt->ndev, num_mw, mw->dma_addr);
  463. return 0;
  464. }
  465. static void ntb_qp_link_cleanup(struct work_struct *work)
  466. {
  467. struct ntb_transport_qp *qp = container_of(work,
  468. struct ntb_transport_qp,
  469. link_cleanup);
  470. struct ntb_transport *nt = qp->transport;
  471. struct pci_dev *pdev = ntb_query_pdev(nt->ndev);
  472. if (qp->qp_link == NTB_LINK_DOWN) {
  473. cancel_delayed_work_sync(&qp->link_work);
  474. return;
  475. }
  476. if (qp->event_handler)
  477. qp->event_handler(qp->cb_data, NTB_LINK_DOWN);
  478. dev_info(&pdev->dev, "qp %d: Link Down\n", qp->qp_num);
  479. qp->qp_link = NTB_LINK_DOWN;
  480. if (nt->transport_link == NTB_LINK_UP)
  481. schedule_delayed_work(&qp->link_work,
  482. msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
  483. }
  484. static void ntb_qp_link_down(struct ntb_transport_qp *qp)
  485. {
  486. schedule_work(&qp->link_cleanup);
  487. }
  488. static void ntb_transport_link_cleanup(struct work_struct *work)
  489. {
  490. struct ntb_transport *nt = container_of(work, struct ntb_transport,
  491. link_cleanup);
  492. int i;
  493. if (nt->transport_link == NTB_LINK_DOWN)
  494. cancel_delayed_work_sync(&nt->link_work);
  495. else
  496. nt->transport_link = NTB_LINK_DOWN;
  497. /* Pass along the info to any clients */
  498. for (i = 0; i < nt->max_qps; i++)
  499. if (!test_bit(i, &nt->qp_bitmap))
  500. ntb_qp_link_down(&nt->qps[i]);
  501. /* The scratchpad registers keep the values if the remote side
  502. * goes down, blast them now to give them a sane value the next
  503. * time they are accessed
  504. */
  505. for (i = 0; i < MAX_SPAD; i++)
  506. ntb_write_local_spad(nt->ndev, i, 0);
  507. }
  508. static void ntb_transport_event_callback(void *data, enum ntb_hw_event event)
  509. {
  510. struct ntb_transport *nt = data;
  511. switch (event) {
  512. case NTB_EVENT_HW_LINK_UP:
  513. schedule_delayed_work(&nt->link_work, 0);
  514. break;
  515. case NTB_EVENT_HW_LINK_DOWN:
  516. schedule_work(&nt->link_cleanup);
  517. break;
  518. default:
  519. BUG();
  520. }
  521. }
  522. static void ntb_transport_link_work(struct work_struct *work)
  523. {
  524. struct ntb_transport *nt = container_of(work, struct ntb_transport,
  525. link_work.work);
  526. struct ntb_device *ndev = nt->ndev;
  527. struct pci_dev *pdev = ntb_query_pdev(ndev);
  528. u32 val;
  529. int rc, i;
  530. /* send the local info, in the opposite order of the way we read it */
  531. for (i = 0; i < NTB_NUM_MW; i++) {
  532. rc = ntb_write_remote_spad(ndev, MW0_SZ_HIGH + (i * 2),
  533. ntb_get_mw_size(ndev, i) >> 32);
  534. if (rc) {
  535. dev_err(&pdev->dev, "Error writing %u to remote spad %d\n",
  536. (u32)(ntb_get_mw_size(ndev, i) >> 32),
  537. MW0_SZ_HIGH + (i * 2));
  538. goto out;
  539. }
  540. rc = ntb_write_remote_spad(ndev, MW0_SZ_LOW + (i * 2),
  541. (u32) ntb_get_mw_size(ndev, i));
  542. if (rc) {
  543. dev_err(&pdev->dev, "Error writing %u to remote spad %d\n",
  544. (u32) ntb_get_mw_size(ndev, i),
  545. MW0_SZ_LOW + (i * 2));
  546. goto out;
  547. }
  548. }
  549. rc = ntb_write_remote_spad(ndev, NUM_MWS, NTB_NUM_MW);
  550. if (rc) {
  551. dev_err(&pdev->dev, "Error writing %x to remote spad %d\n",
  552. NTB_NUM_MW, NUM_MWS);
  553. goto out;
  554. }
  555. rc = ntb_write_remote_spad(ndev, NUM_QPS, nt->max_qps);
  556. if (rc) {
  557. dev_err(&pdev->dev, "Error writing %x to remote spad %d\n",
  558. nt->max_qps, NUM_QPS);
  559. goto out;
  560. }
  561. rc = ntb_write_remote_spad(ndev, VERSION, NTB_TRANSPORT_VERSION);
  562. if (rc) {
  563. dev_err(&pdev->dev, "Error writing %x to remote spad %d\n",
  564. NTB_TRANSPORT_VERSION, VERSION);
  565. goto out;
  566. }
  567. /* Query the remote side for its info */
  568. rc = ntb_read_remote_spad(ndev, VERSION, &val);
  569. if (rc) {
  570. dev_err(&pdev->dev, "Error reading remote spad %d\n", VERSION);
  571. goto out;
  572. }
  573. if (val != NTB_TRANSPORT_VERSION)
  574. goto out;
  575. dev_dbg(&pdev->dev, "Remote version = %d\n", val);
  576. rc = ntb_read_remote_spad(ndev, NUM_QPS, &val);
  577. if (rc) {
  578. dev_err(&pdev->dev, "Error reading remote spad %d\n", NUM_QPS);
  579. goto out;
  580. }
  581. if (val != nt->max_qps)
  582. goto out;
  583. dev_dbg(&pdev->dev, "Remote max number of qps = %d\n", val);
  584. rc = ntb_read_remote_spad(ndev, NUM_MWS, &val);
  585. if (rc) {
  586. dev_err(&pdev->dev, "Error reading remote spad %d\n", NUM_MWS);
  587. goto out;
  588. }
  589. if (val != NTB_NUM_MW)
  590. goto out;
  591. dev_dbg(&pdev->dev, "Remote number of mws = %d\n", val);
  592. for (i = 0; i < NTB_NUM_MW; i++) {
  593. u64 val64;
  594. rc = ntb_read_remote_spad(ndev, MW0_SZ_HIGH + (i * 2), &val);
  595. if (rc) {
  596. dev_err(&pdev->dev, "Error reading remote spad %d\n",
  597. MW0_SZ_HIGH + (i * 2));
  598. goto out1;
  599. }
  600. val64 = (u64) val << 32;
  601. rc = ntb_read_remote_spad(ndev, MW0_SZ_LOW + (i * 2), &val);
  602. if (rc) {
  603. dev_err(&pdev->dev, "Error reading remote spad %d\n",
  604. MW0_SZ_LOW + (i * 2));
  605. goto out1;
  606. }
  607. val64 |= val;
  608. dev_dbg(&pdev->dev, "Remote MW%d size = %llu\n", i, val64);
  609. rc = ntb_set_mw(nt, i, val64);
  610. if (rc)
  611. goto out1;
  612. }
  613. nt->transport_link = NTB_LINK_UP;
  614. for (i = 0; i < nt->max_qps; i++) {
  615. struct ntb_transport_qp *qp = &nt->qps[i];
  616. ntb_transport_setup_qp_mw(nt, i);
  617. if (qp->client_ready == NTB_LINK_UP)
  618. schedule_delayed_work(&qp->link_work, 0);
  619. }
  620. return;
  621. out1:
  622. for (i = 0; i < NTB_NUM_MW; i++)
  623. ntb_free_mw(nt, i);
  624. out:
  625. if (ntb_hw_link_status(ndev))
  626. schedule_delayed_work(&nt->link_work,
  627. msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
  628. }
  629. static void ntb_qp_link_work(struct work_struct *work)
  630. {
  631. struct ntb_transport_qp *qp = container_of(work,
  632. struct ntb_transport_qp,
  633. link_work.work);
  634. struct pci_dev *pdev = ntb_query_pdev(qp->ndev);
  635. struct ntb_transport *nt = qp->transport;
  636. int rc, val;
  637. WARN_ON(nt->transport_link != NTB_LINK_UP);
  638. rc = ntb_read_local_spad(nt->ndev, QP_LINKS, &val);
  639. if (rc) {
  640. dev_err(&pdev->dev, "Error reading spad %d\n", QP_LINKS);
  641. return;
  642. }
  643. rc = ntb_write_remote_spad(nt->ndev, QP_LINKS, val | 1 << qp->qp_num);
  644. if (rc)
  645. dev_err(&pdev->dev, "Error writing %x to remote spad %d\n",
  646. val | 1 << qp->qp_num, QP_LINKS);
  647. /* query remote spad for qp ready bits */
  648. rc = ntb_read_remote_spad(nt->ndev, QP_LINKS, &val);
  649. if (rc)
  650. dev_err(&pdev->dev, "Error reading remote spad %d\n", QP_LINKS);
  651. dev_dbg(&pdev->dev, "Remote QP link status = %x\n", val);
  652. /* See if the remote side is up */
  653. if (1 << qp->qp_num & val) {
  654. qp->qp_link = NTB_LINK_UP;
  655. dev_info(&pdev->dev, "qp %d: Link Up\n", qp->qp_num);
  656. if (qp->event_handler)
  657. qp->event_handler(qp->cb_data, NTB_LINK_UP);
  658. } else if (nt->transport_link == NTB_LINK_UP)
  659. schedule_delayed_work(&qp->link_work,
  660. msecs_to_jiffies(NTB_LINK_DOWN_TIMEOUT));
  661. }
  662. static void ntb_transport_init_queue(struct ntb_transport *nt,
  663. unsigned int qp_num)
  664. {
  665. struct ntb_transport_qp *qp;
  666. unsigned int num_qps_mw, tx_size;
  667. u8 mw_num = QP_TO_MW(qp_num);
  668. qp = &nt->qps[qp_num];
  669. qp->qp_num = qp_num;
  670. qp->transport = nt;
  671. qp->ndev = nt->ndev;
  672. qp->qp_link = NTB_LINK_DOWN;
  673. qp->client_ready = NTB_LINK_DOWN;
  674. qp->event_handler = NULL;
  675. if (nt->max_qps % NTB_NUM_MW && mw_num < nt->max_qps % NTB_NUM_MW)
  676. num_qps_mw = nt->max_qps / NTB_NUM_MW + 1;
  677. else
  678. num_qps_mw = nt->max_qps / NTB_NUM_MW;
  679. tx_size = (unsigned int) ntb_get_mw_size(qp->ndev, mw_num) / num_qps_mw;
  680. qp->rx_info = ntb_get_mw_vbase(nt->ndev, mw_num) +
  681. (qp_num / NTB_NUM_MW * tx_size);
  682. tx_size -= sizeof(struct ntb_rx_info);
  683. qp->tx_mw = qp->rx_info + 1;
  684. /* Due to housekeeping, there must be atleast 2 buffs */
  685. qp->tx_max_frame = min(transport_mtu, tx_size / 2);
  686. qp->tx_max_entry = tx_size / qp->tx_max_frame;
  687. if (nt->debugfs_dir) {
  688. char debugfs_name[4];
  689. snprintf(debugfs_name, 4, "qp%d", qp_num);
  690. qp->debugfs_dir = debugfs_create_dir(debugfs_name,
  691. nt->debugfs_dir);
  692. qp->debugfs_stats = debugfs_create_file("stats", S_IRUSR,
  693. qp->debugfs_dir, qp,
  694. &ntb_qp_debugfs_stats);
  695. }
  696. INIT_DELAYED_WORK(&qp->link_work, ntb_qp_link_work);
  697. INIT_WORK(&qp->link_cleanup, ntb_qp_link_cleanup);
  698. spin_lock_init(&qp->ntb_rx_pend_q_lock);
  699. spin_lock_init(&qp->ntb_rx_free_q_lock);
  700. spin_lock_init(&qp->ntb_tx_free_q_lock);
  701. INIT_LIST_HEAD(&qp->rx_pend_q);
  702. INIT_LIST_HEAD(&qp->rx_free_q);
  703. INIT_LIST_HEAD(&qp->tx_free_q);
  704. }
  705. int ntb_transport_init(struct pci_dev *pdev)
  706. {
  707. struct ntb_transport *nt;
  708. int rc, i;
  709. nt = kzalloc(sizeof(struct ntb_transport), GFP_KERNEL);
  710. if (!nt)
  711. return -ENOMEM;
  712. if (debugfs_initialized())
  713. nt->debugfs_dir = debugfs_create_dir(KBUILD_MODNAME, NULL);
  714. else
  715. nt->debugfs_dir = NULL;
  716. nt->ndev = ntb_register_transport(pdev, nt);
  717. if (!nt->ndev) {
  718. rc = -EIO;
  719. goto err;
  720. }
  721. nt->max_qps = min(nt->ndev->max_cbs, max_num_clients);
  722. nt->qps = kcalloc(nt->max_qps, sizeof(struct ntb_transport_qp),
  723. GFP_KERNEL);
  724. if (!nt->qps) {
  725. rc = -ENOMEM;
  726. goto err1;
  727. }
  728. nt->qp_bitmap = ((u64) 1 << nt->max_qps) - 1;
  729. for (i = 0; i < nt->max_qps; i++)
  730. ntb_transport_init_queue(nt, i);
  731. INIT_DELAYED_WORK(&nt->link_work, ntb_transport_link_work);
  732. INIT_WORK(&nt->link_cleanup, ntb_transport_link_cleanup);
  733. rc = ntb_register_event_callback(nt->ndev,
  734. ntb_transport_event_callback);
  735. if (rc)
  736. goto err2;
  737. INIT_LIST_HEAD(&nt->client_devs);
  738. rc = ntb_bus_init(nt);
  739. if (rc)
  740. goto err3;
  741. if (ntb_hw_link_status(nt->ndev))
  742. schedule_delayed_work(&nt->link_work, 0);
  743. return 0;
  744. err3:
  745. ntb_unregister_event_callback(nt->ndev);
  746. err2:
  747. kfree(nt->qps);
  748. err1:
  749. ntb_unregister_transport(nt->ndev);
  750. err:
  751. debugfs_remove_recursive(nt->debugfs_dir);
  752. kfree(nt);
  753. return rc;
  754. }
  755. void ntb_transport_free(void *transport)
  756. {
  757. struct ntb_transport *nt = transport;
  758. struct pci_dev *pdev;
  759. int i;
  760. nt->transport_link = NTB_LINK_DOWN;
  761. /* verify that all the qp's are freed */
  762. for (i = 0; i < nt->max_qps; i++)
  763. if (!test_bit(i, &nt->qp_bitmap))
  764. ntb_transport_free_queue(&nt->qps[i]);
  765. ntb_bus_remove(nt);
  766. cancel_delayed_work_sync(&nt->link_work);
  767. debugfs_remove_recursive(nt->debugfs_dir);
  768. ntb_unregister_event_callback(nt->ndev);
  769. pdev = ntb_query_pdev(nt->ndev);
  770. for (i = 0; i < NTB_NUM_MW; i++)
  771. ntb_free_mw(nt, i);
  772. kfree(nt->qps);
  773. ntb_unregister_transport(nt->ndev);
  774. kfree(nt);
  775. }
  776. static void ntb_rx_copy_task(struct ntb_transport_qp *qp,
  777. struct ntb_queue_entry *entry, void *offset)
  778. {
  779. void *cb_data = entry->cb_data;
  780. unsigned int len = entry->len;
  781. memcpy(entry->buf, offset, entry->len);
  782. ntb_list_add(&qp->ntb_rx_free_q_lock, &entry->entry, &qp->rx_free_q);
  783. if (qp->rx_handler && qp->client_ready == NTB_LINK_UP)
  784. qp->rx_handler(qp, qp->cb_data, cb_data, len);
  785. }
  786. static int ntb_process_rxc(struct ntb_transport_qp *qp)
  787. {
  788. struct ntb_payload_header *hdr;
  789. struct ntb_queue_entry *entry;
  790. void *offset;
  791. offset = qp->rx_buff + qp->rx_max_frame * qp->rx_index;
  792. hdr = offset + qp->rx_max_frame - sizeof(struct ntb_payload_header);
  793. entry = ntb_list_rm(&qp->ntb_rx_pend_q_lock, &qp->rx_pend_q);
  794. if (!entry) {
  795. dev_dbg(&ntb_query_pdev(qp->ndev)->dev,
  796. "no buffer - HDR ver %u, len %d, flags %x\n",
  797. hdr->ver, hdr->len, hdr->flags);
  798. qp->rx_err_no_buf++;
  799. return -ENOMEM;
  800. }
  801. if (!(hdr->flags & DESC_DONE_FLAG)) {
  802. ntb_list_add(&qp->ntb_rx_pend_q_lock, &entry->entry,
  803. &qp->rx_pend_q);
  804. qp->rx_ring_empty++;
  805. return -EAGAIN;
  806. }
  807. if (hdr->ver != (u32) qp->rx_pkts) {
  808. dev_dbg(&ntb_query_pdev(qp->ndev)->dev,
  809. "qp %d: version mismatch, expected %llu - got %u\n",
  810. qp->qp_num, qp->rx_pkts, hdr->ver);
  811. ntb_list_add(&qp->ntb_rx_pend_q_lock, &entry->entry,
  812. &qp->rx_pend_q);
  813. qp->rx_err_ver++;
  814. return -EIO;
  815. }
  816. if (hdr->flags & LINK_DOWN_FLAG) {
  817. ntb_qp_link_down(qp);
  818. ntb_list_add(&qp->ntb_rx_pend_q_lock, &entry->entry,
  819. &qp->rx_pend_q);
  820. goto out;
  821. }
  822. dev_dbg(&ntb_query_pdev(qp->ndev)->dev,
  823. "rx offset %u, ver %u - %d payload received, buf size %d\n",
  824. qp->rx_index, hdr->ver, hdr->len, entry->len);
  825. if (hdr->len <= entry->len) {
  826. entry->len = hdr->len;
  827. ntb_rx_copy_task(qp, entry, offset);
  828. } else {
  829. ntb_list_add(&qp->ntb_rx_pend_q_lock, &entry->entry,
  830. &qp->rx_pend_q);
  831. qp->rx_err_oflow++;
  832. dev_dbg(&ntb_query_pdev(qp->ndev)->dev,
  833. "RX overflow! Wanted %d got %d\n",
  834. hdr->len, entry->len);
  835. }
  836. qp->rx_bytes += hdr->len;
  837. qp->rx_pkts++;
  838. out:
  839. /* Ensure that the data is fully copied out before clearing the flag */
  840. wmb();
  841. hdr->flags = 0;
  842. iowrite32(qp->rx_index, &qp->rx_info->entry);
  843. qp->rx_index++;
  844. qp->rx_index %= qp->rx_max_entry;
  845. return 0;
  846. }
  847. static void ntb_transport_rx(unsigned long data)
  848. {
  849. struct ntb_transport_qp *qp = (struct ntb_transport_qp *)data;
  850. int rc, i;
  851. /* Limit the number of packets processed in a single interrupt to
  852. * provide fairness to others
  853. */
  854. for (i = 0; i < qp->rx_max_entry; i++) {
  855. rc = ntb_process_rxc(qp);
  856. if (rc)
  857. break;
  858. }
  859. }
  860. static void ntb_transport_rxc_db(void *data, int db_num)
  861. {
  862. struct ntb_transport_qp *qp = data;
  863. dev_dbg(&ntb_query_pdev(qp->ndev)->dev, "%s: doorbell %d received\n",
  864. __func__, db_num);
  865. tasklet_schedule(&qp->rx_work);
  866. }
  867. static void ntb_tx_copy_task(struct ntb_transport_qp *qp,
  868. struct ntb_queue_entry *entry,
  869. void __iomem *offset)
  870. {
  871. struct ntb_payload_header __iomem *hdr;
  872. memcpy_toio(offset, entry->buf, entry->len);
  873. hdr = offset + qp->tx_max_frame - sizeof(struct ntb_payload_header);
  874. iowrite32(entry->len, &hdr->len);
  875. iowrite32((u32) qp->tx_pkts, &hdr->ver);
  876. /* Ensure that the data is fully copied out before setting the flag */
  877. wmb();
  878. iowrite32(entry->flags | DESC_DONE_FLAG, &hdr->flags);
  879. ntb_ring_sdb(qp->ndev, qp->qp_num);
  880. /* The entry length can only be zero if the packet is intended to be a
  881. * "link down" or similar. Since no payload is being sent in these
  882. * cases, there is nothing to add to the completion queue.
  883. */
  884. if (entry->len > 0) {
  885. qp->tx_bytes += entry->len;
  886. if (qp->tx_handler)
  887. qp->tx_handler(qp, qp->cb_data, entry->cb_data,
  888. entry->len);
  889. }
  890. ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry, &qp->tx_free_q);
  891. }
  892. static int ntb_process_tx(struct ntb_transport_qp *qp,
  893. struct ntb_queue_entry *entry)
  894. {
  895. void __iomem *offset;
  896. offset = qp->tx_mw + qp->tx_max_frame * qp->tx_index;
  897. dev_dbg(&ntb_query_pdev(qp->ndev)->dev, "%lld - offset %p, tx %u, entry len %d flags %x buff %p\n",
  898. qp->tx_pkts, offset, qp->tx_index, entry->len, entry->flags,
  899. entry->buf);
  900. if (qp->tx_index == qp->remote_rx_info->entry) {
  901. qp->tx_ring_full++;
  902. return -EAGAIN;
  903. }
  904. if (entry->len > qp->tx_max_frame - sizeof(struct ntb_payload_header)) {
  905. if (qp->tx_handler)
  906. qp->tx_handler(qp->cb_data, qp, NULL, -EIO);
  907. ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
  908. &qp->tx_free_q);
  909. return 0;
  910. }
  911. ntb_tx_copy_task(qp, entry, offset);
  912. qp->tx_index++;
  913. qp->tx_index %= qp->tx_max_entry;
  914. qp->tx_pkts++;
  915. return 0;
  916. }
  917. static void ntb_send_link_down(struct ntb_transport_qp *qp)
  918. {
  919. struct pci_dev *pdev = ntb_query_pdev(qp->ndev);
  920. struct ntb_queue_entry *entry;
  921. int i, rc;
  922. if (qp->qp_link == NTB_LINK_DOWN)
  923. return;
  924. qp->qp_link = NTB_LINK_DOWN;
  925. dev_info(&pdev->dev, "qp %d: Link Down\n", qp->qp_num);
  926. for (i = 0; i < NTB_LINK_DOWN_TIMEOUT; i++) {
  927. entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q);
  928. if (entry)
  929. break;
  930. msleep(100);
  931. }
  932. if (!entry)
  933. return;
  934. entry->cb_data = NULL;
  935. entry->buf = NULL;
  936. entry->len = 0;
  937. entry->flags = LINK_DOWN_FLAG;
  938. rc = ntb_process_tx(qp, entry);
  939. if (rc)
  940. dev_err(&pdev->dev, "ntb: QP%d unable to send linkdown msg\n",
  941. qp->qp_num);
  942. }
  943. /**
  944. * ntb_transport_create_queue - Create a new NTB transport layer queue
  945. * @rx_handler: receive callback function
  946. * @tx_handler: transmit callback function
  947. * @event_handler: event callback function
  948. *
  949. * Create a new NTB transport layer queue and provide the queue with a callback
  950. * routine for both transmit and receive. The receive callback routine will be
  951. * used to pass up data when the transport has received it on the queue. The
  952. * transmit callback routine will be called when the transport has completed the
  953. * transmission of the data on the queue and the data is ready to be freed.
  954. *
  955. * RETURNS: pointer to newly created ntb_queue, NULL on error.
  956. */
  957. struct ntb_transport_qp *
  958. ntb_transport_create_queue(void *data, struct pci_dev *pdev,
  959. const struct ntb_queue_handlers *handlers)
  960. {
  961. struct ntb_queue_entry *entry;
  962. struct ntb_transport_qp *qp;
  963. struct ntb_transport *nt;
  964. unsigned int free_queue;
  965. int rc, i;
  966. nt = ntb_find_transport(pdev);
  967. if (!nt)
  968. goto err;
  969. free_queue = ffs(nt->qp_bitmap);
  970. if (!free_queue)
  971. goto err;
  972. /* decrement free_queue to make it zero based */
  973. free_queue--;
  974. clear_bit(free_queue, &nt->qp_bitmap);
  975. qp = &nt->qps[free_queue];
  976. qp->cb_data = data;
  977. qp->rx_handler = handlers->rx_handler;
  978. qp->tx_handler = handlers->tx_handler;
  979. qp->event_handler = handlers->event_handler;
  980. for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) {
  981. entry = kzalloc(sizeof(struct ntb_queue_entry), GFP_ATOMIC);
  982. if (!entry)
  983. goto err1;
  984. ntb_list_add(&qp->ntb_rx_free_q_lock, &entry->entry,
  985. &qp->rx_free_q);
  986. }
  987. for (i = 0; i < NTB_QP_DEF_NUM_ENTRIES; i++) {
  988. entry = kzalloc(sizeof(struct ntb_queue_entry), GFP_ATOMIC);
  989. if (!entry)
  990. goto err2;
  991. ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
  992. &qp->tx_free_q);
  993. }
  994. tasklet_init(&qp->rx_work, ntb_transport_rx, (unsigned long) qp);
  995. rc = ntb_register_db_callback(qp->ndev, free_queue, qp,
  996. ntb_transport_rxc_db);
  997. if (rc)
  998. goto err3;
  999. dev_info(&pdev->dev, "NTB Transport QP %d created\n", qp->qp_num);
  1000. return qp;
  1001. err3:
  1002. tasklet_disable(&qp->rx_work);
  1003. err2:
  1004. while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q)))
  1005. kfree(entry);
  1006. err1:
  1007. while ((entry = ntb_list_rm(&qp->ntb_rx_free_q_lock, &qp->rx_free_q)))
  1008. kfree(entry);
  1009. set_bit(free_queue, &nt->qp_bitmap);
  1010. err:
  1011. return NULL;
  1012. }
  1013. EXPORT_SYMBOL_GPL(ntb_transport_create_queue);
  1014. /**
  1015. * ntb_transport_free_queue - Frees NTB transport queue
  1016. * @qp: NTB queue to be freed
  1017. *
  1018. * Frees NTB transport queue
  1019. */
  1020. void ntb_transport_free_queue(struct ntb_transport_qp *qp)
  1021. {
  1022. struct pci_dev *pdev;
  1023. struct ntb_queue_entry *entry;
  1024. if (!qp)
  1025. return;
  1026. pdev = ntb_query_pdev(qp->ndev);
  1027. cancel_delayed_work_sync(&qp->link_work);
  1028. ntb_unregister_db_callback(qp->ndev, qp->qp_num);
  1029. tasklet_disable(&qp->rx_work);
  1030. while ((entry = ntb_list_rm(&qp->ntb_rx_free_q_lock, &qp->rx_free_q)))
  1031. kfree(entry);
  1032. while ((entry = ntb_list_rm(&qp->ntb_rx_pend_q_lock, &qp->rx_pend_q))) {
  1033. dev_warn(&pdev->dev, "Freeing item from a non-empty queue\n");
  1034. kfree(entry);
  1035. }
  1036. while ((entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q)))
  1037. kfree(entry);
  1038. set_bit(qp->qp_num, &qp->transport->qp_bitmap);
  1039. dev_info(&pdev->dev, "NTB Transport QP %d freed\n", qp->qp_num);
  1040. }
  1041. EXPORT_SYMBOL_GPL(ntb_transport_free_queue);
  1042. /**
  1043. * ntb_transport_rx_remove - Dequeues enqueued rx packet
  1044. * @qp: NTB queue to be freed
  1045. * @len: pointer to variable to write enqueued buffers length
  1046. *
  1047. * Dequeues unused buffers from receive queue. Should only be used during
  1048. * shutdown of qp.
  1049. *
  1050. * RETURNS: NULL error value on error, or void* for success.
  1051. */
  1052. void *ntb_transport_rx_remove(struct ntb_transport_qp *qp, unsigned int *len)
  1053. {
  1054. struct ntb_queue_entry *entry;
  1055. void *buf;
  1056. if (!qp || qp->client_ready == NTB_LINK_UP)
  1057. return NULL;
  1058. entry = ntb_list_rm(&qp->ntb_rx_pend_q_lock, &qp->rx_pend_q);
  1059. if (!entry)
  1060. return NULL;
  1061. buf = entry->cb_data;
  1062. *len = entry->len;
  1063. ntb_list_add(&qp->ntb_rx_free_q_lock, &entry->entry, &qp->rx_free_q);
  1064. return buf;
  1065. }
  1066. EXPORT_SYMBOL_GPL(ntb_transport_rx_remove);
  1067. /**
  1068. * ntb_transport_rx_enqueue - Enqueue a new NTB queue entry
  1069. * @qp: NTB transport layer queue the entry is to be enqueued on
  1070. * @cb: per buffer pointer for callback function to use
  1071. * @data: pointer to data buffer that incoming packets will be copied into
  1072. * @len: length of the data buffer
  1073. *
  1074. * Enqueue a new receive buffer onto the transport queue into which a NTB
  1075. * payload can be received into.
  1076. *
  1077. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  1078. */
  1079. int ntb_transport_rx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data,
  1080. unsigned int len)
  1081. {
  1082. struct ntb_queue_entry *entry;
  1083. if (!qp)
  1084. return -EINVAL;
  1085. entry = ntb_list_rm(&qp->ntb_rx_free_q_lock, &qp->rx_free_q);
  1086. if (!entry)
  1087. return -ENOMEM;
  1088. entry->cb_data = cb;
  1089. entry->buf = data;
  1090. entry->len = len;
  1091. ntb_list_add(&qp->ntb_rx_pend_q_lock, &entry->entry, &qp->rx_pend_q);
  1092. return 0;
  1093. }
  1094. EXPORT_SYMBOL_GPL(ntb_transport_rx_enqueue);
  1095. /**
  1096. * ntb_transport_tx_enqueue - Enqueue a new NTB queue entry
  1097. * @qp: NTB transport layer queue the entry is to be enqueued on
  1098. * @cb: per buffer pointer for callback function to use
  1099. * @data: pointer to data buffer that will be sent
  1100. * @len: length of the data buffer
  1101. *
  1102. * Enqueue a new transmit buffer onto the transport queue from which a NTB
  1103. * payload will be transmitted. This assumes that a lock is behing held to
  1104. * serialize access to the qp.
  1105. *
  1106. * RETURNS: An appropriate -ERRNO error value on error, or zero for success.
  1107. */
  1108. int ntb_transport_tx_enqueue(struct ntb_transport_qp *qp, void *cb, void *data,
  1109. unsigned int len)
  1110. {
  1111. struct ntb_queue_entry *entry;
  1112. int rc;
  1113. if (!qp || qp->qp_link != NTB_LINK_UP || !len)
  1114. return -EINVAL;
  1115. entry = ntb_list_rm(&qp->ntb_tx_free_q_lock, &qp->tx_free_q);
  1116. if (!entry)
  1117. return -ENOMEM;
  1118. entry->cb_data = cb;
  1119. entry->buf = data;
  1120. entry->len = len;
  1121. entry->flags = 0;
  1122. rc = ntb_process_tx(qp, entry);
  1123. if (rc)
  1124. ntb_list_add(&qp->ntb_tx_free_q_lock, &entry->entry,
  1125. &qp->tx_free_q);
  1126. return rc;
  1127. }
  1128. EXPORT_SYMBOL_GPL(ntb_transport_tx_enqueue);
  1129. /**
  1130. * ntb_transport_link_up - Notify NTB transport of client readiness to use queue
  1131. * @qp: NTB transport layer queue to be enabled
  1132. *
  1133. * Notify NTB transport layer of client readiness to use queue
  1134. */
  1135. void ntb_transport_link_up(struct ntb_transport_qp *qp)
  1136. {
  1137. if (!qp)
  1138. return;
  1139. qp->client_ready = NTB_LINK_UP;
  1140. if (qp->transport->transport_link == NTB_LINK_UP)
  1141. schedule_delayed_work(&qp->link_work, 0);
  1142. }
  1143. EXPORT_SYMBOL_GPL(ntb_transport_link_up);
  1144. /**
  1145. * ntb_transport_link_down - Notify NTB transport to no longer enqueue data
  1146. * @qp: NTB transport layer queue to be disabled
  1147. *
  1148. * Notify NTB transport layer of client's desire to no longer receive data on
  1149. * transport queue specified. It is the client's responsibility to ensure all
  1150. * entries on queue are purged or otherwise handled appropraitely.
  1151. */
  1152. void ntb_transport_link_down(struct ntb_transport_qp *qp)
  1153. {
  1154. struct pci_dev *pdev;
  1155. int rc, val;
  1156. if (!qp)
  1157. return;
  1158. pdev = ntb_query_pdev(qp->ndev);
  1159. qp->client_ready = NTB_LINK_DOWN;
  1160. rc = ntb_read_local_spad(qp->ndev, QP_LINKS, &val);
  1161. if (rc) {
  1162. dev_err(&pdev->dev, "Error reading spad %d\n", QP_LINKS);
  1163. return;
  1164. }
  1165. rc = ntb_write_remote_spad(qp->ndev, QP_LINKS,
  1166. val & ~(1 << qp->qp_num));
  1167. if (rc)
  1168. dev_err(&pdev->dev, "Error writing %x to remote spad %d\n",
  1169. val & ~(1 << qp->qp_num), QP_LINKS);
  1170. if (qp->qp_link == NTB_LINK_UP)
  1171. ntb_send_link_down(qp);
  1172. else
  1173. cancel_delayed_work_sync(&qp->link_work);
  1174. }
  1175. EXPORT_SYMBOL_GPL(ntb_transport_link_down);
  1176. /**
  1177. * ntb_transport_link_query - Query transport link state
  1178. * @qp: NTB transport layer queue to be queried
  1179. *
  1180. * Query connectivity to the remote system of the NTB transport queue
  1181. *
  1182. * RETURNS: true for link up or false for link down
  1183. */
  1184. bool ntb_transport_link_query(struct ntb_transport_qp *qp)
  1185. {
  1186. if (!qp)
  1187. return false;
  1188. return qp->qp_link == NTB_LINK_UP;
  1189. }
  1190. EXPORT_SYMBOL_GPL(ntb_transport_link_query);
  1191. /**
  1192. * ntb_transport_qp_num - Query the qp number
  1193. * @qp: NTB transport layer queue to be queried
  1194. *
  1195. * Query qp number of the NTB transport queue
  1196. *
  1197. * RETURNS: a zero based number specifying the qp number
  1198. */
  1199. unsigned char ntb_transport_qp_num(struct ntb_transport_qp *qp)
  1200. {
  1201. if (!qp)
  1202. return 0;
  1203. return qp->qp_num;
  1204. }
  1205. EXPORT_SYMBOL_GPL(ntb_transport_qp_num);
  1206. /**
  1207. * ntb_transport_max_size - Query the max payload size of a qp
  1208. * @qp: NTB transport layer queue to be queried
  1209. *
  1210. * Query the maximum payload size permissible on the given qp
  1211. *
  1212. * RETURNS: the max payload size of a qp
  1213. */
  1214. unsigned int ntb_transport_max_size(struct ntb_transport_qp *qp)
  1215. {
  1216. if (!qp)
  1217. return 0;
  1218. return qp->tx_max_frame - sizeof(struct ntb_payload_header);
  1219. }
  1220. EXPORT_SYMBOL_GPL(ntb_transport_max_size);