Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 | /* * I2C driver for Marvell 88PM80x * * Copyright (C) 2012 Marvell International Ltd. * Haojian Zhuang <haojian.zhuang@marvell.com> * Joseph(Yossi) Hanin <yhanin@marvell.com> * Qiao Zhou <zhouqiao@marvell.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/i2c.h> #include <linux/mfd/88pm80x.h> #include <linux/slab.h> #include <linux/uaccess.h> #include <linux/err.h> /* 88pm80x chips have same definition for chip id register. */ #define PM80X_CHIP_ID (0x00) #define PM80X_CHIP_ID_NUM(x) (((x) >> 5) & 0x7) #define PM80X_CHIP_ID_REVISION(x) ((x) & 0x1F) struct pm80x_chip_mapping { unsigned int id; int type; }; static struct pm80x_chip_mapping chip_mapping[] = { /* 88PM800 chip id number */ {0x3, CHIP_PM800}, /* 88PM805 chip id number */ {0x0, CHIP_PM805}, }; /* * workaround: some registers needed by pm805 are defined in pm800, so * need to use this global variable to maintain the relation between * pm800 and pm805. would remove it after HW chip fixes the issue. */ static struct pm80x_chip *g_pm80x_chip; const struct regmap_config pm80x_regmap_config = { .reg_bits = 8, .val_bits = 8, }; EXPORT_SYMBOL_GPL(pm80x_regmap_config); int pm80x_init(struct i2c_client *client) { struct pm80x_chip *chip; struct regmap *map; unsigned int val; int i, ret = 0; chip = devm_kzalloc(&client->dev, sizeof(struct pm80x_chip), GFP_KERNEL); if (!chip) return -ENOMEM; map = devm_regmap_init_i2c(client, &pm80x_regmap_config); if (IS_ERR(map)) { ret = PTR_ERR(map); dev_err(&client->dev, "Failed to allocate register map: %d\n", ret); return ret; } chip->client = client; chip->regmap = map; chip->irq = client->irq; chip->dev = &client->dev; dev_set_drvdata(chip->dev, chip); i2c_set_clientdata(chip->client, chip); ret = regmap_read(chip->regmap, PM80X_CHIP_ID, &val); if (ret < 0) { dev_err(chip->dev, "Failed to read CHIP ID: %d\n", ret); return ret; } for (i = 0; i < ARRAY_SIZE(chip_mapping); i++) { if (chip_mapping[i].id == PM80X_CHIP_ID_NUM(val)) { chip->type = chip_mapping[i].type; break; } } if (i == ARRAY_SIZE(chip_mapping)) { dev_err(chip->dev, "Failed to detect Marvell 88PM800:ChipID[0x%x]\n", val); return -EINVAL; } device_init_wakeup(&client->dev, 1); /* * workaround: set g_pm80x_chip to the first probed chip. if the * second chip is probed, just point to the companion to each * other so that pm805 can access those specific register. would * remove it after HW chip fixes the issue. */ if (!g_pm80x_chip) g_pm80x_chip = chip; else { chip->companion = g_pm80x_chip->client; g_pm80x_chip->companion = chip->client; } return 0; } EXPORT_SYMBOL_GPL(pm80x_init); int pm80x_deinit(void) { /* * workaround: clear the dependency between pm800 and pm805. * would remove it after HW chip fixes the issue. */ if (g_pm80x_chip->companion) g_pm80x_chip->companion = NULL; else g_pm80x_chip = NULL; return 0; } EXPORT_SYMBOL_GPL(pm80x_deinit); #ifdef CONFIG_PM_SLEEP static int pm80x_suspend(struct device *dev) { struct i2c_client *client = container_of(dev, struct i2c_client, dev); struct pm80x_chip *chip = i2c_get_clientdata(client); if (chip && chip->wu_flag) if (device_may_wakeup(chip->dev)) enable_irq_wake(chip->irq); return 0; } static int pm80x_resume(struct device *dev) { struct i2c_client *client = container_of(dev, struct i2c_client, dev); struct pm80x_chip *chip = i2c_get_clientdata(client); if (chip && chip->wu_flag) if (device_may_wakeup(chip->dev)) disable_irq_wake(chip->irq); return 0; } #endif SIMPLE_DEV_PM_OPS(pm80x_pm_ops, pm80x_suspend, pm80x_resume); EXPORT_SYMBOL_GPL(pm80x_pm_ops); MODULE_DESCRIPTION("I2C Driver for Marvell 88PM80x"); MODULE_AUTHOR("Qiao Zhou <zhouqiao@marvell.com>"); MODULE_LICENSE("GPL"); |