240 lines
6.4 KiB
C
240 lines
6.4 KiB
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,
|
||
|
|
};
|