kcapi.c 28 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199
  1. /* $Id: kcapi.c,v 1.1.2.8 2004/03/26 19:57:20 armin Exp $
  2. *
  3. * Kernel CAPI 2.0 Module
  4. *
  5. * Copyright 1999 by Carsten Paeth <calle@calle.de>
  6. * Copyright 2002 by Kai Germaschewski <kai@germaschewski.name>
  7. *
  8. * This software may be used and distributed according to the terms
  9. * of the GNU General Public License, incorporated herein by reference.
  10. *
  11. */
  12. #define AVMB1_COMPAT
  13. #include "kcapi.h"
  14. #include <linux/module.h>
  15. #include <linux/mm.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/ioport.h>
  18. #include <linux/proc_fs.h>
  19. #include <linux/sched.h>
  20. #include <linux/seq_file.h>
  21. #include <linux/skbuff.h>
  22. #include <linux/workqueue.h>
  23. #include <linux/capi.h>
  24. #include <linux/kernelcapi.h>
  25. #include <linux/init.h>
  26. #include <linux/moduleparam.h>
  27. #include <linux/delay.h>
  28. #include <asm/uaccess.h>
  29. #include <linux/isdn/capicmd.h>
  30. #include <linux/isdn/capiutil.h>
  31. #ifdef AVMB1_COMPAT
  32. #include <linux/b1lli.h>
  33. #endif
  34. #include <linux/mutex.h>
  35. static char *revision = "$Revision: 1.1.2.8 $";
  36. /* ------------------------------------------------------------- */
  37. static int showcapimsgs = 0;
  38. MODULE_DESCRIPTION("CAPI4Linux: kernel CAPI layer");
  39. MODULE_AUTHOR("Carsten Paeth");
  40. MODULE_LICENSE("GPL");
  41. module_param(showcapimsgs, uint, 0);
  42. /* ------------------------------------------------------------- */
  43. struct capi_notifier {
  44. struct work_struct work;
  45. unsigned int cmd;
  46. u32 controller;
  47. u16 applid;
  48. u32 ncci;
  49. };
  50. /* ------------------------------------------------------------- */
  51. static struct capi_version driver_version = {2, 0, 1, 1<<4};
  52. static char driver_serial[CAPI_SERIAL_LEN] = "0004711";
  53. static char capi_manufakturer[64] = "AVM Berlin";
  54. #define NCCI2CTRL(ncci) (((ncci) >> 24) & 0x7f)
  55. LIST_HEAD(capi_drivers);
  56. DEFINE_RWLOCK(capi_drivers_list_lock);
  57. static DEFINE_RWLOCK(application_lock);
  58. static DEFINE_MUTEX(controller_mutex);
  59. struct capi20_appl *capi_applications[CAPI_MAXAPPL];
  60. struct capi_ctr *capi_cards[CAPI_MAXCONTR];
  61. static int ncards;
  62. /* -------- controller ref counting -------------------------------------- */
  63. static inline struct capi_ctr *
  64. capi_ctr_get(struct capi_ctr *card)
  65. {
  66. if (!try_module_get(card->owner))
  67. return NULL;
  68. return card;
  69. }
  70. static inline void
  71. capi_ctr_put(struct capi_ctr *card)
  72. {
  73. module_put(card->owner);
  74. }
  75. /* ------------------------------------------------------------- */
  76. static inline struct capi_ctr *get_capi_ctr_by_nr(u16 contr)
  77. {
  78. if (contr - 1 >= CAPI_MAXCONTR)
  79. return NULL;
  80. return capi_cards[contr - 1];
  81. }
  82. static inline struct capi20_appl *get_capi_appl_by_nr(u16 applid)
  83. {
  84. if (applid - 1 >= CAPI_MAXAPPL)
  85. return NULL;
  86. return capi_applications[applid - 1];
  87. }
  88. /* -------- util functions ------------------------------------ */
  89. static inline int capi_cmd_valid(u8 cmd)
  90. {
  91. switch (cmd) {
  92. case CAPI_ALERT:
  93. case CAPI_CONNECT:
  94. case CAPI_CONNECT_ACTIVE:
  95. case CAPI_CONNECT_B3_ACTIVE:
  96. case CAPI_CONNECT_B3:
  97. case CAPI_CONNECT_B3_T90_ACTIVE:
  98. case CAPI_DATA_B3:
  99. case CAPI_DISCONNECT_B3:
  100. case CAPI_DISCONNECT:
  101. case CAPI_FACILITY:
  102. case CAPI_INFO:
  103. case CAPI_LISTEN:
  104. case CAPI_MANUFACTURER:
  105. case CAPI_RESET_B3:
  106. case CAPI_SELECT_B_PROTOCOL:
  107. return 1;
  108. }
  109. return 0;
  110. }
  111. static inline int capi_subcmd_valid(u8 subcmd)
  112. {
  113. switch (subcmd) {
  114. case CAPI_REQ:
  115. case CAPI_CONF:
  116. case CAPI_IND:
  117. case CAPI_RESP:
  118. return 1;
  119. }
  120. return 0;
  121. }
  122. /* ------------------------------------------------------------ */
  123. static void register_appl(struct capi_ctr *card, u16 applid, capi_register_params *rparam)
  124. {
  125. card = capi_ctr_get(card);
  126. if (card)
  127. card->register_appl(card, applid, rparam);
  128. else
  129. printk(KERN_WARNING "%s: cannot get card resources\n", __func__);
  130. }
  131. static void release_appl(struct capi_ctr *card, u16 applid)
  132. {
  133. DBG("applid %#x", applid);
  134. card->release_appl(card, applid);
  135. capi_ctr_put(card);
  136. }
  137. /* -------- KCI_CONTRUP --------------------------------------- */
  138. static void notify_up(u32 contr)
  139. {
  140. struct capi_ctr *card = get_capi_ctr_by_nr(contr);
  141. struct capi20_appl *ap;
  142. u16 applid;
  143. if (showcapimsgs & 1) {
  144. printk(KERN_DEBUG "kcapi: notify up contr %d\n", contr);
  145. }
  146. if (!card) {
  147. printk(KERN_WARNING "%s: invalid contr %d\n", __func__, contr);
  148. return;
  149. }
  150. for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
  151. ap = get_capi_appl_by_nr(applid);
  152. if (!ap || ap->release_in_progress) continue;
  153. register_appl(card, applid, &ap->rparam);
  154. if (ap->callback && !ap->release_in_progress)
  155. ap->callback(KCI_CONTRUP, contr, &card->profile);
  156. }
  157. }
  158. /* -------- KCI_CONTRDOWN ------------------------------------- */
  159. static void notify_down(u32 contr)
  160. {
  161. struct capi20_appl *ap;
  162. u16 applid;
  163. if (showcapimsgs & 1) {
  164. printk(KERN_DEBUG "kcapi: notify down contr %d\n", contr);
  165. }
  166. for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
  167. ap = get_capi_appl_by_nr(applid);
  168. if (ap && ap->callback && !ap->release_in_progress)
  169. ap->callback(KCI_CONTRDOWN, contr, NULL);
  170. }
  171. }
  172. static void notify_handler(struct work_struct *work)
  173. {
  174. struct capi_notifier *np =
  175. container_of(work, struct capi_notifier, work);
  176. switch (np->cmd) {
  177. case KCI_CONTRUP:
  178. notify_up(np->controller);
  179. break;
  180. case KCI_CONTRDOWN:
  181. notify_down(np->controller);
  182. break;
  183. }
  184. kfree(np);
  185. }
  186. /*
  187. * The notifier will result in adding/deleteing of devices. Devices can
  188. * only removed in user process, not in bh.
  189. */
  190. static int notify_push(unsigned int cmd, u32 controller, u16 applid, u32 ncci)
  191. {
  192. struct capi_notifier *np = kmalloc(sizeof(*np), GFP_ATOMIC);
  193. if (!np)
  194. return -ENOMEM;
  195. INIT_WORK(&np->work, notify_handler);
  196. np->cmd = cmd;
  197. np->controller = controller;
  198. np->applid = applid;
  199. np->ncci = ncci;
  200. schedule_work(&np->work);
  201. return 0;
  202. }
  203. /* -------- Receiver ------------------------------------------ */
  204. static void recv_handler(struct work_struct *work)
  205. {
  206. struct sk_buff *skb;
  207. struct capi20_appl *ap =
  208. container_of(work, struct capi20_appl, recv_work);
  209. if ((!ap) || (ap->release_in_progress))
  210. return;
  211. mutex_lock(&ap->recv_mtx);
  212. while ((skb = skb_dequeue(&ap->recv_queue))) {
  213. if (CAPIMSG_CMD(skb->data) == CAPI_DATA_B3_IND)
  214. ap->nrecvdatapkt++;
  215. else
  216. ap->nrecvctlpkt++;
  217. ap->recv_message(ap, skb);
  218. }
  219. mutex_unlock(&ap->recv_mtx);
  220. }
  221. /**
  222. * capi_ctr_handle_message() - handle incoming CAPI message
  223. * @card: controller descriptor structure.
  224. * @appl: application ID.
  225. * @skb: message.
  226. *
  227. * Called by hardware driver to pass a CAPI message to the application.
  228. */
  229. void capi_ctr_handle_message(struct capi_ctr * card, u16 appl, struct sk_buff *skb)
  230. {
  231. struct capi20_appl *ap;
  232. int showctl = 0;
  233. u8 cmd, subcmd;
  234. unsigned long flags;
  235. _cdebbuf *cdb;
  236. if (card->cardstate != CARD_RUNNING) {
  237. cdb = capi_message2str(skb->data);
  238. if (cdb) {
  239. printk(KERN_INFO "kcapi: controller [%03d] not active, got: %s",
  240. card->cnr, cdb->buf);
  241. cdebbuf_free(cdb);
  242. } else
  243. printk(KERN_INFO "kcapi: controller [%03d] not active, cannot trace\n",
  244. card->cnr);
  245. goto error;
  246. }
  247. cmd = CAPIMSG_COMMAND(skb->data);
  248. subcmd = CAPIMSG_SUBCOMMAND(skb->data);
  249. if (cmd == CAPI_DATA_B3 && subcmd == CAPI_IND) {
  250. card->nrecvdatapkt++;
  251. if (card->traceflag > 2) showctl |= 2;
  252. } else {
  253. card->nrecvctlpkt++;
  254. if (card->traceflag) showctl |= 2;
  255. }
  256. showctl |= (card->traceflag & 1);
  257. if (showctl & 2) {
  258. if (showctl & 1) {
  259. printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u\n",
  260. card->cnr, CAPIMSG_APPID(skb->data),
  261. capi_cmd2str(cmd, subcmd),
  262. CAPIMSG_LEN(skb->data));
  263. } else {
  264. cdb = capi_message2str(skb->data);
  265. if (cdb) {
  266. printk(KERN_DEBUG "kcapi: got [%03d] %s\n",
  267. card->cnr, cdb->buf);
  268. cdebbuf_free(cdb);
  269. } else
  270. printk(KERN_DEBUG "kcapi: got [%03d] id#%d %s len=%u, cannot trace\n",
  271. card->cnr, CAPIMSG_APPID(skb->data),
  272. capi_cmd2str(cmd, subcmd),
  273. CAPIMSG_LEN(skb->data));
  274. }
  275. }
  276. read_lock_irqsave(&application_lock, flags);
  277. ap = get_capi_appl_by_nr(CAPIMSG_APPID(skb->data));
  278. if ((!ap) || (ap->release_in_progress)) {
  279. read_unlock_irqrestore(&application_lock, flags);
  280. cdb = capi_message2str(skb->data);
  281. if (cdb) {
  282. printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s)\n",
  283. CAPIMSG_APPID(skb->data), cdb->buf);
  284. cdebbuf_free(cdb);
  285. } else
  286. printk(KERN_ERR "kcapi: handle_message: applid %d state released (%s) cannot trace\n",
  287. CAPIMSG_APPID(skb->data),
  288. capi_cmd2str(cmd, subcmd));
  289. goto error;
  290. }
  291. skb_queue_tail(&ap->recv_queue, skb);
  292. schedule_work(&ap->recv_work);
  293. read_unlock_irqrestore(&application_lock, flags);
  294. return;
  295. error:
  296. kfree_skb(skb);
  297. }
  298. EXPORT_SYMBOL(capi_ctr_handle_message);
  299. /**
  300. * capi_ctr_ready() - signal CAPI controller ready
  301. * @card: controller descriptor structure.
  302. *
  303. * Called by hardware driver to signal that the controller is up and running.
  304. */
  305. void capi_ctr_ready(struct capi_ctr * card)
  306. {
  307. card->cardstate = CARD_RUNNING;
  308. printk(KERN_NOTICE "kcapi: card [%03d] \"%s\" ready.\n",
  309. card->cnr, card->name);
  310. notify_push(KCI_CONTRUP, card->cnr, 0, 0);
  311. }
  312. EXPORT_SYMBOL(capi_ctr_ready);
  313. /**
  314. * capi_ctr_down() - signal CAPI controller not ready
  315. * @card: controller descriptor structure.
  316. *
  317. * Called by hardware driver to signal that the controller is down and
  318. * unavailable for use.
  319. */
  320. void capi_ctr_down(struct capi_ctr * card)
  321. {
  322. u16 appl;
  323. DBG("");
  324. if (card->cardstate == CARD_DETECTED)
  325. return;
  326. card->cardstate = CARD_DETECTED;
  327. memset(card->manu, 0, sizeof(card->manu));
  328. memset(&card->version, 0, sizeof(card->version));
  329. memset(&card->profile, 0, sizeof(card->profile));
  330. memset(card->serial, 0, sizeof(card->serial));
  331. for (appl = 1; appl <= CAPI_MAXAPPL; appl++) {
  332. struct capi20_appl *ap = get_capi_appl_by_nr(appl);
  333. if (!ap || ap->release_in_progress)
  334. continue;
  335. capi_ctr_put(card);
  336. }
  337. printk(KERN_NOTICE "kcapi: card [%03d] down.\n", card->cnr);
  338. notify_push(KCI_CONTRDOWN, card->cnr, 0, 0);
  339. }
  340. EXPORT_SYMBOL(capi_ctr_down);
  341. /**
  342. * capi_ctr_suspend_output() - suspend controller
  343. * @card: controller descriptor structure.
  344. *
  345. * Called by hardware driver to stop data flow.
  346. */
  347. void capi_ctr_suspend_output(struct capi_ctr *card)
  348. {
  349. if (!card->blocked) {
  350. printk(KERN_DEBUG "kcapi: card [%03d] suspend\n", card->cnr);
  351. card->blocked = 1;
  352. }
  353. }
  354. EXPORT_SYMBOL(capi_ctr_suspend_output);
  355. /**
  356. * capi_ctr_resume_output() - resume controller
  357. * @card: controller descriptor structure.
  358. *
  359. * Called by hardware driver to resume data flow.
  360. */
  361. void capi_ctr_resume_output(struct capi_ctr *card)
  362. {
  363. if (card->blocked) {
  364. printk(KERN_DEBUG "kcapi: card [%03d] resume\n", card->cnr);
  365. card->blocked = 0;
  366. }
  367. }
  368. EXPORT_SYMBOL(capi_ctr_resume_output);
  369. /* ------------------------------------------------------------- */
  370. /**
  371. * attach_capi_ctr() - register CAPI controller
  372. * @card: controller descriptor structure.
  373. *
  374. * Called by hardware driver to register a controller with the CAPI subsystem.
  375. * Return value: 0 on success, error code < 0 on error
  376. */
  377. int
  378. attach_capi_ctr(struct capi_ctr *card)
  379. {
  380. int i;
  381. mutex_lock(&controller_mutex);
  382. for (i = 0; i < CAPI_MAXCONTR; i++) {
  383. if (capi_cards[i] == NULL)
  384. break;
  385. }
  386. if (i == CAPI_MAXCONTR) {
  387. mutex_unlock(&controller_mutex);
  388. printk(KERN_ERR "kcapi: out of controller slots\n");
  389. return -EBUSY;
  390. }
  391. capi_cards[i] = card;
  392. mutex_unlock(&controller_mutex);
  393. card->nrecvctlpkt = 0;
  394. card->nrecvdatapkt = 0;
  395. card->nsentctlpkt = 0;
  396. card->nsentdatapkt = 0;
  397. card->cnr = i + 1;
  398. card->cardstate = CARD_DETECTED;
  399. card->blocked = 0;
  400. card->traceflag = showcapimsgs;
  401. sprintf(card->procfn, "capi/controllers/%d", card->cnr);
  402. card->procent = proc_create_data(card->procfn, 0, NULL, card->proc_fops, card);
  403. ncards++;
  404. printk(KERN_NOTICE "kcapi: Controller [%03d]: %s attached\n",
  405. card->cnr, card->name);
  406. return 0;
  407. }
  408. EXPORT_SYMBOL(attach_capi_ctr);
  409. /**
  410. * detach_capi_ctr() - unregister CAPI controller
  411. * @card: controller descriptor structure.
  412. *
  413. * Called by hardware driver to remove the registration of a controller
  414. * with the CAPI subsystem.
  415. * Return value: 0 on success, error code < 0 on error
  416. */
  417. int detach_capi_ctr(struct capi_ctr *card)
  418. {
  419. if (card->cardstate != CARD_DETECTED)
  420. capi_ctr_down(card);
  421. ncards--;
  422. if (card->procent) {
  423. remove_proc_entry(card->procfn, NULL);
  424. card->procent = NULL;
  425. }
  426. capi_cards[card->cnr - 1] = NULL;
  427. printk(KERN_NOTICE "kcapi: Controller [%03d]: %s unregistered\n",
  428. card->cnr, card->name);
  429. return 0;
  430. }
  431. EXPORT_SYMBOL(detach_capi_ctr);
  432. /**
  433. * register_capi_driver() - register CAPI driver
  434. * @driver: driver descriptor structure.
  435. *
  436. * Called by hardware driver to register itself with the CAPI subsystem.
  437. */
  438. void register_capi_driver(struct capi_driver *driver)
  439. {
  440. unsigned long flags;
  441. write_lock_irqsave(&capi_drivers_list_lock, flags);
  442. list_add_tail(&driver->list, &capi_drivers);
  443. write_unlock_irqrestore(&capi_drivers_list_lock, flags);
  444. }
  445. EXPORT_SYMBOL(register_capi_driver);
  446. /**
  447. * unregister_capi_driver() - unregister CAPI driver
  448. * @driver: driver descriptor structure.
  449. *
  450. * Called by hardware driver to unregister itself from the CAPI subsystem.
  451. */
  452. void unregister_capi_driver(struct capi_driver *driver)
  453. {
  454. unsigned long flags;
  455. write_lock_irqsave(&capi_drivers_list_lock, flags);
  456. list_del(&driver->list);
  457. write_unlock_irqrestore(&capi_drivers_list_lock, flags);
  458. }
  459. EXPORT_SYMBOL(unregister_capi_driver);
  460. /* ------------------------------------------------------------- */
  461. /* -------- CAPI2.0 Interface ---------------------------------- */
  462. /* ------------------------------------------------------------- */
  463. /**
  464. * capi20_isinstalled() - CAPI 2.0 operation CAPI_INSTALLED
  465. *
  466. * Return value: CAPI result code (CAPI_NOERROR if at least one ISDN controller
  467. * is ready for use, CAPI_REGNOTINSTALLED otherwise)
  468. */
  469. u16 capi20_isinstalled(void)
  470. {
  471. int i;
  472. for (i = 0; i < CAPI_MAXCONTR; i++) {
  473. if (capi_cards[i] && capi_cards[i]->cardstate == CARD_RUNNING)
  474. return CAPI_NOERROR;
  475. }
  476. return CAPI_REGNOTINSTALLED;
  477. }
  478. EXPORT_SYMBOL(capi20_isinstalled);
  479. /**
  480. * capi20_register() - CAPI 2.0 operation CAPI_REGISTER
  481. * @ap: CAPI application descriptor structure.
  482. *
  483. * Register an application's presence with CAPI.
  484. * A unique application ID is assigned and stored in @ap->applid.
  485. * After this function returns successfully, the message receive
  486. * callback function @ap->recv_message() may be called at any time
  487. * until capi20_release() has been called for the same @ap.
  488. * Return value: CAPI result code
  489. */
  490. u16 capi20_register(struct capi20_appl *ap)
  491. {
  492. int i;
  493. u16 applid;
  494. unsigned long flags;
  495. DBG("");
  496. if (ap->rparam.datablklen < 128)
  497. return CAPI_LOGBLKSIZETOSMALL;
  498. write_lock_irqsave(&application_lock, flags);
  499. for (applid = 1; applid <= CAPI_MAXAPPL; applid++) {
  500. if (capi_applications[applid - 1] == NULL)
  501. break;
  502. }
  503. if (applid > CAPI_MAXAPPL) {
  504. write_unlock_irqrestore(&application_lock, flags);
  505. return CAPI_TOOMANYAPPLS;
  506. }
  507. ap->applid = applid;
  508. capi_applications[applid - 1] = ap;
  509. ap->nrecvctlpkt = 0;
  510. ap->nrecvdatapkt = 0;
  511. ap->nsentctlpkt = 0;
  512. ap->nsentdatapkt = 0;
  513. ap->callback = NULL;
  514. mutex_init(&ap->recv_mtx);
  515. skb_queue_head_init(&ap->recv_queue);
  516. INIT_WORK(&ap->recv_work, recv_handler);
  517. ap->release_in_progress = 0;
  518. write_unlock_irqrestore(&application_lock, flags);
  519. mutex_lock(&controller_mutex);
  520. for (i = 0; i < CAPI_MAXCONTR; i++) {
  521. if (!capi_cards[i] || capi_cards[i]->cardstate != CARD_RUNNING)
  522. continue;
  523. register_appl(capi_cards[i], applid, &ap->rparam);
  524. }
  525. mutex_unlock(&controller_mutex);
  526. if (showcapimsgs & 1) {
  527. printk(KERN_DEBUG "kcapi: appl %d up\n", applid);
  528. }
  529. return CAPI_NOERROR;
  530. }
  531. EXPORT_SYMBOL(capi20_register);
  532. /**
  533. * capi20_release() - CAPI 2.0 operation CAPI_RELEASE
  534. * @ap: CAPI application descriptor structure.
  535. *
  536. * Terminate an application's registration with CAPI.
  537. * After this function returns successfully, the message receive
  538. * callback function @ap->recv_message() will no longer be called.
  539. * Return value: CAPI result code
  540. */
  541. u16 capi20_release(struct capi20_appl *ap)
  542. {
  543. int i;
  544. unsigned long flags;
  545. DBG("applid %#x", ap->applid);
  546. write_lock_irqsave(&application_lock, flags);
  547. ap->release_in_progress = 1;
  548. capi_applications[ap->applid - 1] = NULL;
  549. write_unlock_irqrestore(&application_lock, flags);
  550. mutex_lock(&controller_mutex);
  551. for (i = 0; i < CAPI_MAXCONTR; i++) {
  552. if (!capi_cards[i] || capi_cards[i]->cardstate != CARD_RUNNING)
  553. continue;
  554. release_appl(capi_cards[i], ap->applid);
  555. }
  556. mutex_unlock(&controller_mutex);
  557. flush_scheduled_work();
  558. skb_queue_purge(&ap->recv_queue);
  559. if (showcapimsgs & 1) {
  560. printk(KERN_DEBUG "kcapi: appl %d down\n", ap->applid);
  561. }
  562. return CAPI_NOERROR;
  563. }
  564. EXPORT_SYMBOL(capi20_release);
  565. /**
  566. * capi20_put_message() - CAPI 2.0 operation CAPI_PUT_MESSAGE
  567. * @ap: CAPI application descriptor structure.
  568. * @skb: CAPI message.
  569. *
  570. * Transfer a single message to CAPI.
  571. * Return value: CAPI result code
  572. */
  573. u16 capi20_put_message(struct capi20_appl *ap, struct sk_buff *skb)
  574. {
  575. struct capi_ctr *card;
  576. int showctl = 0;
  577. u8 cmd, subcmd;
  578. DBG("applid %#x", ap->applid);
  579. if (ncards == 0)
  580. return CAPI_REGNOTINSTALLED;
  581. if ((ap->applid == 0) || ap->release_in_progress)
  582. return CAPI_ILLAPPNR;
  583. if (skb->len < 12
  584. || !capi_cmd_valid(CAPIMSG_COMMAND(skb->data))
  585. || !capi_subcmd_valid(CAPIMSG_SUBCOMMAND(skb->data)))
  586. return CAPI_ILLCMDORSUBCMDORMSGTOSMALL;
  587. card = get_capi_ctr_by_nr(CAPIMSG_CONTROLLER(skb->data));
  588. if (!card || card->cardstate != CARD_RUNNING) {
  589. card = get_capi_ctr_by_nr(1); // XXX why?
  590. if (!card || card->cardstate != CARD_RUNNING)
  591. return CAPI_REGNOTINSTALLED;
  592. }
  593. if (card->blocked)
  594. return CAPI_SENDQUEUEFULL;
  595. cmd = CAPIMSG_COMMAND(skb->data);
  596. subcmd = CAPIMSG_SUBCOMMAND(skb->data);
  597. if (cmd == CAPI_DATA_B3 && subcmd== CAPI_REQ) {
  598. card->nsentdatapkt++;
  599. ap->nsentdatapkt++;
  600. if (card->traceflag > 2) showctl |= 2;
  601. } else {
  602. card->nsentctlpkt++;
  603. ap->nsentctlpkt++;
  604. if (card->traceflag) showctl |= 2;
  605. }
  606. showctl |= (card->traceflag & 1);
  607. if (showctl & 2) {
  608. if (showctl & 1) {
  609. printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u\n",
  610. CAPIMSG_CONTROLLER(skb->data),
  611. CAPIMSG_APPID(skb->data),
  612. capi_cmd2str(cmd, subcmd),
  613. CAPIMSG_LEN(skb->data));
  614. } else {
  615. _cdebbuf *cdb = capi_message2str(skb->data);
  616. if (cdb) {
  617. printk(KERN_DEBUG "kcapi: put [%03d] %s\n",
  618. CAPIMSG_CONTROLLER(skb->data),
  619. cdb->buf);
  620. cdebbuf_free(cdb);
  621. } else
  622. printk(KERN_DEBUG "kcapi: put [%03d] id#%d %s len=%u cannot trace\n",
  623. CAPIMSG_CONTROLLER(skb->data),
  624. CAPIMSG_APPID(skb->data),
  625. capi_cmd2str(cmd, subcmd),
  626. CAPIMSG_LEN(skb->data));
  627. }
  628. }
  629. return card->send_message(card, skb);
  630. }
  631. EXPORT_SYMBOL(capi20_put_message);
  632. /**
  633. * capi20_get_manufacturer() - CAPI 2.0 operation CAPI_GET_MANUFACTURER
  634. * @contr: controller number.
  635. * @buf: result buffer (64 bytes).
  636. *
  637. * Retrieve information about the manufacturer of the specified ISDN controller
  638. * or (for @contr == 0) the driver itself.
  639. * Return value: CAPI result code
  640. */
  641. u16 capi20_get_manufacturer(u32 contr, u8 *buf)
  642. {
  643. struct capi_ctr *card;
  644. if (contr == 0) {
  645. strlcpy(buf, capi_manufakturer, CAPI_MANUFACTURER_LEN);
  646. return CAPI_NOERROR;
  647. }
  648. card = get_capi_ctr_by_nr(contr);
  649. if (!card || card->cardstate != CARD_RUNNING)
  650. return CAPI_REGNOTINSTALLED;
  651. strlcpy(buf, card->manu, CAPI_MANUFACTURER_LEN);
  652. return CAPI_NOERROR;
  653. }
  654. EXPORT_SYMBOL(capi20_get_manufacturer);
  655. /**
  656. * capi20_get_version() - CAPI 2.0 operation CAPI_GET_VERSION
  657. * @contr: controller number.
  658. * @verp: result structure.
  659. *
  660. * Retrieve version information for the specified ISDN controller
  661. * or (for @contr == 0) the driver itself.
  662. * Return value: CAPI result code
  663. */
  664. u16 capi20_get_version(u32 contr, struct capi_version *verp)
  665. {
  666. struct capi_ctr *card;
  667. if (contr == 0) {
  668. *verp = driver_version;
  669. return CAPI_NOERROR;
  670. }
  671. card = get_capi_ctr_by_nr(contr);
  672. if (!card || card->cardstate != CARD_RUNNING)
  673. return CAPI_REGNOTINSTALLED;
  674. memcpy((void *) verp, &card->version, sizeof(capi_version));
  675. return CAPI_NOERROR;
  676. }
  677. EXPORT_SYMBOL(capi20_get_version);
  678. /**
  679. * capi20_get_serial() - CAPI 2.0 operation CAPI_GET_SERIAL_NUMBER
  680. * @contr: controller number.
  681. * @serial: result buffer (8 bytes).
  682. *
  683. * Retrieve the serial number of the specified ISDN controller
  684. * or (for @contr == 0) the driver itself.
  685. * Return value: CAPI result code
  686. */
  687. u16 capi20_get_serial(u32 contr, u8 *serial)
  688. {
  689. struct capi_ctr *card;
  690. if (contr == 0) {
  691. strlcpy(serial, driver_serial, CAPI_SERIAL_LEN);
  692. return CAPI_NOERROR;
  693. }
  694. card = get_capi_ctr_by_nr(contr);
  695. if (!card || card->cardstate != CARD_RUNNING)
  696. return CAPI_REGNOTINSTALLED;
  697. strlcpy((void *) serial, card->serial, CAPI_SERIAL_LEN);
  698. return CAPI_NOERROR;
  699. }
  700. EXPORT_SYMBOL(capi20_get_serial);
  701. /**
  702. * capi20_get_profile() - CAPI 2.0 operation CAPI_GET_PROFILE
  703. * @contr: controller number.
  704. * @profp: result structure.
  705. *
  706. * Retrieve capability information for the specified ISDN controller
  707. * or (for @contr == 0) the number of installed controllers.
  708. * Return value: CAPI result code
  709. */
  710. u16 capi20_get_profile(u32 contr, struct capi_profile *profp)
  711. {
  712. struct capi_ctr *card;
  713. if (contr == 0) {
  714. profp->ncontroller = ncards;
  715. return CAPI_NOERROR;
  716. }
  717. card = get_capi_ctr_by_nr(contr);
  718. if (!card || card->cardstate != CARD_RUNNING)
  719. return CAPI_REGNOTINSTALLED;
  720. memcpy((void *) profp, &card->profile,
  721. sizeof(struct capi_profile));
  722. return CAPI_NOERROR;
  723. }
  724. EXPORT_SYMBOL(capi20_get_profile);
  725. #ifdef AVMB1_COMPAT
  726. static int old_capi_manufacturer(unsigned int cmd, void __user *data)
  727. {
  728. avmb1_loadandconfigdef ldef;
  729. avmb1_extcarddef cdef;
  730. avmb1_resetdef rdef;
  731. capicardparams cparams;
  732. struct capi_ctr *card;
  733. struct capi_driver *driver = NULL;
  734. capiloaddata ldata;
  735. struct list_head *l;
  736. unsigned long flags;
  737. int retval;
  738. switch (cmd) {
  739. case AVMB1_ADDCARD:
  740. case AVMB1_ADDCARD_WITH_TYPE:
  741. if (cmd == AVMB1_ADDCARD) {
  742. if ((retval = copy_from_user(&cdef, data,
  743. sizeof(avmb1_carddef))))
  744. return retval;
  745. cdef.cardtype = AVM_CARDTYPE_B1;
  746. } else {
  747. if ((retval = copy_from_user(&cdef, data,
  748. sizeof(avmb1_extcarddef))))
  749. return retval;
  750. }
  751. cparams.port = cdef.port;
  752. cparams.irq = cdef.irq;
  753. cparams.cardnr = cdef.cardnr;
  754. read_lock_irqsave(&capi_drivers_list_lock, flags);
  755. switch (cdef.cardtype) {
  756. case AVM_CARDTYPE_B1:
  757. list_for_each(l, &capi_drivers) {
  758. driver = list_entry(l, struct capi_driver, list);
  759. if (strcmp(driver->name, "b1isa") == 0)
  760. break;
  761. }
  762. break;
  763. case AVM_CARDTYPE_T1:
  764. list_for_each(l, &capi_drivers) {
  765. driver = list_entry(l, struct capi_driver, list);
  766. if (strcmp(driver->name, "t1isa") == 0)
  767. break;
  768. }
  769. break;
  770. default:
  771. driver = NULL;
  772. break;
  773. }
  774. if (!driver) {
  775. read_unlock_irqrestore(&capi_drivers_list_lock, flags);
  776. printk(KERN_ERR "kcapi: driver not loaded.\n");
  777. return -EIO;
  778. }
  779. if (!driver->add_card) {
  780. read_unlock_irqrestore(&capi_drivers_list_lock, flags);
  781. printk(KERN_ERR "kcapi: driver has no add card function.\n");
  782. return -EIO;
  783. }
  784. retval = driver->add_card(driver, &cparams);
  785. read_unlock_irqrestore(&capi_drivers_list_lock, flags);
  786. return retval;
  787. case AVMB1_LOAD:
  788. case AVMB1_LOAD_AND_CONFIG:
  789. if (cmd == AVMB1_LOAD) {
  790. if (copy_from_user(&ldef, data,
  791. sizeof(avmb1_loaddef)))
  792. return -EFAULT;
  793. ldef.t4config.len = 0;
  794. ldef.t4config.data = NULL;
  795. } else {
  796. if (copy_from_user(&ldef, data,
  797. sizeof(avmb1_loadandconfigdef)))
  798. return -EFAULT;
  799. }
  800. card = get_capi_ctr_by_nr(ldef.contr);
  801. if (!card)
  802. return -EINVAL;
  803. card = capi_ctr_get(card);
  804. if (!card)
  805. return -ESRCH;
  806. if (card->load_firmware == NULL) {
  807. printk(KERN_DEBUG "kcapi: load: no load function\n");
  808. capi_ctr_put(card);
  809. return -ESRCH;
  810. }
  811. if (ldef.t4file.len <= 0) {
  812. printk(KERN_DEBUG "kcapi: load: invalid parameter: length of t4file is %d ?\n", ldef.t4file.len);
  813. capi_ctr_put(card);
  814. return -EINVAL;
  815. }
  816. if (ldef.t4file.data == NULL) {
  817. printk(KERN_DEBUG "kcapi: load: invalid parameter: dataptr is 0\n");
  818. capi_ctr_put(card);
  819. return -EINVAL;
  820. }
  821. ldata.firmware.user = 1;
  822. ldata.firmware.data = ldef.t4file.data;
  823. ldata.firmware.len = ldef.t4file.len;
  824. ldata.configuration.user = 1;
  825. ldata.configuration.data = ldef.t4config.data;
  826. ldata.configuration.len = ldef.t4config.len;
  827. if (card->cardstate != CARD_DETECTED) {
  828. printk(KERN_INFO "kcapi: load: contr=%d not in detect state\n", ldef.contr);
  829. capi_ctr_put(card);
  830. return -EBUSY;
  831. }
  832. card->cardstate = CARD_LOADING;
  833. retval = card->load_firmware(card, &ldata);
  834. if (retval) {
  835. card->cardstate = CARD_DETECTED;
  836. capi_ctr_put(card);
  837. return retval;
  838. }
  839. while (card->cardstate != CARD_RUNNING) {
  840. msleep_interruptible(100); /* 0.1 sec */
  841. if (signal_pending(current)) {
  842. capi_ctr_put(card);
  843. return -EINTR;
  844. }
  845. }
  846. capi_ctr_put(card);
  847. return 0;
  848. case AVMB1_RESETCARD:
  849. if (copy_from_user(&rdef, data, sizeof(avmb1_resetdef)))
  850. return -EFAULT;
  851. card = get_capi_ctr_by_nr(rdef.contr);
  852. if (!card)
  853. return -ESRCH;
  854. if (card->cardstate == CARD_DETECTED)
  855. return 0;
  856. card->reset_ctr(card);
  857. while (card->cardstate > CARD_DETECTED) {
  858. msleep_interruptible(100); /* 0.1 sec */
  859. if (signal_pending(current))
  860. return -EINTR;
  861. }
  862. return 0;
  863. }
  864. return -EINVAL;
  865. }
  866. #endif
  867. /**
  868. * capi20_manufacturer() - CAPI 2.0 operation CAPI_MANUFACTURER
  869. * @cmd: command.
  870. * @data: parameter.
  871. *
  872. * Perform manufacturer specific command.
  873. * Return value: CAPI result code
  874. */
  875. int capi20_manufacturer(unsigned int cmd, void __user *data)
  876. {
  877. struct capi_ctr *card;
  878. switch (cmd) {
  879. #ifdef AVMB1_COMPAT
  880. case AVMB1_LOAD:
  881. case AVMB1_LOAD_AND_CONFIG:
  882. case AVMB1_RESETCARD:
  883. case AVMB1_GET_CARDINFO:
  884. case AVMB1_REMOVECARD:
  885. return old_capi_manufacturer(cmd, data);
  886. #endif
  887. case KCAPI_CMD_TRACE:
  888. {
  889. kcapi_flagdef fdef;
  890. if (copy_from_user(&fdef, data, sizeof(kcapi_flagdef)))
  891. return -EFAULT;
  892. card = get_capi_ctr_by_nr(fdef.contr);
  893. if (!card)
  894. return -ESRCH;
  895. card->traceflag = fdef.flag;
  896. printk(KERN_INFO "kcapi: contr [%03d] set trace=%d\n",
  897. card->cnr, card->traceflag);
  898. return 0;
  899. }
  900. case KCAPI_CMD_ADDCARD:
  901. {
  902. struct list_head *l;
  903. struct capi_driver *driver = NULL;
  904. capicardparams cparams;
  905. kcapi_carddef cdef;
  906. int retval;
  907. if ((retval = copy_from_user(&cdef, data, sizeof(cdef))))
  908. return retval;
  909. cparams.port = cdef.port;
  910. cparams.irq = cdef.irq;
  911. cparams.membase = cdef.membase;
  912. cparams.cardnr = cdef.cardnr;
  913. cparams.cardtype = 0;
  914. cdef.driver[sizeof(cdef.driver)-1] = 0;
  915. list_for_each(l, &capi_drivers) {
  916. driver = list_entry(l, struct capi_driver, list);
  917. if (strcmp(driver->name, cdef.driver) == 0)
  918. break;
  919. }
  920. if (driver == NULL) {
  921. printk(KERN_ERR "kcapi: driver \"%s\" not loaded.\n",
  922. cdef.driver);
  923. return -ESRCH;
  924. }
  925. if (!driver->add_card) {
  926. printk(KERN_ERR "kcapi: driver \"%s\" has no add card function.\n", cdef.driver);
  927. return -EIO;
  928. }
  929. return driver->add_card(driver, &cparams);
  930. }
  931. default:
  932. printk(KERN_ERR "kcapi: manufacturer command %d unknown.\n",
  933. cmd);
  934. break;
  935. }
  936. return -EINVAL;
  937. }
  938. EXPORT_SYMBOL(capi20_manufacturer);
  939. /* temporary hack */
  940. /**
  941. * capi20_set_callback() - set CAPI application notification callback function
  942. * @ap: CAPI application descriptor structure.
  943. * @callback: callback function (NULL to remove).
  944. *
  945. * If not NULL, the callback function will be called to notify the
  946. * application of the addition or removal of a controller.
  947. * The first argument (cmd) will tell whether the controller was added
  948. * (KCI_CONTRUP) or removed (KCI_CONTRDOWN).
  949. * The second argument (contr) will be the controller number.
  950. * For cmd==KCI_CONTRUP the third argument (data) will be a pointer to the
  951. * new controller's capability profile structure.
  952. */
  953. void capi20_set_callback(struct capi20_appl *ap,
  954. void (*callback) (unsigned int cmd, __u32 contr, void *data))
  955. {
  956. ap->callback = callback;
  957. }
  958. EXPORT_SYMBOL(capi20_set_callback);
  959. /* ------------------------------------------------------------- */
  960. /* -------- Init & Cleanup ------------------------------------- */
  961. /* ------------------------------------------------------------- */
  962. /*
  963. * init / exit functions
  964. */
  965. static int __init kcapi_init(void)
  966. {
  967. char *p;
  968. char rev[32];
  969. int ret;
  970. ret = cdebug_init();
  971. if (ret)
  972. return ret;
  973. kcapi_proc_init();
  974. if ((p = strchr(revision, ':')) != NULL && p[1]) {
  975. strlcpy(rev, p + 2, sizeof(rev));
  976. if ((p = strchr(rev, '$')) != NULL && p > rev)
  977. *(p-1) = 0;
  978. } else
  979. strcpy(rev, "1.0");
  980. printk(KERN_NOTICE "CAPI Subsystem Rev %s\n", rev);
  981. return 0;
  982. }
  983. static void __exit kcapi_exit(void)
  984. {
  985. kcapi_proc_exit();
  986. /* make sure all notifiers are finished */
  987. flush_scheduled_work();
  988. cdebug_exit();
  989. }
  990. module_init(kcapi_init);
  991. module_exit(kcapi_exit);