kcapi.c 28 KB

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