static u32 pmic_reg(struct pmic *p, u32 reg, u32 *val, u32 write) { u32 pmic_tx, pmic_rx; u32 tmp; if (!slave) { slave = pmic_spi_probe(p); if (!slave) return -1; } if (check_reg(p, reg)) return -1; if (spi_claim_bus(slave)) return -1; pmic_tx = p->hw.spi.prepare_tx(reg, val, write); tmp = cpu_to_be32(pmic_tx); if (spi_xfer(slave, pmic_spi_bitlen, &tmp, &pmic_rx, pmic_spi_flags)) { spi_release_bus(slave); return -1; } if (write) { pmic_tx = p->hw.spi.prepare_tx(reg, val, 0); tmp = cpu_to_be32(pmic_tx); if (spi_xfer(slave, pmic_spi_bitlen, &tmp, &pmic_rx, pmic_spi_flags)) { spi_release_bus(slave); return -1; } } spi_release_bus(slave); *val = cpu_to_be32(pmic_rx); return 0; }
u32 pmic_reg(u32 reg, u32 val, u32 write) { u32 pmic_tx, pmic_rx; if (!slave) { slave = pmic_spi_probe(); if (!slave) return -1; } if (reg > 63 || write > 1) { printf("<reg num> = %d is invalid. Should be less then 63\n", reg); return -1; } if (spi_claim_bus(slave)) return -1; pmic_tx = (write << 31) | (reg << 25) | (val & 0x00FFFFFF); if (spi_xfer(slave, 4 << 3, &pmic_tx, &pmic_rx, SPI_XFER_BEGIN | SPI_XFER_END)) { spi_release_bus(slave); return -1; } if (write) { pmic_tx &= ~(1 << 31); if (spi_xfer(slave, 4 << 3, &pmic_tx, &pmic_rx, SPI_XFER_BEGIN | SPI_XFER_END)) { spi_release_bus(slave); return -1; } } spi_release_bus(slave); return pmic_rx; }