OpenHarmony-v4.1-Release/s

/*
 * vendor/amlogic/iomap/iomap.c
 *
 * Copyright (C) 2017 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 <asm/compiler.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/printk.h>
#include <linux/string.h>
#include <linux/of_address.h>
#include <linux/io.h>
#include <linux/regmap.h>
#include <linux/device.h>
#include <linux/of_platform.h>
#include <linux/platform_device.h>
#include <linux/amlogic/iomap.h>
#undef pr_fmt
#define pr_fmt(fmt) "aml_iomap: " fmt

static const struct of_device_id iomap_dt_match[] = {
    {.compatible = "amlogic, iomap"},
    {},
};

static void __iomem *meson_reg_map[IO_BUS_MAX] = {NULL};
static uint meson_reg_max[IO_BUS_MAX] = {0};
void __iomem *vpp_base;
EXPORT_SYMBOL(vpp_base);
unsigned int vpp_max;

inline int aml_reg_read(u32 bus_type, unsigned int reg, unsigned int *val)
{
    if (bus_type < IO_BUS_MAX && (meson_reg_map[bus_type]) && (meson_reg_max[bus_type] >= reg)) {
        *val = readl((meson_reg_map[bus_type] + reg));
        return 0;
    } else {
        return -1;
    }
}
EXPORT_SYMBOL(aml_reg_read);

inline int aml_reg_write(u32 bus_type, unsigned int reg, unsigned int val)
{
    if (bus_type < IO_BUS_MAX && (meson_reg_map[bus_type]) && (meson_reg_max[bus_type] >= reg)) {
        writel(val, (meson_reg_map[bus_type] + reg));
        return 0;
    } else {
        return -1;
    }
}
EXPORT_SYMBOL(aml_reg_write);

int aml_regmap_update_bits(u32 bus_type, unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret = 0;
    unsigned int tmp, orig;

    ret = aml_reg_read(bus_type, reg, &orig);
    if (ret) {
        pr_err("read bus reg %x error %d\n", reg, ret);
        return ret;
    }
    tmp = orig & ~mask;
    tmp |= val & mask;
    ret = aml_reg_write(bus_type, reg, tmp);
    if (ret) {
        pr_err("write bus reg %x error %d\n", reg, ret);
    }
    return ret;
}
EXPORT_SYMBOL(aml_regmap_update_bits);

/*
 * CBUS REG Read Write and Update some bits
 */
int aml_read_cbus(unsigned int reg)
{
    int ret, val;

    ret = aml_reg_read(IO_CBUS_BASE, reg << 2L, &val);
    if (ret) {
        pr_err("read cbus reg %x error %d\n", reg, ret);
        return -1;
    } else {
        return val;
    }
}
EXPORT_SYMBOL(aml_read_cbus);

