On Fri, Feb 18, 2022 at 04:51:47PM +0100, Hans Schultz wrote:
> diff --git a/drivers/net/dsa/mv88e6xxx/port.c 
> b/drivers/net/dsa/mv88e6xxx/port.c
> index ab41619a809b..46b7381899a0 100644
> --- a/drivers/net/dsa/mv88e6xxx/port.c
> +++ b/drivers/net/dsa/mv88e6xxx/port.c
> @@ -1234,6 +1234,39 @@ int mv88e6xxx_port_set_mirror(struct mv88e6xxx_chip 
> *chip, int port,
>       return err;
>  }
>  
> +int mv88e6xxx_port_set_lock(struct mv88e6xxx_chip *chip, int port,
> +                         bool locked)
> +{
> +     u16 reg;
> +     int err;
> +
> +     err = mv88e6xxx_port_read(chip, port, MV88E6XXX_PORT_CTL0, &reg);
> +     if (err)
> +             return err;
> +
> +     reg &= ~MV88E6XXX_PORT_CTL0_SA_FILT_MASK;
> +     if (locked)
> +             reg |= MV88E6XXX_PORT_CTL0_SA_FILT_DROP_ON_LOCK;
> +
> +     err = mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_CTL0, reg);
> +     if (err)
> +             return err;
> +
> +     err = mv88e6xxx_port_read(chip, port, MV88E6XXX_PORT_ASSOC_VECTOR, 
> &reg);
> +     if (err)
> +             return err;
> +
> +     reg &= ~MV88E6XXX_PORT_ASSOC_VECTOR_LOCKED_PORT;
> +     if (locked)
> +             reg |= MV88E6XXX_PORT_ASSOC_VECTOR_LOCKED_PORT;
> +
> +     err = mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_ASSOC_VECTOR, 
> reg);

        return mv88e6xxx_port_write(...);

> +     if (err)
> +             return err;
> +
> +     return 0;
> +}

Reply via email to