]>
Commit | Line | Data |
---|---|---|
c72dfae2 SB |
1 | /* |
2 | * Copyright (C) ST-Ericsson AB 2010 | |
3 | * Author: Sjur Brendeland sjur.brandeland@stericsson.com | |
4 | * License terms: GNU General Public License (GPL) version 2 | |
5 | */ | |
6 | ||
7 | #include <linux/module.h> | |
8 | #include <linux/spinlock.h> | |
9 | #include <net/caif/cfctrl.h> | |
10 | #include <net/caif/cfcnfg.h> | |
11 | #include <net/caif/caif_dev.h> | |
12 | ||
13 | int connect_req_to_link_param(struct cfcnfg *cnfg, | |
14 | struct caif_connect_request *s, | |
15 | struct cfctrl_link_param *l) | |
16 | { | |
17 | struct dev_info *dev_info; | |
18 | enum cfcnfg_phy_preference pref; | |
19 | memset(l, 0, sizeof(*l)); | |
20 | l->priority = s->priority; | |
21 | ||
22 | if (s->link_name[0] != '\0') | |
23 | l->phyid = cfcnfg_get_named(cnfg, s->link_name); | |
24 | else { | |
25 | switch (s->link_selector) { | |
26 | case CAIF_LINK_HIGH_BANDW: | |
27 | pref = CFPHYPREF_HIGH_BW; | |
28 | break; | |
29 | case CAIF_LINK_LOW_LATENCY: | |
30 | pref = CFPHYPREF_LOW_LAT; | |
31 | break; | |
32 | default: | |
33 | return -EINVAL; | |
34 | } | |
35 | dev_info = cfcnfg_get_phyid(cnfg, pref); | |
36 | if (dev_info == NULL) | |
37 | return -ENODEV; | |
38 | l->phyid = dev_info->id; | |
39 | } | |
40 | switch (s->protocol) { | |
41 | case CAIFPROTO_AT: | |
42 | l->linktype = CFCTRL_SRV_VEI; | |
43 | if (s->sockaddr.u.at.type == CAIF_ATTYPE_PLAIN) | |
44 | l->chtype = 0x02; | |
45 | else | |
46 | l->chtype = s->sockaddr.u.at.type; | |
47 | l->endpoint = 0x00; | |
48 | break; | |
49 | case CAIFPROTO_DATAGRAM: | |
50 | l->linktype = CFCTRL_SRV_DATAGRAM; | |
51 | l->chtype = 0x00; | |
52 | l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; | |
53 | break; | |
54 | case CAIFPROTO_DATAGRAM_LOOP: | |
55 | l->linktype = CFCTRL_SRV_DATAGRAM; | |
56 | l->chtype = 0x03; | |
57 | l->endpoint = 0x00; | |
58 | l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; | |
59 | break; | |
60 | case CAIFPROTO_RFM: | |
61 | l->linktype = CFCTRL_SRV_RFM; | |
62 | l->u.datagram.connid = s->sockaddr.u.rfm.connection_id; | |
63 | strncpy(l->u.rfm.volume, s->sockaddr.u.rfm.volume, | |
64 | sizeof(l->u.rfm.volume)-1); | |
65 | l->u.rfm.volume[sizeof(l->u.rfm.volume)-1] = 0; | |
66 | break; | |
67 | case CAIFPROTO_UTIL: | |
68 | l->linktype = CFCTRL_SRV_UTIL; | |
69 | l->endpoint = 0x00; | |
70 | l->chtype = 0x00; | |
71 | strncpy(l->u.utility.name, s->sockaddr.u.util.service, | |
72 | sizeof(l->u.utility.name)-1); | |
73 | l->u.utility.name[sizeof(l->u.utility.name)-1] = 0; | |
74 | caif_assert(sizeof(l->u.utility.name) > 10); | |
75 | l->u.utility.paramlen = s->param.size; | |
76 | if (l->u.utility.paramlen > sizeof(l->u.utility.params)) | |
77 | l->u.utility.paramlen = sizeof(l->u.utility.params); | |
78 | ||
79 | memcpy(l->u.utility.params, s->param.data, | |
80 | l->u.utility.paramlen); | |
81 | ||
69ad7820 SB |
82 | break; |
83 | case CAIFPROTO_DEBUG: | |
84 | l->linktype = CFCTRL_SRV_DBG; | |
85 | l->endpoint = s->sockaddr.u.dbg.service; | |
86 | l->chtype = s->sockaddr.u.dbg.type; | |
c72dfae2 SB |
87 | break; |
88 | default: | |
89 | return -EINVAL; | |
90 | } | |
91 | return 0; | |
92 | } |