| // SPDX-License-Identifier: BSD-3-Clause |
| /* |
| * Qualcomm SPMI bus driver |
| * |
| * (C) Copyright 2015 Mateusz Kulikowski <mateusz.kulikowski@gmail.com> |
| * |
| * Loosely based on Little Kernel driver |
| */ |
| |
| #include <dm.h> |
| #include <errno.h> |
| #include <fdtdec.h> |
| #include <asm/global_data.h> |
| #include <asm/io.h> |
| #include <dm/device_compat.h> |
| #include <spmi/spmi.h> |
| |
| DECLARE_GLOBAL_DATA_PTR; |
| |
| /* PMIC Arbiter configuration registers */ |
| #define PMIC_ARB_VERSION 0x0000 |
| #define PMIC_ARB_VERSION_V2_MIN 0x20010000 |
| #define PMIC_ARB_VERSION_V3_MIN 0x30000000 |
| #define PMIC_ARB_VERSION_V5_MIN 0x50000000 |
| #define PMIC_ARB_VERSION_V7_MIN 0x70000000 |
| |
| #define APID_MAP_OFFSET_V1_V2_V3 (0x800) |
| #define APID_MAP_OFFSET_V5 (0x900) |
| #define APID_MAP_OFFSET_V7 (0x2000) |
| #define ARB_CHANNEL_OFFSET(n) (0x4 * (n)) |
| #define SPMI_CH_OFFSET(chnl) ((chnl) * 0x8000) |
| #define SPMI_V5_OBS_CH_OFFSET(chnl) ((chnl) * 0x80) |
| #define SPMI_V7_OBS_CH_OFFSET(chnl) ((chnl) * 0x20) |
| #define SPMI_V5_RW_CH_OFFSET(chnl) ((chnl) * 0x10000) |
| #define SPMI_V7_RW_CH_OFFSET(chnl) ((chnl) * 0x1000) |
| |
| #define SPMI_OWNERSHIP_PERIPH2OWNER(x) ((x) & 0x7) |
| |
| #define SPMI_REG_CMD0 0x0 |
| #define SPMI_REG_CONFIG 0x4 |
| #define SPMI_REG_STATUS 0x8 |
| #define SPMI_REG_WDATA 0x10 |
| #define SPMI_REG_RDATA 0x18 |
| |
| #define SPMI_CMD_OPCODE_SHIFT 27 |
| #define SPMI_CMD_SLAVE_ID_SHIFT 20 |
| #define SPMI_CMD_ADDR_SHIFT 12 |
| #define SPMI_CMD_ADDR_OFFSET_SHIFT 4 |
| #define SPMI_CMD_BYTE_CNT_SHIFT 0 |
| |
| #define SPMI_CMD_EXT_REG_WRITE_LONG 0x00 |
| #define SPMI_CMD_EXT_REG_READ_LONG 0x01 |
| |
| #define SPMI_STATUS_DONE 0x1 |
| |
| #define SPMI_MAX_CHANNELS 128 |
| #define SPMI_MAX_CHANNELS_V5 512 |
| #define SPMI_MAX_CHANNELS_V7 1024 |
| #define SPMI_MAX_SLAVES 16 |
| #define SPMI_MAX_PERIPH 256 |
| |
| #define SPMI_CHANNEL_READ_ONLY BIT(31) |
| #define SPMI_CHANNEL_MASK 0xffff |
| |
| enum arb_ver { |
| V1 = 1, |
| V2, |
| V3, |
| V5 = 5, |
| V7 = 7 |
| }; |
| |
| /* |
| * PMIC arbiter version 5 uses different register offsets for read/write vs |
| * observer channels. |
| */ |
| enum pmic_arb_channel { |
| PMIC_ARB_CHANNEL_RW, |
| PMIC_ARB_CHANNEL_OBS, |
| }; |
| |
| struct msm_spmi_priv { |
| phys_addr_t arb_chnl; /* ARB channel mapping base */ |
| phys_addr_t spmi_chnls; /* SPMI channels */ |
| phys_addr_t spmi_obs; /* SPMI observer */ |
| phys_addr_t spmi_cnfg; /* SPMI config */ |
| u32 owner; /* Current owner */ |
| unsigned int max_channels; /* Max channels */ |
| /* SPMI channel map */ |
| uint32_t channel_map[SPMI_MAX_SLAVES][SPMI_MAX_PERIPH]; |
| /* SPMI bus arbiter version */ |
| u32 arb_ver; |
| }; |
| |
| static u32 pmic_arb_fmt_cmd_v1(u8 opc, u8 sid, u8 pid, u8 off) |
| { |
| return (opc << 27) | (sid << 20) | (pid << 12) | (off << 4) | 1; |
| } |
| |
| static u32 pmic_arb_fmt_cmd_v2(u8 opc, u8 off) |
| { |
| return (opc << 27) | (off << 4) | 1; |
| } |
| |
| static int msm_spmi_write(struct udevice *dev, int usid, int pid, int off, |
| uint8_t val) |
| { |
| struct msm_spmi_priv *priv = dev_get_priv(dev); |
| unsigned channel; |
| unsigned int ch_offset; |
| uint32_t reg = 0; |
| |
| if (usid >= SPMI_MAX_SLAVES) |
| return -EIO; |
| if (pid >= SPMI_MAX_PERIPH) |
| return -EIO; |
| if (priv->channel_map[usid][pid] & SPMI_CHANNEL_READ_ONLY) |
| return -EPERM; |
| |
| channel = priv->channel_map[usid][pid] & SPMI_CHANNEL_MASK; |
| |
| dev_dbg(dev, "[%d:%d] %s: channel %d\n", usid, pid, __func__, channel); |
| |
| switch (priv->arb_ver) { |
| case V1: |
| ch_offset = SPMI_CH_OFFSET(channel); |
| |
| reg = pmic_arb_fmt_cmd_v1(SPMI_CMD_EXT_REG_WRITE_LONG, |
| usid, pid, off); |
| break; |
| |
| case V2: |
| ch_offset = SPMI_CH_OFFSET(channel); |
| |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_WRITE_LONG, off); |
| break; |
| |
| case V5: |
| ch_offset = SPMI_V5_RW_CH_OFFSET(channel); |
| |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_WRITE_LONG, off); |
| break; |
| |
| case V7: |
| ch_offset = SPMI_V7_RW_CH_OFFSET(channel); |
| |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_WRITE_LONG, off); |
| break; |
| } |
| |
| /* Disable IRQ mode for the current channel*/ |
| writel(0x0, priv->spmi_chnls + ch_offset + SPMI_REG_CONFIG); |
| |
| /* Write single byte */ |
| writel(val, priv->spmi_chnls + ch_offset + SPMI_REG_WDATA); |
| |
| /* Send write command */ |
| writel(reg, priv->spmi_chnls + ch_offset + SPMI_REG_CMD0); |
| |
| /* Wait till CMD DONE status */ |
| reg = 0; |
| while (!reg) { |
| reg = readl(priv->spmi_chnls + ch_offset + |
| SPMI_REG_STATUS); |
| } |
| |
| if (reg ^ SPMI_STATUS_DONE) { |
| printf("SPMI write failure.\n"); |
| return -EIO; |
| } |
| |
| return 0; |
| } |
| |
| static int msm_spmi_read(struct udevice *dev, int usid, int pid, int off) |
| { |
| struct msm_spmi_priv *priv = dev_get_priv(dev); |
| unsigned channel; |
| unsigned int ch_offset; |
| uint32_t reg = 0; |
| |
| if (usid >= SPMI_MAX_SLAVES) |
| return -EIO; |
| if (pid >= SPMI_MAX_PERIPH) |
| return -EIO; |
| |
| channel = priv->channel_map[usid][pid] & SPMI_CHANNEL_MASK; |
| |
| dev_dbg(dev, "[%d:%d] %s: channel %d\n", usid, pid, __func__, channel); |
| |
| switch (priv->arb_ver) { |
| case V1: |
| ch_offset = SPMI_CH_OFFSET(channel); |
| |
| /* Prepare read command */ |
| reg = pmic_arb_fmt_cmd_v1(SPMI_CMD_EXT_REG_READ_LONG, |
| usid, pid, off); |
| break; |
| |
| case V2: |
| ch_offset = SPMI_CH_OFFSET(channel); |
| |
| /* Prepare read command */ |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_READ_LONG, off); |
| break; |
| |
| case V5: |
| ch_offset = SPMI_V5_OBS_CH_OFFSET(channel); |
| |
| /* Prepare read command */ |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_READ_LONG, off); |
| break; |
| |
| case V7: |
| ch_offset = SPMI_V7_OBS_CH_OFFSET(channel); |
| |
| /* Prepare read command */ |
| reg = pmic_arb_fmt_cmd_v2(SPMI_CMD_EXT_REG_READ_LONG, off); |
| break; |
| } |
| |
| /* Disable IRQ mode for the current channel*/ |
| writel(0x0, priv->spmi_obs + ch_offset + SPMI_REG_CONFIG); |
| |
| /* Request read */ |
| writel(reg, priv->spmi_obs + ch_offset + SPMI_REG_CMD0); |
| |
| /* Wait till CMD DONE status */ |
| reg = 0; |
| while (!reg) { |
| reg = readl(priv->spmi_obs + ch_offset + SPMI_REG_STATUS); |
| } |
| |
| if (reg ^ SPMI_STATUS_DONE) { |
| printf("SPMI read failure.\n"); |
| return -EIO; |
| } |
| |
| /* Read the data */ |
| return readl(priv->spmi_obs + ch_offset + |
| SPMI_REG_RDATA) & 0xFF; |
| } |
| |
| static struct dm_spmi_ops msm_spmi_ops = { |
| .read = msm_spmi_read, |
| .write = msm_spmi_write, |
| }; |
| |
| static int msm_spmi_probe(struct udevice *dev) |
| { |
| struct msm_spmi_priv *priv = dev_get_priv(dev); |
| phys_addr_t core_addr; |
| u32 hw_ver; |
| int i; |
| |
| core_addr = dev_read_addr_name(dev, "core"); |
| priv->spmi_chnls = dev_read_addr_name(dev, "chnls"); |
| priv->spmi_obs = dev_read_addr_name(dev, "obsrvr"); |
| dev_read_u32(dev, "qcom,ee", &priv->owner); |
| |
| hw_ver = readl(core_addr + PMIC_ARB_VERSION); |
| |
| if (hw_ver < PMIC_ARB_VERSION_V3_MIN) { |
| priv->arb_ver = V2; |
| priv->arb_chnl = core_addr + APID_MAP_OFFSET_V1_V2_V3; |
| priv->max_channels = SPMI_MAX_CHANNELS; |
| } else if (hw_ver < PMIC_ARB_VERSION_V5_MIN) { |
| priv->arb_ver = V3; |
| priv->arb_chnl = core_addr + APID_MAP_OFFSET_V1_V2_V3; |
| priv->max_channels = SPMI_MAX_CHANNELS; |
| } else if (hw_ver < PMIC_ARB_VERSION_V7_MIN) { |
| priv->arb_ver = V5; |
| priv->arb_chnl = core_addr + APID_MAP_OFFSET_V5; |
| priv->max_channels = SPMI_MAX_CHANNELS; |
| priv->spmi_cnfg = dev_read_addr_name(dev, "cnfg"); |
| } else { |
| /* TOFIX: handle second bus */ |
| priv->arb_ver = V7; |
| priv->arb_chnl = core_addr + APID_MAP_OFFSET_V7; |
| priv->max_channels = SPMI_MAX_CHANNELS_V7; |
| priv->spmi_cnfg = dev_read_addr_name(dev, "cnfg"); |
| } |
| |
| dev_dbg(dev, "PMIC Arb Version-%d (%#x)\n", hw_ver >> 28, hw_ver); |
| |
| if (priv->arb_chnl == FDT_ADDR_T_NONE || |
| priv->spmi_chnls == FDT_ADDR_T_NONE || |
| priv->spmi_obs == FDT_ADDR_T_NONE) |
| return -EINVAL; |
| |
| dev_dbg(dev, "priv->arb_chnl address (%#08llx)\n", priv->arb_chnl); |
| dev_dbg(dev, "priv->spmi_chnls address (%#08llx)\n", priv->spmi_chnls); |
| dev_dbg(dev, "priv->spmi_obs address (%#08llx)\n", priv->spmi_obs); |
| /* Scan peripherals connected to each SPMI channel */ |
| for (i = 0; i < priv->max_channels; i++) { |
| uint32_t periph = readl(priv->arb_chnl + ARB_CHANNEL_OFFSET(i)); |
| uint8_t slave_id = (periph & 0xf0000) >> 16; |
| uint8_t pid = (periph & 0xff00) >> 8; |
| |
| priv->channel_map[slave_id][pid] = i; |
| |
| /* Mark channels read-only when from different owner */ |
| if (priv->arb_ver == V5 || priv->arb_ver == V7) { |
| uint32_t cnfg = readl(priv->spmi_cnfg + ARB_CHANNEL_OFFSET(i)); |
| uint8_t owner = SPMI_OWNERSHIP_PERIPH2OWNER(cnfg); |
| |
| if (owner != priv->owner) |
| priv->channel_map[slave_id][pid] |= SPMI_CHANNEL_READ_ONLY; |
| } |
| } |
| return 0; |
| } |
| |
| static const struct udevice_id msm_spmi_ids[] = { |
| { .compatible = "qcom,spmi-pmic-arb" }, |
| { } |
| }; |
| |
| U_BOOT_DRIVER(msm_spmi) = { |
| .name = "msm_spmi", |
| .id = UCLASS_SPMI, |
| .of_match = msm_spmi_ids, |
| .ops = &msm_spmi_ops, |
| .probe = msm_spmi_probe, |
| .priv_auto = sizeof(struct msm_spmi_priv), |
| }; |