Quelle  global2_avb.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Marvell 88E6xxx Switch Global 2 Registers support
 *
 * Copyright (c) 2008 Marvell Semiconductor
 *
 * Copyright (c) 2016-2017 Savoir-faire Linux Inc.
 * Vivien Didelot <vivien.didelot@savoirfairelinux.com>
 *
 * Copyright (c) 2017 National Instruments
 * Brandon Streiff <brandon.streiff@ni.com>
 */

#include <linux/bitfield.h>

#include "global2.h"

/* Offset 0x16: AVB Command Register
 * Offset 0x17: AVB Data Register
 *
 * There are two different versions of this register interface:
 *    "6352": 3-bit "op" field, 4-bit "port" field.
 *    "6390": 2-bit "op" field, 5-bit "port" field.
 *
 * The "op" codes are different between the two, as well as the special
 * port fields for global PTP and TAI configuration.
 */

/* mv88e6xxx_g2_avb_read -- Read one or multiple 16-bit words.
 * The hardware supports snapshotting up to four contiguous registers.
 */
static int mv88e6xxx_g2_avb_wait(struct mv88e6xxx_chip *chip)
{
 int bit = __bf_shf(MV88E6352_G2_AVB_CMD_BUSY);

 return mv88e6xxx_g2_wait_bit(chip, MV88E6352_G2_AVB_CMD, bit, 0);
}

static int mv88e6xxx_g2_avb_read(struct mv88e6xxx_chip *chip, u16 readop,
     u16 *data, int len)
{
 int err;
 int i;

 err = mv88e6xxx_g2_avb_wait(chip);
 if (err)
  return err;

 /* Hardware can only snapshot four words. */
 if (len > 4)
  return -E2BIG;

 err = mv88e6xxx_g2_write(chip, MV88E6352_G2_AVB_CMD,
     MV88E6352_G2_AVB_CMD_BUSY | readop);
 if (err)
  return err;

 err = mv88e6xxx_g2_avb_wait(chip);
 if (err)
  return err;

 for (i = 0; i < len; ++i) {
  err = mv88e6xxx_g2_read(chip, MV88E6352_G2_AVB_DATA,
     &data[i]);
  if (err)
   return err;
 }

 return 0;
}

/* mv88e6xxx_g2_avb_write -- Write one 16-bit word. */
static int mv88e6xxx_g2_avb_write(struct mv88e6xxx_chip *chip, u16 writeop,
      u16 data)
{
 int err;

 err = mv88e6xxx_g2_avb_wait(chip);
 if (err)
  return err;

 err = mv88e6xxx_g2_write(chip, MV88E6352_G2_AVB_DATA, data);
 if (err)
  return err;

 err = mv88e6xxx_g2_write(chip, MV88E6352_G2_AVB_CMD,
     MV88E6352_G2_AVB_CMD_BUSY | writeop);

 return mv88e6xxx_g2_avb_wait(chip);
}

static int mv88e6352_g2_avb_port_ptp_read(struct mv88e6xxx_chip *chip,
       int port, int addr, u16 *data,
       int len)
{
 u16 readop = (len == 1 ? MV88E6352_G2_AVB_CMD_OP_READ :
     MV88E6352_G2_AVB_CMD_OP_READ_INCR) |
       (port << 8) | (MV88E6352_G2_AVB_CMD_BLOCK_PTP << 5) |
       addr;

 return mv88e6xxx_g2_avb_read(chip, readop, data, len);
}

static int mv88e6352_g2_avb_port_ptp_write(struct mv88e6xxx_chip *chip,
        int port, int addr, u16 data)
{
 u16 writeop = MV88E6352_G2_AVB_CMD_OP_WRITE | (port << 8) |
        (MV88E6352_G2_AVB_CMD_BLOCK_PTP << 5) | addr;

 return mv88e6xxx_g2_avb_write(chip, writeop, data);
}

static int mv88e6352_g2_avb_ptp_read(struct mv88e6xxx_chip *chip, int addr,
         u16 *data, int len)
{
 return mv88e6352_g2_avb_port_ptp_read(chip,
     MV88E6352_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data, len);
}

static int mv88e6352_g2_avb_ptp_write(struct mv88e6xxx_chip *chip, int addr,
          u16 data)
{
 return mv88e6352_g2_avb_port_ptp_write(chip,
     MV88E6352_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data);
}

static int mv88e6352_g2_avb_tai_read(struct mv88e6xxx_chip *chip, int addr,
         u16 *data, int len)
{
 return mv88e6352_g2_avb_port_ptp_read(chip,
     MV88E6352_G2_AVB_CMD_PORT_TAIGLOBAL,
     addr, data, len);
}

