|
|
@@ -19,6 +19,7 @@
|
|
|
#include <linux/rbtree.h>
|
|
|
#include <linux/sched.h>
|
|
|
#include <linux/delay.h>
|
|
|
+#include <linux/log2.h>
|
|
|
|
|
|
#define CREATE_TRACE_POINTS
|
|
|
#include "trace.h"
|
|
|
@@ -557,6 +558,8 @@ enum regmap_endian regmap_get_val_endian(struct device *dev,
|
|
|
endian = REGMAP_ENDIAN_BIG;
|
|
|
else if (of_property_read_bool(np, "little-endian"))
|
|
|
endian = REGMAP_ENDIAN_LITTLE;
|
|
|
+ else if (of_property_read_bool(np, "native-endian"))
|
|
|
+ endian = REGMAP_ENDIAN_NATIVE;
|
|
|
|
|
|
/* If the endianness was specified in DT, use that */
|
|
|
if (endian != REGMAP_ENDIAN_DEFAULT)
|
|
|
@@ -638,6 +641,10 @@ struct regmap *__regmap_init(struct device *dev,
|
|
|
map->reg_stride = config->reg_stride;
|
|
|
else
|
|
|
map->reg_stride = 1;
|
|
|
+ if (is_power_of_2(map->reg_stride))
|
|
|
+ map->reg_stride_order = ilog2(map->reg_stride);
|
|
|
+ else
|
|
|
+ map->reg_stride_order = -1;
|
|
|
map->use_single_read = config->use_single_rw || !bus || !bus->read;
|
|
|
map->use_single_write = config->use_single_rw || !bus || !bus->write;
|
|
|
map->can_multi_write = config->can_multi_write && bus && bus->write;
|
|
|
@@ -1308,7 +1315,7 @@ int _regmap_raw_write(struct regmap *map, unsigned int reg,
|
|
|
if (map->writeable_reg)
|
|
|
for (i = 0; i < val_len / map->format.val_bytes; i++)
|
|
|
if (!map->writeable_reg(map->dev,
|
|
|
- reg + (i * map->reg_stride)))
|
|
|
+ reg + regmap_get_offset(map, i)))
|
|
|
return -EINVAL;
|
|
|
|
|
|
if (!map->cache_bypass && map->format.parse_val) {
|
|
|
@@ -1316,7 +1323,8 @@ int _regmap_raw_write(struct regmap *map, unsigned int reg,
|
|
|
int val_bytes = map->format.val_bytes;
|
|
|
for (i = 0; i < val_len / val_bytes; i++) {
|
|
|
ival = map->format.parse_val(val + (i * val_bytes));
|
|
|
- ret = regcache_write(map, reg + (i * map->reg_stride),
|
|
|
+ ret = regcache_write(map,
|
|
|
+ reg + regmap_get_offset(map, i),
|
|
|
ival);
|
|
|
if (ret) {
|
|
|
dev_err(map->dev,
|
|
|
@@ -1690,100 +1698,63 @@ int regmap_raw_write(struct regmap *map, unsigned int reg,
|
|
|
EXPORT_SYMBOL_GPL(regmap_raw_write);
|
|
|
|
|
|
/**
|
|
|
- * regmap_field_write(): Write a value to a single register field
|
|
|
- *
|
|
|
- * @field: Register field to write to
|
|
|
- * @val: Value to be written
|
|
|
- *
|
|
|
- * A value of zero will be returned on success, a negative errno will
|
|
|
- * be returned in error cases.
|
|
|
- */
|
|
|
-int regmap_field_write(struct regmap_field *field, unsigned int val)
|
|
|
-{
|
|
|
- return regmap_update_bits(field->regmap, field->reg,
|
|
|
- field->mask, val << field->shift);
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_field_write);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_field_update_bits(): Perform a read/modify/write cycle
|
|
|
- * on the register field
|
|
|
+ * regmap_field_update_bits_base():
|
|
|
+ * Perform a read/modify/write cycle on the register field
|
|
|
+ * with change, async, force option
|
|
|
*
|
|
|
* @field: Register field to write to
|
|
|
* @mask: Bitmask to change
|
|
|
* @val: Value to be written
|
|
|
+ * @change: Boolean indicating if a write was done
|
|
|
+ * @async: Boolean indicating asynchronously
|
|
|
+ * @force: Boolean indicating use force update
|
|
|
*
|
|
|
* A value of zero will be returned on success, a negative errno will
|
|
|
* be returned in error cases.
|
|
|
*/
|
|
|
-int regmap_field_update_bits(struct regmap_field *field, unsigned int mask, unsigned int val)
|
|
|
+int regmap_field_update_bits_base(struct regmap_field *field,
|
|
|
+ unsigned int mask, unsigned int val,
|
|
|
+ bool *change, bool async, bool force)
|
|
|
{
|
|
|
mask = (mask << field->shift) & field->mask;
|
|
|
|
|
|
- return regmap_update_bits(field->regmap, field->reg,
|
|
|
- mask, val << field->shift);
|
|
|
+ return regmap_update_bits_base(field->regmap, field->reg,
|
|
|
+ mask, val << field->shift,
|
|
|
+ change, async, force);
|
|
|
}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_field_update_bits);
|
|
|
+EXPORT_SYMBOL_GPL(regmap_field_update_bits_base);
|
|
|
|
|
|
/**
|
|
|
- * regmap_fields_write(): Write a value to a single register field with port ID
|
|
|
- *
|
|
|
- * @field: Register field to write to
|
|
|
- * @id: port ID
|
|
|
- * @val: Value to be written
|
|
|
- *
|
|
|
- * A value of zero will be returned on success, a negative errno will
|
|
|
- * be returned in error cases.
|
|
|
- */
|
|
|
-int regmap_fields_write(struct regmap_field *field, unsigned int id,
|
|
|
- unsigned int val)
|
|
|
-{
|
|
|
- if (id >= field->id_size)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- return regmap_update_bits(field->regmap,
|
|
|
- field->reg + (field->id_offset * id),
|
|
|
- field->mask, val << field->shift);
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_fields_write);
|
|
|
-
|
|
|
-int regmap_fields_force_write(struct regmap_field *field, unsigned int id,
|
|
|
- unsigned int val)
|
|
|
-{
|
|
|
- if (id >= field->id_size)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- return regmap_write_bits(field->regmap,
|
|
|
- field->reg + (field->id_offset * id),
|
|
|
- field->mask, val << field->shift);
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_fields_force_write);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_fields_update_bits(): Perform a read/modify/write cycle
|
|
|
- * on the register field
|
|
|
+ * regmap_fields_update_bits_base():
|
|
|
+ * Perform a read/modify/write cycle on the register field
|
|
|
+ * with change, async, force option
|
|
|
*
|
|
|
* @field: Register field to write to
|
|
|
* @id: port ID
|
|
|
* @mask: Bitmask to change
|
|
|
* @val: Value to be written
|
|
|
+ * @change: Boolean indicating if a write was done
|
|
|
+ * @async: Boolean indicating asynchronously
|
|
|
+ * @force: Boolean indicating use force update
|
|
|
*
|
|
|
* A value of zero will be returned on success, a negative errno will
|
|
|
* be returned in error cases.
|
|
|
*/
|
|
|
-int regmap_fields_update_bits(struct regmap_field *field, unsigned int id,
|
|
|
- unsigned int mask, unsigned int val)
|
|
|
+int regmap_fields_update_bits_base(struct regmap_field *field, unsigned int id,
|
|
|
+ unsigned int mask, unsigned int val,
|
|
|
+ bool *change, bool async, bool force)
|
|
|
{
|
|
|
if (id >= field->id_size)
|
|
|
return -EINVAL;
|
|
|
|
|
|
mask = (mask << field->shift) & field->mask;
|
|
|
|
|
|
- return regmap_update_bits(field->regmap,
|
|
|
- field->reg + (field->id_offset * id),
|
|
|
- mask, val << field->shift);
|
|
|
+ return regmap_update_bits_base(field->regmap,
|
|
|
+ field->reg + (field->id_offset * id),
|
|
|
+ mask, val << field->shift,
|
|
|
+ change, async, force);
|
|
|
}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_fields_update_bits);
|
|
|
+EXPORT_SYMBOL_GPL(regmap_fields_update_bits_base);
|
|
|
|
|
|
/*
|
|
|
* regmap_bulk_write(): Write multiple registers to the device
|
|
|
@@ -1846,8 +1817,9 @@ int regmap_bulk_write(struct regmap *map, unsigned int reg, const void *val,
|
|
|
goto out;
|
|
|
}
|
|
|
|
|
|
- ret = _regmap_write(map, reg + (i * map->reg_stride),
|
|
|
- ival);
|
|
|
+ ret = _regmap_write(map,
|
|
|
+ reg + regmap_get_offset(map, i),
|
|
|
+ ival);
|
|
|
if (ret != 0)
|
|
|
goto out;
|
|
|
}
|
|
|
@@ -2253,6 +2225,9 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
|
|
|
WARN_ON(!map->bus);
|
|
|
|
|
|
+ if (!map->bus || !map->bus->read)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
range = _regmap_range_lookup(map, reg);
|
|
|
if (range) {
|
|
|
ret = _regmap_select_page(map, ®, range,
|
|
|
@@ -2416,7 +2391,7 @@ int regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
* cost as we expect to hit the cache.
|
|
|
*/
|
|
|
for (i = 0; i < val_count; i++) {
|
|
|
- ret = _regmap_read(map, reg + (i * map->reg_stride),
|
|
|
+ ret = _regmap_read(map, reg + regmap_get_offset(map, i),
|
|
|
&v);
|
|
|
if (ret != 0)
|
|
|
goto out;
|
|
|
@@ -2568,7 +2543,7 @@ int regmap_bulk_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
} else {
|
|
|
for (i = 0; i < val_count; i++) {
|
|
|
unsigned int ival;
|
|
|
- ret = regmap_read(map, reg + (i * map->reg_stride),
|
|
|
+ ret = regmap_read(map, reg + regmap_get_offset(map, i),
|
|
|
&ival);
|
|
|
if (ret != 0)
|
|
|
return ret;
|
|
|
@@ -2648,138 +2623,36 @@ static int _regmap_update_bits(struct regmap *map, unsigned int reg,
|
|
|
}
|
|
|
|
|
|
/**
|
|
|
- * regmap_update_bits: Perform a read/modify/write cycle on the register map
|
|
|
- *
|
|
|
- * @map: Register map to update
|
|
|
- * @reg: Register to update
|
|
|
- * @mask: Bitmask to change
|
|
|
- * @val: New value for bitmask
|
|
|
- *
|
|
|
- * Returns zero for success, a negative number on error.
|
|
|
- */
|
|
|
-int regmap_update_bits(struct regmap *map, unsigned int reg,
|
|
|
- unsigned int mask, unsigned int val)
|
|
|
-{
|
|
|
- int ret;
|
|
|
-
|
|
|
- map->lock(map->lock_arg);
|
|
|
- ret = _regmap_update_bits(map, reg, mask, val, NULL, false);
|
|
|
- map->unlock(map->lock_arg);
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_update_bits);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_write_bits: Perform a read/modify/write cycle on the register map
|
|
|
- *
|
|
|
- * @map: Register map to update
|
|
|
- * @reg: Register to update
|
|
|
- * @mask: Bitmask to change
|
|
|
- * @val: New value for bitmask
|
|
|
- *
|
|
|
- * Returns zero for success, a negative number on error.
|
|
|
- */
|
|
|
-int regmap_write_bits(struct regmap *map, unsigned int reg,
|
|
|
- unsigned int mask, unsigned int val)
|
|
|
-{
|
|
|
- int ret;
|
|
|
-
|
|
|
- map->lock(map->lock_arg);
|
|
|
- ret = _regmap_update_bits(map, reg, mask, val, NULL, true);
|
|
|
- map->unlock(map->lock_arg);
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_write_bits);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_update_bits_async: Perform a read/modify/write cycle on the register
|
|
|
- * map asynchronously
|
|
|
- *
|
|
|
- * @map: Register map to update
|
|
|
- * @reg: Register to update
|
|
|
- * @mask: Bitmask to change
|
|
|
- * @val: New value for bitmask
|
|
|
- *
|
|
|
- * With most buses the read must be done synchronously so this is most
|
|
|
- * useful for devices with a cache which do not need to interact with
|
|
|
- * the hardware to determine the current register value.
|
|
|
- *
|
|
|
- * Returns zero for success, a negative number on error.
|
|
|
- */
|
|
|
-int regmap_update_bits_async(struct regmap *map, unsigned int reg,
|
|
|
- unsigned int mask, unsigned int val)
|
|
|
-{
|
|
|
- int ret;
|
|
|
-
|
|
|
- map->lock(map->lock_arg);
|
|
|
-
|
|
|
- map->async = true;
|
|
|
-
|
|
|
- ret = _regmap_update_bits(map, reg, mask, val, NULL, false);
|
|
|
-
|
|
|
- map->async = false;
|
|
|
-
|
|
|
- map->unlock(map->lock_arg);
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_update_bits_async);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_update_bits_check: Perform a read/modify/write cycle on the
|
|
|
- * register map and report if updated
|
|
|
- *
|
|
|
- * @map: Register map to update
|
|
|
- * @reg: Register to update
|
|
|
- * @mask: Bitmask to change
|
|
|
- * @val: New value for bitmask
|
|
|
- * @change: Boolean indicating if a write was done
|
|
|
- *
|
|
|
- * Returns zero for success, a negative number on error.
|
|
|
- */
|
|
|
-int regmap_update_bits_check(struct regmap *map, unsigned int reg,
|
|
|
- unsigned int mask, unsigned int val,
|
|
|
- bool *change)
|
|
|
-{
|
|
|
- int ret;
|
|
|
-
|
|
|
- map->lock(map->lock_arg);
|
|
|
- ret = _regmap_update_bits(map, reg, mask, val, change, false);
|
|
|
- map->unlock(map->lock_arg);
|
|
|
- return ret;
|
|
|
-}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_update_bits_check);
|
|
|
-
|
|
|
-/**
|
|
|
- * regmap_update_bits_check_async: Perform a read/modify/write cycle on the
|
|
|
- * register map asynchronously and report if
|
|
|
- * updated
|
|
|
+ * regmap_update_bits_base:
|
|
|
+ * Perform a read/modify/write cycle on the
|
|
|
+ * register map with change, async, force option
|
|
|
*
|
|
|
* @map: Register map to update
|
|
|
* @reg: Register to update
|
|
|
* @mask: Bitmask to change
|
|
|
* @val: New value for bitmask
|
|
|
* @change: Boolean indicating if a write was done
|
|
|
+ * @async: Boolean indicating asynchronously
|
|
|
+ * @force: Boolean indicating use force update
|
|
|
*
|
|
|
+ * if async was true,
|
|
|
* With most buses the read must be done synchronously so this is most
|
|
|
* useful for devices with a cache which do not need to interact with
|
|
|
* the hardware to determine the current register value.
|
|
|
*
|
|
|
* Returns zero for success, a negative number on error.
|
|
|
*/
|
|
|
-int regmap_update_bits_check_async(struct regmap *map, unsigned int reg,
|
|
|
- unsigned int mask, unsigned int val,
|
|
|
- bool *change)
|
|
|
+int regmap_update_bits_base(struct regmap *map, unsigned int reg,
|
|
|
+ unsigned int mask, unsigned int val,
|
|
|
+ bool *change, bool async, bool force)
|
|
|
{
|
|
|
int ret;
|
|
|
|
|
|
map->lock(map->lock_arg);
|
|
|
|
|
|
- map->async = true;
|
|
|
+ map->async = async;
|
|
|
|
|
|
- ret = _regmap_update_bits(map, reg, mask, val, change, false);
|
|
|
+ ret = _regmap_update_bits(map, reg, mask, val, change, force);
|
|
|
|
|
|
map->async = false;
|
|
|
|
|
|
@@ -2787,7 +2660,7 @@ int regmap_update_bits_check_async(struct regmap *map, unsigned int reg,
|
|
|
|
|
|
return ret;
|
|
|
}
|
|
|
-EXPORT_SYMBOL_GPL(regmap_update_bits_check_async);
|
|
|
+EXPORT_SYMBOL_GPL(regmap_update_bits_base);
|
|
|
|
|
|
void regmap_async_complete_cb(struct regmap_async *async, int ret)
|
|
|
{
|