goto restore_link;
        }
 
-       if (chip->info->ops->port_set_cmode_writable) {
-               err = chip->info->ops->port_set_cmode_writable(chip, port);
-               if (err && err != -EOPNOTSUPP)
-                       goto restore_link;
-       }
-
        if (chip->info->ops->port_set_cmode) {
                err = chip->info->ops->port_set_cmode(chip, port, mode);
                if (err && err != -EOPNOTSUPP)
        .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
        .port_link_state = mv88e6352_port_link_state,
        .port_get_cmode = mv88e6352_port_get_cmode,
-       .port_set_cmode_writable = mv88e6341_port_set_cmode_writable,
        .port_set_cmode = mv88e6341_port_set_cmode,
        .port_setup_message_port = mv88e6xxx_setup_message_port,
        .stats_snapshot = mv88e6390_g1_stats_snapshot,
        .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
        .port_link_state = mv88e6352_port_link_state,
        .port_get_cmode = mv88e6352_port_get_cmode,
-       .port_set_cmode_writable = mv88e6341_port_set_cmode_writable,
        .port_set_cmode = mv88e6341_port_set_cmode,
        .port_setup_message_port = mv88e6xxx_setup_message_port,
        .stats_snapshot = mv88e6390_g1_stats_snapshot,
 
        /* CMODE control what PHY mode the MAC will use, eg. SGMII, RGMII, etc.
         * Some chips allow this to be configured on specific ports.
         */
-       int (*port_set_cmode_writable)(struct mv88e6xxx_chip *chip, int port);
        int (*port_set_cmode)(struct mv88e6xxx_chip *chip, int port,
                              phy_interface_t mode);
        int (*port_get_cmode)(struct mv88e6xxx_chip *chip, int port, u8 *cmode);
 
        return mv88e6xxx_port_set_cmode(chip, port, mode);
 }
 
-int mv88e6341_port_set_cmode_writable(struct mv88e6xxx_chip *chip, int port)
+static int mv88e6341_port_set_cmode_writable(struct mv88e6xxx_chip *chip,
+                                            int port)
 {
        int err, addr;
        u16 reg, bits;
 int mv88e6341_port_set_cmode(struct mv88e6xxx_chip *chip, int port,
                             phy_interface_t mode)
 {
+       int err;
+
        if (port != 5)
                return -EOPNOTSUPP;
 
                break;
        }
 
+       err = mv88e6341_port_set_cmode_writable(chip, port);
+       if (err)
+               return err;
+
        return mv88e6xxx_port_set_cmode(chip, port, mode);
 }
 
 
                               u8 out);
 int mv88e6390_port_pause_limit(struct mv88e6xxx_chip *chip, int port, u8 in,
                               u8 out);
-int mv88e6341_port_set_cmode_writable(struct mv88e6xxx_chip *chip, int port);
 int mv88e6341_port_set_cmode(struct mv88e6xxx_chip *chip, int port,
                             phy_interface_t mode);
 int mv88e6390_port_set_cmode(struct mv88e6xxx_chip *chip, int port,