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>
18 #include <linux/rtl8366.h>
20 #ifdef CONFIG_RTL8366_SMI_DEBUG_FS
21 #include <linux/debugfs.h>
24 #include "rtl8366_smi.h"
26 #define RTL8366_SMI_ACK_RETRY_COUNT 5
28 #define RTL8366_SMI_HW_STOP_DELAY 25 /* msecs */
29 #define RTL8366_SMI_HW_START_DELAY 100 /* msecs */
31 static inline void rtl8366_smi_clk_delay(struct rtl8366_smi
*smi
)
33 ndelay(smi
->clk_delay
);
36 static void rtl8366_smi_start(struct rtl8366_smi
*smi
)
38 unsigned int sda
= smi
->gpio_sda
;
39 unsigned int sck
= smi
->gpio_sck
;
42 * Set GPIO pins to output mode, with initial state:
45 gpio_direction_output(sck
, 0);
46 gpio_direction_output(sda
, 1);
47 rtl8366_smi_clk_delay(smi
);
49 /* CLK 1: 0 -> 1, 1 -> 0 */
50 gpio_set_value(sck
, 1);
51 rtl8366_smi_clk_delay(smi
);
52 gpio_set_value(sck
, 0);
53 rtl8366_smi_clk_delay(smi
);
56 gpio_set_value(sck
, 1);
57 rtl8366_smi_clk_delay(smi
);
58 gpio_set_value(sda
, 0);
59 rtl8366_smi_clk_delay(smi
);
60 gpio_set_value(sck
, 0);
61 rtl8366_smi_clk_delay(smi
);
62 gpio_set_value(sda
, 1);
65 static void rtl8366_smi_stop(struct rtl8366_smi
*smi
)
67 unsigned int sda
= smi
->gpio_sda
;
68 unsigned int sck
= smi
->gpio_sck
;
70 rtl8366_smi_clk_delay(smi
);
71 gpio_set_value(sda
, 0);
72 gpio_set_value(sck
, 1);
73 rtl8366_smi_clk_delay(smi
);
74 gpio_set_value(sda
, 1);
75 rtl8366_smi_clk_delay(smi
);
76 gpio_set_value(sck
, 1);
77 rtl8366_smi_clk_delay(smi
);
78 gpio_set_value(sck
, 0);
79 rtl8366_smi_clk_delay(smi
);
80 gpio_set_value(sck
, 1);
83 rtl8366_smi_clk_delay(smi
);
84 gpio_set_value(sck
, 0);
85 rtl8366_smi_clk_delay(smi
);
86 gpio_set_value(sck
, 1);
88 /* set GPIO pins to input mode */
89 gpio_direction_input(sda
);
90 gpio_direction_input(sck
);
93 static void rtl8366_smi_write_bits(struct rtl8366_smi
*smi
, u32 data
, u32 len
)
95 unsigned int sda
= smi
->gpio_sda
;
96 unsigned int sck
= smi
->gpio_sck
;
98 for (; len
> 0; len
--) {
99 rtl8366_smi_clk_delay(smi
);
102 gpio_set_value(sda
, !!(data
& ( 1 << (len
- 1))));
103 rtl8366_smi_clk_delay(smi
);
106 gpio_set_value(sck
, 1);
107 rtl8366_smi_clk_delay(smi
);
108 gpio_set_value(sck
, 0);
112 static void rtl8366_smi_read_bits(struct rtl8366_smi
*smi
, u32 len
, u32
*data
)
114 unsigned int sda
= smi
->gpio_sda
;
115 unsigned int sck
= smi
->gpio_sck
;
117 gpio_direction_input(sda
);
119 for (*data
= 0; len
> 0; len
--) {
122 rtl8366_smi_clk_delay(smi
);
125 gpio_set_value(sck
, 1);
126 rtl8366_smi_clk_delay(smi
);
127 u
= !!gpio_get_value(sda
);
128 gpio_set_value(sck
, 0);
130 *data
|= (u
<< (len
- 1));
133 gpio_direction_output(sda
, 0);
136 static int rtl8366_smi_wait_for_ack(struct rtl8366_smi
*smi
)
144 rtl8366_smi_read_bits(smi
, 1, &ack
);
148 if (++retry_cnt
> RTL8366_SMI_ACK_RETRY_COUNT
) {
149 dev_err(smi
->parent
, "ACK timeout\n");
157 static int rtl8366_smi_write_byte(struct rtl8366_smi
*smi
, u8 data
)
159 rtl8366_smi_write_bits(smi
, data
, 8);
160 return rtl8366_smi_wait_for_ack(smi
);
163 static int rtl8366_smi_write_byte_noack(struct rtl8366_smi
*smi
, u8 data
)
165 rtl8366_smi_write_bits(smi
, data
, 8);
169 static int rtl8366_smi_read_byte0(struct rtl8366_smi
*smi
, u8
*data
)
174 rtl8366_smi_read_bits(smi
, 8, &t
);
178 rtl8366_smi_write_bits(smi
, 0x00, 1);
183 static int rtl8366_smi_read_byte1(struct rtl8366_smi
*smi
, u8
*data
)
188 rtl8366_smi_read_bits(smi
, 8, &t
);
192 rtl8366_smi_write_bits(smi
, 0x01, 1);
197 int rtl8366_smi_read_reg(struct rtl8366_smi
*smi
, u32 addr
, u32
*data
)
204 spin_lock_irqsave(&smi
->lock
, flags
);
206 rtl8366_smi_start(smi
);
208 /* send READ command */
209 ret
= rtl8366_smi_write_byte(smi
, smi
->cmd_read
);
214 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
219 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
224 rtl8366_smi_read_byte0(smi
, &lo
);
225 /* read DATA[15:8] */
226 rtl8366_smi_read_byte1(smi
, &hi
);
228 *data
= ((u32
) lo
) | (((u32
) hi
) << 8);
233 rtl8366_smi_stop(smi
);
234 spin_unlock_irqrestore(&smi
->lock
, flags
);
238 EXPORT_SYMBOL_GPL(rtl8366_smi_read_reg
);
240 static int __rtl8366_smi_write_reg(struct rtl8366_smi
*smi
,
241 u32 addr
, u32 data
, bool ack
)
246 spin_lock_irqsave(&smi
->lock
, flags
);
248 rtl8366_smi_start(smi
);
250 /* send WRITE command */
251 ret
= rtl8366_smi_write_byte(smi
, smi
->cmd_write
);
256 ret
= rtl8366_smi_write_byte(smi
, addr
& 0xff);
261 ret
= rtl8366_smi_write_byte(smi
, addr
>> 8);
265 /* write DATA[7:0] */
266 ret
= rtl8366_smi_write_byte(smi
, data
& 0xff);
270 /* write DATA[15:8] */
272 ret
= rtl8366_smi_write_byte(smi
, data
>> 8);
274 ret
= rtl8366_smi_write_byte_noack(smi
, data
>> 8);
281 rtl8366_smi_stop(smi
);
282 spin_unlock_irqrestore(&smi
->lock
, flags
);
287 int rtl8366_smi_write_reg(struct rtl8366_smi
*smi
, u32 addr
, u32 data
)
289 return __rtl8366_smi_write_reg(smi
, addr
, data
, true);
291 EXPORT_SYMBOL_GPL(rtl8366_smi_write_reg
);
293 int rtl8366_smi_write_reg_noack(struct rtl8366_smi
*smi
, u32 addr
, u32 data
)
295 return __rtl8366_smi_write_reg(smi
, addr
, data
, false);
297 EXPORT_SYMBOL_GPL(rtl8366_smi_write_reg_noack
);
299 int rtl8366_smi_rmwr(struct rtl8366_smi
*smi
, u32 addr
, u32 mask
, u32 data
)
304 err
= rtl8366_smi_read_reg(smi
, addr
, &t
);
308 err
= rtl8366_smi_write_reg(smi
, addr
, (t
& ~mask
) | data
);
312 EXPORT_SYMBOL_GPL(rtl8366_smi_rmwr
);
314 static int rtl8366_reset(struct rtl8366_smi
*smi
)
318 msleep(RTL8366_SMI_HW_STOP_DELAY
);
319 smi
->hw_reset(false);
320 msleep(RTL8366_SMI_HW_START_DELAY
);
324 return smi
->ops
->reset_chip(smi
);
327 static int rtl8366_mc_is_used(struct rtl8366_smi
*smi
, int mc_index
, int *used
)
333 for (i
= 0; i
< smi
->num_ports
; i
++) {
336 err
= smi
->ops
->get_mc_index(smi
, i
, &index
);
340 if (mc_index
== index
) {
349 static int rtl8366_set_vlan(struct rtl8366_smi
*smi
, int vid
, u32 member
,
352 struct rtl8366_vlan_4k vlan4k
;
356 /* Update the 4K table */
357 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
361 vlan4k
.member
= member
;
362 vlan4k
.untag
= untag
;
364 err
= smi
->ops
->set_vlan_4k(smi
, &vlan4k
);
368 /* Try to find an existing MC entry for this VID */
369 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
370 struct rtl8366_vlan_mc vlanmc
;
372 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
376 if (vid
== vlanmc
.vid
) {
377 /* update the MC entry */
378 vlanmc
.member
= member
;
379 vlanmc
.untag
= untag
;
382 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
390 static int rtl8366_get_pvid(struct rtl8366_smi
*smi
, int port
, int *val
)
392 struct rtl8366_vlan_mc vlanmc
;
396 err
= smi
->ops
->get_mc_index(smi
, port
, &index
);
400 err
= smi
->ops
->get_vlan_mc(smi
, index
, &vlanmc
);
408 static int rtl8366_set_pvid(struct rtl8366_smi
*smi
, unsigned port
,
411 struct rtl8366_vlan_mc vlanmc
;
412 struct rtl8366_vlan_4k vlan4k
;
416 /* Try to find an existing MC entry for this VID */
417 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
418 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
422 if (vid
== vlanmc
.vid
) {
423 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
427 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
432 /* We have no MC entry for this VID, try to find an empty one */
433 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
434 err
= smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
438 if (vlanmc
.vid
== 0 && vlanmc
.member
== 0) {
439 /* Update the entry from the 4K table */
440 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
445 vlanmc
.member
= vlan4k
.member
;
446 vlanmc
.untag
= vlan4k
.untag
;
447 vlanmc
.fid
= vlan4k
.fid
;
448 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
452 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
457 /* MC table is full, try to find an unused entry and replace it */
458 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
461 err
= rtl8366_mc_is_used(smi
, i
, &used
);
466 /* Update the entry from the 4K table */
467 err
= smi
->ops
->get_vlan_4k(smi
, vid
, &vlan4k
);
472 vlanmc
.member
= vlan4k
.member
;
473 vlanmc
.untag
= vlan4k
.untag
;
474 vlanmc
.fid
= vlan4k
.fid
;
475 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
479 err
= smi
->ops
->set_mc_index(smi
, port
, i
);
485 "all VLAN member configurations are in use\n");
490 int rtl8366_enable_vlan(struct rtl8366_smi
*smi
, int enable
)
494 err
= smi
->ops
->enable_vlan(smi
, enable
);
498 smi
->vlan_enabled
= enable
;
501 smi
->vlan4k_enabled
= 0;
502 err
= smi
->ops
->enable_vlan4k(smi
, enable
);
507 EXPORT_SYMBOL_GPL(rtl8366_enable_vlan
);
509 static int rtl8366_enable_vlan4k(struct rtl8366_smi
*smi
, int enable
)
514 err
= smi
->ops
->enable_vlan(smi
, enable
);
518 smi
->vlan_enabled
= enable
;
521 err
= smi
->ops
->enable_vlan4k(smi
, enable
);
525 smi
->vlan4k_enabled
= enable
;
529 int rtl8366_enable_all_ports(struct rtl8366_smi
*smi
, int enable
)
534 for (port
= 0; port
< smi
->num_ports
; port
++) {
535 err
= smi
->ops
->enable_port(smi
, port
, enable
);
542 EXPORT_SYMBOL_GPL(rtl8366_enable_all_ports
);
544 int rtl8366_reset_vlan(struct rtl8366_smi
*smi
)
546 struct rtl8366_vlan_mc vlanmc
;
550 rtl8366_enable_vlan(smi
, 0);
551 rtl8366_enable_vlan4k(smi
, 0);
553 /* clear VLAN member configurations */
559 for (i
= 0; i
< smi
->num_vlan_mc
; i
++) {
560 err
= smi
->ops
->set_vlan_mc(smi
, i
, &vlanmc
);
567 EXPORT_SYMBOL_GPL(rtl8366_reset_vlan
);
569 static int rtl8366_init_vlan(struct rtl8366_smi
*smi
)
574 err
= rtl8366_reset_vlan(smi
);
578 for (port
= 0; port
< smi
->num_ports
; port
++) {
581 if (port
== smi
->cpu_port
)
582 mask
= (1 << smi
->num_ports
) - 1;
584 mask
= (1 << port
) | (1 << smi
->cpu_port
);
586 err
= rtl8366_set_vlan(smi
, (port
+ 1), mask
, mask
, 0);
590 err
= rtl8366_set_pvid(smi
, port
, (port
+ 1));
595 return rtl8366_enable_vlan(smi
, 1);
598 #ifdef CONFIG_RTL8366_SMI_DEBUG_FS
599 int rtl8366_debugfs_open(struct inode
*inode
, struct file
*file
)
601 file
->private_data
= inode
->i_private
;
604 EXPORT_SYMBOL_GPL(rtl8366_debugfs_open
);
606 static ssize_t
rtl8366_read_debugfs_vlan_mc(struct file
*file
,
607 char __user
*user_buf
,
608 size_t count
, loff_t
*ppos
)
610 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
612 char *buf
= smi
->buf
;
614 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
615 "%2s %6s %4s %6s %6s %3s\n",
616 "id", "vid","prio", "member", "untag", "fid");
618 for (i
= 0; i
< smi
->num_vlan_mc
; ++i
) {
619 struct rtl8366_vlan_mc vlanmc
;
621 smi
->ops
->get_vlan_mc(smi
, i
, &vlanmc
);
623 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
624 "%2d %6d %4d 0x%04x 0x%04x %3d\n",
625 i
, vlanmc
.vid
, vlanmc
.priority
,
626 vlanmc
.member
, vlanmc
.untag
, vlanmc
.fid
);
629 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
632 #define RTL8366_VLAN4K_PAGE_SIZE 64
633 #define RTL8366_VLAN4K_NUM_PAGES (4096 / RTL8366_VLAN4K_PAGE_SIZE)
635 static ssize_t
rtl8366_read_debugfs_vlan_4k(struct file
*file
,
636 char __user
*user_buf
,
637 size_t count
, loff_t
*ppos
)
639 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
642 char *buf
= smi
->buf
;
644 if (smi
->dbg_vlan_4k_page
>= RTL8366_VLAN4K_NUM_PAGES
) {
645 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
646 "invalid page: %u\n", smi
->dbg_vlan_4k_page
);
647 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
650 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
652 "vid", "member", "untag", "fid");
654 offset
= RTL8366_VLAN4K_PAGE_SIZE
* smi
->dbg_vlan_4k_page
;
655 for (i
= 0; i
< RTL8366_VLAN4K_PAGE_SIZE
; i
++) {
656 struct rtl8366_vlan_4k vlan4k
;
658 smi
->ops
->get_vlan_4k(smi
, offset
+ i
, &vlan4k
);
660 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
661 "%4d 0x%04x 0x%04x %3d\n",
662 vlan4k
.vid
, vlan4k
.member
,
663 vlan4k
.untag
, vlan4k
.fid
);
666 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
669 static ssize_t
rtl8366_read_debugfs_pvid(struct file
*file
,
670 char __user
*user_buf
,
671 size_t count
, loff_t
*ppos
)
673 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
674 char *buf
= smi
->buf
;
678 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%4s %4s\n",
681 for (i
= 0; i
< smi
->num_ports
; i
++) {
685 err
= rtl8366_get_pvid(smi
, i
, &pvid
);
687 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
690 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
691 "%4d %4d\n", i
, pvid
);
694 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
697 static ssize_t
rtl8366_read_debugfs_reg(struct file
*file
,
698 char __user
*user_buf
,
699 size_t count
, loff_t
*ppos
)
701 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
702 u32 t
, reg
= smi
->dbg_reg
;
704 char *buf
= smi
->buf
;
706 memset(buf
, '\0', sizeof(smi
->buf
));
708 err
= rtl8366_smi_read_reg(smi
, reg
, &t
);
710 len
+= snprintf(buf
, sizeof(smi
->buf
),
711 "Read failed (reg: 0x%04x)\n", reg
);
712 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
715 len
+= snprintf(buf
, sizeof(smi
->buf
), "reg = 0x%04x, val = 0x%04x\n",
718 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
721 static ssize_t
rtl8366_write_debugfs_reg(struct file
*file
,
722 const char __user
*user_buf
,
723 size_t count
, loff_t
*ppos
)
725 struct rtl8366_smi
*smi
= (struct rtl8366_smi
*)file
->private_data
;
727 u32 reg
= smi
->dbg_reg
;
730 char *buf
= smi
->buf
;
732 len
= min(count
, sizeof(smi
->buf
) - 1);
733 if (copy_from_user(buf
, user_buf
, len
)) {
734 dev_err(smi
->parent
, "copy from user failed\n");
739 if (len
> 0 && buf
[len
- 1] == '\n')
743 if (strict_strtoul(buf
, 16, &data
)) {
744 dev_err(smi
->parent
, "Invalid reg value %s\n", buf
);
746 err
= rtl8366_smi_write_reg(smi
, reg
, data
);
749 "writing reg 0x%04x val 0x%04lx failed\n",
757 static ssize_t
rtl8366_read_debugfs_mibs(struct file
*file
,
758 char __user
*user_buf
,
759 size_t count
, loff_t
*ppos
)
761 struct rtl8366_smi
*smi
= file
->private_data
;
763 char *buf
= smi
->buf
;
765 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s",
768 for (i
= 0; i
< smi
->num_ports
; i
++) {
771 snprintf(port_buf
, sizeof(port_buf
), "Port %d", i
);
772 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, " %12s",
775 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
777 for (i
= 0; i
< smi
->num_mib_counters
; i
++) {
778 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%-36s ",
779 smi
->mib_counters
[i
].name
);
780 for (j
= 0; j
< smi
->num_ports
; j
++) {
781 unsigned long long counter
= 0;
783 if (!smi
->ops
->get_mib_counter(smi
, i
, j
, &counter
))
784 len
+= snprintf(buf
+ len
,
785 sizeof(smi
->buf
) - len
,
788 len
+= snprintf(buf
+ len
,
789 sizeof(smi
->buf
) - len
,
792 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "\n");
795 return simple_read_from_buffer(user_buf
, count
, ppos
, buf
, len
);
798 static const struct file_operations fops_rtl8366_regs
= {
799 .read
= rtl8366_read_debugfs_reg
,
800 .write
= rtl8366_write_debugfs_reg
,
801 .open
= rtl8366_debugfs_open
,
805 static const struct file_operations fops_rtl8366_vlan_mc
= {
806 .read
= rtl8366_read_debugfs_vlan_mc
,
807 .open
= rtl8366_debugfs_open
,
811 static const struct file_operations fops_rtl8366_vlan_4k
= {
812 .read
= rtl8366_read_debugfs_vlan_4k
,
813 .open
= rtl8366_debugfs_open
,
817 static const struct file_operations fops_rtl8366_pvid
= {
818 .read
= rtl8366_read_debugfs_pvid
,
819 .open
= rtl8366_debugfs_open
,
823 static const struct file_operations fops_rtl8366_mibs
= {
824 .read
= rtl8366_read_debugfs_mibs
,
825 .open
= rtl8366_debugfs_open
,
829 static void rtl8366_debugfs_init(struct rtl8366_smi
*smi
)
834 if (!smi
->debugfs_root
)
835 smi
->debugfs_root
= debugfs_create_dir(dev_name(smi
->parent
),
838 if (!smi
->debugfs_root
) {
839 dev_err(smi
->parent
, "Unable to create debugfs dir\n");
842 root
= smi
->debugfs_root
;
844 node
= debugfs_create_x16("reg", S_IRUGO
| S_IWUSR
, root
,
847 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
852 node
= debugfs_create_file("val", S_IRUGO
| S_IWUSR
, root
, smi
,
855 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
860 node
= debugfs_create_file("vlan_mc", S_IRUSR
, root
, smi
,
861 &fops_rtl8366_vlan_mc
);
863 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
868 node
= debugfs_create_u8("vlan_4k_page", S_IRUGO
| S_IWUSR
, root
,
869 &smi
->dbg_vlan_4k_page
);
871 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
876 node
= debugfs_create_file("vlan_4k", S_IRUSR
, root
, smi
,
877 &fops_rtl8366_vlan_4k
);
879 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
884 node
= debugfs_create_file("pvid", S_IRUSR
, root
, smi
,
887 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
892 node
= debugfs_create_file("mibs", S_IRUSR
, smi
->debugfs_root
, smi
,
895 dev_err(smi
->parent
, "Creating debugfs file '%s' failed\n",
899 static void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
)
901 if (smi
->debugfs_root
) {
902 debugfs_remove_recursive(smi
->debugfs_root
);
903 smi
->debugfs_root
= NULL
;
907 static inline void rtl8366_debugfs_init(struct rtl8366_smi
*smi
) {}
908 static inline void rtl8366_debugfs_remove(struct rtl8366_smi
*smi
) {}
909 #endif /* CONFIG_RTL8366_SMI_DEBUG_FS */
911 static int rtl8366_smi_mii_init(struct rtl8366_smi
*smi
)
916 smi
->mii_bus
= mdiobus_alloc();
917 if (smi
->mii_bus
== NULL
) {
922 smi
->mii_bus
->priv
= (void *) smi
;
923 smi
->mii_bus
->name
= dev_name(smi
->parent
);
924 smi
->mii_bus
->read
= smi
->ops
->mii_read
;
925 smi
->mii_bus
->write
= smi
->ops
->mii_write
;
926 snprintf(smi
->mii_bus
->id
, MII_BUS_ID_SIZE
, "%s",
927 dev_name(smi
->parent
));
928 smi
->mii_bus
->parent
= smi
->parent
;
929 smi
->mii_bus
->phy_mask
= ~(0x1f);
930 smi
->mii_bus
->irq
= smi
->mii_irq
;
931 for (i
= 0; i
< PHY_MAX_ADDR
; i
++)
932 smi
->mii_irq
[i
] = PHY_POLL
;
934 ret
= mdiobus_register(smi
->mii_bus
);
941 mdiobus_free(smi
->mii_bus
);
946 static void rtl8366_smi_mii_cleanup(struct rtl8366_smi
*smi
)
948 mdiobus_unregister(smi
->mii_bus
);
949 mdiobus_free(smi
->mii_bus
);
952 int rtl8366_sw_reset_switch(struct switch_dev
*dev
)
954 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
957 err
= rtl8366_reset(smi
);
961 err
= smi
->ops
->setup(smi
);
965 err
= rtl8366_reset_vlan(smi
);
969 err
= rtl8366_enable_vlan(smi
, 1);
973 return rtl8366_enable_all_ports(smi
, 1);
975 EXPORT_SYMBOL_GPL(rtl8366_sw_reset_switch
);
977 int rtl8366_sw_get_port_pvid(struct switch_dev
*dev
, int port
, int *val
)
979 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
980 return rtl8366_get_pvid(smi
, port
, val
);
982 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_pvid
);
984 int rtl8366_sw_set_port_pvid(struct switch_dev
*dev
, int port
, int val
)
986 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
987 return rtl8366_set_pvid(smi
, port
, val
);
989 EXPORT_SYMBOL_GPL(rtl8366_sw_set_port_pvid
);
991 int rtl8366_sw_get_port_mib(struct switch_dev
*dev
,
992 const struct switch_attr
*attr
,
993 struct switch_val
*val
)
995 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
997 unsigned long long counter
= 0;
998 char *buf
= smi
->buf
;
1000 if (val
->port_vlan
>= smi
->num_ports
)
1003 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1004 "Port %d MIB counters\n",
1007 for (i
= 0; i
< smi
->num_mib_counters
; ++i
) {
1008 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1009 "%-36s: ", smi
->mib_counters
[i
].name
);
1010 if (!smi
->ops
->get_mib_counter(smi
, i
, val
->port_vlan
,
1012 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1015 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1023 EXPORT_SYMBOL_GPL(rtl8366_sw_get_port_mib
);
1025 int rtl8366_sw_get_vlan_info(struct switch_dev
*dev
,
1026 const struct switch_attr
*attr
,
1027 struct switch_val
*val
)
1031 struct rtl8366_vlan_4k vlan4k
;
1032 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1033 char *buf
= smi
->buf
;
1036 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1039 memset(buf
, '\0', sizeof(smi
->buf
));
1041 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1045 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1046 "VLAN %d: Ports: '", vlan4k
.vid
);
1048 for (i
= 0; i
< smi
->num_ports
; i
++) {
1049 if (!(vlan4k
.member
& (1 << i
)))
1052 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
, "%d%s", i
,
1053 (vlan4k
.untag
& (1 << i
)) ? "" : "t");
1056 len
+= snprintf(buf
+ len
, sizeof(smi
->buf
) - len
,
1057 "', members=%04x, untag=%04x, fid=%u",
1058 vlan4k
.member
, vlan4k
.untag
, vlan4k
.fid
);
1065 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_info
);
1067 int rtl8366_sw_get_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
1069 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1070 struct switch_port
*port
;
1071 struct rtl8366_vlan_4k vlan4k
;
1074 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1077 smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1079 port
= &val
->value
.ports
[0];
1081 for (i
= 0; i
< smi
->num_ports
; i
++) {
1082 if (!(vlan4k
.member
& BIT(i
)))
1086 port
->flags
= (vlan4k
.untag
& BIT(i
)) ?
1087 0 : BIT(SWITCH_PORT_FLAG_TAGGED
);
1093 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_ports
);
1095 int rtl8366_sw_set_vlan_ports(struct switch_dev
*dev
, struct switch_val
*val
)
1097 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1098 struct switch_port
*port
;
1104 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1107 port
= &val
->value
.ports
[0];
1108 for (i
= 0; i
< val
->len
; i
++, port
++) {
1109 member
|= BIT(port
->id
);
1111 if (!(port
->flags
& BIT(SWITCH_PORT_FLAG_TAGGED
)))
1112 untag
|= BIT(port
->id
);
1115 * To ensure that we have a valid MC entry for this VLAN,
1116 * initialize the port VLAN ID here.
1118 err
= rtl8366_set_pvid(smi
, port
->id
, val
->port_vlan
);
1123 return rtl8366_set_vlan(smi
, val
->port_vlan
, member
, untag
, 0);
1125 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_ports
);
1127 int rtl8366_sw_get_vlan_fid(struct switch_dev
*dev
,
1128 const struct switch_attr
*attr
,
1129 struct switch_val
*val
)
1131 struct rtl8366_vlan_4k vlan4k
;
1132 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1135 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1138 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1142 val
->value
.i
= vlan4k
.fid
;
1146 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_fid
);
1148 int rtl8366_sw_set_vlan_fid(struct switch_dev
*dev
,
1149 const struct switch_attr
*attr
,
1150 struct switch_val
*val
)
1152 struct rtl8366_vlan_4k vlan4k
;
1153 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1156 if (!smi
->ops
->is_vlan_valid(smi
, val
->port_vlan
))
1159 if (val
->value
.i
< 0 || val
->value
.i
> attr
->max
)
1162 err
= smi
->ops
->get_vlan_4k(smi
, val
->port_vlan
, &vlan4k
);
1166 return rtl8366_set_vlan(smi
, val
->port_vlan
,
1171 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_fid
);
1173 int rtl8366_sw_get_vlan_enable(struct switch_dev
*dev
,
1174 const struct switch_attr
*attr
,
1175 struct switch_val
*val
)
1177 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1183 val
->value
.i
= smi
->vlan_enabled
;
1185 val
->value
.i
= smi
->vlan4k_enabled
;
1189 EXPORT_SYMBOL_GPL(rtl8366_sw_get_vlan_enable
);
1191 int rtl8366_sw_set_vlan_enable(struct switch_dev
*dev
,
1192 const struct switch_attr
*attr
,
1193 struct switch_val
*val
)
1195 struct rtl8366_smi
*smi
= sw_to_rtl8366_smi(dev
);
1202 err
= rtl8366_enable_vlan(smi
, val
->value
.i
);
1204 err
= rtl8366_enable_vlan4k(smi
, val
->value
.i
);
1208 EXPORT_SYMBOL_GPL(rtl8366_sw_set_vlan_enable
);
1210 struct rtl8366_smi
*rtl8366_smi_alloc(struct device
*parent
)
1212 struct rtl8366_smi
*smi
;
1216 smi
= kzalloc(sizeof(*smi
), GFP_KERNEL
);
1218 dev_err(parent
, "no memory for private data\n");
1222 smi
->parent
= parent
;
1225 EXPORT_SYMBOL_GPL(rtl8366_smi_alloc
);
1227 static int __rtl8366_smi_init(struct rtl8366_smi
*smi
, const char *name
)
1231 err
= gpio_request(smi
->gpio_sda
, name
);
1233 printk(KERN_ERR
"rtl8366_smi: gpio_request failed for %u, err=%d\n",
1234 smi
->gpio_sda
, err
);
1238 err
= gpio_request(smi
->gpio_sck
, name
);
1240 printk(KERN_ERR
"rtl8366_smi: gpio_request failed for %u, err=%d\n",
1241 smi
->gpio_sck
, err
);
1245 spin_lock_init(&smi
->lock
);
1247 /* start the switch */
1248 if (smi
->hw_reset
) {
1249 smi
->hw_reset(false);
1250 msleep(RTL8366_SMI_HW_START_DELAY
);
1256 gpio_free(smi
->gpio_sda
);
1261 static void __rtl8366_smi_cleanup(struct rtl8366_smi
*smi
)
1264 smi
->hw_reset(true);
1266 gpio_free(smi
->gpio_sck
);
1267 gpio_free(smi
->gpio_sda
);
1270 enum rtl8366_type
rtl8366_smi_detect(struct rtl8366_platform_data
*pdata
)
1272 static struct rtl8366_smi smi
;
1273 enum rtl8366_type type
= RTL8366_TYPE_UNKNOWN
;
1276 memset(&smi
, 0, sizeof(smi
));
1277 smi
.gpio_sda
= pdata
->gpio_sda
;
1278 smi
.gpio_sck
= pdata
->gpio_sck
;
1280 smi
.cmd_read
= 0xa9;
1281 smi
.cmd_write
= 0xa8;
1283 if (__rtl8366_smi_init(&smi
, "rtl8366"))
1286 if (rtl8366_smi_read_reg(&smi
, 0x5c, ®
))
1291 printk("Found an RTL8366S switch\n");
1292 type
= RTL8366_TYPE_S
;
1295 printk("Found an RTL8366RB switch\n");
1296 type
= RTL8366_TYPE_RB
;
1299 printk("Found an Unknown RTL8366 switch (id=0x%04x)\n", reg
);
1304 __rtl8366_smi_cleanup(&smi
);
1309 int rtl8366_smi_init(struct rtl8366_smi
*smi
)
1316 err
= __rtl8366_smi_init(smi
, dev_name(smi
->parent
));
1320 dev_info(smi
->parent
, "using GPIO pins %u (SDA) and %u (SCK)\n",
1321 smi
->gpio_sda
, smi
->gpio_sck
);
1323 err
= smi
->ops
->detect(smi
);
1325 dev_err(smi
->parent
, "chip detection failed, err=%d\n", err
);
1329 err
= rtl8366_reset(smi
);
1333 err
= smi
->ops
->setup(smi
);
1335 dev_err(smi
->parent
, "chip setup failed, err=%d\n", err
);
1339 err
= rtl8366_init_vlan(smi
);
1341 dev_err(smi
->parent
, "VLAN initialization failed, err=%d\n",
1346 err
= rtl8366_enable_all_ports(smi
, 1);
1350 err
= rtl8366_smi_mii_init(smi
);
1354 rtl8366_debugfs_init(smi
);
1359 __rtl8366_smi_cleanup(smi
);
1363 EXPORT_SYMBOL_GPL(rtl8366_smi_init
);
1365 void rtl8366_smi_cleanup(struct rtl8366_smi
*smi
)
1367 rtl8366_debugfs_remove(smi
);
1368 rtl8366_smi_mii_cleanup(smi
);
1369 __rtl8366_smi_cleanup(smi
);
1371 EXPORT_SYMBOL_GPL(rtl8366_smi_cleanup
);
1373 MODULE_DESCRIPTION("Realtek RTL8366 SMI interface driver");
1374 MODULE_AUTHOR("Gabor Juhos <juhosg@openwrt.org>");
1375 MODULE_LICENSE("GPL v2");