YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | CMTP implementation for Linux Bluetooth stack (BlueZ). |
| 3 | Copyright (C) 2002-2003 Marcel Holtmann <marcel@holtmann.org> |
| 4 | |
| 5 | This program is free software; you can redistribute it and/or modify |
| 6 | it under the terms of the GNU General Public License version 2 as |
| 7 | published by the Free Software Foundation; |
| 8 | |
| 9 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
| 10 | OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 11 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. |
| 12 | IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 13 | CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES |
| 14 | WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| 15 | ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 17 | |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 18 | ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, |
| 19 | COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | SOFTWARE IS DISCLAIMED. |
| 21 | */ |
| 22 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | #include <linux/module.h> |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 24 | #include <linux/proc_fs.h> |
| 25 | #include <linux/seq_file.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | #include <linux/types.h> |
| 27 | #include <linux/errno.h> |
| 28 | #include <linux/kernel.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | #include <linux/sched.h> |
| 30 | #include <linux/slab.h> |
| 31 | #include <linux/poll.h> |
| 32 | #include <linux/fcntl.h> |
| 33 | #include <linux/skbuff.h> |
| 34 | #include <linux/socket.h> |
| 35 | #include <linux/ioctl.h> |
| 36 | #include <linux/file.h> |
| 37 | #include <linux/wait.h> |
Szymon Janc | fada4ac | 2011-03-21 14:20:06 +0100 | [diff] [blame] | 38 | #include <linux/kthread.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | #include <net/sock.h> |
| 40 | |
| 41 | #include <linux/isdn/capilli.h> |
| 42 | #include <linux/isdn/capicmd.h> |
| 43 | #include <linux/isdn/capiutil.h> |
| 44 | |
| 45 | #include "cmtp.h" |
| 46 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | #define CAPI_INTEROPERABILITY 0x20 |
| 48 | |
| 49 | #define CAPI_INTEROPERABILITY_REQ CAPICMD(CAPI_INTEROPERABILITY, CAPI_REQ) |
| 50 | #define CAPI_INTEROPERABILITY_CONF CAPICMD(CAPI_INTEROPERABILITY, CAPI_CONF) |
| 51 | #define CAPI_INTEROPERABILITY_IND CAPICMD(CAPI_INTEROPERABILITY, CAPI_IND) |
| 52 | #define CAPI_INTEROPERABILITY_RESP CAPICMD(CAPI_INTEROPERABILITY, CAPI_RESP) |
| 53 | |
| 54 | #define CAPI_INTEROPERABILITY_REQ_LEN (CAPI_MSG_BASELEN + 2) |
| 55 | #define CAPI_INTEROPERABILITY_CONF_LEN (CAPI_MSG_BASELEN + 4) |
| 56 | #define CAPI_INTEROPERABILITY_IND_LEN (CAPI_MSG_BASELEN + 2) |
| 57 | #define CAPI_INTEROPERABILITY_RESP_LEN (CAPI_MSG_BASELEN + 2) |
| 58 | |
| 59 | #define CAPI_FUNCTION_REGISTER 0 |
| 60 | #define CAPI_FUNCTION_RELEASE 1 |
| 61 | #define CAPI_FUNCTION_GET_PROFILE 2 |
| 62 | #define CAPI_FUNCTION_GET_MANUFACTURER 3 |
| 63 | #define CAPI_FUNCTION_GET_VERSION 4 |
| 64 | #define CAPI_FUNCTION_GET_SERIAL_NUMBER 5 |
| 65 | #define CAPI_FUNCTION_MANUFACTURER 6 |
| 66 | #define CAPI_FUNCTION_LOOPBACK 7 |
| 67 | |
| 68 | |
| 69 | #define CMTP_MSGNUM 1 |
| 70 | #define CMTP_APPLID 2 |
| 71 | #define CMTP_MAPPING 3 |
| 72 | |
| 73 | static struct cmtp_application *cmtp_application_add(struct cmtp_session *session, __u16 appl) |
| 74 | { |
Marcel Holtmann | 25ea6db | 2006-07-06 15:40:09 +0200 | [diff] [blame] | 75 | struct cmtp_application *app = kzalloc(sizeof(*app), GFP_KERNEL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | |
| 77 | BT_DBG("session %p application %p appl %d", session, app, appl); |
| 78 | |
| 79 | if (!app) |
| 80 | return NULL; |
| 81 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | app->state = BT_OPEN; |
| 83 | app->appl = appl; |
| 84 | |
| 85 | list_add_tail(&app->list, &session->applications); |
| 86 | |
| 87 | return app; |
| 88 | } |
| 89 | |
| 90 | static void cmtp_application_del(struct cmtp_session *session, struct cmtp_application *app) |
| 91 | { |
| 92 | BT_DBG("session %p application %p", session, app); |
| 93 | |
| 94 | if (app) { |
| 95 | list_del(&app->list); |
| 96 | kfree(app); |
| 97 | } |
| 98 | } |
| 99 | |
| 100 | static struct cmtp_application *cmtp_application_get(struct cmtp_session *session, int pattern, __u16 value) |
| 101 | { |
| 102 | struct cmtp_application *app; |
| 103 | struct list_head *p, *n; |
| 104 | |
| 105 | list_for_each_safe(p, n, &session->applications) { |
| 106 | app = list_entry(p, struct cmtp_application, list); |
| 107 | switch (pattern) { |
| 108 | case CMTP_MSGNUM: |
| 109 | if (app->msgnum == value) |
| 110 | return app; |
| 111 | break; |
| 112 | case CMTP_APPLID: |
| 113 | if (app->appl == value) |
| 114 | return app; |
| 115 | break; |
| 116 | case CMTP_MAPPING: |
| 117 | if (app->mapping == value) |
| 118 | return app; |
| 119 | break; |
| 120 | } |
| 121 | } |
| 122 | |
| 123 | return NULL; |
| 124 | } |
| 125 | |
| 126 | static int cmtp_msgnum_get(struct cmtp_session *session) |
| 127 | { |
| 128 | session->msgnum++; |
| 129 | |
| 130 | if ((session->msgnum & 0xff) > 200) |
| 131 | session->msgnum = CMTP_INITIAL_MSGNUM + 1; |
| 132 | |
| 133 | return session->msgnum; |
| 134 | } |
| 135 | |
| 136 | static void cmtp_send_capimsg(struct cmtp_session *session, struct sk_buff *skb) |
| 137 | { |
| 138 | struct cmtp_scb *scb = (void *) skb->cb; |
| 139 | |
| 140 | BT_DBG("session %p skb %p len %d", session, skb, skb->len); |
| 141 | |
| 142 | scb->id = -1; |
| 143 | scb->data = (CAPIMSG_COMMAND(skb->data) == CAPI_DATA_B3); |
| 144 | |
| 145 | skb_queue_tail(&session->transmit, skb); |
| 146 | |
Szymon Janc | fada4ac | 2011-03-21 14:20:06 +0100 | [diff] [blame] | 147 | wake_up_interruptible(sk_sleep(session->sock->sk)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | } |
| 149 | |
| 150 | static void cmtp_send_interopmsg(struct cmtp_session *session, |
| 151 | __u8 subcmd, __u16 appl, __u16 msgnum, |
| 152 | __u16 function, unsigned char *buf, int len) |
| 153 | { |
| 154 | struct sk_buff *skb; |
| 155 | unsigned char *s; |
| 156 | |
| 157 | BT_DBG("session %p subcmd 0x%02x appl %d msgnum %d", session, subcmd, appl, msgnum); |
| 158 | |
Andrei Emeltchenko | 5a08ecc | 2011-01-11 17:20:20 +0200 | [diff] [blame] | 159 | skb = alloc_skb(CAPI_MSG_BASELEN + 6 + len, GFP_ATOMIC); |
| 160 | if (!skb) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 161 | BT_ERR("Can't allocate memory for interoperability packet"); |
| 162 | return; |
| 163 | } |
| 164 | |
| 165 | s = skb_put(skb, CAPI_MSG_BASELEN + 6 + len); |
| 166 | |
| 167 | capimsg_setu16(s, 0, CAPI_MSG_BASELEN + 6 + len); |
| 168 | capimsg_setu16(s, 2, appl); |
| 169 | capimsg_setu8 (s, 4, CAPI_INTEROPERABILITY); |
| 170 | capimsg_setu8 (s, 5, subcmd); |
| 171 | capimsg_setu16(s, 6, msgnum); |
| 172 | |
| 173 | /* Interoperability selector (Bluetooth Device Management) */ |
| 174 | capimsg_setu16(s, 8, 0x0001); |
| 175 | |
| 176 | capimsg_setu8 (s, 10, 3 + len); |
| 177 | capimsg_setu16(s, 11, function); |
| 178 | capimsg_setu8 (s, 13, len); |
| 179 | |
| 180 | if (len > 0) |
| 181 | memcpy(s + 14, buf, len); |
| 182 | |
| 183 | cmtp_send_capimsg(session, skb); |
| 184 | } |
| 185 | |
| 186 | static void cmtp_recv_interopmsg(struct cmtp_session *session, struct sk_buff *skb) |
| 187 | { |
| 188 | struct capi_ctr *ctrl = &session->ctrl; |
| 189 | struct cmtp_application *application; |
| 190 | __u16 appl, msgnum, func, info; |
| 191 | __u32 controller; |
| 192 | |
| 193 | BT_DBG("session %p skb %p len %d", session, skb, skb->len); |
| 194 | |
| 195 | switch (CAPIMSG_SUBCOMMAND(skb->data)) { |
| 196 | case CAPI_CONF: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 197 | if (skb->len < CAPI_MSG_BASELEN + 10) |
| 198 | break; |
| 199 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | func = CAPIMSG_U16(skb->data, CAPI_MSG_BASELEN + 5); |
| 201 | info = CAPIMSG_U16(skb->data, CAPI_MSG_BASELEN + 8); |
| 202 | |
| 203 | switch (func) { |
| 204 | case CAPI_FUNCTION_REGISTER: |
| 205 | msgnum = CAPIMSG_MSGID(skb->data); |
| 206 | |
| 207 | application = cmtp_application_get(session, CMTP_MSGNUM, msgnum); |
| 208 | if (application) { |
| 209 | application->state = BT_CONNECTED; |
| 210 | application->msgnum = 0; |
| 211 | application->mapping = CAPIMSG_APPID(skb->data); |
| 212 | wake_up_interruptible(&session->wait); |
| 213 | } |
| 214 | |
| 215 | break; |
| 216 | |
| 217 | case CAPI_FUNCTION_RELEASE: |
| 218 | appl = CAPIMSG_APPID(skb->data); |
| 219 | |
| 220 | application = cmtp_application_get(session, CMTP_MAPPING, appl); |
| 221 | if (application) { |
| 222 | application->state = BT_CLOSED; |
| 223 | application->msgnum = 0; |
| 224 | wake_up_interruptible(&session->wait); |
| 225 | } |
| 226 | |
| 227 | break; |
| 228 | |
| 229 | case CAPI_FUNCTION_GET_PROFILE: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 230 | if (skb->len < CAPI_MSG_BASELEN + 11 + sizeof(capi_profile)) |
| 231 | break; |
| 232 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 | controller = CAPIMSG_U16(skb->data, CAPI_MSG_BASELEN + 11); |
| 234 | msgnum = CAPIMSG_MSGID(skb->data); |
| 235 | |
| 236 | if (!info && (msgnum == CMTP_INITIAL_MSGNUM)) { |
| 237 | session->ncontroller = controller; |
| 238 | wake_up_interruptible(&session->wait); |
| 239 | break; |
| 240 | } |
| 241 | |
| 242 | if (!info && ctrl) { |
| 243 | memcpy(&ctrl->profile, |
| 244 | skb->data + CAPI_MSG_BASELEN + 11, |
| 245 | sizeof(capi_profile)); |
| 246 | session->state = BT_CONNECTED; |
| 247 | capi_ctr_ready(ctrl); |
| 248 | } |
| 249 | |
| 250 | break; |
| 251 | |
| 252 | case CAPI_FUNCTION_GET_MANUFACTURER: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 253 | if (skb->len < CAPI_MSG_BASELEN + 15) |
| 254 | break; |
| 255 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 256 | controller = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 10); |
| 257 | |
| 258 | if (!info && ctrl) { |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 259 | int len = min_t(uint, CAPI_MANUFACTURER_LEN, |
| 260 | skb->data[CAPI_MSG_BASELEN + 14]); |
| 261 | |
| 262 | memset(ctrl->manu, 0, CAPI_MANUFACTURER_LEN); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | strncpy(ctrl->manu, |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 264 | skb->data + CAPI_MSG_BASELEN + 15, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 265 | } |
| 266 | |
| 267 | break; |
| 268 | |
| 269 | case CAPI_FUNCTION_GET_VERSION: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 270 | if (skb->len < CAPI_MSG_BASELEN + 32) |
| 271 | break; |
| 272 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 273 | controller = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 12); |
| 274 | |
| 275 | if (!info && ctrl) { |
| 276 | ctrl->version.majorversion = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 16); |
| 277 | ctrl->version.minorversion = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 20); |
| 278 | ctrl->version.majormanuversion = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 24); |
| 279 | ctrl->version.minormanuversion = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 28); |
| 280 | } |
| 281 | |
| 282 | break; |
| 283 | |
| 284 | case CAPI_FUNCTION_GET_SERIAL_NUMBER: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 285 | if (skb->len < CAPI_MSG_BASELEN + 17) |
| 286 | break; |
| 287 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | controller = CAPIMSG_U32(skb->data, CAPI_MSG_BASELEN + 12); |
| 289 | |
| 290 | if (!info && ctrl) { |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 291 | int len = min_t(uint, CAPI_SERIAL_LEN, |
| 292 | skb->data[CAPI_MSG_BASELEN + 16]); |
| 293 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | memset(ctrl->serial, 0, CAPI_SERIAL_LEN); |
| 295 | strncpy(ctrl->serial, |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 296 | skb->data + CAPI_MSG_BASELEN + 17, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | } |
| 298 | |
| 299 | break; |
| 300 | } |
| 301 | |
| 302 | break; |
| 303 | |
| 304 | case CAPI_IND: |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 305 | if (skb->len < CAPI_MSG_BASELEN + 6) |
| 306 | break; |
| 307 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 308 | func = CAPIMSG_U16(skb->data, CAPI_MSG_BASELEN + 3); |
| 309 | |
| 310 | if (func == CAPI_FUNCTION_LOOPBACK) { |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 311 | int len = min_t(uint, skb->len - CAPI_MSG_BASELEN - 6, |
| 312 | skb->data[CAPI_MSG_BASELEN + 5]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | appl = CAPIMSG_APPID(skb->data); |
| 314 | msgnum = CAPIMSG_MSGID(skb->data); |
| 315 | cmtp_send_interopmsg(session, CAPI_RESP, appl, msgnum, func, |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 316 | skb->data + CAPI_MSG_BASELEN + 6, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 317 | } |
| 318 | |
| 319 | break; |
| 320 | } |
| 321 | |
| 322 | kfree_skb(skb); |
| 323 | } |
| 324 | |
| 325 | void cmtp_recv_capimsg(struct cmtp_session *session, struct sk_buff *skb) |
| 326 | { |
| 327 | struct capi_ctr *ctrl = &session->ctrl; |
| 328 | struct cmtp_application *application; |
David Miller | d29d04c | 2011-05-19 17:50:05 -0400 | [diff] [blame] | 329 | __u16 appl; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 330 | __u32 contr; |
| 331 | |
| 332 | BT_DBG("session %p skb %p len %d", session, skb, skb->len); |
| 333 | |
Marcel Holtmann | f477756 | 2007-01-08 02:16:23 +0100 | [diff] [blame] | 334 | if (skb->len < CAPI_MSG_BASELEN) |
| 335 | return; |
| 336 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 337 | if (CAPIMSG_COMMAND(skb->data) == CAPI_INTEROPERABILITY) { |
| 338 | cmtp_recv_interopmsg(session, skb); |
| 339 | return; |
| 340 | } |
| 341 | |
| 342 | if (session->flags & (1 << CMTP_LOOPBACK)) { |
| 343 | kfree_skb(skb); |
| 344 | return; |
| 345 | } |
| 346 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 | appl = CAPIMSG_APPID(skb->data); |
| 348 | contr = CAPIMSG_CONTROL(skb->data); |
| 349 | |
| 350 | application = cmtp_application_get(session, CMTP_MAPPING, appl); |
| 351 | if (application) { |
| 352 | appl = application->appl; |
| 353 | CAPIMSG_SETAPPID(skb->data, appl); |
| 354 | } else { |
| 355 | BT_ERR("Can't find application with id %d", appl); |
| 356 | kfree_skb(skb); |
| 357 | return; |
| 358 | } |
| 359 | |
| 360 | if ((contr & 0x7f) == 0x01) { |
| 361 | contr = (contr & 0xffffff80) | session->num; |
| 362 | CAPIMSG_SETCONTROL(skb->data, contr); |
| 363 | } |
| 364 | |
| 365 | if (!ctrl) { |
| 366 | BT_ERR("Can't find controller %d for message", session->num); |
| 367 | kfree_skb(skb); |
| 368 | return; |
| 369 | } |
| 370 | |
| 371 | capi_ctr_handle_message(ctrl, appl, skb); |
| 372 | } |
| 373 | |
| 374 | static int cmtp_load_firmware(struct capi_ctr *ctrl, capiloaddata *data) |
| 375 | { |
| 376 | BT_DBG("ctrl %p data %p", ctrl, data); |
| 377 | |
| 378 | return 0; |
| 379 | } |
| 380 | |
| 381 | static void cmtp_reset_ctr(struct capi_ctr *ctrl) |
| 382 | { |
| 383 | struct cmtp_session *session = ctrl->driverdata; |
| 384 | |
| 385 | BT_DBG("ctrl %p", ctrl); |
| 386 | |
Tilman Schmidt | 4e32997 | 2009-06-07 09:09:23 +0000 | [diff] [blame] | 387 | capi_ctr_down(ctrl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 388 | |
Peter Hurley | 7176522 | 2011-08-05 10:44:21 -0400 | [diff] [blame] | 389 | atomic_inc(&session->terminate); |
| 390 | wake_up_process(session->task); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 391 | } |
| 392 | |
| 393 | static void cmtp_register_appl(struct capi_ctr *ctrl, __u16 appl, capi_register_params *rp) |
| 394 | { |
| 395 | DECLARE_WAITQUEUE(wait, current); |
| 396 | struct cmtp_session *session = ctrl->driverdata; |
| 397 | struct cmtp_application *application; |
| 398 | unsigned long timeo = CMTP_INTEROP_TIMEOUT; |
| 399 | unsigned char buf[8]; |
| 400 | int err = 0, nconn, want = rp->level3cnt; |
| 401 | |
| 402 | BT_DBG("ctrl %p appl %d level3cnt %d datablkcnt %d datablklen %d", |
| 403 | ctrl, appl, rp->level3cnt, rp->datablkcnt, rp->datablklen); |
| 404 | |
| 405 | application = cmtp_application_add(session, appl); |
| 406 | if (!application) { |
| 407 | BT_ERR("Can't allocate memory for new application"); |
| 408 | return; |
| 409 | } |
| 410 | |
| 411 | if (want < 0) |
| 412 | nconn = ctrl->profile.nbchannel * -want; |
| 413 | else |
| 414 | nconn = want; |
| 415 | |
| 416 | if (nconn == 0) |
| 417 | nconn = ctrl->profile.nbchannel; |
| 418 | |
| 419 | capimsg_setu16(buf, 0, nconn); |
| 420 | capimsg_setu16(buf, 2, rp->datablkcnt); |
| 421 | capimsg_setu16(buf, 4, rp->datablklen); |
| 422 | |
| 423 | application->state = BT_CONFIG; |
| 424 | application->msgnum = cmtp_msgnum_get(session); |
| 425 | |
| 426 | cmtp_send_interopmsg(session, CAPI_REQ, 0x0000, application->msgnum, |
| 427 | CAPI_FUNCTION_REGISTER, buf, 6); |
| 428 | |
| 429 | add_wait_queue(&session->wait, &wait); |
| 430 | while (1) { |
| 431 | set_current_state(TASK_INTERRUPTIBLE); |
| 432 | |
| 433 | if (!timeo) { |
| 434 | err = -EAGAIN; |
| 435 | break; |
| 436 | } |
| 437 | |
| 438 | if (application->state == BT_CLOSED) { |
| 439 | err = -application->err; |
| 440 | break; |
| 441 | } |
| 442 | |
| 443 | if (application->state == BT_CONNECTED) |
| 444 | break; |
| 445 | |
| 446 | if (signal_pending(current)) { |
| 447 | err = -EINTR; |
| 448 | break; |
| 449 | } |
| 450 | |
| 451 | timeo = schedule_timeout(timeo); |
| 452 | } |
| 453 | set_current_state(TASK_RUNNING); |
| 454 | remove_wait_queue(&session->wait, &wait); |
| 455 | |
| 456 | if (err) { |
| 457 | cmtp_application_del(session, application); |
| 458 | return; |
| 459 | } |
| 460 | } |
| 461 | |
| 462 | static void cmtp_release_appl(struct capi_ctr *ctrl, __u16 appl) |
| 463 | { |
| 464 | struct cmtp_session *session = ctrl->driverdata; |
| 465 | struct cmtp_application *application; |
| 466 | |
| 467 | BT_DBG("ctrl %p appl %d", ctrl, appl); |
| 468 | |
| 469 | application = cmtp_application_get(session, CMTP_APPLID, appl); |
| 470 | if (!application) { |
| 471 | BT_ERR("Can't find application"); |
| 472 | return; |
| 473 | } |
| 474 | |
| 475 | application->msgnum = cmtp_msgnum_get(session); |
| 476 | |
| 477 | cmtp_send_interopmsg(session, CAPI_REQ, application->mapping, application->msgnum, |
| 478 | CAPI_FUNCTION_RELEASE, NULL, 0); |
| 479 | |
| 480 | wait_event_interruptible_timeout(session->wait, |
| 481 | (application->state == BT_CLOSED), CMTP_INTEROP_TIMEOUT); |
| 482 | |
| 483 | cmtp_application_del(session, application); |
| 484 | } |
| 485 | |
| 486 | static u16 cmtp_send_message(struct capi_ctr *ctrl, struct sk_buff *skb) |
| 487 | { |
| 488 | struct cmtp_session *session = ctrl->driverdata; |
| 489 | struct cmtp_application *application; |
| 490 | __u16 appl; |
| 491 | __u32 contr; |
| 492 | |
| 493 | BT_DBG("ctrl %p skb %p", ctrl, skb); |
| 494 | |
| 495 | appl = CAPIMSG_APPID(skb->data); |
| 496 | contr = CAPIMSG_CONTROL(skb->data); |
| 497 | |
| 498 | application = cmtp_application_get(session, CMTP_APPLID, appl); |
| 499 | if ((!application) || (application->state != BT_CONNECTED)) { |
| 500 | BT_ERR("Can't find application with id %d", appl); |
| 501 | return CAPI_ILLAPPNR; |
| 502 | } |
| 503 | |
| 504 | CAPIMSG_SETAPPID(skb->data, application->mapping); |
| 505 | |
| 506 | if ((contr & 0x7f) == session->num) { |
| 507 | contr = (contr & 0xffffff80) | 0x01; |
| 508 | CAPIMSG_SETCONTROL(skb->data, contr); |
| 509 | } |
| 510 | |
| 511 | cmtp_send_capimsg(session, skb); |
| 512 | |
| 513 | return CAPI_NOERROR; |
| 514 | } |
| 515 | |
| 516 | static char *cmtp_procinfo(struct capi_ctr *ctrl) |
| 517 | { |
| 518 | return "CAPI Message Transport Protocol"; |
| 519 | } |
| 520 | |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 521 | static int cmtp_proc_show(struct seq_file *m, void *v) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 522 | { |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 523 | struct capi_ctr *ctrl = m->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 524 | struct cmtp_session *session = ctrl->driverdata; |
| 525 | struct cmtp_application *app; |
| 526 | struct list_head *p, *n; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 | |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 528 | seq_printf(m, "%s\n\n", cmtp_procinfo(ctrl)); |
| 529 | seq_printf(m, "addr %s\n", session->name); |
| 530 | seq_printf(m, "ctrl %d\n", session->num); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 531 | |
| 532 | list_for_each_safe(p, n, &session->applications) { |
| 533 | app = list_entry(p, struct cmtp_application, list); |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 534 | seq_printf(m, "appl %d -> %d\n", app->appl, app->mapping); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | } |
| 536 | |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 537 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 538 | } |
| 539 | |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 540 | static int cmtp_proc_open(struct inode *inode, struct file *file) |
| 541 | { |
| 542 | return single_open(file, cmtp_proc_show, PDE(inode)->data); |
| 543 | } |
| 544 | |
| 545 | static const struct file_operations cmtp_proc_fops = { |
| 546 | .owner = THIS_MODULE, |
| 547 | .open = cmtp_proc_open, |
| 548 | .read = seq_read, |
| 549 | .llseek = seq_lseek, |
| 550 | .release = single_release, |
| 551 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 552 | |
| 553 | int cmtp_attach_device(struct cmtp_session *session) |
| 554 | { |
| 555 | unsigned char buf[4]; |
| 556 | long ret; |
| 557 | |
| 558 | BT_DBG("session %p", session); |
| 559 | |
| 560 | capimsg_setu32(buf, 0, 0); |
| 561 | |
| 562 | cmtp_send_interopmsg(session, CAPI_REQ, 0xffff, CMTP_INITIAL_MSGNUM, |
| 563 | CAPI_FUNCTION_GET_PROFILE, buf, 4); |
| 564 | |
| 565 | ret = wait_event_interruptible_timeout(session->wait, |
| 566 | session->ncontroller, CMTP_INTEROP_TIMEOUT); |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 567 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 568 | BT_INFO("Found %d CAPI controller(s) on device %s", session->ncontroller, session->name); |
| 569 | |
| 570 | if (!ret) |
| 571 | return -ETIMEDOUT; |
| 572 | |
| 573 | if (!session->ncontroller) |
| 574 | return -ENODEV; |
| 575 | |
| 576 | if (session->ncontroller > 1) |
| 577 | BT_INFO("Setting up only CAPI controller 1"); |
| 578 | |
| 579 | session->ctrl.owner = THIS_MODULE; |
| 580 | session->ctrl.driverdata = session; |
| 581 | strcpy(session->ctrl.name, session->name); |
| 582 | |
| 583 | session->ctrl.driver_name = "cmtp"; |
| 584 | session->ctrl.load_firmware = cmtp_load_firmware; |
| 585 | session->ctrl.reset_ctr = cmtp_reset_ctr; |
| 586 | session->ctrl.register_appl = cmtp_register_appl; |
| 587 | session->ctrl.release_appl = cmtp_release_appl; |
| 588 | session->ctrl.send_message = cmtp_send_message; |
| 589 | |
| 590 | session->ctrl.procinfo = cmtp_procinfo; |
Alexey Dobriyan | 9a58a80 | 2010-01-14 03:10:54 -0800 | [diff] [blame] | 591 | session->ctrl.proc_fops = &cmtp_proc_fops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 592 | |
| 593 | if (attach_capi_ctr(&session->ctrl) < 0) { |
| 594 | BT_ERR("Can't attach new controller"); |
| 595 | return -EBUSY; |
| 596 | } |
| 597 | |
| 598 | session->num = session->ctrl.cnr; |
| 599 | |
| 600 | BT_DBG("session %p num %d", session, session->num); |
| 601 | |
| 602 | capimsg_setu32(buf, 0, 1); |
| 603 | |
| 604 | cmtp_send_interopmsg(session, CAPI_REQ, 0xffff, cmtp_msgnum_get(session), |
| 605 | CAPI_FUNCTION_GET_MANUFACTURER, buf, 4); |
| 606 | |
| 607 | cmtp_send_interopmsg(session, CAPI_REQ, 0xffff, cmtp_msgnum_get(session), |
| 608 | CAPI_FUNCTION_GET_VERSION, buf, 4); |
| 609 | |
| 610 | cmtp_send_interopmsg(session, CAPI_REQ, 0xffff, cmtp_msgnum_get(session), |
| 611 | CAPI_FUNCTION_GET_SERIAL_NUMBER, buf, 4); |
| 612 | |
| 613 | cmtp_send_interopmsg(session, CAPI_REQ, 0xffff, cmtp_msgnum_get(session), |
| 614 | CAPI_FUNCTION_GET_PROFILE, buf, 4); |
| 615 | |
| 616 | return 0; |
| 617 | } |
| 618 | |
| 619 | void cmtp_detach_device(struct cmtp_session *session) |
| 620 | { |
| 621 | BT_DBG("session %p", session); |
| 622 | |
| 623 | detach_capi_ctr(&session->ctrl); |
| 624 | } |