2 * Realtek RTL8366 SMI interface driver
4 * Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License version 2 as published
8 * by the Free Software Foundation.
11 #include <linux/kernel.h>
12 #include <linux/module.h>
13 #include <linux/device.h>
14 #include <linux/delay.h>
15 #include <linux/gpio.h>
16 #include <linux/spinlock.h>
17 #include <linux/skbuff.h>
19 #ifdef CONFIG_RTL8366S_PHY_DEBUG_FS
20 #include <linux/debugfs.h>
23 #include "rtl8366_smi.h"
25 #define RTL8366_SMI_ACK_RETRY_COUNT 5
26 #define RTL8366_SMI_CLK_DELAY 10 /* nsec */
28 static inline void rtl8366_smi_clk_delay(struct rtl8366_smi
*smi
)
30 ndelay(RTL8366_SMI_CLK_DELAY
);
33 static void rtl8366_smi_start(struct rtl8366_smi
*smi
)
35 unsigned int sda
= smi
->gpio_sda
;
36 unsigned int sck
= smi
->gpio_sck
;
39 * Set GPIO pins to output mode, with initial state:
42 gpio_direction_output(sck
, 0);
43 gpio_direction_output(sda
, 1);
44 rtl8366_smi_clk_delay(smi
);
46 /* CLK 1: 0 -> 1, 1 -> 0 */
47 gpio_set_value(sck
, 1);
48 rtl8366_smi_clk_delay(smi
);
49 gpio_set_value(sck
, 0);
50 rtl8366_smi_clk_delay(smi
);
53 gpio_set_value(sck
, 1);
54 rtl8366_smi_clk_delay(smi
);
55 gpio_set_value(sda
, 0);
56 rtl8366_smi_clk_delay(smi
);
57 gpio_set_value(sck
, 0);
58 rtl8366_smi_clk_delay(smi
);
59 gpio_set_value(sda
, 1);
62 static void rtl8366_smi_stop(struct rtl8366_smi
*smi
)
64 unsigned int sda
= smi
->gpio_sda
;
65 unsigned int sck
= smi
->gpio_sck
;
67 rtl8366_smi_clk_delay(smi
);
68 gpio_set_value(sda
, 0);
69 gpio_set_value(sck
, 1);
70 rtl8366_smi_clk_delay(smi
);
71 gpio_set_value(sda
, 1);
72 rtl8366_smi_clk_delay(smi
);
73 gpio_set_value(sck
, 1);
74 rtl8366_smi_clk_delay(smi
);
75 gpio_set_value(sck
, 0);
76 rtl8366_smi_clk_delay(smi
);
77 gpio_set_value(sck
, 1);
80 rtl8366_smi_clk_delay(smi
);
81 gpio_set_value(sck
, 0);
82 rtl8366_smi_clk_delay(smi
);
83 gpio_set_value(sck
, 1);
85 /* set GPIO pins to input mode */
86 gpio_direction_input(sda
);
87 gpio_direction_input(sck
);
90 static void rtl8366_smi_write_bits(struct rtl8366_smi
*smi
, u32 data
, u32 len
)
92 unsigned int sda
= smi
->gpio_sda
;
93 unsigned int sck
= smi
->gpio_sck
;
95 for (; len
> 0; len
--) {
96 rtl8366_smi_clk_delay(smi
);
99 gpio_set_value(sda
, !!(data
& ( 1 << (len
- 1))));
100 rtl8366_smi_clk_delay(smi
);
103 gpio_set_value(sck
, 1);
104 rtl8366_smi_clk_delay(smi
);
105 gpio_set_value(sck
, 0);
109 static void rtl8366_smi_read_bits(struct rtl8366_smi
*smi
, u32 len
, u32
*data
)
111 unsigned int sda
= smi
->gpio_sda
;
112 unsigned int sck
= smi
->gpio_sck
;
114 gpio_direction_input(sda
);
116 for (*data
= 0; len
> 0; len
--) {
119 rtl8366_smi_clk_delay(smi
);
122 gpio_set_value(sck
, 1);
123 rtl8366_smi_clk_delay(smi
);
124 u
= !!gpio_get_value(sda
);
125 gpio_set_value(sck
, 0);
127 *data
|= (u
<< (len
- 1));
130 gpio_direction_output(sda
, 0);
133 static int rtl8366_smi_wait_for_ack(struct rtl8366_smi
*smi
)
141 rtl8366_smi_read_bits(smi
, 1, &ack
);
145 if (++retry_cnt
> RTL8366_SMI_ACK_RETRY_COUNT
)
152 static int rtl8366_smi_write_byte(struct rtl8366_smi
*smi
, u8 data
)
154 rtl8366_smi_write_bits(smi
, data
, 8);
155 return rtl8366_smi_wait_for_ack(smi
);
158 static int rtl8366_smi_read_byte0(struct rtl8366_smi
*smi
, u8
*data
)
163 rtl8366_smi_read_bits(smi
, 8, &t
);
167 rtl8366_smi_write_bits(smi
, 0x00, 1);
172 static int rtl8366_smi_read_byte1(struct rtl8366_smi
*smi
, u8
*data
)
177 rtl8366_smi_read_bits(smi
, 8, &t
);
181 rtl8366_smi_write_bits(smi
, 0x01, 1);
186 int rtl8366_smi_read_reg(struct rtl8366_smi
*smi
, u32 addr
, u32
*data
)
193 spin_lock_irqsave(&smi
->lock
, flags
);
195 rtl8366_smi_start(smi
);
197 /* send READ command */
198 ret
= rtl8366_smi_write_byte(smi
, 0x0a << 4 | 0x04 << 1 | 0x01);
203 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
208 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
213 rtl8366_smi_read_byte0(smi
, &lo
);
214 /* read DATA[15:8] */
215 rtl8366_smi_read_byte1(smi
, &hi
);
217 *data
= ((u32
) lo
) | (((u32
) hi
) << 8);
222 rtl8366_smi_stop(smi
);
223 spin_unlock_irqrestore(&smi
->lock
, flags
);
227 EXPORT_SYMBOL_GPL(rtl8366_smi_read_reg
);
229 int rtl8366_smi_write_reg(struct rtl8366_smi
*smi
, u32 addr
, u32 data
)
234 spin_lock_irqsave(&smi
->lock
, flags
);
236 rtl8366_smi_start(smi
);
238 /* send WRITE command */
239 ret
= rtl8366_smi_write_byte(smi
, 0x0a << 4 | 0x04 << 1 | 0x00);
244 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
249 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
253 /* write DATA[7:0] */
254 ret
= rtl8366_smi_write_byte(smi
, data
& 0xff);
258 /* write DATA[15:8] */
259 ret
= rtl8366_smi_write_byte(smi
, data
>> 8);
266 rtl8366_smi_stop(smi
);
267 spin_unlock_irqrestore(&smi
->lock
, flags
);
271 EXPORT_SYMBOL_GPL(rtl8366_smi_write_reg
);
273 int rtl8366_smi_rmwr(struct rtl8366_smi
*smi
, u32 addr
, u32 mask
, u32 data
)
278 err
= rtl8366_smi_read_reg(smi
, addr
, &t
);
282 err
= rtl8366_smi_write_reg(smi
, addr
, (t
& ~mask
) | data
);
286 EXPORT_SYMBOL_GPL(rtl8366_smi_rmwr
);
288 static int rtl8366_mc_is_used(struct rtl8366_smi
*smi
, int mc_index
, int *used
)
294 for (i
= 0; i
< smi
->num_ports
; i
++) {
297 err
= smi
->ops
->get_mc_index(smi
, i
, &index
);
301 if (mc_index
== index
) {
310 static int rtl8366_set_vlan(struct rtl8366_smi
*smi
, int vid
, u32 member
,
313 struct rtl8366_vlan_4k vlan4k
;
317 /* Update the 4K table */
318 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
322 vlan4k
.member
= member
;
323 vlan4k
.untag
= untag
;
325 err
= smi
->ops
->set_vlan_4k(smi
, &vlan4k
);
329 /* Try to find an existing MC entry for this VID */
330 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
331 struct rtl8366_vlan_mc vlanmc
;
333 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
337 if (vid
== vlanmc
.vid
) {
338 /* update the MC entry */
339 vlanmc
.member
= member
;
340 vlanmc
.untag
= untag
;
343 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
351 static int rtl8366_get_pvid(struct rtl8366_smi
*smi
, int port
, int *val
)
353 struct rtl8366_vlan_mc vlanmc
;
357 err
= smi
->ops
->get_mc_index(smi
, port
, &index
);
361 err
= smi
->ops
->get_vlan_mc(smi
, index
, &vlanmc
);
369 static int rtl8366_set_pvid(struct rtl8366_smi
*smi
, unsigned port
,
372 struct rtl8366_vlan_mc vlanmc
;
373 struct rtl8366_vlan_4k vlan4k
;
377 /* Try to find an existing MC entry for this VID */
378 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
379 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
383 if (vid
== vlanmc
.vid
) {
384 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
388 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
393 /* We have no MC entry for this VID, try to find an empty one */
394 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
395 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
399 if (vlanmc
.vid
== 0 && vlanmc
.member
== 0) {
400 /* Update the entry from the 4K table */
401 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
406 vlanmc
.member
= vlan4k
.member
;
407 vlanmc
.untag
= vlan4k
.untag
;
408 vlanmc
.fid
= vlan4k
.fid
;
409 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
413 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
418 /* MC table is full, try to find an unused entry and replace it */
419 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
422 err
= rtl8366_mc_is_used(smi
, i
, &used
);
427 /* Update the entry from the 4K table */
428 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
433 vlanmc
.member
= vlan4k
.member
;
434 vlanmc
.untag
= vlan4k
.untag
;
435 vlanmc
.fid
= vlan4k
.fid
;
436 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
440 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
446 "all VLAN member configurations are in use\n");
451 int rtl8366_reset_vlan(struct rtl8366_smi
*smi
)
453 struct rtl8366_vlan_mc vlanmc
;
457 /* clear VLAN member configurations */
463 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
464 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
469 for (i
= 0; i
< smi
->num_ports
; i
++) {
470 if (i
== smi
->cpu_port
)
473 err
= rtl8366_set_vlan(smi
, (i
+ 1),
474 (1 << i
) | (1 << smi
->cpu_port
),
475 (1 << i
) | (1 << smi
->cpu_port
),
480 err
= rtl8366_set_pvid(smi
, i
, (i
+ 1));
487 EXPORT_SYMBOL_GPL(rtl8366_reset_vlan
);
489 #ifdef CONFIG_RTL8366S_PHY_DEBUG_FS
490 int rtl8366_debugfs_open(struct inode
*inode
, struct file
*file
)
492 file
->private_data
= inode
->i_private
;
495 EXPORT_SYMBOL_GPL(rtl8366_debugfs_open
);
497 static ssize_t
rtl8366_read_debugfs_vlan_mc(struct file
*file
,
498 char __user
*user_buf
,
499 size_t count
, loff_t
*ppos
)
501 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
503 char *buf
= smi
->buf
;
505 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
506 "%2s %6s %4s %6s %6s %3s\n",
507 "id", "vid","prio", "member", "untag", "fid");
509 for (i
= 0; i
< smi
->num_vlan_mc
; ++i
) {
510 struct rtl8366_vlan_mc vlanmc
;
512 smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
514 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
515 "%2d %6d %4d 0x%04x 0x%04x %3d\n",
516 i
, vlanmc
.vid
, vlanmc
.priority
,
517 vlanmc
.member
, vlanmc
.untag
, vlanmc
.fid
);
520 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
523 static ssize_t
rtl8366_read_debugfs_reg(struct file
*file
,
524 char __user
*user_buf
,
525 size_t count
, loff_t
*ppos
)
527 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
528 u32 t
, reg
= smi
->dbg_reg
;
530 char *buf
= smi
->buf
;
532 memset(buf
, '\0', sizeof(smi
->buf
));
534 err
= rtl8366_smi_read_reg(smi
, reg
, &t
);
536 len
+= snprintf(buf
, sizeof(smi
->buf
),
537 "Read failed (reg: 0x%04x)\n", reg
);
538 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
541 len
+= snprintf(buf
, sizeof(smi
->buf
), "reg = 0x%04x, val = 0x%04x\n",
544 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
547 static ssize_t
rtl8366_write_debugfs_reg(struct file
*file
,
548 const char __user
*user_buf
,
549 size_t count
, loff_t
*ppos
)
551 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
553 u32 reg
= smi
->dbg_reg
;
556 char *buf
= smi
->buf
;
558 len
= min(count
, sizeof(smi
->buf
) - 1);
559 if (copy_from_user(buf
, user_buf
, len
)) {
560 dev_err(smi
->parent
, "copy from user failed\n");
565 if (len
> 0 && buf
[len
- 1] == '\n')
569 if (strict_strtoul(buf
, 16, &data
)) {
570 dev_err(smi
->parent
, "Invalid reg value %s\n", buf
);
572 err
= rtl8366_smi_write_reg(smi
, reg
, data
);
575 "writing reg 0x%04x val 0x%04lx failed\n",
583 static ssize_t
rtl8366_read_debugfs_mibs(struct file
*file
,
584 char __user
*user_buf
,
585 size_t count
, loff_t
*ppos
)
587 struct rtl8366_smi
*smi
= file
->private_data
;
589 char *buf
= smi
->buf
;
591 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s",
594 for (i
= 0; i
< smi
->num_ports
; i
++) {
597 snprintf(port_buf
, sizeof(port_buf
), "Port %d", i
);
598 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, " %12s",
601 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
603 for (i
= 0; i
< smi
->num_mib_counters
; i
++) {
604 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s ",
605 smi
->mib_counters
[i
].name
);
606 for (j
= 0; j
< smi
->num_ports
; j
++) {
607 unsigned long long counter
= 0;
609 if (!smi
->ops
->get_mib_counter(smi
, i
, j
, &counter
))
610 len
+= snprintf(buf
+ len
,
611 sizeof(smi
->buf
) - len
,
614 len
+= snprintf(buf
+ len
,
615 sizeof(smi
->buf
) - len
,
618 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
621 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
624 static const struct file_operations fops_rtl8366_regs
= {
625 .read
= rtl8366_read_debugfs_reg
,
626 .write
= rtl8366_write_debugfs_reg
,
627 .open
= rtl8366_debugfs_open
,
631 static const struct file_operations fops_rtl8366_vlan_mc
= {
632 .read
= rtl8366_read_debugfs_vlan_mc
,
633 .open
= rtl8366_debugfs_open
,
637 static const struct file_operations fops_rtl8366_mibs
= {
638 .read
= rtl8366_read_debugfs_mibs
,
639 .open
= rtl8366_debugfs_open
,
643 static void rtl8366_debugfs_init(struct rtl8366_smi
*smi
)
648 if (!smi
->debugfs_root
)
649 smi
->debugfs_root
= debugfs_create_dir(dev_name(smi
->parent
),
652 if (!smi
->debugfs_root
) {
653 dev_err(smi
->parent
, "Unable to create debugfs dir\n");
656 root
= smi
->debugfs_root
;
658 node
= debugfs_create_x16("reg", S_IRUGO
| S_IWUSR
, root
,
661 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
666 node
= debugfs_create_file("val", S_IRUGO
| S_IWUSR
, root
, smi
,
669 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
674 node
= debugfs_create_file("vlan_mc", S_IRUSR
, root
, smi
,
675 &fops_rtl8366_vlan_mc
);
677 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
682 node
= debugfs_create_file("mibs", S_IRUSR
, smi
->debugfs_root
, smi
,
685 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
689 static void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
)
691 if (smi
->debugfs_root
) {
692 debugfs_remove_recursive(smi
->debugfs_root
);
693 smi
->debugfs_root
= NULL
;
697 static inline void rtl8366_debugfs_init(struct rtl8366_smi
*smi
) {}
698 static inline void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
) {}
699 #endif /* CONFIG_RTL8366S_PHY_DEBUG_FS */
701 static int rtl8366_smi_mii_init(struct rtl8366_smi
*smi
)
706 smi
->mii_bus
= mdiobus_alloc();
707 if (smi
->mii_bus
== NULL
) {
712 smi
->mii_bus
->priv
= (void *) smi
;
713 smi
->mii_bus
->name
= dev_name(smi
->parent
);
714 smi
->mii_bus
->read
= smi
->ops
->mii_read
;
715 smi
->mii_bus
->write
= smi
->ops
->mii_write
;
716 snprintf(smi
->mii_bus
->id
, MII_BUS_ID_SIZE
, "%s",
717 dev_name(smi
->parent
));
718 smi
->mii_bus
->parent
= smi
->parent
;
719 smi
->mii_bus
->phy_mask
= ~(0x1f);
720 smi
->mii_bus
->irq
= smi
->mii_irq
;
721 for (i
= 0; i
< PHY_MAX_ADDR
; i
++)
722 smi
->mii_irq
[i
] = PHY_POLL
;
724 ret
= mdiobus_register(smi
->mii_bus
);
731 mdiobus_free(smi
->mii_bus
);
736 static void rtl8366_smi_mii_cleanup(struct rtl8366_smi
*smi
)
738 mdiobus_unregister(smi
->mii_bus
);
739 mdiobus_free(smi
->mii_bus
);
742 int rtl8366_sw_get_port_pvid(struct switch_dev
*dev
, int port
, int *val
)
744 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
745 return rtl8366_get_pvid(smi
, port
, val
);
747 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_pvid
);
749 int rtl8366_sw_set_port_pvid(struct switch_dev
*dev
, int port
, int val
)
751 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
752 return rtl8366_set_pvid(smi
, port
, val
);
754 EXPORT_SYMBOL_GPL(rtl8366_sw_set_port_pvid
);
756 int rtl8366_sw_get_port_mib(struct switch_dev
*dev
,
757 const struct switch_attr
*attr
,
758 struct switch_val
*val
)
760 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
762 unsigned long long counter
= 0;
763 char *buf
= smi
->buf
;
765 if (val
->port_vlan
>= smi
->num_ports
)
768 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
769 "Port %d MIB counters\n",
772 for (i
= 0; i
< smi
->num_mib_counters
; ++i
) {
773 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
774 "%-36s: ", smi
->mib_counters
[i
].name
);
775 if (!smi
->ops
->get_mib_counter(smi
, i
, val
->port_vlan
,
777 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
780 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
788 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_mib
);
790 int rtl8366_sw_get_vlan_info(struct switch_dev
*dev
,
791 const struct switch_attr
*attr
,
792 struct switch_val
*val
)
796 struct rtl8366_vlan_4k vlan4k
;
797 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
798 char *buf
= smi
->buf
;
801 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
804 memset(buf
, '\0', sizeof(smi
->buf
));
806 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
810 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
811 "VLAN %d: Ports: '", vlan4k
.vid
);
813 for (i
= 0; i
< smi
->num_ports
; i
++) {
814 if (!(vlan4k
.member
& (1 << i
)))
817 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%d%s", i
,
818 (vlan4k
.untag
& (1 << i
)) ? "" : "t");
821 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
822 "', members=%04x, untag=%04x, fid=%u",
823 vlan4k
.member
, vlan4k
.untag
, vlan4k
.fid
);
830 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_info
);
832 int rtl8366_sw_get_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
834 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
835 struct switch_port
*port
;
836 struct rtl8366_vlan_4k vlan4k
;
839 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
842 smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
844 port
= &val
->value
.ports
[0];
846 for (i
= 0; i
< smi
->num_ports
; i
++) {
847 if (!(vlan4k
.member
& BIT(i
)))
851 port
->flags
= (vlan4k
.untag
& BIT(i
)) ?
852 0 : BIT(SWITCH_PORT_FLAG_TAGGED
);
858 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_ports
);
860 int rtl8366_sw_set_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
862 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
863 struct switch_port
*port
;
868 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
871 port
= &val
->value
.ports
[0];
872 for (i
= 0; i
< val
->len
; i
++, port
++) {
873 member
|= BIT(port
->id
);
875 if (!(port
->flags
& BIT(SWITCH_PORT_FLAG_TAGGED
)))
876 untag
|= BIT(port
->id
);
879 return rtl8366_set_vlan(smi
, val
->port_vlan
, member
, untag
, 0);
881 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_ports
);
883 struct rtl8366_smi
*rtl8366_smi_alloc(struct device
*parent
)
885 struct rtl8366_smi
*smi
;
889 smi
= kzalloc(sizeof(*smi
), GFP_KERNEL
);
891 dev_err(parent
, "no memory for private data\n");
895 smi
->parent
= parent
;
898 EXPORT_SYMBOL_GPL(rtl8366_smi_alloc
);
900 int rtl8366_smi_init(struct rtl8366_smi
*smi
)
907 err
= gpio_request(smi
->gpio_sda
, dev_name(smi
->parent
));
909 dev_err(smi
->parent
, "gpio_request failed for %u, err=%d\n",
914 err
= gpio_request(smi
->gpio_sck
, dev_name(smi
->parent
));
916 dev_err(smi
->parent
, "gpio_request failed for %u, err=%d\n",
921 spin_lock_init(&smi
->lock
);
923 dev_info(smi
->parent
, "using GPIO pins %u (SDA) and %u (SCK)\n",
924 smi
->gpio_sda
, smi
->gpio_sck
);
926 err
= smi
->ops
->detect(smi
);
928 dev_err(smi
->parent
, "chip detection failed, err=%d\n", err
);
932 err
= smi
->ops
->setup(smi
);
934 dev_err(smi
->parent
, "chip setup failed, err=%d\n", err
);
938 err
= rtl8366_smi_mii_init(smi
);
942 rtl8366_debugfs_init(smi
);
947 gpio_free(smi
->gpio_sck
);
949 gpio_free(smi
->gpio_sda
);
953 EXPORT_SYMBOL_GPL(rtl8366_smi_init
);
955 void rtl8366_smi_cleanup(struct rtl8366_smi
*smi
)
957 rtl8366_debugfs_remove(smi
);
958 rtl8366_smi_mii_cleanup(smi
);
959 gpio_free(smi
->gpio_sck
);
960 gpio_free(smi
->gpio_sda
);
962 EXPORT_SYMBOL_GPL(rtl8366_smi_cleanup
);
964 MODULE_DESCRIPTION("Realtek RTL8366 SMI interface driver");
965 MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");
966 MODULE_LICENSE("GPL v2");