| /* |
| * Marvell 88E6xxx Switch Global 2 Scratch & Misc Registers support |
| * |
| * Copyright (c) 2008 Marvell Semiconductor |
| * |
| * Copyright (c) 2017 National Instruments |
| * Brandon Streiff <brandon.streiff@ni.com> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| */ |
| |
| #include "chip.h" |
| #include "global2.h" |
| |
| /* Offset 0x1A: Scratch and Misc. Register */ |
| static int mv88e6xxx_g2_scratch_read(struct mv88e6xxx_chip *chip, int reg, |
| u8 *data) |
| { |
| u16 value; |
| int err; |
| |
| err = mv88e6xxx_g2_write(chip, MV88E6XXX_G2_SCRATCH_MISC_MISC, |
| reg << 8); |
| if (err) |
| return err; |
| |
| err = mv88e6xxx_g2_read(chip, MV88E6XXX_G2_SCRATCH_MISC_MISC, &value); |
| if (err) |
| return err; |
| |
| *data = (value & MV88E6XXX_G2_SCRATCH_MISC_DATA_MASK); |
| |
| return 0; |
| } |
| |
| static int mv88e6xxx_g2_scratch_write(struct mv88e6xxx_chip *chip, int reg, |
| u8 data) |
| { |
| u16 value = (reg << 8) | data; |
| |
| return mv88e6xxx_g2_update(chip, MV88E6XXX_G2_SCRATCH_MISC_MISC, value); |
| } |
| |
| /** |
| * mv88e6xxx_g2_scratch_gpio_get_bit - get a bit |
| * @chip: chip private data |
| * @nr: bit index |
| * @set: is bit set? |
| */ |
| static int mv88e6xxx_g2_scratch_get_bit(struct mv88e6xxx_chip *chip, |
| int base_reg, unsigned int offset, |
| int *set) |
| { |
| int reg = base_reg + (offset / 8); |
| u8 mask = (1 << (offset & 0x7)); |
| u8 val; |
| int err; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, reg, &val); |
| if (err) |
| return err; |
| |
| *set = !!(mask & val); |
| |
| return 0; |
| } |
| |
| /** |
| * mv88e6xxx_g2_scratch_gpio_set_bit - set (or clear) a bit |
| * @chip: chip private data |
| * @nr: bit index |
| * @set: set if true, clear if false |
| * |
| * Helper function for dealing with the direction and data registers. |
| */ |
| static int mv88e6xxx_g2_scratch_set_bit(struct mv88e6xxx_chip *chip, |
| int base_reg, unsigned int offset, |
| int set) |
| { |
| int reg = base_reg + (offset / 8); |
| u8 mask = (1 << (offset & 0x7)); |
| u8 val; |
| int err; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, reg, &val); |
| if (err) |
| return err; |
| |
| if (set) |
| val |= mask; |
| else |
| val &= ~mask; |
| |
| return mv88e6xxx_g2_scratch_write(chip, reg, val); |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_get_data - get data on gpio pin |
| * @chip: chip private data |
| * @pin: gpio index |
| * |
| * Return: 0 for low, 1 for high, negative error |
| */ |
| static int mv88e6352_g2_scratch_gpio_get_data(struct mv88e6xxx_chip *chip, |
| unsigned int pin) |
| { |
| int val = 0; |
| int err; |
| |
| err = mv88e6xxx_g2_scratch_get_bit(chip, |
| MV88E6352_G2_SCRATCH_GPIO_DATA0, |
| pin, &val); |
| if (err) |
| return err; |
| |
| return val; |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_set_data - set data on gpio pin |
| * @chip: chip private data |
| * @pin: gpio index |
| * @value: value to set |
| */ |
| static int mv88e6352_g2_scratch_gpio_set_data(struct mv88e6xxx_chip *chip, |
| unsigned int pin, int value) |
| { |
| u8 mask = (1 << (pin & 0x7)); |
| int offset = (pin / 8); |
| int reg; |
| |
| reg = MV88E6352_G2_SCRATCH_GPIO_DATA0 + offset; |
| |
| if (value) |
| chip->gpio_data[offset] |= mask; |
| else |
| chip->gpio_data[offset] &= ~mask; |
| |
| return mv88e6xxx_g2_scratch_write(chip, reg, chip->gpio_data[offset]); |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_get_dir - get direction of gpio pin |
| * @chip: chip private data |
| * @pin: gpio index |
| * |
| * Return: 0 for output, 1 for input (same as GPIOF_DIR_XXX). |
| */ |
| static int mv88e6352_g2_scratch_gpio_get_dir(struct mv88e6xxx_chip *chip, |
| unsigned int pin) |
| { |
| int val = 0; |
| int err; |
| |
| err = mv88e6xxx_g2_scratch_get_bit(chip, |
| MV88E6352_G2_SCRATCH_GPIO_DIR0, |
| pin, &val); |
| if (err) |
| return err; |
| |
| return val; |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_set_dir - set direction of gpio pin |
| * @chip: chip private data |
| * @pin: gpio index |
| */ |
| static int mv88e6352_g2_scratch_gpio_set_dir(struct mv88e6xxx_chip *chip, |
| unsigned int pin, bool input) |
| { |
| int value = (input ? MV88E6352_G2_SCRATCH_GPIO_DIR_IN : |
| MV88E6352_G2_SCRATCH_GPIO_DIR_OUT); |
| |
| return mv88e6xxx_g2_scratch_set_bit(chip, |
| MV88E6352_G2_SCRATCH_GPIO_DIR0, |
| pin, value); |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_get_pctl - get pin control setting |
| * @chip: chip private data |
| * @pin: gpio index |
| * @func: function number |
| * |
| * Note that the function numbers themselves may vary by chipset. |
| */ |
| static int mv88e6352_g2_scratch_gpio_get_pctl(struct mv88e6xxx_chip *chip, |
| unsigned int pin, int *func) |
| { |
| int reg = MV88E6352_G2_SCRATCH_GPIO_PCTL0 + (pin / 2); |
| int offset = (pin & 0x1) ? 4 : 0; |
| u8 mask = (0x7 << offset); |
| int err; |
| u8 val; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, reg, &val); |
| if (err) |
| return err; |
| |
| *func = (val & mask) >> offset; |
| |
| return 0; |
| } |
| |
| /** |
| * mv88e6352_g2_scratch_gpio_set_pctl - set pin control setting |
| * @chip: chip private data |
| * @pin: gpio index |
| * @func: function number |
| */ |
| static int mv88e6352_g2_scratch_gpio_set_pctl(struct mv88e6xxx_chip *chip, |
| unsigned int pin, int func) |
| { |
| int reg = MV88E6352_G2_SCRATCH_GPIO_PCTL0 + (pin / 2); |
| int offset = (pin & 0x1) ? 4 : 0; |
| u8 mask = (0x7 << offset); |
| int err; |
| u8 val; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, reg, &val); |
| if (err) |
| return err; |
| |
| val = (val & ~mask) | ((func & mask) << offset); |
| |
| return mv88e6xxx_g2_scratch_write(chip, reg, val); |
| } |
| |
| const struct mv88e6xxx_gpio_ops mv88e6352_gpio_ops = { |
| .get_data = mv88e6352_g2_scratch_gpio_get_data, |
| .set_data = mv88e6352_g2_scratch_gpio_set_data, |
| .get_dir = mv88e6352_g2_scratch_gpio_get_dir, |
| .set_dir = mv88e6352_g2_scratch_gpio_set_dir, |
| .get_pctl = mv88e6352_g2_scratch_gpio_get_pctl, |
| .set_pctl = mv88e6352_g2_scratch_gpio_set_pctl, |
| }; |
| |
| /** |
| * mv88e6xxx_g2_gpio_set_smi - set gpio muxing for external smi |
| * @chip: chip private data |
| * @external: set mux for external smi, or free for gpio usage |
| * |
| * Some mv88e6xxx models have GPIO pins that may be configured as |
| * an external SMI interface, or they may be made free for other |
| * GPIO uses. |
| */ |
| int mv88e6xxx_g2_scratch_gpio_set_smi(struct mv88e6xxx_chip *chip, |
| bool external) |
| { |
| int misc_cfg = MV88E6352_G2_SCRATCH_MISC_CFG; |
| int config_data1 = MV88E6352_G2_SCRATCH_CONFIG_DATA1; |
| int config_data2 = MV88E6352_G2_SCRATCH_CONFIG_DATA2; |
| bool no_cpu; |
| u8 p0_mode; |
| int err; |
| u8 val; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, config_data2, &val); |
| if (err) |
| return err; |
| |
| p0_mode = val & MV88E6352_G2_SCRATCH_CONFIG_DATA2_P0_MODE_MASK; |
| |
| if (p0_mode == 0x01 || p0_mode == 0x02) |
| return -EBUSY; |
| |
| err = mv88e6xxx_g2_scratch_read(chip, config_data1, &val); |
| if (err) |
| return err; |
| |
| no_cpu = !!(val & MV88E6352_G2_SCRATCH_CONFIG_DATA1_NO_CPU); |
| |
| err = mv88e6xxx_g2_scratch_read(chip, misc_cfg, &val); |
| if (err) |
| return err; |
| |
| /* NO_CPU being 0 inverts the meaning of the bit */ |
| if (!no_cpu) |
| external = !external; |
| |
| if (external) |
| val |= MV88E6352_G2_SCRATCH_MISC_CFG_NORMALSMI; |
| else |
| val &= ~MV88E6352_G2_SCRATCH_MISC_CFG_NORMALSMI; |
| |
| return mv88e6xxx_g2_scratch_write(chip, misc_cfg, val); |
| } |
