regmap: Introduce max_raw_read/write for regmap_bulk_read/write
There are some buses which have a limit on the maximum number of bytes that can be send/received. An example for this is I2C_FUNC_SMBUS_I2C_BLOCK which does not support any reads/writes of more than 32 bytes. The regmap_bulk operations should still be able to utilize the full 32 bytes in this case. Signed-off-by: Markus Pargmann <mpa@pengutronix.de> Signed-off-by: Mark Brown <broonie@kernel.org>
This commit is contained in:
parent
10524612e8
commit
adaac45975
|
@ -146,6 +146,10 @@ struct regmap {
|
||||||
/* if set, the device supports multi write mode */
|
/* if set, the device supports multi write mode */
|
||||||
bool can_multi_write;
|
bool can_multi_write;
|
||||||
|
|
||||||
|
/* if set, raw reads/writes are limited to this size */
|
||||||
|
size_t max_raw_read;
|
||||||
|
size_t max_raw_write;
|
||||||
|
|
||||||
struct rb_root range_tree;
|
struct rb_root range_tree;
|
||||||
void *selector_work_buf; /* Scratch buffer used for selector */
|
void *selector_work_buf; /* Scratch buffer used for selector */
|
||||||
};
|
};
|
||||||
|
|
|
@ -579,6 +579,8 @@ struct regmap *regmap_init(struct device *dev,
|
||||||
map->use_single_read = config->use_single_rw || !bus || !bus->read;
|
map->use_single_read = config->use_single_rw || !bus || !bus->read;
|
||||||
map->use_single_write = config->use_single_rw || !bus || !bus->write;
|
map->use_single_write = config->use_single_rw || !bus || !bus->write;
|
||||||
map->can_multi_write = config->can_multi_write && bus && bus->write;
|
map->can_multi_write = config->can_multi_write && bus && bus->write;
|
||||||
|
map->max_raw_read = bus->max_raw_read;
|
||||||
|
map->max_raw_write = bus->max_raw_write;
|
||||||
map->dev = dev;
|
map->dev = dev;
|
||||||
map->bus = bus;
|
map->bus = bus;
|
||||||
map->bus_context = bus_context;
|
map->bus_context = bus_context;
|
||||||
|
@ -1674,6 +1676,7 @@ int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
|
||||||
{
|
{
|
||||||
int ret = 0, i;
|
int ret = 0, i;
|
||||||
size_t val_bytes = map->format.val_bytes;
|
size_t val_bytes = map->format.val_bytes;
|
||||||
|
size_t total_size = val_bytes * val_count;
|
||||||
|
|
||||||
if (map->bus && !map->format.parse_inplace)
|
if (map->bus && !map->format.parse_inplace)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
@ -1722,16 +1725,37 @@ int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
|
||||||
}
|
}
|
||||||
out:
|
out:
|
||||||
map->unlock(map->lock_arg);
|
map->unlock(map->lock_arg);
|
||||||
} else if (map->use_single_write) {
|
} else if (map->use_single_write ||
|
||||||
|
(map->max_raw_write && map->max_raw_write < total_size)) {
|
||||||
|
int chunk_stride = map->reg_stride;
|
||||||
|
size_t chunk_size = val_bytes;
|
||||||
|
size_t chunk_count = val_count;
|
||||||
|
|
||||||
|
if (!map->use_single_write) {
|
||||||
|
chunk_size = map->max_raw_write;
|
||||||
|
if (chunk_size % val_bytes)
|
||||||
|
chunk_size -= chunk_size % val_bytes;
|
||||||
|
chunk_count = total_size / chunk_size;
|
||||||
|
chunk_stride *= chunk_size / val_bytes;
|
||||||
|
}
|
||||||
|
|
||||||
map->lock(map->lock_arg);
|
map->lock(map->lock_arg);
|
||||||
for (i = 0; i < val_count; i++) {
|
/* Write as many bytes as possible with chunk_size */
|
||||||
|
for (i = 0; i < chunk_count; i++) {
|
||||||
ret = _regmap_raw_write(map,
|
ret = _regmap_raw_write(map,
|
||||||
reg + (i * map->reg_stride),
|
reg + (i * chunk_stride),
|
||||||
val + (i * val_bytes),
|
val + (i * chunk_size),
|
||||||
val_bytes);
|
chunk_size);
|
||||||
if (ret)
|
if (ret)
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Write remaining bytes */
|
||||||
|
if (!ret && chunk_size * i < total_size) {
|
||||||
|
ret = _regmap_raw_write(map, reg + (i * chunk_stride),
|
||||||
|
val + (i * chunk_size),
|
||||||
|
total_size - i * chunk_size);
|
||||||
|
}
|
||||||
map->unlock(map->lock_arg);
|
map->unlock(map->lock_arg);
|
||||||
} else {
|
} else {
|
||||||
void *wval;
|
void *wval;
|
||||||
|
@ -2319,20 +2343,51 @@ int regmap_bulk_read(struct regmap *map, unsigned int reg, void *val,
|
||||||
* Some devices does not support bulk read, for
|
* Some devices does not support bulk read, for
|
||||||
* them we have a series of single read operations.
|
* them we have a series of single read operations.
|
||||||
*/
|
*/
|
||||||
if (map->use_single_read) {
|
size_t total_size = val_bytes * val_count;
|
||||||
for (i = 0; i < val_count; i++) {
|
|
||||||
ret = regmap_raw_read(map,
|
if (!map->use_single_read &&
|
||||||
reg + (i * map->reg_stride),
|
(!map->max_raw_read || map->max_raw_read > total_size)) {
|
||||||
val + (i * val_bytes),
|
|
||||||
val_bytes);
|
|
||||||
if (ret != 0)
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
ret = regmap_raw_read(map, reg, val,
|
ret = regmap_raw_read(map, reg, val,
|
||||||
val_bytes * val_count);
|
val_bytes * val_count);
|
||||||
if (ret != 0)
|
if (ret != 0)
|
||||||
return ret;
|
return ret;
|
||||||
|
} else {
|
||||||
|
/*
|
||||||
|
* Some devices do not support bulk read or do not
|
||||||
|
* support large bulk reads, for them we have a series
|
||||||
|
* of read operations.
|
||||||
|
*/
|
||||||
|
int chunk_stride = map->reg_stride;
|
||||||
|
size_t chunk_size = val_bytes;
|
||||||
|
size_t chunk_count = val_count;
|
||||||
|
|
||||||
|
if (!map->use_single_read) {
|
||||||
|
chunk_size = map->max_raw_read;
|
||||||
|
if (chunk_size % val_bytes)
|
||||||
|
chunk_size -= chunk_size % val_bytes;
|
||||||
|
chunk_count = total_size / chunk_size;
|
||||||
|
chunk_stride *= chunk_size / val_bytes;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Read bytes that fit into a multiple of chunk_size */
|
||||||
|
for (i = 0; i < chunk_count; i++) {
|
||||||
|
ret = regmap_raw_read(map,
|
||||||
|
reg + (i * chunk_stride),
|
||||||
|
val + (i * chunk_size),
|
||||||
|
chunk_size);
|
||||||
|
if (ret != 0)
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Read remaining bytes */
|
||||||
|
if (chunk_size * i < total_size) {
|
||||||
|
ret = regmap_raw_read(map,
|
||||||
|
reg + (i * chunk_stride),
|
||||||
|
val + (i * chunk_size),
|
||||||
|
total_size - i * chunk_size);
|
||||||
|
if (ret != 0)
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
for (i = 0; i < val_count * val_bytes; i += val_bytes)
|
for (i = 0; i < val_count * val_bytes; i += val_bytes)
|
||||||
|
|
|
@ -311,6 +311,8 @@ typedef void (*regmap_hw_free_context)(void *context);
|
||||||
* @val_format_endian_default: Default endianness for formatted register
|
* @val_format_endian_default: Default endianness for formatted register
|
||||||
* values. Used when the regmap_config specifies DEFAULT. If this is
|
* values. Used when the regmap_config specifies DEFAULT. If this is
|
||||||
* DEFAULT, BIG is assumed.
|
* DEFAULT, BIG is assumed.
|
||||||
|
* @max_raw_read: Max raw read size that can be used on the bus.
|
||||||
|
* @max_raw_write: Max raw write size that can be used on the bus.
|
||||||
*/
|
*/
|
||||||
struct regmap_bus {
|
struct regmap_bus {
|
||||||
bool fast_io;
|
bool fast_io;
|
||||||
|
@ -325,6 +327,8 @@ struct regmap_bus {
|
||||||
u8 read_flag_mask;
|
u8 read_flag_mask;
|
||||||
enum regmap_endian reg_format_endian_default;
|
enum regmap_endian reg_format_endian_default;
|
||||||
enum regmap_endian val_format_endian_default;
|
enum regmap_endian val_format_endian_default;
|
||||||
|
size_t max_raw_read;
|
||||||
|
size_t max_raw_write;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct regmap *regmap_init(struct device *dev,
|
struct regmap *regmap_init(struct device *dev,
|
||||||
|
|
Loading…
Reference in New Issue