Blame view
net/caif/cfvidl.c
1.72 KB
b482cd205
|
1 2 |
/* * Copyright (C) ST-Ericsson AB 2010 |
26ee65e68
|
3 |
* Author: Sjur Brendeland |
b482cd205
|
4 5 |
* License terms: GNU General Public License (GPL) version 2 */ |
b31fa5bad
|
6 |
#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__ |
b482cd205
|
7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 |
#include <linux/kernel.h> #include <linux/types.h> #include <linux/slab.h> #include <linux/errno.h> #include <net/caif/caif_layer.h> #include <net/caif/cfsrvl.h> #include <net/caif/cfpkt.h> #define container_obj(layr) ((struct cfsrvl *) layr) static int cfvidl_receive(struct cflayer *layr, struct cfpkt *pkt); static int cfvidl_transmit(struct cflayer *layr, struct cfpkt *pkt); struct cflayer *cfvidl_create(u8 channel_id, struct dev_info *dev_info) { |
7ac2ed0ce
|
22 23 |
struct cfsrvl *vid = kzalloc(sizeof(struct cfsrvl), GFP_ATOMIC); if (!vid) |
b482cd205
|
24 |
return NULL; |
b482cd205
|
25 |
caif_assert(offsetof(struct cfsrvl, layer) == 0); |
b1c74247b
|
26 |
cfsrvl_init(vid, channel_id, dev_info, false); |
b482cd205
|
27 28 29 30 31 32 33 34 35 36 |
vid->layer.receive = cfvidl_receive; vid->layer.transmit = cfvidl_transmit; snprintf(vid->layer.name, CAIF_LAYER_NAME_SZ - 1, "vid1"); return &vid->layer; } static int cfvidl_receive(struct cflayer *layr, struct cfpkt *pkt) { u32 videoheader; if (cfpkt_extr_head(pkt, &videoheader, 4) < 0) { |
b31fa5bad
|
37 38 |
pr_err("Packet is erroneous! "); |
b482cd205
|
39 40 41 42 43 44 45 46 47 48 49 50 |
cfpkt_destroy(pkt); return -EPROTO; } return layr->up->receive(layr->up, pkt); } static int cfvidl_transmit(struct cflayer *layr, struct cfpkt *pkt) { struct cfsrvl *service = container_obj(layr); struct caif_payload_info *info; u32 videoheader = 0; int ret; |
374458b3f
|
51 52 53 |
if (!cfsrvl_ready(service, &ret)) { cfpkt_destroy(pkt); |
b482cd205
|
54 |
return ret; |
374458b3f
|
55 |
} |
b482cd205
|
56 57 58 59 60 |
cfpkt_add_head(pkt, &videoheader, 4); /* Add info for MUX-layer to route the packet out */ info = cfpkt_info(pkt); info->channel_id = service->layer.id; info->dev_info = &service->dev_info; |
4dd820c08
|
61 |
return layr->dn->transmit(layr->dn, pkt); |
b482cd205
|
62 |
} |