Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 | // SPDX-License-Identifier: GPL-2.0-or-later /* * Copyright 2015 Toradex AG * * Stefan Agner <stefan@agner.ch> * * Freescale TCON device driver */ #include <linux/clk.h> #include <linux/io.h> #include <linux/mm.h> #include <linux/of_address.h> #include <linux/platform_device.h> #include <linux/regmap.h> #include "fsl_tcon.h" void fsl_tcon_bypass_disable(struct fsl_tcon *tcon) { regmap_update_bits(tcon->regs, FSL_TCON_CTRL1, FSL_TCON_CTRL1_TCON_BYPASS, 0); } void fsl_tcon_bypass_enable(struct fsl_tcon *tcon) { regmap_update_bits(tcon->regs, FSL_TCON_CTRL1, FSL_TCON_CTRL1_TCON_BYPASS, FSL_TCON_CTRL1_TCON_BYPASS); } static struct regmap_config fsl_tcon_regmap_config = { .reg_bits = 32, .reg_stride = 4, .val_bits = 32, .name = "tcon", }; static int fsl_tcon_init_regmap(struct device *dev, struct fsl_tcon *tcon, struct device_node *np) { struct resource res; void __iomem *regs; if (of_address_to_resource(np, 0, &res)) return -EINVAL; regs = devm_ioremap_resource(dev, &res); if (IS_ERR(regs)) return PTR_ERR(regs); tcon->regs = devm_regmap_init_mmio(dev, regs, &fsl_tcon_regmap_config); return PTR_ERR_OR_ZERO(tcon->regs); } struct fsl_tcon *fsl_tcon_init(struct device *dev) { struct fsl_tcon *tcon; struct device_node *np; int ret; /* TCON node is not mandatory, some devices do not provide TCON */ np = of_parse_phandle(dev->of_node, "fsl,tcon", 0); if (!np) return NULL; tcon = devm_kzalloc(dev, sizeof(*tcon), GFP_KERNEL); if (!tcon) goto err_node_put; ret = fsl_tcon_init_regmap(dev, tcon, np); if (ret) { dev_err(dev, "Couldn't create the TCON regmap\n"); goto err_node_put; } tcon->ipg_clk = of_clk_get_by_name(np, "ipg"); if (IS_ERR(tcon->ipg_clk)) { dev_err(dev, "Couldn't get the TCON bus clock\n"); goto err_node_put; } ret = clk_prepare_enable(tcon->ipg_clk); if (ret) { dev_err(dev, "Couldn't enable the TCON clock\n"); goto err_node_put; } of_node_put(np); dev_info(dev, "Using TCON in bypass mode\n"); return tcon; err_node_put: of_node_put(np); return NULL; } void fsl_tcon_free(struct fsl_tcon *tcon) { clk_disable_unprepare(tcon->ipg_clk); clk_put(tcon->ipg_clk); } |