|
@@ -168,6 +168,17 @@ bool regmap_precious(struct regmap *map, unsigned int reg)
|
|
|
return false;
|
|
|
}
|
|
|
|
|
|
+bool regmap_readable_noinc(struct regmap *map, unsigned int reg)
|
|
|
+{
|
|
|
+ if (map->readable_noinc_reg)
|
|
|
+ return map->readable_noinc_reg(map->dev, reg);
|
|
|
+
|
|
|
+ if (map->rd_noinc_table)
|
|
|
+ return regmap_check_range_table(map, reg, map->rd_noinc_table);
|
|
|
+
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
static bool regmap_volatile_range(struct regmap *map, unsigned int reg,
|
|
|
size_t num)
|
|
|
{
|
|
@@ -766,10 +777,12 @@ struct regmap *__regmap_init(struct device *dev,
|
|
|
map->rd_table = config->rd_table;
|
|
|
map->volatile_table = config->volatile_table;
|
|
|
map->precious_table = config->precious_table;
|
|
|
+ map->rd_noinc_table = config->rd_noinc_table;
|
|
|
map->writeable_reg = config->writeable_reg;
|
|
|
map->readable_reg = config->readable_reg;
|
|
|
map->volatile_reg = config->volatile_reg;
|
|
|
map->precious_reg = config->precious_reg;
|
|
|
+ map->readable_noinc_reg = config->readable_noinc_reg;
|
|
|
map->cache_type = config->cache_type;
|
|
|
|
|
|
spin_lock_init(&map->async_lock);
|
|
@@ -1285,6 +1298,7 @@ int regmap_reinit_cache(struct regmap *map, const struct regmap_config *config)
|
|
|
map->readable_reg = config->readable_reg;
|
|
|
map->volatile_reg = config->volatile_reg;
|
|
|
map->precious_reg = config->precious_reg;
|
|
|
+ map->readable_noinc_reg = config->readable_noinc_reg;
|
|
|
map->cache_type = config->cache_type;
|
|
|
|
|
|
regmap_debugfs_init(map, config->name);
|
|
@@ -2564,7 +2578,70 @@ int regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
EXPORT_SYMBOL_GPL(regmap_raw_read);
|
|
|
|
|
|
/**
|
|
|
- * regmap_field_read() - Read a value to a single register field
|
|
|
+ * regmap_noinc_read(): Read data from a register without incrementing the
|
|
|
+ * register number
|
|
|
+ *
|
|
|
+ * @map: Register map to read from
|
|
|
+ * @reg: Register to read from
|
|
|
+ * @val: Pointer to data buffer
|
|
|
+ * @val_len: Length of output buffer in bytes.
|
|
|
+ *
|
|
|
+ * The regmap API usually assumes that bulk bus read operations will read a
|
|
|
+ * range of registers. Some devices have certain registers for which a read
|
|
|
+ * operation read will read from an internal FIFO.
|
|
|
+ *
|
|
|
+ * The target register must be volatile but registers after it can be
|
|
|
+ * completely unrelated cacheable registers.
|
|
|
+ *
|
|
|
+ * This will attempt multiple reads as required to read val_len bytes.
|
|
|
+ *
|
|
|
+ * A value of zero will be returned on success, a negative errno will be
|
|
|
+ * returned in error cases.
|
|
|
+ */
|
|
|
+int regmap_noinc_read(struct regmap *map, unsigned int reg,
|
|
|
+ void *val, size_t val_len)
|
|
|
+{
|
|
|
+ size_t read_len;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ if (!map->bus)
|
|
|
+ return -EINVAL;
|
|
|
+ if (!map->bus->read)
|
|
|
+ return -ENOTSUPP;
|
|
|
+ if (val_len % map->format.val_bytes)
|
|
|
+ return -EINVAL;
|
|
|
+ if (!IS_ALIGNED(reg, map->reg_stride))
|
|
|
+ return -EINVAL;
|
|
|
+ if (val_len == 0)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ map->lock(map->lock_arg);
|
|
|
+
|
|
|
+ if (!regmap_volatile(map, reg) || !regmap_readable_noinc(map, reg)) {
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto out_unlock;
|
|
|
+ }
|
|
|
+
|
|
|
+ while (val_len) {
|
|
|
+ if (map->max_raw_read && map->max_raw_read < val_len)
|
|
|
+ read_len = map->max_raw_read;
|
|
|
+ else
|
|
|
+ read_len = val_len;
|
|
|
+ ret = _regmap_raw_read(map, reg, val, read_len);
|
|
|
+ if (ret)
|
|
|
+ goto out_unlock;
|
|
|
+ val = ((u8 *)val) + read_len;
|
|
|
+ val_len -= read_len;
|
|
|
+ }
|
|
|
+
|
|
|
+out_unlock:
|
|
|
+ map->unlock(map->lock_arg);
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+EXPORT_SYMBOL_GPL(regmap_noinc_read);
|
|
|
+
|
|
|
+/**
|
|
|
+ * regmap_field_read(): Read a value to a single register field
|
|
|
*
|
|
|
* @field: Register field to read from
|
|
|
* @val: Pointer to store read value
|