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; | |
f2527ec4 ACM |
19 | int res; |
20 | ||
c72dfae2 | 21 | memset(l, 0, sizeof(*l)); |
f2527ec4 ACM |
22 | /* In caif protocol low value is high priority */ |
23 | l->priority = CAIF_PRIO_MAX - s->priority + 1; | |
c72dfae2 | 24 | |
f2527ec4 ACM |
25 | if (s->ifindex != 0){ |
26 | res = cfcnfg_get_id_from_ifi(cnfg, s->ifindex); | |
27 | if (res < 0) | |
28 | return res; | |
29 | l->phyid = res; | |
30 | } | |
c72dfae2 SB |
31 | else { |
32 | switch (s->link_selector) { | |
33 | case CAIF_LINK_HIGH_BANDW: | |
34 | pref = CFPHYPREF_HIGH_BW; | |
35 | break; | |
36 | case CAIF_LINK_LOW_LATENCY: | |
37 | pref = CFPHYPREF_LOW_LAT; | |
38 | break; | |
39 | default: | |
40 | return -EINVAL; | |
41 | } | |
42 | dev_info = cfcnfg_get_phyid(cnfg, pref); | |
43 | if (dev_info == NULL) | |
44 | return -ENODEV; | |
45 | l->phyid = dev_info->id; | |
46 | } | |
47 | switch (s->protocol) { | |
48 | case CAIFPROTO_AT: | |
49 | l->linktype = CFCTRL_SRV_VEI; | |
50 | if (s->sockaddr.u.at.type == CAIF_ATTYPE_PLAIN) | |
51 | l->chtype = 0x02; | |
52 | else | |
53 | l->chtype = s->sockaddr.u.at.type; | |
54 | l->endpoint = 0x00; | |
55 | break; | |
56 | case CAIFPROTO_DATAGRAM: | |
57 | l->linktype = CFCTRL_SRV_DATAGRAM; | |
58 | l->chtype = 0x00; | |
59 | l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; | |
60 | break; | |
61 | case CAIFPROTO_DATAGRAM_LOOP: | |
62 | l->linktype = CFCTRL_SRV_DATAGRAM; | |
63 | l->chtype = 0x03; | |
64 | l->endpoint = 0x00; | |
65 | l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; | |
66 | break; | |
67 | case CAIFPROTO_RFM: | |
68 | l->linktype = CFCTRL_SRV_RFM; | |
69 | l->u.datagram.connid = s->sockaddr.u.rfm.connection_id; | |
70 | strncpy(l->u.rfm.volume, s->sockaddr.u.rfm.volume, | |
71 | sizeof(l->u.rfm.volume)-1); | |
72 | l->u.rfm.volume[sizeof(l->u.rfm.volume)-1] = 0; | |
73 | break; | |
74 | case CAIFPROTO_UTIL: | |
75 | l->linktype = CFCTRL_SRV_UTIL; | |
76 | l->endpoint = 0x00; | |
77 | l->chtype = 0x00; | |
78 | strncpy(l->u.utility.name, s->sockaddr.u.util.service, | |
79 | sizeof(l->u.utility.name)-1); | |
80 | l->u.utility.name[sizeof(l->u.utility.name)-1] = 0; | |
81 | caif_assert(sizeof(l->u.utility.name) > 10); | |
82 | l->u.utility.paramlen = s->param.size; | |
83 | if (l->u.utility.paramlen > sizeof(l->u.utility.params)) | |
84 | l->u.utility.paramlen = sizeof(l->u.utility.params); | |
85 | ||
86 | memcpy(l->u.utility.params, s->param.data, | |
87 | l->u.utility.paramlen); | |
88 | ||
69ad7820 SB |
89 | break; |
90 | case CAIFPROTO_DEBUG: | |
91 | l->linktype = CFCTRL_SRV_DBG; | |
92 | l->endpoint = s->sockaddr.u.dbg.service; | |
93 | l->chtype = s->sockaddr.u.dbg.type; | |
c72dfae2 SB |
94 | break; |
95 | default: | |
96 | return -EINVAL; | |
97 | } | |
98 | return 0; | |
99 | } |