root/drivers/mfd/smsc-ece1099.c

DEFINITIONS

1. smsc_i2c_probe

   1 /*
   2  * TI SMSC MFD Driver
   3  *
   4  * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
   5  *
   6  * Author: Sourav Poddar <sourav.poddar@ti.com>
   7  *
   8  *  This program is free software; you can redistribute it and/or modify it
   9  *  under  the terms of the GNU General  Public License as published by the
  10  *  Free Software Foundation;  GPL v2.
  11  *
  12  */
  13 
  14 #include <linux/init.h>
  15 #include <linux/slab.h>
  16 #include <linux/i2c.h>
  17 #include <linux/gpio.h>
  18 #include <linux/workqueue.h>
  19 #include <linux/irq.h>
  20 #include <linux/regmap.h>
  21 #include <linux/err.h>
  22 #include <linux/mfd/core.h>
  23 #include <linux/mfd/smsc.h>
  24 #include <linux/of_platform.h>
  25 
  26 static const struct regmap_config smsc_regmap_config = {
  27                 .reg_bits = 8,
  28                 .val_bits = 8,
  29                 .max_register = SMSC_VEN_ID_H,
  30                 .cache_type = REGCACHE_RBTREE,
  31 };
  32 
  33 static int smsc_i2c_probe(struct i2c_client *i2c,
  34                         const struct i2c_device_id *id)
  35 {
  36         struct smsc *smsc;
  37         int devid, rev, venid_l, venid_h;
  38         int ret;
  39 
  40         smsc = devm_kzalloc(&i2c->dev, sizeof(*smsc), GFP_KERNEL);
  41         if (!smsc)
  42                 return -ENOMEM;
  43 
  44         smsc->regmap = devm_regmap_init_i2c(i2c, &smsc_regmap_config);
  45         if (IS_ERR(smsc->regmap))
  46                 return PTR_ERR(smsc->regmap);
  47 
  48         i2c_set_clientdata(i2c, smsc);
  49         smsc->dev = &i2c->dev;
  50 
  51 #ifdef CONFIG_OF
  52         of_property_read_u32(i2c->dev.of_node, "clock", &smsc->clk);
  53 #endif
  54 
  55         regmap_read(smsc->regmap, SMSC_DEV_ID, &devid);
  56         regmap_read(smsc->regmap, SMSC_DEV_REV, &rev);
  57         regmap_read(smsc->regmap, SMSC_VEN_ID_L, &venid_l);
  58         regmap_read(smsc->regmap, SMSC_VEN_ID_H, &venid_h);
  59 
  60         dev_info(&i2c->dev, "SMSCxxx devid: %02x rev: %02x venid: %02x\n",
  61                 devid, rev, (venid_h << 8) | venid_l);
  62 
  63         ret = regmap_write(smsc->regmap, SMSC_CLK_CTRL, smsc->clk);
  64         if (ret)
  65                 return ret;
  66 
  67 #ifdef CONFIG_OF
  68         if (i2c->dev.of_node)
  69                 ret = devm_of_platform_populate(&i2c->dev);
  70 #endif
  71 
  72         return ret;
  73 }
  74 
  75 static const struct i2c_device_id smsc_i2c_id[] = {
  76         { "smscece1099", 0},
  77         {},
  78 };
  79 
  80 static struct i2c_driver smsc_i2c_driver = {
  81         .driver = {
  82                    .name = "smsc",
  83         },
  84         .probe = smsc_i2c_probe,
  85         .id_table = smsc_i2c_id,
  86 };
  87 builtin_i2c_driver(smsc_i2c_driver);