1 /* -----------------------------------------------------------------------------
2 * Copyright (c) 2011 Ozmo Inc
3 * Released under the GNU General Public License Version 2 (GPLv2).
4 * -----------------------------------------------------------------------------
6 #include <linux/module.h>
8 #include <linux/cdev.h>
9 #include <linux/uaccess.h>
10 #include <linux/netdevice.h>
11 #include <linux/poll.h>
12 #include <linux/sched.h>
14 #include "ozprotocol.h"
22 /*------------------------------------------------------------------------------
24 #define OZ_RD_BUF_SZ 256
28 wait_queue_head_t rdq
;
30 u8 active_addr
[ETH_ALEN
];
31 struct oz_pd
*active_pd
;
34 /* Per PD context for the serial service stored in the PD. */
35 struct oz_serial_ctx
{
39 u8 rd_buf
[OZ_RD_BUF_SZ
];
43 /*------------------------------------------------------------------------------
46 /*------------------------------------------------------------------------------
48 static struct oz_cdev g_cdev
;
49 /*------------------------------------------------------------------------------
50 * Context: process and softirq
52 static struct oz_serial_ctx
*oz_cdev_claim_ctx(struct oz_pd
*pd
)
54 struct oz_serial_ctx
*ctx
;
55 spin_lock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
56 ctx
= (struct oz_serial_ctx
*)pd
->app_ctx
[OZ_APPID_SERIAL
-1];
58 atomic_inc(&ctx
->ref_count
);
59 spin_unlock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
62 /*------------------------------------------------------------------------------
63 * Context: softirq or process
65 static void oz_cdev_release_ctx(struct oz_serial_ctx
*ctx
)
67 if (atomic_dec_and_test(&ctx
->ref_count
)) {
68 oz_trace("Dealloc serial context.\n");
72 /*------------------------------------------------------------------------------
75 int oz_cdev_open(struct inode
*inode
, struct file
*filp
)
78 oz_trace("oz_cdev_open()\n");
79 oz_trace("major = %d minor = %d\n", imajor(inode
), iminor(inode
));
80 dev
= container_of(inode
->i_cdev
, struct oz_cdev
, cdev
);
81 filp
->private_data
= dev
;
84 /*------------------------------------------------------------------------------
87 int oz_cdev_release(struct inode
*inode
, struct file
*filp
)
89 oz_trace("oz_cdev_release()\n");
92 /*------------------------------------------------------------------------------
95 ssize_t
oz_cdev_read(struct file
*filp
, char __user
*buf
, size_t count
,
102 struct oz_serial_ctx
*ctx
= 0;
104 spin_lock_bh(&g_cdev
.lock
);
105 pd
= g_cdev
.active_pd
;
108 spin_unlock_bh(&g_cdev
.lock
);
111 ctx
= oz_cdev_claim_ctx(pd
);
114 n
= ctx
->rd_in
- ctx
->rd_out
;
120 n
= OZ_RD_BUF_SZ
- ix
;
123 if (copy_to_user(buf
, &ctx
->rd_buf
[ix
], n
)) {
128 if (ix
== OZ_RD_BUF_SZ
)
131 if (copy_to_user(&buf
[n
], ctx
->rd_buf
, count
-n
)) {
139 oz_cdev_release_ctx(ctx
);
144 /*------------------------------------------------------------------------------
147 ssize_t
oz_cdev_write(struct file
*filp
, const char __user
*buf
, size_t count
,
151 struct oz_elt_buf
*eb
;
152 struct oz_elt_info
*ei
= 0;
154 struct oz_app_hdr
*app_hdr
;
155 struct oz_serial_ctx
*ctx
;
157 spin_lock_bh(&g_cdev
.lock
);
158 pd
= g_cdev
.active_pd
;
161 spin_unlock_bh(&g_cdev
.lock
);
165 ei
= oz_elt_info_alloc(eb
);
170 elt
= (struct oz_elt
*)ei
->data
;
171 app_hdr
= (struct oz_app_hdr
*)(elt
+1);
172 elt
->length
= sizeof(struct oz_app_hdr
) + count
;
173 elt
->type
= OZ_ELT_APP_DATA
;
174 ei
->app_id
= OZ_APPID_SERIAL
;
175 ei
->length
= elt
->length
+ sizeof(struct oz_elt
);
176 app_hdr
->app_id
= OZ_APPID_SERIAL
;
177 if (copy_from_user(app_hdr
+1, buf
, count
))
179 spin_lock_bh(&pd
->app_lock
[OZ_APPID_USB
-1]);
180 ctx
= (struct oz_serial_ctx
*)pd
->app_ctx
[OZ_APPID_SERIAL
-1];
182 app_hdr
->elt_seq_num
= ctx
->tx_seq_num
++;
183 if (ctx
->tx_seq_num
== 0)
185 spin_lock(&eb
->lock
);
186 if (oz_queue_elt_info(eb
, 0, 0, ei
) == 0)
188 spin_unlock(&eb
->lock
);
190 spin_unlock_bh(&pd
->app_lock
[OZ_APPID_USB
-1]);
194 spin_lock_bh(&eb
->lock
);
195 oz_elt_info_free(eb
, ei
);
196 spin_unlock_bh(&eb
->lock
);
201 /*------------------------------------------------------------------------------
204 static int oz_set_active_pd(u8
*addr
)
208 struct oz_pd
*old_pd
;
209 pd
= oz_pd_find(addr
);
211 spin_lock_bh(&g_cdev
.lock
);
212 memcpy(g_cdev
.active_addr
, addr
, ETH_ALEN
);
213 old_pd
= g_cdev
.active_pd
;
214 g_cdev
.active_pd
= pd
;
215 spin_unlock_bh(&g_cdev
.lock
);
219 if (!memcmp(addr
, "\0\0\0\0\0\0", sizeof(addr
))) {
220 spin_lock_bh(&g_cdev
.lock
);
221 pd
= g_cdev
.active_pd
;
222 g_cdev
.active_pd
= 0;
223 memset(g_cdev
.active_addr
, 0,
224 sizeof(g_cdev
.active_addr
));
225 spin_unlock_bh(&g_cdev
.lock
);
234 /*------------------------------------------------------------------------------
237 long oz_cdev_ioctl(struct file
*filp
, unsigned int cmd
, unsigned long arg
)
240 if (_IOC_TYPE(cmd
) != OZ_IOCTL_MAGIC
)
242 if (_IOC_NR(cmd
) > OZ_IOCTL_MAX
)
244 if (_IOC_DIR(cmd
) & _IOC_READ
)
245 rc
= !access_ok(VERIFY_WRITE
, (void __user
*)arg
,
247 else if (_IOC_DIR(cmd
) & _IOC_WRITE
)
248 rc
= !access_ok(VERIFY_READ
, (void __user
*)arg
,
253 case OZ_IOCTL_GET_PD_LIST
: {
254 struct oz_pd_list list
;
255 oz_trace("OZ_IOCTL_GET_PD_LIST\n");
256 list
.count
= oz_get_pd_list(list
.addr
, OZ_MAX_PDS
);
257 if (copy_to_user((void __user
*)arg
, &list
,
262 case OZ_IOCTL_SET_ACTIVE_PD
: {
264 oz_trace("OZ_IOCTL_SET_ACTIVE_PD\n");
265 if (copy_from_user(addr
, (void __user
*)arg
, ETH_ALEN
))
267 rc
= oz_set_active_pd(addr
);
270 case OZ_IOCTL_GET_ACTIVE_PD
: {
272 oz_trace("OZ_IOCTL_GET_ACTIVE_PD\n");
273 spin_lock_bh(&g_cdev
.lock
);
274 memcpy(addr
, g_cdev
.active_addr
, ETH_ALEN
);
275 spin_unlock_bh(&g_cdev
.lock
);
276 if (copy_to_user((void __user
*)arg
, addr
, ETH_ALEN
))
280 #ifdef WANT_EVENT_TRACE
281 case OZ_IOCTL_CLEAR_EVENTS
:
284 case OZ_IOCTL_GET_EVENTS
:
285 rc
= oz_events_copy((void __user
*)arg
);
287 case OZ_IOCTL_SET_EVENT_MASK
:
288 if (copy_from_user(&g_evt_mask
, (void __user
*)arg
,
289 sizeof(unsigned long))) {
293 #endif /* WANT_EVENT_TRACE */
294 case OZ_IOCTL_ADD_BINDING
:
295 case OZ_IOCTL_REMOVE_BINDING
: {
296 struct oz_binding_info b
;
297 if (copy_from_user(&b
, (void __user
*)arg
,
298 sizeof(struct oz_binding_info
))) {
301 /* Make sure name is null terminated. */
302 b
.name
[OZ_MAX_BINDING_LEN
-1] = 0;
303 if (cmd
== OZ_IOCTL_ADD_BINDING
)
304 oz_binding_add(b
.name
);
306 oz_binding_remove(b
.name
);
312 /*------------------------------------------------------------------------------
315 unsigned int oz_cdev_poll(struct file
*filp
, poll_table
*wait
)
317 unsigned int ret
= 0;
318 struct oz_cdev
*dev
= filp
->private_data
;
319 oz_trace("Poll called wait = %p\n", wait
);
320 spin_lock_bh(&dev
->lock
);
321 if (dev
->active_pd
) {
322 struct oz_serial_ctx
*ctx
= oz_cdev_claim_ctx(dev
->active_pd
);
324 if (ctx
->rd_in
!= ctx
->rd_out
)
325 ret
|= POLLIN
| POLLRDNORM
;
326 oz_cdev_release_ctx(ctx
);
329 spin_unlock_bh(&dev
->lock
);
331 poll_wait(filp
, &dev
->rdq
, wait
);
334 /*------------------------------------------------------------------------------
336 const struct file_operations oz_fops
= {
337 .owner
= THIS_MODULE
,
338 .open
= oz_cdev_open
,
339 .release
= oz_cdev_release
,
340 .read
= oz_cdev_read
,
341 .write
= oz_cdev_write
,
342 .unlocked_ioctl
= oz_cdev_ioctl
,
345 /*------------------------------------------------------------------------------
348 int oz_cdev_register(void)
351 memset(&g_cdev
, 0, sizeof(g_cdev
));
352 err
= alloc_chrdev_region(&g_cdev
.devnum
, 0, 1, "ozwpan");
355 oz_trace("Alloc dev number %d:%d\n", MAJOR(g_cdev
.devnum
),
356 MINOR(g_cdev
.devnum
));
357 cdev_init(&g_cdev
.cdev
, &oz_fops
);
358 g_cdev
.cdev
.owner
= THIS_MODULE
;
359 g_cdev
.cdev
.ops
= &oz_fops
;
360 spin_lock_init(&g_cdev
.lock
);
361 init_waitqueue_head(&g_cdev
.rdq
);
362 err
= cdev_add(&g_cdev
.cdev
, g_cdev
.devnum
, 1);
365 /*------------------------------------------------------------------------------
368 int oz_cdev_deregister(void)
370 cdev_del(&g_cdev
.cdev
);
371 unregister_chrdev_region(g_cdev
.devnum
, 1);
374 /*------------------------------------------------------------------------------
377 int oz_cdev_init(void)
379 oz_event_log(OZ_EVT_SERVICE
, 1, OZ_APPID_SERIAL
, 0, 0);
380 oz_app_enable(OZ_APPID_SERIAL
, 1);
383 /*------------------------------------------------------------------------------
386 void oz_cdev_term(void)
388 oz_event_log(OZ_EVT_SERVICE
, 2, OZ_APPID_SERIAL
, 0, 0);
389 oz_app_enable(OZ_APPID_SERIAL
, 0);
391 /*------------------------------------------------------------------------------
392 * Context: softirq-serialized
394 int oz_cdev_start(struct oz_pd
*pd
, int resume
)
396 struct oz_serial_ctx
*ctx
;
397 struct oz_serial_ctx
*old_ctx
= 0;
398 oz_event_log(OZ_EVT_SERVICE
, 3, OZ_APPID_SERIAL
, 0, resume
);
400 oz_trace("Serial service resumed.\n");
403 ctx
= (struct oz_serial_ctx
*)
404 oz_alloc(sizeof(struct oz_serial_ctx
), GFP_ATOMIC
);
407 memset(ctx
, 0, sizeof(struct oz_serial_ctx
));
408 atomic_set(&ctx
->ref_count
, 1);
410 spin_lock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
411 old_ctx
= pd
->app_ctx
[OZ_APPID_SERIAL
-1];
413 spin_unlock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
416 pd
->app_ctx
[OZ_APPID_SERIAL
-1] = ctx
;
417 spin_unlock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
419 spin_lock(&g_cdev
.lock
);
420 if ((g_cdev
.active_pd
== 0) &&
421 (memcmp(pd
->mac_addr
, g_cdev
.active_addr
, ETH_ALEN
) == 0)) {
423 g_cdev
.active_pd
= pd
;
424 oz_trace("Active PD arrived.\n");
426 spin_unlock(&g_cdev
.lock
);
427 oz_trace("Serial service started.\n");
430 /*------------------------------------------------------------------------------
431 * Context: softirq or process
433 void oz_cdev_stop(struct oz_pd
*pd
, int pause
)
435 struct oz_serial_ctx
*ctx
;
436 oz_event_log(OZ_EVT_SERVICE
, 4, OZ_APPID_SERIAL
, 0, pause
);
438 oz_trace("Serial service paused.\n");
441 spin_lock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
442 ctx
= (struct oz_serial_ctx
*)pd
->app_ctx
[OZ_APPID_SERIAL
-1];
443 pd
->app_ctx
[OZ_APPID_SERIAL
-1] = 0;
444 spin_unlock_bh(&pd
->app_lock
[OZ_APPID_SERIAL
-1]);
446 oz_cdev_release_ctx(ctx
);
447 spin_lock(&g_cdev
.lock
);
448 if (pd
== g_cdev
.active_pd
)
449 g_cdev
.active_pd
= 0;
452 spin_unlock(&g_cdev
.lock
);
455 oz_trace("Active PD departed.\n");
457 oz_trace("Serial service stopped.\n");
459 /*------------------------------------------------------------------------------
460 * Context: softirq-serialized
462 void oz_cdev_rx(struct oz_pd
*pd
, struct oz_elt
*elt
)
464 struct oz_serial_ctx
*ctx
;
465 struct oz_app_hdr
*app_hdr
;
472 ctx
= oz_cdev_claim_ctx(pd
);
474 oz_trace("Cannot claim serial context.\n");
478 app_hdr
= (struct oz_app_hdr
*)(elt
+1);
479 /* If sequence number is non-zero then check it is not a duplicate.
481 if (app_hdr
->elt_seq_num
!= 0) {
482 if (((ctx
->rx_seq_num
- app_hdr
->elt_seq_num
) & 0x80) == 0) {
483 /* Reject duplicate element. */
484 oz_trace("Duplicate element:%02x %02x\n",
485 app_hdr
->elt_seq_num
, ctx
->rx_seq_num
);
489 ctx
->rx_seq_num
= app_hdr
->elt_seq_num
;
490 len
= elt
->length
- sizeof(struct oz_app_hdr
);
491 data
= ((u8
*)(elt
+1)) + sizeof(struct oz_app_hdr
);
494 space
= ctx
->rd_out
- ctx
->rd_in
- 1;
496 space
+= OZ_RD_BUF_SZ
;
498 oz_trace("Not enough space:%d %d\n", len
, space
);
502 copy_sz
= OZ_RD_BUF_SZ
- ix
;
505 memcpy(&ctx
->rd_buf
[ix
], data
, copy_sz
);
508 if (ix
== OZ_RD_BUF_SZ
)
511 memcpy(ctx
->rd_buf
, data
+copy_sz
, len
);
515 wake_up(&g_cdev
.rdq
);
517 oz_cdev_release_ctx(ctx
);
519 /*------------------------------------------------------------------------------
522 void oz_cdev_heartbeat(struct oz_pd
*pd
)