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 #include <linux/of_platform.h>
20 #include <linux/of_gpio.h>
21 #include <linux/rtl8366.h>
22 #include <linux/version.h>
24 #ifdef CONFIG_RTL8366_SMI_DEBUG_FS
25 #include <linux/debugfs.h>
28 #include "rtl8366_smi.h"
30 #define RTL8366_SMI_ACK_RETRY_COUNT 5
32 #define RTL8366_SMI_HW_STOP_DELAY 25 /* msecs */
33 #define RTL8366_SMI_HW_START_DELAY 100 /* msecs */
35 static inline void rtl8366_smi_clk_delay(struct rtl8366_smi
*smi
)
37 ndelay(smi
->clk_delay
);
40 static void rtl8366_smi_start(struct rtl8366_smi
*smi
)
42 unsigned int sda
= smi
->gpio_sda
;
43 unsigned int sck
= smi
->gpio_sck
;
46 * Set GPIO pins to output mode, with initial state:
49 gpio_direction_output(sck
, 0);
50 gpio_direction_output(sda
, 1);
51 rtl8366_smi_clk_delay(smi
);
53 /* CLK 1: 0 -> 1, 1 -> 0 */
54 gpio_set_value(sck
, 1);
55 rtl8366_smi_clk_delay(smi
);
56 gpio_set_value(sck
, 0);
57 rtl8366_smi_clk_delay(smi
);
60 gpio_set_value(sck
, 1);
61 rtl8366_smi_clk_delay(smi
);
62 gpio_set_value(sda
, 0);
63 rtl8366_smi_clk_delay(smi
);
64 gpio_set_value(sck
, 0);
65 rtl8366_smi_clk_delay(smi
);
66 gpio_set_value(sda
, 1);
69 static void rtl8366_smi_stop(struct rtl8366_smi
*smi
)
71 unsigned int sda
= smi
->gpio_sda
;
72 unsigned int sck
= smi
->gpio_sck
;
74 rtl8366_smi_clk_delay(smi
);
75 gpio_set_value(sda
, 0);
76 gpio_set_value(sck
, 1);
77 rtl8366_smi_clk_delay(smi
);
78 gpio_set_value(sda
, 1);
79 rtl8366_smi_clk_delay(smi
);
80 gpio_set_value(sck
, 1);
81 rtl8366_smi_clk_delay(smi
);
82 gpio_set_value(sck
, 0);
83 rtl8366_smi_clk_delay(smi
);
84 gpio_set_value(sck
, 1);
87 rtl8366_smi_clk_delay(smi
);
88 gpio_set_value(sck
, 0);
89 rtl8366_smi_clk_delay(smi
);
90 gpio_set_value(sck
, 1);
92 /* set GPIO pins to input mode */
93 gpio_direction_input(sda
);
94 gpio_direction_input(sck
);
97 static void rtl8366_smi_write_bits(struct rtl8366_smi
*smi
, u32 data
, u32 len
)
99 unsigned int sda
= smi
->gpio_sda
;
100 unsigned int sck
= smi
->gpio_sck
;
102 for (; len
> 0; len
--) {
103 rtl8366_smi_clk_delay(smi
);
106 gpio_set_value(sda
, !!(data
& ( 1 << (len
- 1))));
107 rtl8366_smi_clk_delay(smi
);
110 gpio_set_value(sck
, 1);
111 rtl8366_smi_clk_delay(smi
);
112 gpio_set_value(sck
, 0);
116 static void rtl8366_smi_read_bits(struct rtl8366_smi
*smi
, u32 len
, u32
*data
)
118 unsigned int sda
= smi
->gpio_sda
;
119 unsigned int sck
= smi
->gpio_sck
;
121 gpio_direction_input(sda
);
123 for (*data
= 0; len
> 0; len
--) {
126 rtl8366_smi_clk_delay(smi
);
129 gpio_set_value(sck
, 1);
130 rtl8366_smi_clk_delay(smi
);
131 u
= !!gpio_get_value(sda
);
132 gpio_set_value(sck
, 0);
134 *data
|= (u
<< (len
- 1));
137 gpio_direction_output(sda
, 0);
140 static int rtl8366_smi_wait_for_ack(struct rtl8366_smi
*smi
)
148 rtl8366_smi_read_bits(smi
, 1, &ack
);
152 if (++retry_cnt
> RTL8366_SMI_ACK_RETRY_COUNT
) {
153 dev_err(smi
->parent
, "ACK timeout\n");
161 static int rtl8366_smi_write_byte(struct rtl8366_smi
*smi
, u8 data
)
163 rtl8366_smi_write_bits(smi
, data
, 8);
164 return rtl8366_smi_wait_for_ack(smi
);
167 static int rtl8366_smi_write_byte_noack(struct rtl8366_smi
*smi
, u8 data
)
169 rtl8366_smi_write_bits(smi
, data
, 8);
173 static int rtl8366_smi_read_byte0(struct rtl8366_smi
*smi
, u8
*data
)
178 rtl8366_smi_read_bits(smi
, 8, &t
);
182 rtl8366_smi_write_bits(smi
, 0x00, 1);
187 static int rtl8366_smi_read_byte1(struct rtl8366_smi
*smi
, u8
*data
)
192 rtl8366_smi_read_bits(smi
, 8, &t
);
196 rtl8366_smi_write_bits(smi
, 0x01, 1);
201 int rtl8366_smi_read_reg(struct rtl8366_smi
*smi
, u32 addr
, u32
*data
)
208 spin_lock_irqsave(&smi
->lock
, flags
);
210 rtl8366_smi_start(smi
);
212 /* send READ command */
213 ret
= rtl8366_smi_write_byte(smi
, smi
->cmd_read
);
218 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
223 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
228 rtl8366_smi_read_byte0(smi
, &lo
);
229 /* read DATA[15:8] */
230 rtl8366_smi_read_byte1(smi
, &hi
);
232 *data
= ((u32
) lo
) | (((u32
) hi
) << 8);
237 rtl8366_smi_stop(smi
);
238 spin_unlock_irqrestore(&smi
->lock
, flags
);
242 EXPORT_SYMBOL_GPL(rtl8366_smi_read_reg
);
244 static int __rtl8366_smi_write_reg(struct rtl8366_smi
*smi
,
245 u32 addr
, u32 data
, bool ack
)
250 spin_lock_irqsave(&smi
->lock
, flags
);
252 rtl8366_smi_start(smi
);
254 /* send WRITE command */
255 ret
= rtl8366_smi_write_byte(smi
, smi
->cmd_write
);
260 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
265 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
269 /* write DATA[7:0] */
270 ret
= rtl8366_smi_write_byte(smi
, data
& 0xff);
274 /* write DATA[15:8] */
276 ret
= rtl8366_smi_write_byte(smi
, data
>> 8);
278 ret
= rtl8366_smi_write_byte_noack(smi
, data
>> 8);
285 rtl8366_smi_stop(smi
);
286 spin_unlock_irqrestore(&smi
->lock
, flags
);
291 int rtl8366_smi_write_reg(struct rtl8366_smi
*smi
, u32 addr
, u32 data
)
293 return __rtl8366_smi_write_reg(smi
, addr
, data
, true);
295 EXPORT_SYMBOL_GPL(rtl8366_smi_write_reg
);
297 int rtl8366_smi_write_reg_noack(struct rtl8366_smi
*smi
, u32 addr
, u32 data
)
299 return __rtl8366_smi_write_reg(smi
, addr
, data
, false);
301 EXPORT_SYMBOL_GPL(rtl8366_smi_write_reg_noack
);
303 int rtl8366_smi_rmwr(struct rtl8366_smi
*smi
, u32 addr
, u32 mask
, u32 data
)
308 err
= rtl8366_smi_read_reg(smi
, addr
, &t
);
312 err
= rtl8366_smi_write_reg(smi
, addr
, (t
& ~mask
) | data
);
316 EXPORT_SYMBOL_GPL(rtl8366_smi_rmwr
);
318 static int rtl8366_reset(struct rtl8366_smi
*smi
)
322 msleep(RTL8366_SMI_HW_STOP_DELAY
);
323 smi
->hw_reset(false);
324 msleep(RTL8366_SMI_HW_START_DELAY
);
328 return smi
->ops
->reset_chip(smi
);
331 static int rtl8366_mc_is_used(struct rtl8366_smi
*smi
, int mc_index
, int *used
)
337 for (i
= 0; i
< smi
->num_ports
; i
++) {
340 err
= smi
->ops
->get_mc_index(smi
, i
, &index
);
344 if (mc_index
== index
) {
353 static int rtl8366_set_vlan(struct rtl8366_smi
*smi
, int vid
, u32 member
,
356 struct rtl8366_vlan_4k vlan4k
;
360 /* Update the 4K table */
361 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
365 vlan4k
.member
= member
;
366 vlan4k
.untag
= untag
;
368 err
= smi
->ops
->set_vlan_4k(smi
, &vlan4k
);
372 /* Try to find an existing MC entry for this VID */
373 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
374 struct rtl8366_vlan_mc vlanmc
;
376 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
380 if (vid
== vlanmc
.vid
) {
381 /* update the MC entry */
382 vlanmc
.member
= member
;
383 vlanmc
.untag
= untag
;
386 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
394 static int rtl8366_get_pvid(struct rtl8366_smi
*smi
, int port
, int *val
)
396 struct rtl8366_vlan_mc vlanmc
;
400 err
= smi
->ops
->get_mc_index(smi
, port
, &index
);
404 err
= smi
->ops
->get_vlan_mc(smi
, index
, &vlanmc
);
412 static int rtl8366_set_pvid(struct rtl8366_smi
*smi
, unsigned port
,
415 struct rtl8366_vlan_mc vlanmc
;
416 struct rtl8366_vlan_4k vlan4k
;
420 /* Try to find an existing MC entry for this VID */
421 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
422 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
426 if (vid
== vlanmc
.vid
) {
427 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
431 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
436 /* We have no MC entry for this VID, try to find an empty one */
437 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
438 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
442 if (vlanmc
.vid
== 0 && vlanmc
.member
== 0) {
443 /* Update the entry from the 4K table */
444 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
449 vlanmc
.member
= vlan4k
.member
;
450 vlanmc
.untag
= vlan4k
.untag
;
451 vlanmc
.fid
= vlan4k
.fid
;
452 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
456 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
461 /* MC table is full, try to find an unused entry and replace it */
462 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
465 err
= rtl8366_mc_is_used(smi
, i
, &used
);
470 /* Update the entry from the 4K table */
471 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
476 vlanmc
.member
= vlan4k
.member
;
477 vlanmc
.untag
= vlan4k
.untag
;
478 vlanmc
.fid
= vlan4k
.fid
;
479 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
483 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
489 "all VLAN member configurations are in use\n");
494 int rtl8366_enable_vlan(struct rtl8366_smi
*smi
, int enable
)
498 err
= smi
->ops
->enable_vlan(smi
, enable
);
502 smi
->vlan_enabled
= enable
;
505 smi
->vlan4k_enabled
= 0;
506 err
= smi
->ops
->enable_vlan4k(smi
, enable
);
511 EXPORT_SYMBOL_GPL(rtl8366_enable_vlan
);
513 static int rtl8366_enable_vlan4k(struct rtl8366_smi
*smi
, int enable
)
518 err
= smi
->ops
->enable_vlan(smi
, enable
);
522 smi
->vlan_enabled
= enable
;
525 err
= smi
->ops
->enable_vlan4k(smi
, enable
);
529 smi
->vlan4k_enabled
= enable
;
533 int rtl8366_enable_all_ports(struct rtl8366_smi
*smi
, int enable
)
538 for (port
= 0; port
< smi
->num_ports
; port
++) {
539 err
= smi
->ops
->enable_port(smi
, port
, enable
);
546 EXPORT_SYMBOL_GPL(rtl8366_enable_all_ports
);
548 int rtl8366_reset_vlan(struct rtl8366_smi
*smi
)
550 struct rtl8366_vlan_mc vlanmc
;
554 rtl8366_enable_vlan(smi
, 0);
555 rtl8366_enable_vlan4k(smi
, 0);
557 /* clear VLAN member configurations */
563 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
564 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
571 EXPORT_SYMBOL_GPL(rtl8366_reset_vlan
);
573 static int rtl8366_init_vlan(struct rtl8366_smi
*smi
)
578 err
= rtl8366_reset_vlan(smi
);
582 for (port
= 0; port
< smi
->num_ports
; port
++) {
585 if (port
== smi
->cpu_port
)
586 mask
= (1 << smi
->num_ports
) - 1;
588 mask
= (1 << port
) | (1 << smi
->cpu_port
);
590 err
= rtl8366_set_vlan(smi
, (port
+ 1), mask
, mask
, 0);
594 err
= rtl8366_set_pvid(smi
, port
, (port
+ 1));
599 return rtl8366_enable_vlan(smi
, 1);
602 #ifdef CONFIG_RTL8366_SMI_DEBUG_FS
603 int rtl8366_debugfs_open(struct inode
*inode
, struct file
*file
)
605 file
->private_data
= inode
->i_private
;
608 EXPORT_SYMBOL_GPL(rtl8366_debugfs_open
);
610 static ssize_t
rtl8366_read_debugfs_vlan_mc(struct file
*file
,
611 char __user
*user_buf
,
612 size_t count
, loff_t
*ppos
)
614 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
616 char *buf
= smi
->buf
;
618 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
619 "%2s %6s %4s %6s %6s %3s\n",
620 "id", "vid","prio", "member", "untag", "fid");
622 for (i
= 0; i
< smi
->num_vlan_mc
; ++i
) {
623 struct rtl8366_vlan_mc vlanmc
;
625 smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
627 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
628 "%2d %6d %4d 0x%04x 0x%04x %3d\n",
629 i
, vlanmc
.vid
, vlanmc
.priority
,
630 vlanmc
.member
, vlanmc
.untag
, vlanmc
.fid
);
633 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
636 #define RTL8366_VLAN4K_PAGE_SIZE 64
637 #define RTL8366_VLAN4K_NUM_PAGES (4096 / RTL8366_VLAN4K_PAGE_SIZE)
639 static ssize_t
rtl8366_read_debugfs_vlan_4k(struct file
*file
,
640 char __user
*user_buf
,
641 size_t count
, loff_t
*ppos
)
643 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
646 char *buf
= smi
->buf
;
648 if (smi
->dbg_vlan_4k_page
>= RTL8366_VLAN4K_NUM_PAGES
) {
649 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
650 "invalid page: %u\n", smi
->dbg_vlan_4k_page
);
651 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
654 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
656 "vid", "member", "untag", "fid");
658 offset
= RTL8366_VLAN4K_PAGE_SIZE
* smi
->dbg_vlan_4k_page
;
659 for (i
= 0; i
< RTL8366_VLAN4K_PAGE_SIZE
; i
++) {
660 struct rtl8366_vlan_4k vlan4k
;
662 smi
->ops
->get_vlan_4k(smi
, offset
+ i
, &vlan4k
);
664 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
665 "%4d 0x%04x 0x%04x %3d\n",
666 vlan4k
.vid
, vlan4k
.member
,
667 vlan4k
.untag
, vlan4k
.fid
);
670 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
673 static ssize_t
rtl8366_read_debugfs_pvid(struct file
*file
,
674 char __user
*user_buf
,
675 size_t count
, loff_t
*ppos
)
677 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
678 char *buf
= smi
->buf
;
682 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%4s %4s\n",
685 for (i
= 0; i
< smi
->num_ports
; i
++) {
689 err
= rtl8366_get_pvid(smi
, i
, &pvid
);
691 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
694 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
695 "%4d %4d\n", i
, pvid
);
698 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
701 static ssize_t
rtl8366_read_debugfs_reg(struct file
*file
,
702 char __user
*user_buf
,
703 size_t count
, loff_t
*ppos
)
705 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
706 u32 t
, reg
= smi
->dbg_reg
;
708 char *buf
= smi
->buf
;
710 memset(buf
, '\0', sizeof(smi
->buf
));
712 err
= rtl8366_smi_read_reg(smi
, reg
, &t
);
714 len
+= snprintf(buf
, sizeof(smi
->buf
),
715 "Read failed (reg: 0x%04x)\n", reg
);
716 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
719 len
+= snprintf(buf
, sizeof(smi
->buf
), "reg = 0x%04x, val = 0x%04x\n",
722 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
725 static ssize_t
rtl8366_write_debugfs_reg(struct file
*file
,
726 const char __user
*user_buf
,
727 size_t count
, loff_t
*ppos
)
729 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
731 u32 reg
= smi
->dbg_reg
;
734 char *buf
= smi
->buf
;
736 len
= min(count
, sizeof(smi
->buf
) - 1);
737 if (copy_from_user(buf
, user_buf
, len
)) {
738 dev_err(smi
->parent
, "copy from user failed\n");
743 if (len
> 0 && buf
[len
- 1] == '\n')
747 if (kstrtoul(buf
, 16, &data
)) {
748 dev_err(smi
->parent
, "Invalid reg value %s\n", buf
);
750 err
= rtl8366_smi_write_reg(smi
, reg
, data
);
753 "writing reg 0x%04x val 0x%04lx failed\n",
761 static ssize_t
rtl8366_read_debugfs_mibs(struct file
*file
,
762 char __user
*user_buf
,
763 size_t count
, loff_t
*ppos
)
765 struct rtl8366_smi
*smi
= file
->private_data
;
767 char *buf
= smi
->buf
;
769 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s",
772 for (i
= 0; i
< smi
->num_ports
; i
++) {
775 snprintf(port_buf
, sizeof(port_buf
), "Port %d", i
);
776 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, " %12s",
779 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
781 for (i
= 0; i
< smi
->num_mib_counters
; i
++) {
782 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s ",
783 smi
->mib_counters
[i
].name
);
784 for (j
= 0; j
< smi
->num_ports
; j
++) {
785 unsigned long long counter
= 0;
787 if (!smi
->ops
->get_mib_counter(smi
, i
, j
, &counter
))
788 len
+= snprintf(buf
+ len
,
789 sizeof(smi
->buf
) - len
,
792 len
+= snprintf(buf
+ len
,
793 sizeof(smi
->buf
) - len
,
796 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
799 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
802 static const struct file_operations fops_rtl8366_regs
= {
803 .read
= rtl8366_read_debugfs_reg
,
804 .write
= rtl8366_write_debugfs_reg
,
805 .open
= rtl8366_debugfs_open
,
809 static const struct file_operations fops_rtl8366_vlan_mc
= {
810 .read
= rtl8366_read_debugfs_vlan_mc
,
811 .open
= rtl8366_debugfs_open
,
815 static const struct file_operations fops_rtl8366_vlan_4k
= {
816 .read
= rtl8366_read_debugfs_vlan_4k
,
817 .open
= rtl8366_debugfs_open
,
821 static const struct file_operations fops_rtl8366_pvid
= {
822 .read
= rtl8366_read_debugfs_pvid
,
823 .open
= rtl8366_debugfs_open
,
827 static const struct file_operations fops_rtl8366_mibs
= {
828 .read
= rtl8366_read_debugfs_mibs
,
829 .open
= rtl8366_debugfs_open
,
833 static void rtl8366_debugfs_init(struct rtl8366_smi
*smi
)
838 if (!smi
->debugfs_root
)
839 smi
->debugfs_root
= debugfs_create_dir(dev_name(smi
->parent
),
842 if (!smi
->debugfs_root
) {
843 dev_err(smi
->parent
, "Unable to create debugfs dir\n");
846 root
= smi
->debugfs_root
;
848 node
= debugfs_create_x16("reg", S_IRUGO
| S_IWUSR
, root
,
851 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
856 node
= debugfs_create_file("val", S_IRUGO
| S_IWUSR
, root
, smi
,
859 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
864 node
= debugfs_create_file("vlan_mc", S_IRUSR
, root
, smi
,
865 &fops_rtl8366_vlan_mc
);
867 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
872 node
= debugfs_create_u8("vlan_4k_page", S_IRUGO
| S_IWUSR
, root
,
873 &smi
->dbg_vlan_4k_page
);
875 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
880 node
= debugfs_create_file("vlan_4k", S_IRUSR
, root
, smi
,
881 &fops_rtl8366_vlan_4k
);
883 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
888 node
= debugfs_create_file("pvid", S_IRUSR
, root
, smi
,
891 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
896 node
= debugfs_create_file("mibs", S_IRUSR
, smi
->debugfs_root
, smi
,
899 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
903 static void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
)
905 if (smi
->debugfs_root
) {
906 debugfs_remove_recursive(smi
->debugfs_root
);
907 smi
->debugfs_root
= NULL
;
911 static inline void rtl8366_debugfs_init(struct rtl8366_smi
*smi
) {}
912 static inline void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
) {}
913 #endif /* CONFIG_RTL8366_SMI_DEBUG_FS */
915 static int rtl8366_smi_mii_init(struct rtl8366_smi
*smi
)
919 smi
->mii_bus
= mdiobus_alloc();
920 if (smi
->mii_bus
== NULL
) {
925 smi
->mii_bus
->priv
= (void *) smi
;
926 smi
->mii_bus
->name
= dev_name(smi
->parent
);
927 smi
->mii_bus
->read
= smi
->ops
->mii_read
;
928 smi
->mii_bus
->write
= smi
->ops
->mii_write
;
929 snprintf(smi
->mii_bus
->id
, MII_BUS_ID_SIZE
, "%s",
930 dev_name(smi
->parent
));
931 smi
->mii_bus
->parent
= smi
->parent
;
932 smi
->mii_bus
->phy_mask
= ~(0x1f);
933 #if LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0)
936 smi
->mii_bus
->irq
= smi
->mii_irq
;
937 for (i
= 0; i
< PHY_MAX_ADDR
; i
++)
938 smi
->mii_irq
[i
] = PHY_POLL
;
942 ret
= mdiobus_register(smi
->mii_bus
);
949 mdiobus_free(smi
->mii_bus
);
954 static void rtl8366_smi_mii_cleanup(struct rtl8366_smi
*smi
)
956 mdiobus_unregister(smi
->mii_bus
);
957 mdiobus_free(smi
->mii_bus
);
960 int rtl8366_sw_reset_switch(struct switch_dev
*dev
)
962 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
965 err
= rtl8366_reset(smi
);
969 err
= smi
->ops
->setup(smi
);
973 err
= rtl8366_reset_vlan(smi
);
977 err
= rtl8366_enable_vlan(smi
, 1);
981 return rtl8366_enable_all_ports(smi
, 1);
983 EXPORT_SYMBOL_GPL(rtl8366_sw_reset_switch
);
985 int rtl8366_sw_get_port_pvid(struct switch_dev
*dev
, int port
, int *val
)
987 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
988 return rtl8366_get_pvid(smi
, port
, val
);
990 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_pvid
);
992 int rtl8366_sw_set_port_pvid(struct switch_dev
*dev
, int port
, int val
)
994 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
995 return rtl8366_set_pvid(smi
, port
, val
);
997 EXPORT_SYMBOL_GPL(rtl8366_sw_set_port_pvid
);
999 int rtl8366_sw_get_port_mib(struct switch_dev
*dev
,
1000 const struct switch_attr
*attr
,
1001 struct switch_val
*val
)
1003 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1005 unsigned long long counter
= 0;
1006 char *buf
= smi
->buf
;
1008 if (val
->port_vlan
>= smi
->num_ports
)
1011 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1012 "Port %d MIB counters\n",
1015 for (i
= 0; i
< smi
->num_mib_counters
; ++i
) {
1016 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1017 "%-36s: ", smi
->mib_counters
[i
].name
);
1018 if (!smi
->ops
->get_mib_counter(smi
, i
, val
->port_vlan
,
1020 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1023 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1031 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_mib
);
1033 int rtl8366_sw_get_vlan_info(struct switch_dev
*dev
,
1034 const struct switch_attr
*attr
,
1035 struct switch_val
*val
)
1039 struct rtl8366_vlan_4k vlan4k
;
1040 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1041 char *buf
= smi
->buf
;
1044 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1047 memset(buf
, '\0', sizeof(smi
->buf
));
1049 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1053 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1054 "VLAN %d: Ports: '", vlan4k
.vid
);
1056 for (i
= 0; i
< smi
->num_ports
; i
++) {
1057 if (!(vlan4k
.member
& (1 << i
)))
1060 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%d%s", i
,
1061 (vlan4k
.untag
& (1 << i
)) ? "" : "t");
1064 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1065 "', members=%04x, untag=%04x, fid=%u",
1066 vlan4k
.member
, vlan4k
.untag
, vlan4k
.fid
);
1073 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_info
);
1075 int rtl8366_sw_get_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
1077 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1078 struct switch_port
*port
;
1079 struct rtl8366_vlan_4k vlan4k
;
1082 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1085 smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1087 port
= &val
->value
.ports
[0];
1089 for (i
= 0; i
< smi
->num_ports
; i
++) {
1090 if (!(vlan4k
.member
& BIT(i
)))
1094 port
->flags
= (vlan4k
.untag
& BIT(i
)) ?
1095 0 : BIT(SWITCH_PORT_FLAG_TAGGED
);
1101 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_ports
);
1103 int rtl8366_sw_set_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
1105 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1106 struct switch_port
*port
;
1112 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1115 port
= &val
->value
.ports
[0];
1116 for (i
= 0; i
< val
->len
; i
++, port
++) {
1118 member
|= BIT(port
->id
);
1120 if (!(port
->flags
& BIT(SWITCH_PORT_FLAG_TAGGED
)))
1121 untag
|= BIT(port
->id
);
1124 * To ensure that we have a valid MC entry for this VLAN,
1125 * initialize the port VLAN ID here.
1127 err
= rtl8366_get_pvid(smi
, port
->id
, &pvid
);
1131 err
= rtl8366_set_pvid(smi
, port
->id
, val
->port_vlan
);
1137 return rtl8366_set_vlan(smi
, val
->port_vlan
, member
, untag
, 0);
1139 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_ports
);
1141 int rtl8366_sw_get_vlan_fid(struct switch_dev
*dev
,
1142 const struct switch_attr
*attr
,
1143 struct switch_val
*val
)
1145 struct rtl8366_vlan_4k vlan4k
;
1146 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1149 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1152 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1156 val
->value
.i
= vlan4k
.fid
;
1160 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_fid
);
1162 int rtl8366_sw_set_vlan_fid(struct switch_dev
*dev
,
1163 const struct switch_attr
*attr
,
1164 struct switch_val
*val
)
1166 struct rtl8366_vlan_4k vlan4k
;
1167 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1170 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1173 if (val
->value
.i
< 0 || val
->value
.i
> attr
->max
)
1176 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1180 return rtl8366_set_vlan(smi
, val
->port_vlan
,
1185 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_fid
);
1187 int rtl8366_sw_get_vlan_enable(struct switch_dev
*dev
,
1188 const struct switch_attr
*attr
,
1189 struct switch_val
*val
)
1191 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1197 val
->value
.i
= smi
->vlan_enabled
;
1199 val
->value
.i
= smi
->vlan4k_enabled
;
1203 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_enable
);
1205 int rtl8366_sw_set_vlan_enable(struct switch_dev
*dev
,
1206 const struct switch_attr
*attr
,
1207 struct switch_val
*val
)
1209 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1216 err
= rtl8366_enable_vlan(smi
, val
->value
.i
);
1218 err
= rtl8366_enable_vlan4k(smi
, val
->value
.i
);
1222 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_enable
);
1224 struct rtl8366_smi
*rtl8366_smi_alloc(struct device
*parent
)
1226 struct rtl8366_smi
*smi
;
1230 smi
= kzalloc(sizeof(*smi
), GFP_KERNEL
);
1232 dev_err(parent
, "no memory for private data\n");
1236 smi
->parent
= parent
;
1239 EXPORT_SYMBOL_GPL(rtl8366_smi_alloc
);
1241 static int __rtl8366_smi_init(struct rtl8366_smi
*smi
, const char *name
)
1245 err
= gpio_request(smi
->gpio_sda
, name
);
1247 printk(KERN_ERR
"rtl8366_smi: gpio_request failed for %u, err=%d\n",
1248 smi
->gpio_sda
, err
);
1252 err
= gpio_request(smi
->gpio_sck
, name
);
1254 printk(KERN_ERR
"rtl8366_smi: gpio_request failed for %u, err=%d\n",
1255 smi
->gpio_sck
, err
);
1259 spin_lock_init(&smi
->lock
);
1261 /* start the switch */
1262 if (smi
->hw_reset
) {
1263 smi
->hw_reset(false);
1264 msleep(RTL8366_SMI_HW_START_DELAY
);
1270 gpio_free(smi
->gpio_sda
);
1275 static void __rtl8366_smi_cleanup(struct rtl8366_smi
*smi
)
1278 smi
->hw_reset(true);
1280 gpio_free(smi
->gpio_sck
);
1281 gpio_free(smi
->gpio_sda
);
1284 enum rtl8366_type
rtl8366_smi_detect(struct rtl8366_platform_data
*pdata
)
1286 static struct rtl8366_smi smi
;
1287 enum rtl8366_type type
= RTL8366_TYPE_UNKNOWN
;
1290 memset(&smi
, 0, sizeof(smi
));
1291 smi
.gpio_sda
= pdata
->gpio_sda
;
1292 smi
.gpio_sck
= pdata
->gpio_sck
;
1294 smi
.cmd_read
= 0xa9;
1295 smi
.cmd_write
= 0xa8;
1297 if (__rtl8366_smi_init(&smi
, "rtl8366"))
1300 if (rtl8366_smi_read_reg(&smi
, 0x5c, ®
))
1305 printk("Found an RTL8366S switch\n");
1306 type
= RTL8366_TYPE_S
;
1309 printk("Found an RTL8366RB switch\n");
1310 type
= RTL8366_TYPE_RB
;
1313 printk("Found an Unknown RTL8366 switch (id=0x%04x)\n", reg
);
1318 __rtl8366_smi_cleanup(&smi
);
1323 int rtl8366_smi_init(struct rtl8366_smi
*smi
)
1330 err
= __rtl8366_smi_init(smi
, dev_name(smi
->parent
));
1334 dev_info(smi
->parent
, "using GPIO pins %u (SDA) and %u (SCK)\n",
1335 smi
->gpio_sda
, smi
->gpio_sck
);
1337 err
= smi
->ops
->detect(smi
);
1339 dev_err(smi
->parent
, "chip detection failed, err=%d\n", err
);
1343 err
= rtl8366_reset(smi
);
1347 err
= smi
->ops
->setup(smi
);
1349 dev_err(smi
->parent
, "chip setup failed, err=%d\n", err
);
1353 err
= rtl8366_init_vlan(smi
);
1355 dev_err(smi
->parent
, "VLAN initialization failed, err=%d\n",
1360 err
= rtl8366_enable_all_ports(smi
, 1);
1364 err
= rtl8366_smi_mii_init(smi
);
1368 rtl8366_debugfs_init(smi
);
1373 __rtl8366_smi_cleanup(smi
);
1377 EXPORT_SYMBOL_GPL(rtl8366_smi_init
);
1379 void rtl8366_smi_cleanup(struct rtl8366_smi
*smi
)
1381 rtl8366_debugfs_remove(smi
);
1382 rtl8366_smi_mii_cleanup(smi
);
1383 __rtl8366_smi_cleanup(smi
);
1385 EXPORT_SYMBOL_GPL(rtl8366_smi_cleanup
);
1388 int rtl8366_smi_probe_of(struct platform_device
*pdev
, struct rtl8366_smi
*smi
)
1390 int sck
= of_get_named_gpio(pdev
->dev
.of_node
, "gpio-sck", 0);
1391 int sda
= of_get_named_gpio(pdev
->dev
.of_node
, "gpio-sda", 0);
1393 if (!gpio_is_valid(sck
) || !gpio_is_valid(sda
)) {
1394 dev_err(&pdev
->dev
, "gpios missing in devictree\n");
1398 smi
->gpio_sda
= sda
;
1399 smi
->gpio_sck
= sck
;
1404 static inline int rtl8366_smi_probe_of(struct platform_device
*pdev
, struct rtl8366_smi
*smi
)
1410 int rtl8366_smi_probe_plat(struct platform_device
*pdev
, struct rtl8366_smi
*smi
)
1412 struct rtl8366_platform_data
*pdata
= pdev
->dev
.platform_data
;
1414 if (!pdev
->dev
.platform_data
) {
1415 dev_err(&pdev
->dev
, "no platform data specified\n");
1419 smi
->gpio_sda
= pdata
->gpio_sda
;
1420 smi
->gpio_sck
= pdata
->gpio_sck
;
1421 smi
->hw_reset
= pdata
->hw_reset
;
1427 struct rtl8366_smi
*rtl8366_smi_probe(struct platform_device
*pdev
)
1429 struct rtl8366_smi
*smi
;
1432 smi
= rtl8366_smi_alloc(&pdev
->dev
);
1436 if (pdev
->dev
.of_node
)
1437 err
= rtl8366_smi_probe_of(pdev
, smi
);
1439 err
= rtl8366_smi_probe_plat(pdev
, smi
);
1450 EXPORT_SYMBOL_GPL(rtl8366_smi_probe
);
1452 MODULE_DESCRIPTION("Realtek RTL8366 SMI interface driver");
1453 MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");
1454 MODULE_LICENSE("GPL v2");