static int mv88e6352_g2_avb_tai_write(struct mv88e6xxx_chip *chip, int addr,
          u16 data)
{
 return mv88e6352_g2_avb_port_ptp_write(chip,
     MV88E6352_G2_AVB_CMD_PORT_TAIGLOBAL,
     addr, data);
}

const struct mv88e6xxx_avb_ops mv88e6352_avb_ops = {
 .port_ptp_read  = mv88e6352_g2_avb_port_ptp_read,
 .port_ptp_write  = mv88e6352_g2_avb_port_ptp_write,
 .ptp_read  = mv88e6352_g2_avb_ptp_read,
 .ptp_write  = mv88e6352_g2_avb_ptp_write,
 .tai_read  = mv88e6352_g2_avb_tai_read,
 .tai_write  = mv88e6352_g2_avb_tai_write,
};

static int mv88e6165_g2_avb_tai_read(struct mv88e6xxx_chip *chip, int addr,
         u16 *data, int len)
{
 return mv88e6352_g2_avb_port_ptp_read(chip,
     MV88E6165_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data, len);
}

static int mv88e6165_g2_avb_tai_write(struct mv88e6xxx_chip *chip, int addr,
          u16 data)
{
 return mv88e6352_g2_avb_port_ptp_write(chip,
     MV88E6165_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data);
}

const struct mv88e6xxx_avb_ops mv88e6165_avb_ops = {
 .port_ptp_read  = mv88e6352_g2_avb_port_ptp_read,
 .port_ptp_write  = mv88e6352_g2_avb_port_ptp_write,
 .ptp_read  = mv88e6352_g2_avb_ptp_read,
 .ptp_write  = mv88e6352_g2_avb_ptp_write,
 .tai_read  = mv88e6165_g2_avb_tai_read,
 .tai_write  = mv88e6165_g2_avb_tai_write,
};

static int mv88e6390_g2_avb_port_ptp_read(struct mv88e6xxx_chip *chip,
       int port, int addr, u16 *data,
       int len)
{
 u16 readop = (len == 1 ? MV88E6390_G2_AVB_CMD_OP_READ :
     MV88E6390_G2_AVB_CMD_OP_READ_INCR) |
       (port << 8) | (MV88E6352_G2_AVB_CMD_BLOCK_PTP << 5) |
       addr;

 return mv88e6xxx_g2_avb_read(chip, readop, data, len);
}

static int mv88e6390_g2_avb_port_ptp_write(struct mv88e6xxx_chip *chip,
        int port, int addr, u16 data)
{
 u16 writeop = MV88E6390_G2_AVB_CMD_OP_WRITE | (port << 8) |
        (MV88E6352_G2_AVB_CMD_BLOCK_PTP << 5) | addr;

 return mv88e6xxx_g2_avb_write(chip, writeop, data);
}

static int mv88e6390_g2_avb_ptp_read(struct mv88e6xxx_chip *chip, int addr,
         u16 *data, int len)
{
 return mv88e6390_g2_avb_port_ptp_read(chip,
     MV88E6390_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data, len);
}

static int mv88e6390_g2_avb_ptp_write(struct mv88e6xxx_chip *chip, int addr,
          u16 data)
{
 return mv88e6390_g2_avb_port_ptp_write(chip,
     MV88E6390_G2_AVB_CMD_PORT_PTPGLOBAL,
     addr, data);
}

static int mv88e6390_g2_avb_tai_read(struct mv88e6xxx_chip *chip, int addr,
         u16 *data, int len)
{
 return mv88e6390_g2_avb_port_ptp_read(chip,
     MV88E6390_G2_AVB_CMD_PORT_TAIGLOBAL,
     addr, data, len);
}

static int mv88e6390_g2_avb_tai_write(struct mv88e6xxx_chip *chip, int addr,
          u16 data)
{
 return mv88e6390_g2_avb_port_ptp_write(chip,
     MV88E6390_G2_AVB_CMD_PORT_TAIGLOBAL,
     addr, data);
}

const struct mv88e6xxx_avb_ops mv88e6390_avb_ops = {
 .port_ptp_read  = mv88e6390_g2_avb_port_ptp_read,
 .port_ptp_write  = mv88e6390_g2_avb_port_ptp_write,
 .ptp_read  = mv88e6390_g2_avb_ptp_read,
 .ptp_write  = mv88e6390_g2_avb_ptp_write,
 .tai_read  = mv88e6390_g2_avb_tai_read,
 .tai_write  = mv88e6390_g2_avb_tai_write,
};