rtl8366_smi: make rtl8366_phy_config_{aneg,init} static
[openwrt/svn-archive/archive.git] / target / linux / ar71xx / files / drivers / net / phy / rtl8366_smi.c
index b9158d6e3e6f7f1badac03221974f56a69e5e6e8..20510724c5dd7f714e42769bde5054e0f73d3191 100644 (file)
@@ -21,9 +21,7 @@
 #include <linux/phy.h>
 #include <linux/rtl8366_smi.h>
 
-/* #define DEBUG 1 */
-
-#ifdef DEBUG
+#ifdef CONFIG_RTL8366_SMI_DEBUG_FS
 #include <linux/debugfs.h>
 #endif
 
 
 
 #define RTL8366S_PORT_VLAN_CTRL_BASE        0x0058
+#define RTL8366S_PORT_VLAN_CTRL_REG(_p)  \
+               (RTL8366S_PORT_VLAN_CTRL_BASE + (_p) / 4)
+#define RTL8366S_PORT_VLAN_CTRL_MASK       0xf
+#define RTL8366S_PORT_VLAN_CTRL_SHIFT(_p)   (4 * ((_p) % 4))
+
+
 #define RTL8366S_VLAN_TABLE_READ_BASE       0x018B
 #define RTL8366S_VLAN_TABLE_WRITE_BASE      0x0185
 
@@ -167,40 +171,42 @@ struct rtl8366s_vlan4kentry {
        u16     member:6;
 };
 
