Commit | Line | Data |
---|---|---|
6e2128d4 | 1 | /* |
2 | * MAC commands interface | |
3 | * | |
4 | * Copyright 2007-2012 Siemens AG | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License version 2 | |
8 | * as published by the Free Software Foundation. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, | |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
13 | * GNU General Public License for more details. | |
14 | * | |
6e2128d4 | 15 | * Written by: |
16 | * Sergey Lapin <slapin@ossfans.org> | |
17 | * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> | |
18 | * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> | |
19 | */ | |
20 | ||
21 | #include <linux/skbuff.h> | |
22 | #include <linux/if_arp.h> | |
4ca24aca | 23 | #include <linux/ieee802154.h> |
6e2128d4 | 24 | |
25 | #include <net/ieee802154_netdev.h> | |
5ad60d36 | 26 | #include <net/cfg802154.h> |
6e2128d4 | 27 | #include <net/mac802154.h> |
28 | ||
0f1556bc | 29 | #include "ieee802154_i.h" |
f59f419d | 30 | #include "driver-ops.h" |
6e2128d4 | 31 | |
5265f467 | 32 | static int mac802154_mlme_start_req(struct net_device *dev, |
ae531b94 | 33 | struct ieee802154_addr *addr, |
5265f467 | 34 | u8 channel, u8 page, |
35 | u8 bcn_ord, u8 sf_ord, | |
36 | u8 pan_coord, u8 blx, | |
37 | u8 coord_realign) | |
38 | { | |
9b0bb4a8 PB |
39 | struct ieee802154_mlme_ops *ops = ieee802154_mlme_ops(dev); |
40 | int rc = 0; | |
41 | ||
ae531b94 | 42 | BUG_ON(addr->mode != IEEE802154_ADDR_SHORT); |
5265f467 | 43 | |
ae531b94 PB |
44 | mac802154_dev_set_pan_id(dev, addr->pan_id); |
45 | mac802154_dev_set_short_addr(dev, addr->short_addr); | |
5265f467 | 46 | mac802154_dev_set_page_channel(dev, page, channel); |
47 | ||
9b0bb4a8 PB |
48 | if (ops->llsec) { |
49 | struct ieee802154_llsec_params params; | |
50 | int changed = 0; | |
51 | ||
52 | params.coord_shortaddr = addr->short_addr; | |
53 | changed |= IEEE802154_LLSEC_PARAM_COORD_SHORTADDR; | |
54 | ||
55 | params.pan_id = addr->pan_id; | |
56 | changed |= IEEE802154_LLSEC_PARAM_PAN_ID; | |
57 | ||
58 | params.hwaddr = ieee802154_devaddr_from_raw(dev->dev_addr); | |
59 | changed |= IEEE802154_LLSEC_PARAM_HWADDR; | |
60 | ||
61 | params.coord_hwaddr = params.hwaddr; | |
62 | changed |= IEEE802154_LLSEC_PARAM_COORD_HWADDR; | |
63 | ||
64 | rc = ops->llsec->set_params(dev, ¶ms, changed); | |
65 | } | |
66 | ||
9b0bb4a8 | 67 | return rc; |
5265f467 | 68 | } |
69 | ||
c7420c36 AA |
70 | static int mac802154_set_mac_params(struct net_device *dev, |
71 | const struct ieee802154_mac_params *params) | |
72 | { | |
73 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); | |
f59f419d | 74 | struct ieee802154_local *local = sdata->local; |
5fb3f026 | 75 | struct wpan_dev *wpan_dev = &sdata->wpan_dev; |
f59f419d | 76 | int ret; |
c7420c36 AA |
77 | |
78 | mutex_lock(&sdata->local->iflist_mtx); | |
5fb3f026 AA |
79 | /* PHY */ |
80 | wpan_dev->wpan_phy->transmit_power = params->transmit_power; | |
81 | wpan_dev->wpan_phy->cca_mode = params->cca_mode; | |
82 | wpan_dev->wpan_phy->cca_ed_level = params->cca_ed_level; | |
83 | ||
84 | /* MAC */ | |
85 | wpan_dev->min_be = params->min_be; | |
86 | wpan_dev->max_be = params->max_be; | |
87 | wpan_dev->csma_retries = params->csma_retries; | |
88 | wpan_dev->frame_retries = params->frame_retries; | |
89 | wpan_dev->lbt = params->lbt; | |
c7420c36 AA |
90 | mutex_unlock(&sdata->local->iflist_mtx); |
91 | ||
f59f419d AA |
92 | if (local->hw.flags & IEEE802154_HW_TXPOWER) { |
93 | ret = drv_set_tx_power(local, params->transmit_power); | |
94 | if (ret < 0) | |
95 | return ret; | |
96 | } | |
97 | ||
98 | if (local->hw.flags & IEEE802154_HW_CCA_MODE) { | |
99 | ret = drv_set_cca_mode(local, params->cca_mode); | |
100 | if (ret < 0) | |
101 | return ret; | |
102 | } | |
103 | ||
104 | if (local->hw.flags & IEEE802154_HW_CCA_ED_LEVEL) { | |
105 | ret = drv_set_cca_ed_level(local, params->cca_ed_level); | |
106 | if (ret < 0) | |
107 | return ret; | |
108 | } | |
109 | ||
c7420c36 AA |
110 | return 0; |
111 | } | |
112 | ||
113 | static void mac802154_get_mac_params(struct net_device *dev, | |
114 | struct ieee802154_mac_params *params) | |
115 | { | |
116 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); | |
5fb3f026 | 117 | struct wpan_dev *wpan_dev = &sdata->wpan_dev; |
c7420c36 AA |
118 | |
119 | mutex_lock(&sdata->local->iflist_mtx); | |
5fb3f026 AA |
120 | /* PHY */ |
121 | params->transmit_power = wpan_dev->wpan_phy->transmit_power; | |
122 | params->cca_mode = wpan_dev->wpan_phy->cca_mode; | |
123 | params->cca_ed_level = wpan_dev->wpan_phy->cca_ed_level; | |
124 | ||
125 | /* MAC */ | |
126 | params->min_be = wpan_dev->min_be; | |
127 | params->max_be = wpan_dev->max_be; | |
128 | params->csma_retries = wpan_dev->csma_retries; | |
129 | params->frame_retries = wpan_dev->frame_retries; | |
130 | params->lbt = wpan_dev->lbt; | |
c7420c36 AA |
131 | mutex_unlock(&sdata->local->iflist_mtx); |
132 | } | |
133 | ||
29e02374 PB |
134 | static struct ieee802154_llsec_ops mac802154_llsec_ops = { |
135 | .get_params = mac802154_get_params, | |
136 | .set_params = mac802154_set_params, | |
137 | .add_key = mac802154_add_key, | |
138 | .del_key = mac802154_del_key, | |
139 | .add_dev = mac802154_add_dev, | |
140 | .del_dev = mac802154_del_dev, | |
141 | .add_devkey = mac802154_add_devkey, | |
142 | .del_devkey = mac802154_del_devkey, | |
143 | .add_seclevel = mac802154_add_seclevel, | |
144 | .del_seclevel = mac802154_del_seclevel, | |
145 | .lock_table = mac802154_lock_table, | |
146 | .get_table = mac802154_get_table, | |
147 | .unlock_table = mac802154_unlock_table, | |
148 | }; | |
149 | ||
32bad7e3 | 150 | struct ieee802154_mlme_ops mac802154_mlme_wpan = { |
5265f467 | 151 | .start_req = mac802154_mlme_start_req, |
e885a47a | 152 | .get_pan_id = mac802154_dev_get_pan_id, |
153 | .get_short_addr = mac802154_dev_get_short_addr, | |
0483546a | 154 | .get_dsn = mac802154_dev_get_dsn, |
e462ded6 | 155 | |
29e02374 PB |
156 | .llsec = &mac802154_llsec_ops, |
157 | ||
e462ded6 PB |
158 | .set_mac_params = mac802154_set_mac_params, |
159 | .get_mac_params = mac802154_get_mac_params, | |
32bad7e3 | 160 | }; |