Blame view
drivers/mfd/88pm860x-i2c.c
4.21 KB
bbd51b1ff
|
1 |
/* |
53dbab7af
|
2 |
* I2C driver for Marvell 88PM860x |
bbd51b1ff
|
3 4 |
* * Copyright (C) 2009 Marvell International Ltd. |
0363be8b5
|
5 6 |
* * Author: Haojian Zhuang <haojian.zhuang@marvell.com> |
bbd51b1ff
|
7 8 9 10 11 12 13 |
* * 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> |
bbd51b1ff
|
14 |
#include <linux/i2c.h> |
b46a36c0e
|
15 |
#include <linux/regmap.h> |
53dbab7af
|
16 |
#include <linux/mfd/88pm860x.h> |
bbd51b1ff
|
17 |
|
53dbab7af
|
18 |
int pm860x_reg_read(struct i2c_client *i2c, int reg) |
bbd51b1ff
|
19 |
{ |
53dbab7af
|
20 |
struct pm860x_chip *chip = i2c_get_clientdata(i2c); |
b46a36c0e
|
21 22 23 |
struct regmap *map = (i2c == chip->client) ? chip->regmap : chip->regmap_companion; unsigned int data; |
bbd51b1ff
|
24 |
int ret; |
b46a36c0e
|
25 |
ret = regmap_read(map, reg, &data); |
bbd51b1ff
|
26 27 28 29 30 |
if (ret < 0) return ret; else return (int)data; } |
53dbab7af
|
31 |
EXPORT_SYMBOL(pm860x_reg_read); |
bbd51b1ff
|
32 |
|
53dbab7af
|
33 |
int pm860x_reg_write(struct i2c_client *i2c, int reg, |
bbd51b1ff
|
34 35 |
unsigned char data) { |
53dbab7af
|
36 |
struct pm860x_chip *chip = i2c_get_clientdata(i2c); |
b46a36c0e
|
37 38 |
struct regmap *map = (i2c == chip->client) ? chip->regmap : chip->regmap_companion; |
bbd51b1ff
|
39 |
int ret; |
b46a36c0e
|
40 |
ret = regmap_write(map, reg, data); |
bbd51b1ff
|
41 42 |
return ret; } |
53dbab7af
|
43 |
EXPORT_SYMBOL(pm860x_reg_write); |
bbd51b1ff
|
44 |
|
53dbab7af
|
45 |
int pm860x_bulk_read(struct i2c_client *i2c, int reg, |
bbd51b1ff
|
46 47 |
int count, unsigned char *buf) { |
53dbab7af
|
48 |
struct pm860x_chip *chip = i2c_get_clientdata(i2c); |
b46a36c0e
|
49 50 |
struct regmap *map = (i2c == chip->client) ? chip->regmap : chip->regmap_companion; |
bbd51b1ff
|
51 |
int ret; |
b46a36c0e
|
52 |
ret = regmap_raw_read(map, reg, buf, count); |
bbd51b1ff
|
53 54 |
return ret; } |
53dbab7af
|
55 |
EXPORT_SYMBOL(pm860x_bulk_read); |
bbd51b1ff
|
56 |
|
53dbab7af
|
57 |
int pm860x_bulk_write(struct i2c_client *i2c, int reg, |
bbd51b1ff
|
58 59 |
int count, unsigned char *buf) { |
53dbab7af
|
60 |
struct pm860x_chip *chip = i2c_get_clientdata(i2c); |
b46a36c0e
|
61 62 |
struct regmap *map = (i2c == chip->client) ? chip->regmap : chip->regmap_companion; |
bbd51b1ff
|
63 |
int ret; |
b46a36c0e
|
64 |
ret = regmap_raw_write(map, reg, buf, count); |
bbd51b1ff
|
65 66 |
return ret; } |
53dbab7af
|
67 |
EXPORT_SYMBOL(pm860x_bulk_write); |
bbd51b1ff
|
68 |
|
53dbab7af
|
69 |
int pm860x_set_bits(struct i2c_client *i2c, int reg, |
bbd51b1ff
|
70 71 |
unsigned char mask, unsigned char data) { |
53dbab7af
|
72 |
struct pm860x_chip *chip = i2c_get_clientdata(i2c); |
b46a36c0e
|
73 74 |
struct regmap *map = (i2c == chip->client) ? chip->regmap : chip->regmap_companion; |
bbd51b1ff
|
75 |
int ret; |
b46a36c0e
|
76 |
ret = regmap_update_bits(map, reg, mask, data); |
bbd51b1ff
|
77 78 |
return ret; } |
53dbab7af
|
79 |
EXPORT_SYMBOL(pm860x_set_bits); |
bbd51b1ff
|
80 |
|
5bdf7411b
|
81 82 83 84 85 86 |
static int read_device(struct i2c_client *i2c, int reg, int bytes, void *dest) { unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX + 3]; unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX + 2]; struct i2c_adapter *adap = i2c->adapter; |
489422224
|
87 88 89 90 91 92 93 94 95 96 97 98 |
struct i2c_msg msg[2] = { { .addr = i2c->addr, .flags = 0, .len = 1, .buf = msgbuf0 }, { .addr = i2c->addr, .flags = I2C_M_RD, .len = 0, .buf = msgbuf1 }, |
5bdf7411b
|
99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 |
}; int num = 1, ret = 0; if (dest == NULL) return -EINVAL; msgbuf0[0] = (unsigned char)reg; /* command */ msg[1].len = bytes; /* if data needs to read back, num should be 2 */ if (bytes > 0) num = 2; ret = adap->algo->master_xfer(adap, msg, num); memcpy(dest, msgbuf1, bytes); if (ret < 0) return ret; return 0; } static int write_device(struct i2c_client *i2c, int reg, int bytes, void *src) { |
7a36ceb28
|
120 |
unsigned char buf[2]; |
5bdf7411b
|
121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 |
struct i2c_adapter *adap = i2c->adapter; struct i2c_msg msg; int ret; buf[0] = (unsigned char)reg; memcpy(&buf[1], src, bytes); msg.addr = i2c->addr; msg.flags = 0; msg.len = bytes + 1; msg.buf = buf; ret = adap->algo->master_xfer(adap, &msg, 1); if (ret < 0) return ret; return 0; } |
09b034191
|
137 138 139 |
int pm860x_page_reg_write(struct i2c_client *i2c, int reg, unsigned char data) { |
09b034191
|
140 141 |
unsigned char zero; int ret; |
5bdf7411b
|
142 143 144 145 146 147 148 149 |
i2c_lock_adapter(i2c->adapter); read_device(i2c, 0xFA, 0, &zero); read_device(i2c, 0xFB, 0, &zero); read_device(i2c, 0xFF, 0, &zero); ret = write_device(i2c, reg, 1, &data); read_device(i2c, 0xFE, 0, &zero); read_device(i2c, 0xFC, 0, &zero); i2c_unlock_adapter(i2c->adapter); |
09b034191
|
150 151 152 153 154 155 156 |
return ret; } EXPORT_SYMBOL(pm860x_page_reg_write); int pm860x_page_bulk_read(struct i2c_client *i2c, int reg, int count, unsigned char *buf) { |
09b034191
|
157 158 |
unsigned char zero = 0; int ret; |
5bdf7411b
|
159 160 161 162 163 164 165 166 |
i2c_lock_adapter(i2c->adapter); read_device(i2c, 0xfa, 0, &zero); read_device(i2c, 0xfb, 0, &zero); read_device(i2c, 0xff, 0, &zero); ret = read_device(i2c, reg, count, buf); read_device(i2c, 0xFE, 0, &zero); read_device(i2c, 0xFC, 0, &zero); i2c_unlock_adapter(i2c->adapter); |
09b034191
|
167 168 169 |
return ret; } EXPORT_SYMBOL(pm860x_page_bulk_read); |