-static const char *MIBCOUNTERS[] = { "IfInOctets                        ",
-                                    "EtherStatsOctets                  ",
-                                    "EtherStatsUnderSizePkts           ",
-                                    "EtherFregament                    ",
-                                    "EtherStatsPkts64Octets            ",
-                                    "EtherStatsPkts65to127Octets       ",
-                                    "EtherStatsPkts128to255Octets      ",
-                                    "EtherStatsPkts256to511Octets      ",
-                                    "EtherStatsPkts512to1023Octets     ",
-                                    "EtherStatsPkts1024to1518Octets    ",
-                                    "EtherOversizeStats                ",
-                                    "EtherStatsJabbers                 ",
-                                    "IfInUcastPkts                     ",
-                                    "EtherStatsMulticastPkts           ",
-                                    "EtherStatsBroadcastPkts           ",
-                                    "EtherStatsDropEvents              ",
-                                    "Dot3StatsFCSErrors                ",
-                                    "Dot3StatsSymbolErrors             ",
-                                    "Dot3InPauseFrames                 ",
-                                    "Dot3ControlInUnknownOpcodes       ",
-                                    "IfOutOctets                       ",
-                                    "Dot3StatsSingleCollisionFrames    ",
-                                    "Dot3StatMultipleCollisionFrames   ",
-                                    "Dot3sDeferredTransmissions        ",
-                                    "Dot3StatsLateCollisions           ",
-                                    "EtherStatsCollisions              ",
-                                    "Dot3StatsExcessiveCollisions      ",
-                                    "Dot3OutPauseFrames                ",
-                                    "Dot1dBasePortDelayExceededDiscards",
-                                    "Dot1dTpPortInDiscards             ",
-                                    "IfOutUcastPkts                    ",
-                                    "IfOutMulticastPkts                ",
-                                    "IfOutBroadcastPkts                ",
-                                    NULL };
+static const char *MIBCOUNTERS[] = {
+       "IfInOctets                        ",
+       "EtherStatsOctets                  ",
+       "EtherStatsUnderSizePkts           ",
+       "EtherFregament                    ",
+       "EtherStatsPkts64Octets            ",
+       "EtherStatsPkts65to127Octets       ",
+       "EtherStatsPkts128to255Octets      ",
+       "EtherStatsPkts256to511Octets      ",
+       "EtherStatsPkts512to1023Octets     ",
+       "EtherStatsPkts1024to1518Octets    ",
+       "EtherOversizeStats                ",
+       "EtherStatsJabbers                 ",
+       "IfInUcastPkts                     ",
+       "EtherStatsMulticastPkts           ",
+       "EtherStatsBroadcastPkts           ",
+       "EtherStatsDropEvents              ",
+       "Dot3StatsFCSErrors                ",
+       "Dot3StatsSymbolErrors             ",
+       "Dot3InPauseFrames                 ",
+       "Dot3ControlInUnknownOpcodes       ",
+       "IfOutOctets                       ",
+       "Dot3StatsSingleCollisionFrames    ",
+       "Dot3StatMultipleCollisionFrames   ",
+       "Dot3sDeferredTransmissions        ",
+       "Dot3StatsLateCollisions           ",
+       "EtherStatsCollisions              ",
+       "Dot3StatsExcessiveCollisions      ",
+       "Dot3OutPauseFrames                ",
+       "Dot1dBasePortDelayExceededDiscards",
+       "Dot1dTpPortInDiscards             ",
+       "IfOutUcastPkts                    ",
+       "IfOutMulticastPkts                ",
+       "IfOutBroadcastPkts                ",
+       NULL,
+};
 
 struct rtl8366_smi {
        struct platform_device             *pdev;
@@ -209,13 +215,13 @@ struct rtl8366_smi {
        struct mii_bus                     *mii_bus;
        struct switch_dev                  dev;
        int                                mii_irq[PHY_MAX_ADDR];
-       char buf[4096];
-#ifdef DEBUG
+       char                               buf[4096];
+#ifdef CONFIG_RTL8366_SMI_DEBUG_FS
        struct dentry                      *debugfs_root;
 #endif
 };
 
-#ifdef DEBUG
+#ifdef CONFIG_RTL8366_SMI_DEBUG_FS
 u16 g_dbg_reg;
 #endif
 
@@ -553,20 +559,18 @@ static int rtl8366_get_mib_counter(struct rtl8366_smi *smi, int counter,
        if (port > RTL8366_NUM_PORTS || counter >= RTL8366S_MIB_COUNT)
                return -EINVAL;
 
-       i = 0;
        regoffset = RTL8366S_MIB_COUNTER_PORT_OFFSET * (port);
 
-       while (i < counter) {
+       for (i = 0; i < counter; i++)
                regoffset += mibLength[i];
-               i++;
-       }
 
        addr = RTL8366S_MIB_COUNTER_BASE + regoffset;
 
-
-       /* writing access counter address first */
-       /* then ASIC will prepare 64bits counter wait for being retrived */
-       data = 0;/* writing data will be discard by ASIC */
+       /*
+        * Writing access counter address first
+        * then ASIC will prepare 64bits counter wait for being retrived
+        */
+       data = 0; /* writing data will be discard by ASIC */
        err = rtl8366_smi_write_reg(smi, addr, data);
        if (err)
                return err;
@@ -671,16 +675,16 @@ static int rtl8366s_set_vlan_4k_entry(struct rtl8366_smi *smi,
 
        data = *tableaddr;
 
-       rtl8366_smi_write_reg(smi, RTL8366S_VLAN_TABLE_WRITE_BASE + 1, data);
-
+       err = rtl8366_smi_write_reg(smi, RTL8366S_VLAN_TABLE_WRITE_BASE + 1,
+                                   data);
+       if (err)
+               return err;
 
        /* write table access control word */
        err = rtl8366_smi_write_reg(smi, RTL8366S_TABLE_ACCESS_CTRL_REG,
                                    RTL8366S_TABLE_VLAN_WRITE_CTRL);
-       if (err)
-               return err;
 
-       return 0;
+       return err;
 }
 
 static int rtl8366s_get_vlan_member_config(struct rtl8366_smi *smi, u32 index,
@@ -699,7 +703,6 @@ static int rtl8366s_get_vlan_member_config(struct rtl8366_smi *smi, u32 index,
        tableaddr = (u16 *)vlanmc;
 
        addr = RTL8366S_VLAN_MEMCONF_BASE + (index << 1);
-
        err = rtl8366_smi_read_reg(smi, addr, &data);
        if (err)
                return err;
@@ -708,7 +711,6 @@ static int rtl8366s_get_vlan_member_config(struct rtl8366_smi *smi, u32 index,
        tableaddr++;
 
        addr = RTL8366S_VLAN_MEMCONF_BASE + 1 + (index << 1);
-
        err = rtl8366_smi_read_reg(smi, addr, &data);
        if (err)
                return err;
@@ -728,16 +730,15 @@ static int rtl8366s_set_vlan_member_config(struct rtl8366_smi *smi, u32 index,
        u16 *tableaddr;
 
        if (index >= RTL8366_NUM_VLANS ||
-          vlanmc->vid >= RTL8366_NUM_VIDS ||
-          vlanmc->priority > RTL8366S_PRIORITYMAX ||
-          vlanmc->member > RTL8366_PORT_ALL ||
-          vlanmc->untag > RTL8366_PORT_ALL ||
-          vlanmc->fid > RTL8366S_FIDMAX)
+           vlanmc->vid >= RTL8366_NUM_VIDS ||
+           vlanmc->priority > RTL8366S_PRIORITYMAX ||
+           vlanmc->member > RTL8366_PORT_ALL ||
+           vlanmc->untag > RTL8366_PORT_ALL ||
+           vlanmc->fid > RTL8366S_FIDMAX)
                return -EINVAL;
 
        addr = RTL8366S_VLAN_MEMCONF_BASE + (index << 1);
 
-
        tableaddr = (u16 *)vlanmc;
        data = *tableaddr;
 
@@ -760,28 +761,19 @@ static int rtl8366s_set_vlan_member_config(struct rtl8366_smi *smi, u32 index,
 static int rtl8366_get_port_vlan_index(struct rtl8366_smi *smi, int port,
                                       int *val)
 {
-       int err;
-       u32 addr;
        u32 data;
-
-       /* bits mapping to port vlan control register of port n */
-       const u16 bits[RTL8366_NUM_PORTS] = { 0x000F, 0x00F0, 0x0F00,
-                                            0xF000, 0x000F, 0x00F0 };
-       /* bits offset to port vlan control register of port n */
-       const u16 bitoffset[RTL8366_NUM_PORTS] = { 0, 4, 8, 12, 0, 4 };
-       /* address offset to port vlan control register of port n */
-       const u16 addroffset[RTL8366_NUM_PORTS] = { 0, 0, 0, 0, 1, 1 };
+       int err;
 
        if (port >= RTL8366_NUM_PORTS)
                return -EINVAL;
 
-       addr = RTL8366S_PORT_VLAN_CTRL_BASE + addroffset[port];
-
-       err = rtl8366_smi_read_reg(smi, addr, &data);
+       err = rtl8366_smi_read_reg(smi, RTL8366S_PORT_VLAN_CTRL_REG(port),
+                                  &data);
        if (err)
                return err;
 
-       *val = (data & bits[port]) >> bitoffset[port];
+       *val = (data >> RTL8366S_PORT_VLAN_CTRL_SHIFT(port)) &
+              RTL8366S_PORT_VLAN_CTRL_MASK;
 
        return 0;
 
@@ -790,9 +782,9 @@ static int rtl8366_get_port_vlan_index(struct rtl8366_smi *smi, int port,
 static int rtl8366_get_vlan_port_pvid(struct rtl8366_smi *smi, int port,
                                      int *val)
 {
+       struct rtl8366s_vlanconfig vlanmc;
        int err;
        int index;
-       struct rtl8366s_vlanconfig vlanmc;
 
        err = rtl8366_get_port_vlan_index(smi, port, &index);
        if (err)
@@ -809,41 +801,25 @@ static int rtl8366_get_vlan_port_pvid(struct rtl8366_smi *smi, int port,
 static int rtl8366_set_port_vlan_index(struct rtl8366_smi *smi, int port,
                                       int index)
 {
-       int err;
-       u32 addr;
        u32 data;
-       u32 vlan_data;
-       u32 bits;
-
-       /* bits mapping to port vlan control register of port n */
-       const u16 bitmasks[6] = { 0x000F, 0x00F0, 0x0F00,
-                                0xF000, 0x000F, 0x00F0 };
-       /* bits offset to port vlan control register of port n */
-       const u16 bitOff[6] = { 0, 4, 8, 12, 0, 4 };
-       /* address offset to port vlan control register of port n */
-       const u16 addrOff[6] = { 0, 0, 0, 0, 1, 1 };
+       int err;
 
        if (port >= RTL8366_NUM_PORTS || index >= RTL8366_NUM_VLANS)
                return -EINVAL;
 
-       addr = RTL8366S_PORT_VLAN_CTRL_BASE + addrOff[port];
-
-       bits = bitmasks[port];
-
-       data = (index << bitOff[port]) & bits;
-
-       err = rtl8366_smi_read_reg(smi, addr, &vlan_data);
+       err = rtl8366_smi_read_reg(smi, RTL8366S_PORT_VLAN_CTRL_REG(port),
+                                  &data);
        if (err)
                return err;
 
-       vlan_data &= ~(vlan_data & bits);
-       vlan_data |= data;
-
-       err = rtl8366_smi_write_reg(smi, addr, vlan_data);
-       if (err)
-               return err;
+       data &= ~(RTL8366S_PORT_VLAN_CTRL_MASK <<
+                 RTL8366S_PORT_VLAN_CTRL_SHIFT(port));
+       data |= (index & RTL8366S_PORT_VLAN_CTRL_MASK) <<
+                RTL8366S_PORT_VLAN_CTRL_SHIFT(port);
 
-       return 0;
+       err = rtl8366_smi_write_reg(smi, RTL8366S_PORT_VLAN_CTRL_REG(port),
+                                   data);
+       return err;
 }
 
 static int rtl8366_set_vlan_port_pvid(struct rtl8366_smi *smi, int port,
@@ -856,16 +832,16 @@ static int rtl8366_set_vlan_port_pvid(struct rtl8366_smi *smi, int port,
        if (port >= RTL8366_NUM_PORTS || val >= RTL8366_NUM_VIDS)
                return -EINVAL;
 
-
-
        /* Updating the 4K entry; lookup it and change the port member set */
        rtl8366s_get_vlan_4k_entry(smi, val, &vlan4k);
        vlan4k.member |= ((1 << port) | RTL8366_PORT_CPU);
        vlan4k.untag = RTL8366_PORT_ALL_BUT_CPU;
        rtl8366s_set_vlan_4k_entry(smi, &vlan4k);
 
-       /* For the 16 entries more work needs to be done. First see if such
-          VID is already there and change it */
+       /*
+        * For the 16 entries more work needs to be done. First see if such
+        * VID is already there and change it
+        */
        for (i = 0; i < RTL8366_NUM_VLANS; ++i) {
                rtl8366s_get_vlan_member_config(smi, i, &vlanmc);
 
@@ -881,13 +857,17 @@ static int rtl8366_set_vlan_port_pvid(struct rtl8366_smi *smi, int port,
                }
        }
 
-       /* PVID could not be found from vlan table. Replace unused (one that
-          has no member ports) with new one */
+       /*
+         * PVID could not be found from vlan table. Replace unused (one that
+        * has no member ports) with new one
+        */
        for (i = 0; i < RTL8366_NUM_VLANS; ++i) {
                rtl8366s_get_vlan_member_config(smi, i, &vlanmc);
 
-               /* See if this vlan member configuration is unused. It is
-                  unused if member set contains no ports or CPU port only */
+               /*
+                * See if this vlan member configuration is unused. It is
+                * unused if member set contains no ports or CPU port only
+                */
                if (!vlanmc.member || vlanmc.member == RTL8366_PORT_CPU) {
                        vlanmc.vid = val;
                        vlanmc.priority = 0;
@@ -904,8 +884,9 @@ static int rtl8366_set_vlan_port_pvid(struct rtl8366_smi *smi, int port,
                }
        }
 
-       dev_err(&smi->pdev->dev, "All 16 vlan member configurations are in "
-               "use\n");
+       dev_err(&smi->pdev->dev,
+               "All 16 vlan member configurations are in use\n");
+
        return -EINVAL;
 }
 
@@ -913,11 +894,13 @@ static int rtl8366_set_vlan_port_pvid(struct rtl8366_smi *smi, int port,
 static int rtl8366_vlan_set_vlan(struct rtl8366_smi *smi, int enable)
 {
        u32 data = 0;
+
        rtl8366_smi_read_reg(smi, RTL8366_CHIP_GLOBAL_CTRL_REG, &data);
 
-       data &= ~(data & RTL8366_CHIP_CTRL_VLAN);
        if (enable)
                data |= RTL8366_CHIP_CTRL_VLAN;
+       else
+               data &= ~RTL8366_CHIP_CTRL_VLAN;
 
        return rtl8366_smi_write_reg(smi, RTL8366_CHIP_GLOBAL_CTRL_REG, data);
 }
@@ -925,30 +908,34 @@ static int rtl8366_vlan_set_vlan(struct rtl8366_smi *smi, int enable)
 static int rtl8366_vlan_set_4ktable(struct rtl8366_smi *smi, int enable)
 {
        u32 data = 0;
+
        rtl8366_smi_read_reg(smi, RTL8366S_VLAN_TB_CTRL_REG, &data);
 
-       data &= ~(data & 1);
        if (enable)
                data |= 1;
+       else
+               data &= ~1;
 
        return rtl8366_smi_write_reg(smi, RTL8366S_VLAN_TB_CTRL_REG, data);
 }
 
 static int rtl8366s_reset_vlan(struct rtl8366_smi *smi)
 {
-       int i;
        struct rtl8366s_vlan4kentry vlan4k;
        struct rtl8366s_vlanconfig vlanmc;
+       int err;
+       int i;
 
        /* clear 16 VLAN member configuration */
+       vlanmc.vid = 0;
+       vlanmc.priority = 0;
+       vlanmc.member = 0;
+       vlanmc.untag = 0;
+       vlanmc.fid = 0;
        for (i = 0; i < RTL8366_NUM_VLANS; i++) {
-               vlanmc.vid = 0;
-               vlanmc.priority = 0;
-               vlanmc.member = 0;
-               vlanmc.untag = 0;
-               vlanmc.fid = 0;
-               if (rtl8366s_set_vlan_member_config(smi, i, &vlanmc) != 0)
-                       return -EIO;
+               err = rtl8366s_set_vlan_member_config(smi, i, &vlanmc);
+               if (err)
+                       return err;
        }
 
        /* Set a default VLAN with vid 1 to 4K table for all ports */
@@ -956,19 +943,21 @@ static int rtl8366s_reset_vlan(struct rtl8366_smi *smi)
        vlan4k.member = RTL8366_PORT_ALL;
        vlan4k.untag = RTL8366_PORT_ALL;
        vlan4k.fid = 0;
-       if (rtl8366s_set_vlan_4k_entry(smi, &vlan4k) != 0)
-               return -EIO;
+       err = rtl8366s_set_vlan_4k_entry(smi, &vlan4k);
+       if (err)
+               return err;
 
        /* Set all ports PVID to default VLAN */
        for (i = 0; i < RTL8366_NUM_PORTS; i++) {
-               if (rtl8366_set_vlan_port_pvid(smi, i, 0) != 0)
-                       return -EIO;
+               err = rtl8366_set_vlan_port_pvid(smi, i, 0);
+               if (err)
+                       return err;
        }
 
        return 0;
 }
 
-#ifdef DEBUG
+#ifdef CONFIG_RTL8366_SMI_DEBUG_FS
 static int rtl8366_debugfs_open(struct inode *inode, struct file *file)
 {
        file->private_data = inode->i_private;
@@ -979,8 +968,8 @@ static ssize_t rtl8366_read_debugfs_mibs(struct file *file,
                                         char __user *user_buf,
                                         size_t count, loff_t *ppos)
 {
-       int i, j, len = 0;
        struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
+       int i, j, len = 0;
        char *buf = smi->buf;
 
        len += snprintf(buf + len, sizeof(smi->buf) - len, "MIB Counters:\n");
@@ -990,17 +979,18 @@ static ssize_t rtl8366_read_debugfs_mibs(struct file *file,
                        "Port 4\n");
 
        for (i = 0; i < 33; ++i) {
-
                len += snprintf(buf + len, sizeof(smi->buf) - len, "%d:%s ",
                                i, MIBCOUNTERS[i]);
                for (j = 0; j < RTL8366_NUM_PORTS; ++j) {
                        unsigned long long counter = 0;
 
                        if (!rtl8366_get_mib_counter(smi, i, j, &counter))
-                               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               len += snprintf(buf + len,
+                                               sizeof(smi->buf) - len,
                                                "[%llu]", counter);
                        else
-                               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               len += snprintf(buf + len,
+                                               sizeof(smi->buf) - len,
                                                "[error]");
 
                        if (j != RTL8366_NUM_PORTS - 1) {
@@ -1009,7 +999,8 @@ static ssize_t rtl8366_read_debugfs_mibs(struct file *file,
                                                        sizeof(smi->buf) - len,
                                                        "\t");
 
-                               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               len += snprintf(buf + len,
+                                               sizeof(smi->buf) - len,
                                                "\t");
                        }
                }
@@ -1025,11 +1016,12 @@ static ssize_t rtl8366_read_debugfs_vlan(struct file *file,
                                         char __user *user_buf,
                                         size_t count, loff_t *ppos)
 {
-       int i, j, len = 0;
        struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
+       int i, j, len = 0;
        char *buf = smi->buf;
 
-       len += snprintf(buf + len, sizeof(smi->buf) - len, "VLAN Member Config:\n");
+       len += snprintf(buf + len, sizeof(smi->buf) - len,
+                       "VLAN Member Config:\n");
        len += snprintf(buf + len, sizeof(smi->buf) - len,
                        "\t id \t vid \t prio \t member \t untag  \t fid "
                        "\tports\n");
@@ -1063,9 +1055,9 @@ static ssize_t rtl8366_read_debugfs_reg(struct file *file,
                                        char __user *user_buf,
                                        size_t count, loff_t *ppos)
 {
+       struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
        u32 t, reg = g_dbg_reg;
        int err, len = 0;
-       struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
        char *buf = smi->buf;
 
        memset(buf, '\0', sizeof(smi->buf));
@@ -1087,11 +1079,11 @@ static ssize_t rtl8366_write_debugfs_reg(struct file *file,
                                         const char __user *user_buf,
                                         size_t count, loff_t *ppos)
 {
+       struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
        unsigned long data;
        u32 reg = g_dbg_reg;
        int err;
        size_t len;
-       struct rtl8366_smi *smi = (struct rtl8366_smi *)file->private_data;
        char *buf = smi->buf;
 
        len = min(count, sizeof(smi->buf) - 1);
@@ -1168,16 +1160,16 @@ static void rtl8366_debugfs_init(struct rtl8366_smi *smi)
        node = debugfs_create_file("vlan", S_IRUSR, root, smi,
                                   &fops_rtl8366_vlan);
        if (!node) {
-               dev_err(&smi->pdev->dev, "Creating debugfs file vlan "
-                       "failed\n");
+               dev_err(&smi->pdev->dev,
+                       "Creating debugfs file vlan failed\n");
                return;
        }
 
        node = debugfs_create_file("mibs", S_IRUSR, root, smi,
                                   &fops_rtl8366_mibs);
        if (!node) {
-               dev_err(&smi->pdev->dev, "Creating debugfs file mibs "
-                       "xfailed\n");
+               dev_err(&smi->pdev->dev,
+                       "Creating debugfs file mibs failed\n");
                return;
        }
 }
@@ -1193,14 +1185,14 @@ static void rtl8366_debugfs_remove(struct rtl8366_smi *smi)
 #else
 static inline void rtl8366_debugfs_init(struct rtl8366_smi *smi) {}
 static inline void rtl8366_debugfs_remove(struct rtl8366_smi *smi) {}
-#endif
+#endif /* CONFIG_RTL8366_SMI_DEBUG_FS */
 
 static int rtl8366_global_reset_mibs(struct switch_dev *dev,
                                     const struct switch_attr *attr,
                                     struct switch_val *val)
 {
-       u32 data = 0;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data = 0;
 
        if (val->value.i == 1) {
                rtl8366_smi_read_reg(smi, RTL8366S_MIB_CTRL_REG, &data);
@@ -1215,8 +1207,8 @@ static int rtl8366_get_vlan(struct switch_dev *dev,
                            const struct switch_attr *attr,
                            struct switch_val *val)
 {
-       u32 data;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data;
 
        if (attr->ofs == 1) {
                rtl8366_smi_read_reg(smi, RTL8366_CHIP_GLOBAL_CTRL_REG, &data);
@@ -1241,8 +1233,9 @@ static int rtl8366_global_get_blinkrate(struct switch_dev *dev,
                                        const struct switch_attr *attr,
                                        struct switch_val *val)
 {
-       u32 data;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data;
+
        rtl8366_smi_read_reg(smi, RTL8366_LED_BLINKRATE_REG, &data);
 
        val->value.i = (data & (RTL8366_LED_BLINKRATE_MASK));
@@ -1262,7 +1255,7 @@ static int rtl8366_global_set_blinkrate(struct switch_dev *dev,
 
        rtl8366_smi_read_reg(smi, RTL8366_LED_BLINKRATE_REG, &data);
 
-       data &= ~(data & RTL8366_LED_BLINKRATE_MASK);
+       data &= ~RTL8366_LED_BLINKRATE_MASK;
        data |= val->value.i;
 
        rtl8366_smi_write_reg(smi, RTL8366_LED_BLINKRATE_REG, data);
@@ -1320,23 +1313,31 @@ static int rtl8366_attr_get_port_link(struct switch_dev *dev,
                                "Link DOWN, Speed: ");
 
        if (speed == 0)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "10Base-TX ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "10Base-TX ");
        else if (speed == 1)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "100Base-TX ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "100Base-TX ");
        else if (speed == 2)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "1000Base-TX ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "1000Base-TX ");
 
        if (duplex)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "Full-Duplex, ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "Full-Duplex, ");
        else
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "Half-Duplex, ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "Half-Duplex, ");
 
        if (txpause)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "TX-Pause ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "TX-Pause ");
        if (rxpause)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "RX-Pause ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "RX-Pause ");
        if (nway)
-               len += snprintf(buf + len, sizeof(smi->buf) - len, "nway ");
+               len += snprintf(buf + len, sizeof(smi->buf) - len,
+                               "nway ");
 
        val->value.s = buf;
        val->len = len;
@@ -1355,7 +1356,7 @@ static int rtl8366_attr_get_vlan_info(struct switch_dev *dev,
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
        char *buf = smi->buf;
 
-       if (val->port_vlan >= RTL8366_NUM_PORTS)
+       if (val->port_vlan >= RTL8366_NUM_VLANS)
                return -EINVAL;
 
        memset(buf, '\0', sizeof(smi->buf));
@@ -1370,7 +1371,8 @@ static int rtl8366_attr_get_vlan_info(struct switch_dev *dev,
                int index = 0;
                if (!rtl8366_get_port_vlan_index(smi, i, &index) &&
                    index == val->port_vlan)
-                       len += snprintf(buf + len, sizeof(smi->buf) - len, "%d", i);
+                       len += snprintf(buf + len, sizeof(smi->buf) - len,
+                                       "%d", i);
        }
        len += snprintf(buf + len, sizeof(smi->buf) - len, "\n");
 
@@ -1396,8 +1398,9 @@ static int rtl8366_set_port_led(struct switch_dev *dev,
                                const struct switch_attr *attr,
                                struct switch_val *val)
 {
-       u32 data = 0;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data = 0;
+
        if (val->port_vlan >= RTL8366_NUM_PORTS ||
            (1 << val->port_vlan) == RTL8366_PORT_UNKNOWN)
                return -EINVAL;
@@ -1420,8 +1423,9 @@ static int rtl8366_get_port_led(struct switch_dev *dev,
                                const struct switch_attr *attr,
                                struct switch_val *val)
 {
-       u32 data = 0;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data = 0;
+
        if (val->port_vlan >= RTL8366_NUM_LEDGROUPS)
                return -EINVAL;
 
@@ -1435,8 +1439,9 @@ static int rtl8366_reset_port_mibs(struct switch_dev *dev,
                                   const struct switch_attr *attr,
                                   struct switch_val *val)
 {
-       u32 data = 0;
        struct rtl8366_smi *smi = sw_to_rtl8366(dev);
+       u32 data = 0;
+
        if (val->port_vlan >= RTL8366_NUM_PORTS)
                return -EINVAL;
 
@@ -1451,18 +1456,19 @@ static int rtl8366_get_port_mib(struct switch_dev *dev,
                                const struct switch_attr *attr,
                                struct switch_val *val)
 {
+       struct rtl8366_smi *smi = sw_to_rtl8366(dev);
        int i, len = 0;
        unsigned long long counter = 0;
-       struct rtl8366_smi *smi = sw_to_rtl8366(dev);
        char *buf = smi->buf;
 
        if (val->port_vlan >= RTL8366_NUM_PORTS)
                return -EINVAL;
 
-       len += snprintf(buf + len, sizeof(smi->buf) - len, "Port %d MIB counters\n",
+       len += snprintf(buf + len, sizeof(smi->buf) - len,
+                       "Port %d MIB counters\n",
                        val->port_vlan);
-       for (i = 0; i < RTL8366S_MIB_COUNT; ++i) {
 
+       for (i = 0; i < RTL8366S_MIB_COUNT; ++i) {
                len += snprintf(buf + len, sizeof(smi->buf) - len,
                                "%d:%s\t", i, MIBCOUNTERS[i]);
                if (!rtl8366_get_mib_counter(smi, i, val->port_vlan, &counter))
@@ -1498,7 +1504,8 @@ static int rtl8366_get_ports(struct switch_dev *dev,
                        continue;
 
                port->id = i;
-               port->flags = vlanmc.untag ? 0 : BIT(SWITCH_PORT_FLAG_TAGGED);
+               port->flags = (vlanmc.untag & BIT(i)) ?
+                                       0 : BIT(SWITCH_PORT_FLAG_TAGGED);
                val->len++;
                port++;
        }
@@ -1585,8 +1592,7 @@ static struct switch_attr rtl8366_globals[] = {
                .get = rtl8366_get_vlan,
                .max = 1,
                .ofs = 1
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_INT,
                .name = "enable_vlan4k",
                .description = "Enable VLAN 4K mode",
@@ -1594,16 +1600,14 @@ static struct switch_attr rtl8366_globals[] = {
                .get = rtl8366_get_vlan,
                .max = 1,
                .ofs = 2
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_INT,
                .name = "reset_mibs",
                .description = "Reset all MIB counters",
                .set = rtl8366_global_reset_mibs,
                .get = NULL,
                .max = 1
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_INT,
                .name = "blinkrate",
                .description = "Get/Set LED blinking rate (0 = 43ms, 1 = 84ms,"
@@ -1622,24 +1626,21 @@ static struct switch_attr rtl8366_port[] = {
                .max = 1,
                .set = NULL,
                .get = rtl8366_attr_get_port_link
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_INT,
                .name = "reset_mib",
                .description = "Reset single port MIB counters",
                .max = 1,
                .set = rtl8366_reset_port_mibs,
                .get = NULL
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_STRING,
                .name = "mib",
                .description = "Get MIB counters for port",
                .max = 33,
                .set = NULL,
                .get = rtl8366_get_port_mib
-       },
-       {
+       }, {
                .type = SWITCH_TYPE_INT,
                .name = "led",
                .description = "Get/Set port group (0 - 3) led mode (0 - 15)",
@@ -1893,7 +1894,7 @@ static int __init rtl8366_smi_probe(struct platform_device *pdev)
        return err;
 }
 
-int rtl8366_phy_config_init(struct phy_device *phydev)
+static int rtl8366_phy_config_init(struct phy_device *phydev)
 {
        if (!rtl8366_smi_mii_bus_match(phydev->bus))
                return -EINVAL;
@@ -1901,7 +1902,7 @@ int rtl8366_phy_config_init(struct phy_device *phydev)
        return 0;
 }
 
-int rtl8366_phy_config_aneg(struct phy_device *phydev)
+static int rtl8366_phy_config_aneg(struct phy_device *phydev)
 {
        return 0;
 }