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 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 | // SPDX-License-Identifier: GPL-2.0+ /* * Designware APB Timer driver * * Copyright (C) 2018 Marek Vasut <marex@denx.de> */ #include <dm.h> #include <clk.h> #include <dt-structs.h> #include <malloc.h> #include <reset.h> #include <timer.h> #include <dm/device_compat.h> #include <asm/io.h> #include <asm/arch/timer.h> #define DW_APB_LOAD_VAL 0x0 #define DW_APB_CURR_VAL 0x4 #define DW_APB_CTRL 0x8 struct dw_apb_timer_priv { uintptr_t regs; struct reset_ctl_bulk resets; }; struct dw_apb_timer_plat { #if CONFIG_IS_ENABLED(OF_PLATDATA) struct dtd_snps_dw_apb_timer dtplat; #endif }; static u64 dw_apb_timer_get_count(struct udevice *dev) { struct dw_apb_timer_priv *priv = dev_get_priv(dev); /* * The DW APB counter counts down, but this function * requires the count to be incrementing. Invert the * result. */ return timer_conv_64(~readl(priv->regs + DW_APB_CURR_VAL)); } static int dw_apb_timer_probe(struct udevice *dev) { struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev); struct dw_apb_timer_priv *priv = dev_get_priv(dev); struct clk clk; int ret; #if CONFIG_IS_ENABLED(OF_PLATDATA) struct dw_apb_timer_plat *plat = dev_get_plat(dev); struct dtd_snps_dw_apb_timer *dtplat = &plat->dtplat; priv->regs = dtplat->reg[0]; ret = clk_get_by_phandle(dev, &dtplat->clocks[0], &clk); if (ret < 0) return ret; uc_priv->clock_rate = dtplat->clock_frequency; #endif if (CONFIG_IS_ENABLED(OF_REAL)) { ret = reset_get_bulk(dev, &priv->resets); if (ret) dev_warn(dev, "Can't get reset: %d\n", ret); else reset_deassert_bulk(&priv->resets); ret = clk_get_by_index(dev, 0, &clk); if (ret) return ret; uc_priv->clock_rate = clk_get_rate(&clk); } /* init timer */ writel(0xffffffff, priv->regs + DW_APB_LOAD_VAL); writel(0xffffffff, priv->regs + DW_APB_CURR_VAL); setbits_le32(priv->regs + DW_APB_CTRL, 0x3); return 0; } static int dw_apb_timer_of_to_plat(struct udevice *dev) { if (CONFIG_IS_ENABLED(OF_REAL)) { struct dw_apb_timer_priv *priv = dev_get_priv(dev); priv->regs = dev_read_addr(dev); } return 0; } static int dw_apb_timer_remove(struct udevice *dev) { struct dw_apb_timer_priv *priv = dev_get_priv(dev); return reset_release_bulk(&priv->resets); } static const struct timer_ops dw_apb_timer_ops = { .get_count = dw_apb_timer_get_count, }; static const struct udevice_id dw_apb_timer_ids[] = { { .compatible = "snps,dw-apb-timer" }, {} }; U_BOOT_DRIVER(snps_dw_apb_timer) = { .name = "snps_dw_apb_timer", .id = UCLASS_TIMER, .ops = &dw_apb_timer_ops, .probe = dw_apb_timer_probe, .of_match = dw_apb_timer_ids, .of_to_plat = dw_apb_timer_of_to_plat, .remove = dw_apb_timer_remove, .priv_auto = sizeof(struct dw_apb_timer_priv), .plat_auto = sizeof(struct dw_apb_timer_plat), }; |