Merge branch 'amlogic-4.9-dev' into bringup/amlogic-4.9/sync20190611_forQ

[GitHub/LineageOS/G12/android_kernel_amlogic_linux-4.9.git] / sound / soc / amlogic / common / iomapres.c

diff --git a/sound/soc/amlogic/common/iomapres.c b/sound/soc/amlogic/common/iomapres.c
new file mode 100644 (file)
index 0000000..5d2d80e
--- /dev/null
+++ b/sound/soc/amlogic/common/iomapres.c
@@ -0,0 +1,75 @@
+/*
+ * sound/soc/amlogic/common/iomapres.c
+ *
+ * Copyright (C) 2019 Amlogic, Inc. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but WITHOUT
+ * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
+ * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
+ * more details.
+ *
+ */
+#include <linux/of.h>
+#include <linux/of_address.h>
+#include <linux/device.h>
+
+#include <linux/amlogic/media/sound/iomapres.h>
+
+struct regmap *regmap_resource(struct device *dev, char *name)
+{
+       struct resource res;
+       void __iomem *base;
+       struct device_node *node = dev->of_node;
+       static struct regmap_config aud_regmap_config = {
+               .reg_bits = 32,
+               .val_bits = 32,
+               .reg_stride = 4,
+       };
+       int i;
+
+       i = of_property_match_string(node, "reg-names", name);
+       if (of_address_to_resource(node, i, &res))
+               return ERR_PTR(-ENOENT);
+
+       base = devm_ioremap_resource(dev, &res);
+       if (IS_ERR(base))
+               return ERR_CAST(base);
+
+       pr_info("%s, %s, start:%#x, size:%#x\n",
+               __func__, name, (u32)res.start, (u32)resource_size(&res));
+
+       aud_regmap_config.max_register = resource_size(&res) - 4;
+       aud_regmap_config.name =
+               devm_kasprintf(dev, GFP_KERNEL, "%s-%s", node->name, name);
+       if (!aud_regmap_config.name)
+               return ERR_PTR(-ENOMEM);
+
+       return devm_regmap_init_mmio(dev, base, &aud_regmap_config);
+}
+
+unsigned int mmio_read(struct regmap *map, unsigned int reg_ofs)
+{
+       unsigned int val;
+
+       regmap_read(map, (reg_ofs << 2), &val);
+
+       return val;
+}
+
+int mmio_write(struct regmap *map, unsigned int reg_ofs, unsigned int value)
+{
+       return regmap_write(map, (reg_ofs << 2), value);
+}
+
+int mmio_update_bits(struct regmap *map,
+                    unsigned int reg_ofs,
+                    unsigned int mask,
+                    unsigned int value)
+{
+       return regmap_update_bits(map, (reg_ofs << 2), mask, value);
+}