Lines Matching +full:drv +full:- +full:0
2 * WPA Supplicant - roboswitch driver interface
3 * Copyright (c) 2008-2012 Jouke Witteveen
20 #define ROBO_PHY_ADDR 0x1e /* RoboSwitch PHY address */
23 #define ROBO_MII_PAGE 0x10 /* MII page register */
24 #define ROBO_MII_ADDR 0x11 /* MII address register */
25 #define ROBO_MII_DATA_OFFSET 0x18 /* Start of MII data registers */
27 #define ROBO_MII_PAGE_ENABLE 0x01 /* MII page op code */
28 #define ROBO_MII_ADDR_WRITE 0x01 /* MII address write op code */
29 #define ROBO_MII_ADDR_READ 0x02 /* MII address read op code */
34 #define ROBO_ARLCTRL_PAGE 0x04 /* ARL control page */
35 #define ROBO_VLAN_PAGE 0x34 /* VLAN page */
38 #define ROBO_ARLCTRL_CONF 0x00 /* ARL configuration register */
39 #define ROBO_ARLCTRL_ADDR_1 0x10 /* Multiport address 1 */
40 #define ROBO_ARLCTRL_VEC_1 0x16 /* Multiport vector 1 */
41 #define ROBO_ARLCTRL_ADDR_2 0x20 /* Multiport address 2 */
42 #define ROBO_ARLCTRL_VEC_2 0x26 /* Multiport vector 2 */
45 #define ROBO_VLAN_ACCESS 0x08 /* VLAN table access register */
46 #define ROBO_VLAN_ACCESS_5350 0x06 /* VLAN table access register (5350) */
47 #define ROBO_VLAN_READ 0x0c /* VLAN read register */
48 #define ROBO_VLAN_MAX 0xff /* Maximum number of VLANs */
52 { 0x01, 0x80, 0xc2, 0x00, 0x00, 0x03 };
66 /* Copied from the kernel-only part of mii.h. */
69 return (struct mii_ioctl_data *) &rq->ifr_ifru; in if_mii()
74 * RoboSwitch uses 16-bit Big Endian addresses.
80 for (i = 0; i < ETH_ALEN; i += 2) in wpa_driver_roboswitch_addr_be16()
81 be[(ETH_ALEN - i) / 2 - 1] = WPA_GET_BE16(addr + i); in wpa_driver_roboswitch_addr_be16()
86 struct wpa_driver_roboswitch_data *drv, u8 reg) in wpa_driver_roboswitch_mdio_read() argument
88 struct mii_ioctl_data *mii = if_mii(&drv->ifr); in wpa_driver_roboswitch_mdio_read()
90 mii->phy_id = ROBO_PHY_ADDR; in wpa_driver_roboswitch_mdio_read()
91 mii->reg_num = reg; in wpa_driver_roboswitch_mdio_read()
93 if (ioctl(drv->fd, SIOCGMIIREG, &drv->ifr) < 0) { in wpa_driver_roboswitch_mdio_read()
96 return 0x00; in wpa_driver_roboswitch_mdio_read()
98 return mii->val_out; in wpa_driver_roboswitch_mdio_read()
103 struct wpa_driver_roboswitch_data *drv, u8 reg, u16 val) in wpa_driver_roboswitch_mdio_write() argument
105 struct mii_ioctl_data *mii = if_mii(&drv->ifr); in wpa_driver_roboswitch_mdio_write()
107 mii->phy_id = ROBO_PHY_ADDR; in wpa_driver_roboswitch_mdio_write()
108 mii->reg_num = reg; in wpa_driver_roboswitch_mdio_write()
109 mii->val_in = val; in wpa_driver_roboswitch_mdio_write()
111 if (ioctl(drv->fd, SIOCSMIIREG, &drv->ifr) < 0) { in wpa_driver_roboswitch_mdio_write()
118 static int wpa_driver_roboswitch_reg(struct wpa_driver_roboswitch_data *drv, in wpa_driver_roboswitch_reg() argument
124 wpa_driver_roboswitch_mdio_write(drv, ROBO_MII_PAGE, in wpa_driver_roboswitch_reg()
127 wpa_driver_roboswitch_mdio_write(drv, ROBO_MII_ADDR, (reg << 8) | op); in wpa_driver_roboswitch_reg()
130 for (i = 0; i < ROBO_MII_RETRY_MAX; ++i) { in wpa_driver_roboswitch_reg()
131 if ((wpa_driver_roboswitch_mdio_read(drv, ROBO_MII_ADDR) & 3) in wpa_driver_roboswitch_reg()
132 == 0) in wpa_driver_roboswitch_reg()
133 return 0; in wpa_driver_roboswitch_reg()
136 return -1; in wpa_driver_roboswitch_reg()
140 static int wpa_driver_roboswitch_read(struct wpa_driver_roboswitch_data *drv, in wpa_driver_roboswitch_read() argument
146 wpa_driver_roboswitch_reg(drv, page, reg, ROBO_MII_ADDR_READ) < 0) in wpa_driver_roboswitch_read()
147 return -1; in wpa_driver_roboswitch_read()
149 for (i = 0; i < len; ++i) { in wpa_driver_roboswitch_read()
151 drv, ROBO_MII_DATA_OFFSET + i); in wpa_driver_roboswitch_read()
154 return 0; in wpa_driver_roboswitch_read()
158 static int wpa_driver_roboswitch_write(struct wpa_driver_roboswitch_data *drv, in wpa_driver_roboswitch_write() argument
163 if (len > ROBO_MII_DATA_MAX) return -1; in wpa_driver_roboswitch_write()
164 for (i = 0; i < len; ++i) { in wpa_driver_roboswitch_write()
165 wpa_driver_roboswitch_mdio_write(drv, ROBO_MII_DATA_OFFSET + i, in wpa_driver_roboswitch_write()
168 return wpa_driver_roboswitch_reg(drv, page, reg, ROBO_MII_ADDR_WRITE); in wpa_driver_roboswitch_write()
175 struct wpa_driver_roboswitch_data *drv = priv; in wpa_driver_roboswitch_receive() local
178 ether_addr_equal(buf, drv->own_addr)) in wpa_driver_roboswitch_receive()
179 drv_event_eapol_rx(drv->ctx, src_addr, buf + 14, len - 14); in wpa_driver_roboswitch_receive()
185 ssid[0] = 0; in wpa_driver_roboswitch_get_ssid()
186 return 0; in wpa_driver_roboswitch_get_ssid()
194 return 0; in wpa_driver_roboswitch_get_bssid()
201 os_memset(capa, 0, sizeof(*capa)); in wpa_driver_roboswitch_get_capa()
202 capa->flags = WPA_DRIVER_FLAGS_WIRED; in wpa_driver_roboswitch_get_capa()
203 return 0; in wpa_driver_roboswitch_get_capa()
209 struct wpa_driver_roboswitch_data *drv = priv; in wpa_driver_roboswitch_set_param() local
213 sep = drv->ifname + os_strlen(drv->ifname); in wpa_driver_roboswitch_set_param()
215 drv->l2 = l2_packet_init(drv->ifname, NULL, ETH_P_ALL, in wpa_driver_roboswitch_set_param()
216 wpa_driver_roboswitch_receive, drv, in wpa_driver_roboswitch_set_param()
218 if (drv->l2 == NULL) { in wpa_driver_roboswitch_set_param()
220 __func__, drv->ifname); in wpa_driver_roboswitch_set_param()
221 return -1; in wpa_driver_roboswitch_set_param()
223 *sep = '\0'; in wpa_driver_roboswitch_set_param()
224 l2_packet_get_own_addr(drv->l2, drv->own_addr); in wpa_driver_roboswitch_set_param()
227 drv->l2 = NULL; in wpa_driver_roboswitch_set_param()
229 return 0; in wpa_driver_roboswitch_set_param()
235 struct wpa_driver_roboswitch_data *drv = priv; in wpa_driver_roboswitch_get_ifname() local
236 return drv->ifname; in wpa_driver_roboswitch_get_ifname()
240 static int wpa_driver_roboswitch_join(struct wpa_driver_roboswitch_data *drv, in wpa_driver_roboswitch_join() argument
247 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
248 ROBO_ARLCTRL_CONF, read1, 1) < 0) in wpa_driver_roboswitch_join()
249 return -1; in wpa_driver_roboswitch_join()
250 if (!(read1[0] & (1 << 4))) { in wpa_driver_roboswitch_join()
252 read1[0] |= 1 << 4; in wpa_driver_roboswitch_join()
253 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
255 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
257 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
259 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
261 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
265 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
267 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
269 os_memcmp(read1, read2, 6) != 0) in wpa_driver_roboswitch_join()
270 return -1; in wpa_driver_roboswitch_join()
271 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
273 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
275 read1[0] != read2[0]) in wpa_driver_roboswitch_join()
276 return -1; in wpa_driver_roboswitch_join()
277 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
279 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_join()
282 return 0; in wpa_driver_roboswitch_join()
286 static int wpa_driver_roboswitch_leave(struct wpa_driver_roboswitch_data *drv, in wpa_driver_roboswitch_leave() argument
293 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
294 ROBO_ARLCTRL_CONF, &_read, 1) < 0) in wpa_driver_roboswitch_leave()
295 return -1; in wpa_driver_roboswitch_leave()
297 if (!(_read & (1 << 4))) return -1; in wpa_driver_roboswitch_leave()
299 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
300 ROBO_ARLCTRL_ADDR_1, addr_read, 3) < 0 || in wpa_driver_roboswitch_leave()
301 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
302 ROBO_ARLCTRL_VEC_1, &ports_read, 1) < 0) in wpa_driver_roboswitch_leave()
303 return -1; in wpa_driver_roboswitch_leave()
305 if (os_memcmp(addr_read, addr_be16, 6) == 0 && ports_read == ports) { in wpa_driver_roboswitch_leave()
306 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
308 3) < 0 || in wpa_driver_roboswitch_leave()
309 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
311 1) < 0) in wpa_driver_roboswitch_leave()
312 return -1; in wpa_driver_roboswitch_leave()
314 if (os_memcmp(addr_read, addr_be16, 6) == 0 && in wpa_driver_roboswitch_leave()
317 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
321 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
324 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
327 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
330 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
335 if (wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
337 3) < 0 || in wpa_driver_roboswitch_leave()
338 wpa_driver_roboswitch_read(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
340 1) < 0) in wpa_driver_roboswitch_leave()
341 return -1; in wpa_driver_roboswitch_leave()
343 if (os_memcmp(addr_read, addr_be16, 6) == 0 && in wpa_driver_roboswitch_leave()
345 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
348 wpa_driver_roboswitch_write(drv, ROBO_ARLCTRL_PAGE, in wpa_driver_roboswitch_leave()
351 } else return -1; in wpa_driver_roboswitch_leave()
353 return 0; in wpa_driver_roboswitch_leave()
359 struct wpa_driver_roboswitch_data *drv; in wpa_driver_roboswitch_init() local
361 u16 vlan = 0, _read[2]; in wpa_driver_roboswitch_init()
363 drv = os_zalloc(sizeof(*drv)); in wpa_driver_roboswitch_init()
364 if (drv == NULL) return NULL; in wpa_driver_roboswitch_init()
365 drv->ctx = ctx; in wpa_driver_roboswitch_init()
366 drv->own_addr[0] = '\0'; in wpa_driver_roboswitch_init()
369 sep = drv->ifname + in wpa_driver_roboswitch_init()
370 os_strlcpy(drv->ifname, ifname, sizeof(drv->ifname)) - 2; in wpa_driver_roboswitch_init()
372 while (sep > drv->ifname && *sep != '.') sep--; in wpa_driver_roboswitch_init()
373 if (sep <= drv->ifname) { in wpa_driver_roboswitch_init()
375 "interface name %s", __func__, drv->ifname); in wpa_driver_roboswitch_init()
376 os_free(drv); in wpa_driver_roboswitch_init()
379 *sep = '\0'; in wpa_driver_roboswitch_init()
381 if (*sep < '0' || *sep > '9') { in wpa_driver_roboswitch_init()
384 os_free(drv); in wpa_driver_roboswitch_init()
388 vlan += *sep - '0'; in wpa_driver_roboswitch_init()
392 os_free(drv); in wpa_driver_roboswitch_init()
397 drv->fd = socket(PF_INET, SOCK_DGRAM, 0); in wpa_driver_roboswitch_init()
398 if (drv->fd < 0) { in wpa_driver_roboswitch_init()
400 os_free(drv); in wpa_driver_roboswitch_init()
404 os_memset(&drv->ifr, 0, sizeof(drv->ifr)); in wpa_driver_roboswitch_init()
405 os_strlcpy(drv->ifr.ifr_name, drv->ifname, IFNAMSIZ); in wpa_driver_roboswitch_init()
406 if (ioctl(drv->fd, SIOCGMIIPHY, &drv->ifr) < 0) { in wpa_driver_roboswitch_init()
409 os_free(drv); in wpa_driver_roboswitch_init()
412 /* BCM63xx devices provide 0 here */ in wpa_driver_roboswitch_init()
413 if (if_mii(&drv->ifr)->phy_id != ROBO_PHY_ADDR && in wpa_driver_roboswitch_init()
414 if_mii(&drv->ifr)->phy_id != 0) { in wpa_driver_roboswitch_init()
417 os_free(drv); in wpa_driver_roboswitch_init()
422 _read[0] = ROBO_VLAN_MAX; in wpa_driver_roboswitch_init()
423 wpa_driver_roboswitch_write(drv, ROBO_VLAN_PAGE, ROBO_VLAN_ACCESS_5350, in wpa_driver_roboswitch_init()
425 wpa_driver_roboswitch_read(drv, ROBO_VLAN_PAGE, ROBO_VLAN_ACCESS_5350, in wpa_driver_roboswitch_init()
427 drv->is_5350 = _read[0] == _read[1]; in wpa_driver_roboswitch_init()
431 wpa_driver_roboswitch_write(drv, ROBO_VLAN_PAGE, in wpa_driver_roboswitch_init()
432 drv->is_5350 ? ROBO_VLAN_ACCESS_5350 in wpa_driver_roboswitch_init()
435 wpa_driver_roboswitch_read(drv, ROBO_VLAN_PAGE, ROBO_VLAN_READ, _read, in wpa_driver_roboswitch_init()
436 drv->is_5350 ? 2 : 1); in wpa_driver_roboswitch_init()
437 if (!(drv->is_5350 ? _read[1] & (1 << 4) : _read[0] & (1 << 14))) { in wpa_driver_roboswitch_init()
440 os_free(drv); in wpa_driver_roboswitch_init()
443 drv->ports = _read[0] & 0x001F; in wpa_driver_roboswitch_init()
445 drv->ports |= 1 << 8; in wpa_driver_roboswitch_init()
446 if (wpa_driver_roboswitch_join(drv, drv->ports, pae_group_addr) < 0) { in wpa_driver_roboswitch_init()
448 os_free(drv); in wpa_driver_roboswitch_init()
455 return drv; in wpa_driver_roboswitch_init()
461 struct wpa_driver_roboswitch_data *drv = priv; in wpa_driver_roboswitch_deinit() local
463 if (drv->l2) { in wpa_driver_roboswitch_deinit()
464 l2_packet_deinit(drv->l2); in wpa_driver_roboswitch_deinit()
465 drv->l2 = NULL; in wpa_driver_roboswitch_deinit()
467 if (wpa_driver_roboswitch_leave(drv, drv->ports, pae_group_addr) < 0) { in wpa_driver_roboswitch_deinit()
472 close(drv->fd); in wpa_driver_roboswitch_deinit()
473 os_free(drv); in wpa_driver_roboswitch_deinit()