Blame view
net/caif/cfvidl.c
1.72 KB
b482cd205 net-caif: add CAI... |
1 2 |
/* * Copyright (C) ST-Ericsson AB 2010 |
26ee65e68 caif: Remove my b... |
3 |
* Author: Sjur Brendeland |
b482cd205 net-caif: add CAI... |
4 5 |
* License terms: GNU General Public License (GPL) version 2 */ |
b31fa5bad net/caif: Use pr_fmt |
6 |
#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__ |
b482cd205 net-caif: add CAI... |
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 caif: Remove OOM ... |
22 23 |
struct cfsrvl *vid = kzalloc(sizeof(struct cfsrvl), GFP_ATOMIC); if (!vid) |
b482cd205 net-caif: add CAI... |
24 |
return NULL; |
b482cd205 net-caif: add CAI... |
25 |
caif_assert(offsetof(struct cfsrvl, layer) == 0); |
b1c74247b caif: Bugfix not ... |
26 |
cfsrvl_init(vid, channel_id, dev_info, false); |
b482cd205 net-caif: add CAI... |
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 net/caif: Use pr_fmt |
37 38 |
pr_err("Packet is erroneous! "); |
b482cd205 net-caif: add CAI... |
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 caif: Fix for a r... |
51 52 53 |
if (!cfsrvl_ready(service, &ret)) { cfpkt_destroy(pkt); |
b482cd205 net-caif: add CAI... |
54 |
return ret; |
374458b3f caif: Fix for a r... |
55 |
} |
b482cd205 net-caif: add CAI... |
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 caif: Don't resen... |
61 |
return layr->dn->transmit(layr->dn, pkt); |
b482cd205 net-caif: add CAI... |
62 |
} |