void aml_write_cbus(unsigned int reg, unsigned int val)
{
    int ret;

    ret = aml_reg_write(IO_CBUS_BASE, reg << 2L, val);
    if (ret) {
        pr_err("write cbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_write_cbus);

void aml_cbus_update_bits(unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret;

    ret = aml_regmap_update_bits(IO_CBUS_BASE, reg << 2L, mask, val);
    if (ret) {
        pr_err("write cbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_cbus_update_bits);

/*
 * AO REG Read Write and Update some bits
 */
int aml_read_aobus(unsigned int reg)
{
    int ret, val;

    ret = aml_reg_read(IO_AOBUS_BASE, reg, &val);
    if (ret) {
        pr_err("read ao bus reg %x error %d\n", reg, ret);
        return -1;
    } else {
        return val;
    }
}
EXPORT_SYMBOL(aml_read_aobus);

void aml_write_aobus(unsigned int reg, unsigned int val)
{
    int ret;

    ret = aml_reg_write(IO_AOBUS_BASE, reg, val);
    if (ret) {
        pr_err("write ao bus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_write_aobus);

void aml_aobus_update_bits(unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret;

    ret = aml_regmap_update_bits(IO_AOBUS_BASE, reg, mask, val);
    if (ret) {
        pr_err("write aobus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_aobus_update_bits);

/*
 ** VCBUS Bus REG Read Write and Update some bits
 */
int aml_read_vcbus(unsigned int reg)
{
    int ret, val;
    ret = aml_reg_read(IO_VAPB_BUS_BASE, reg << 2L, &val);
    if (ret) {
        pr_err("read vcbus reg %x error %d\n", reg, ret);
        return -1;
    } else {
        return val;
    }
}
EXPORT_SYMBOL(aml_read_vcbus);

void aml_write_vcbus(unsigned int reg, unsigned int val)
{
    int ret;

    ret = aml_reg_write(IO_VAPB_BUS_BASE, reg << 2L, val);
    if (ret) {
        pr_err("write vcbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_write_vcbus);

void aml_vcbus_update_bits(unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret;

    ret = aml_regmap_update_bits(IO_VAPB_BUS_BASE, reg << 2L, mask, val);
    if (ret) {
        pr_err("write vcbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_vcbus_update_bits);

/*
 ** DOS BUS Bus REG Read Write and Update some bits
 */
int aml_read_dosbus(unsigned int reg)
{
    int ret, val;

    ret = aml_reg_read(IO_APB_BUS_BASE, reg << 2L, &val);
    if (ret) {
        pr_err("read vcbus reg %x error %d\n", reg, ret);
        return -1;
    } else {
        return val;
    }
}
EXPORT_SYMBOL(aml_read_dosbus);

void aml_write_dosbus(unsigned int reg, unsigned int val)
{
    int ret;

    ret = aml_reg_write(IO_APB_BUS_BASE, reg << 2L, val);
    if (ret) {
        pr_err("write vcbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_write_dosbus);

void aml_dosbus_update_bits(unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret;

    ret = aml_regmap_update_bits(IO_APB_BUS_BASE, reg << 2L, mask, val);
    if (ret) {
        pr_err("write vcbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_dosbus_update_bits);

/*
 * HIUBUS REG Read Write and Update some bits
 */
int aml_read_hiubus(unsigned int reg)
{
    int ret, val;

    ret = aml_reg_read(IO_HIUBUS_BASE, reg << 2L, &val);
    if (ret) {
        pr_err("read cbus reg %x error %d\n", reg, ret);
        return -1;
    } else {
        return val;
    }
}
EXPORT_SYMBOL(aml_read_hiubus);

void aml_write_hiubus(unsigned int reg, unsigned int val)
{
    int ret;

    ret = aml_reg_write(IO_HIUBUS_BASE, reg << 2L, val);
    if (ret) {
        pr_err("write cbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_write_hiubus);

void aml_hiubus_update_bits(unsigned int reg, unsigned int mask, unsigned int val)
{
    int ret;

    ret = aml_regmap_update_bits(IO_HIUBUS_BASE, reg << 2L, mask, val);
    if (ret) {
        pr_err("write cbus reg %x error %d\n", reg, ret);
    }
}
EXPORT_SYMBOL(aml_hiubus_update_bits);

static int iomap_probe(struct platform_device *pdev)
{
    int i = 0;
    struct resource res;
    struct device_node *np, *child;

    np = pdev->dev.of_node;

    for_each_child_of_node(np, child)
    {
        if (of_address_to_resource(child, 0, &res)) {
            return -1;
        }
        meson_reg_map[i] = ioremap(res.start, resource_size(&res));
        meson_reg_max[i] = res.end - res.start;
        i++;
    }
    if (i > IO_VAPB_BUS_BASE) {
        vpp_base = meson_reg_map[IO_VAPB_BUS_BASE];
        vpp_max = meson_reg_max[IO_VAPB_BUS_BASE];
    }
    pr_info("amlogic iomap probe done\n");
    return 0;
}

static struct platform_driver iomap_platform_driver = {
    .probe = iomap_probe,
    .driver =
        {
            .owner = THIS_MODULE,
            .name = "iomap_version",
            .of_match_table = iomap_dt_match,
        },
};

int __init meson_iomap_version_init(void)
{
    int ret;

    ret = platform_driver_register(&iomap_platform_driver);

    return ret;
}
core_initcall(meson_iomap_version_init);