[PATCH 2/7] mfd: add mc34708 driver
Jean-Christophe PLAGNIOL-VILLARD
plagnioj at jcrosoft.com
Mon Feb 20 22:48:35 EST 2012
> +static struct mc34708 *mc_dev;
> +
> +struct mc34708 *mc34708_get(void)
> +{
> + if (!mc_dev)
> + return NULL;
> +
> + return mc_dev;
> +}
> +EXPORT_SYMBOL(mc34708_get);
no please do not export the current as it will not alloe multiple chip on
board
> +
> +#ifdef CONFIG_SPI
please drop the ifdef
> +static int spi_rw(struct spi_device *spi, void * buf, size_t len)
> +{
> + int ret;
> +
> + struct spi_transfer t = {
> + .tx_buf = (const void *)buf,
> + .rx_buf = buf,
> + .len = len,
> + .cs_change = 0,
> + .delay_usecs = 0,
> + };
> + struct spi_message m;
> +
> + spi_message_init(&m);
> + spi_message_add_tail(&t, &m);
> +
> + if ((ret = spi_sync(spi, &m)))
> + return ret;
> + return 0;
> +}
> +
> +#define MXC_PMIC_REG_NUM(reg) (((reg) & 0x3f) << 25)
> +#define MXC_PMIC_WRITE (1 << 31)
> +
> +static int mc34708_spi_reg_read(struct mc34708 *mc34708, enum mc34708_reg reg, u32 *val)
> +{
> + uint32_t buf;
> +
> + buf = MXC_PMIC_REG_NUM(reg);
> +
> + spi_rw(mc34708->spi, &buf, 4);
you need to check the return
> +
> + *val = buf;
> +
> + return 0;
> +}
> +
> +static int mc34708_spi_reg_write(struct mc34708 *mc34708, enum mc34708_reg reg, u32 val)
> +{
> + uint32_t buf = MXC_PMIC_REG_NUM(reg) | MXC_PMIC_WRITE | (val & 0xffffff);
> +
> + spi_rw(mc34708->spi, &buf, 4);
ditto
> +
> + return 0;
> +}
> +#endif
> +
> +#ifdef CONFIG_I2C
please drop the ifdef
> +static int mc34708_i2c_reg_read(struct mc34708 *mc34708, enum mc34708_reg reg, u32 *val)
> +{
> + u8 buf[3];
> + int ret;
> +
> + ret = i2c_read_reg(mc34708->client, reg, buf, 3);
> + *val = buf[0] << 16 | buf[1] << 8 | buf[2] << 0;
> +
> + return ret == 3 ? 0 : ret;
> +}
> +
> +static int mc34708_i2c_reg_write(struct mc34708 *mc34708, enum mc34708_reg reg, u32 val)
> +{
> + u8 buf[] = {
> + val >> 16,
> + val >> 8,
> + val >> 0,
> + };
why not convert val as a u8* and did this wirk on big endian?
> + int ret;
> +
> + ret = i2c_write_reg(mc34708->client, reg, buf, 3);
> +
> + return ret == 3 ? 0 : ret;
> +}
> +#endif
> +
> +int mc34708_reg_write(struct mc34708 *mc34708, enum mc34708_reg reg, u32 val)
> +{
> +#ifdef CONFIG_I2C
please use IS_ENABLED
> + if (mc34708->mode == MC34708_MODE_I2C)
> + return mc34708_i2c_reg_write(mc34708, reg, val);
> +#endif
> +#ifdef CONFIG_SPI
ditto
> + if (mc34708->mode == MC34708_MODE_SPI)
> + return mc34708_spi_reg_write(mc34708, reg, val);
> +#endif
> + return -EINVAL;
> +}
> +EXPORT_SYMBOL(mc34708_reg_write);
> +
> +int mc34708_reg_read(struct mc34708 *mc34708, enum mc34708_reg reg, u32 *val)
> +{
> +#ifdef CONFIG_I2C
ditto
> + if (mc34708->mode == MC34708_MODE_I2C)
> + return mc34708_i2c_reg_read(mc34708, reg, val);
> +#endif
> +#ifdef CONFIG_SPI
> + if (mc34708->mode == MC34708_MODE_SPI)
> + return mc34708_spi_reg_read(mc34708, reg, val);
> +#endif
> + return -EINVAL;
> +}
> +EXPORT_SYMBOL(mc34708_reg_read);
> +
> +int mc34708_set_bits(struct mc34708 *mc34708, enum mc34708_reg reg, u32 mask, u32 val)
> +{
> + u32 tmp;
> + int err;
> +
> + err = mc34708_reg_read(mc34708, reg, &tmp);
> + tmp = (tmp & ~mask) | val;
no need if err != 0
> +
> + if (!err)
> + err = mc34708_reg_write(mc34708, reg, tmp);
> +
> + return err;
> +}
> +EXPORT_SYMBOL(mc34708_set_bits);
> +
> +static ssize_t mc_read(struct cdev *cdev, void *_buf, size_t count, ulong offset, ulong flags)
> +{
> + struct mc34708 *priv = to_mc34708(cdev);
> + u32 *buf = _buf;
> + size_t i = count >> 2;
> + int err;
> +
> + offset >>= 2;
> +
> + while (i) {
> + err = mc34708_reg_read(priv, offset, buf);
> + if (err)
> + return (ssize_t)err;
> + buf++;
> + i--;
> + offset++;
> + }
> +
> + return count;
> +}
> +
> +static ssize_t mc_write(struct cdev *cdev, const void *_buf, size_t count, ulong offset, ulong flags)
> +{
> + struct mc34708 *mc34708 = to_mc34708(cdev);
> + const u32 *buf = _buf;
> + size_t i = count >> 2;
> + int err;
> +
> + offset >>= 2;
> +
> + while (i) {
> + err = mc34708_reg_write(mc34708, offset, *buf);
> + if (err)
> + return (ssize_t)err;
> + buf++;
> + i--;
> + offset++;
> + }
> +
> + return count;
> +}
> +
> +static struct file_operations mc_fops = {
> + .lseek = dev_lseek_default,
> + .read = mc_read,
> + .write = mc_write,
> +};
> +
> +static int mc34708_query_revision(struct mc34708 *mc34708)
> +{
> + unsigned int rev_id;
> + int rev;
> +
> + mc34708_reg_read(mc34708, 7, &rev_id);
> +
> + if (rev_id > 0xFFF)
> + return -EINVAL;
> +
> + rev = rev_id & 0xFFF;
> +
> + dev_info(mc_dev->cdev.dev, "MC34708 ID: 0x%04x\n", rev);
> +
> + mc34708->revision = rev;
> +
> + return rev;
> +}
> +
> +static int mc_probe(struct device_d *dev, enum mc34708_mode mode)
> +{
> + int rev;
> +
> + if (mc_dev)
> + return -EBUSY;
> +
> + mc_dev = xzalloc(sizeof(struct mc34708));
> + mc_dev->mode = mode;
> + mc_dev->cdev.name = DRIVERNAME;
> + if (mode == MC34708_MODE_I2C) {
please use IS_ENABLED
> + mc_dev->client = to_i2c_client(dev);
> + }
ditto
> + if (mode == MC34708_MODE_SPI) {
> + mc_dev->spi = dev->type_data;
> + mc_dev->spi->mode = SPI_MODE_0 | SPI_CS_HIGH;
> + mc_dev->spi->bits_per_word = 32;
> + }
> + mc_dev->cdev.size = 256;
> + mc_dev->cdev.dev = dev;
> + mc_dev->cdev.ops = &mc_fops;
> +
> + rev = mc34708_query_revision(mc_dev);
> + if (rev < 0) {
> + free(mc_dev);
> + mc_dev = NULL;
> + return -EINVAL;
> + }
> +
> + devfs_create(&mc_dev->cdev);
return?
> +
> + return 0;
> +}
> +
> +static int mc_i2c_probe(struct device_d *dev)
> +{
> + return mc_probe(dev, MC34708_MODE_I2C);
> +}
> +
> +static int mc_spi_probe(struct device_d *dev)
> +{
> + return mc_probe(dev, MC34708_MODE_SPI);
> +}
> +
> +static struct driver_d mc_i2c_driver = {
> + .name = "mc34708-i2c",
> + .probe = mc_i2c_probe,
> +};
> +
> +static struct driver_d mc_spi_driver = {
> + .name = "mc34708-spi",
> + .probe = mc_spi_probe,
> +};
> +
> +static int mc_init(void)
> +{
please use IS_ENABLED
> + register_driver(&mc_i2c_driver);
> + register_driver(&mc_spi_driver);
> + return 0;
Best Regards,
J.
More information about the barebox
mailing list