|
@@ -93,6 +93,29 @@ bool regmap_writeable(struct regmap *map, unsigned int reg)
|
|
|
return true;
|
|
|
}
|
|
|
|
|
|
+bool regmap_cached(struct regmap *map, unsigned int reg)
|
|
|
+{
|
|
|
+ int ret;
|
|
|
+ unsigned int val;
|
|
|
+
|
|
|
+ if (map->cache == REGCACHE_NONE)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ if (!map->cache_ops)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ if (map->max_register && reg > map->max_register)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ map->lock(map->lock_arg);
|
|
|
+ ret = regcache_read(map, reg, &val);
|
|
|
+ map->unlock(map->lock_arg);
|
|
|
+ if (ret)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
bool regmap_readable(struct regmap *map, unsigned int reg)
|
|
|
{
|
|
|
if (!map->reg_read)
|
|
@@ -749,6 +772,9 @@ struct regmap *__regmap_init(struct device *dev,
|
|
|
case REGMAP_ENDIAN_BIG:
|
|
|
map->format.format_reg = regmap_format_16_be;
|
|
|
break;
|
|
|
+ case REGMAP_ENDIAN_LITTLE:
|
|
|
+ map->format.format_reg = regmap_format_16_le;
|
|
|
+ break;
|
|
|
case REGMAP_ENDIAN_NATIVE:
|
|
|
map->format.format_reg = regmap_format_16_native;
|
|
|
break;
|
|
@@ -768,6 +794,9 @@ struct regmap *__regmap_init(struct device *dev,
|
|
|
case REGMAP_ENDIAN_BIG:
|
|
|
map->format.format_reg = regmap_format_32_be;
|
|
|
break;
|
|
|
+ case REGMAP_ENDIAN_LITTLE:
|
|
|
+ map->format.format_reg = regmap_format_32_le;
|
|
|
+ break;
|
|
|
case REGMAP_ENDIAN_NATIVE:
|
|
|
map->format.format_reg = regmap_format_32_native;
|
|
|
break;
|
|
@@ -782,6 +811,9 @@ struct regmap *__regmap_init(struct device *dev,
|
|
|
case REGMAP_ENDIAN_BIG:
|
|
|
map->format.format_reg = regmap_format_64_be;
|
|
|
break;
|
|
|
+ case REGMAP_ENDIAN_LITTLE:
|
|
|
+ map->format.format_reg = regmap_format_64_le;
|
|
|
+ break;
|
|
|
case REGMAP_ENDIAN_NATIVE:
|
|
|
map->format.format_reg = regmap_format_64_native;
|
|
|
break;
|
|
@@ -1296,12 +1328,26 @@ static int _regmap_select_page(struct regmap *map, unsigned int *reg,
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
+static void regmap_set_work_buf_flag_mask(struct regmap *map, int max_bytes,
|
|
|
+ unsigned long mask)
|
|
|
+{
|
|
|
+ u8 *buf;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ if (!mask || !map->work_buf)
|
|
|
+ return;
|
|
|
+
|
|
|
+ buf = map->work_buf;
|
|
|
+
|
|
|
+ for (i = 0; i < max_bytes; i++)
|
|
|
+ buf[i] |= (mask >> (8 * i)) & 0xff;
|
|
|
+}
|
|
|
+
|
|
|
int _regmap_raw_write(struct regmap *map, unsigned int reg,
|
|
|
const void *val, size_t val_len)
|
|
|
{
|
|
|
struct regmap_range_node *range;
|
|
|
unsigned long flags;
|
|
|
- u8 *u8 = map->work_buf;
|
|
|
void *work_val = map->work_buf + map->format.reg_bytes +
|
|
|
map->format.pad_bytes;
|
|
|
void *buf;
|
|
@@ -1370,8 +1416,8 @@ int _regmap_raw_write(struct regmap *map, unsigned int reg,
|
|
|
}
|
|
|
|
|
|
map->format.format_reg(map->work_buf, reg, map->reg_shift);
|
|
|
-
|
|
|
- u8[0] |= map->write_flag_mask;
|
|
|
+ regmap_set_work_buf_flag_mask(map, map->format.reg_bytes,
|
|
|
+ map->write_flag_mask);
|
|
|
|
|
|
/*
|
|
|
* Essentially all I/O mechanisms will be faster with a single
|
|
@@ -2251,7 +2297,6 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
unsigned int val_len)
|
|
|
{
|
|
|
struct regmap_range_node *range;
|
|
|
- u8 *u8 = map->work_buf;
|
|
|
int ret;
|
|
|
|
|
|
WARN_ON(!map->bus);
|
|
@@ -2268,15 +2313,8 @@ static int _regmap_raw_read(struct regmap *map, unsigned int reg, void *val,
|
|
|
}
|
|
|
|
|
|
map->format.format_reg(map->work_buf, reg, map->reg_shift);
|
|
|
-
|
|
|
- /*
|
|
|
- * Some buses or devices flag reads by setting the high bits in the
|
|
|
- * register address; since it's always the high bits for all
|
|
|
- * current formats we can do this here rather than in
|
|
|
- * formatting. This may break if we get interesting formats.
|
|
|
- */
|
|
|
- u8[0] |= map->read_flag_mask;
|
|
|
-
|
|
|
+ regmap_set_work_buf_flag_mask(map, map->format.reg_bytes,
|
|
|
+ map->read_flag_mask);
|
|
|
trace_regmap_hw_read_start(map, reg, val_len / map->format.val_bytes);
|
|
|
|
|
|
ret = map->bus->read(map->bus_context, map->work_buf,
|