drivers/memory/tegra/tegra186-emc.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2019 NVIDIA CORPORATION.  All rights reserved.
   4  */
   5
   6 #include <linux/clk.h>
   7 #include <linux/debugfs.h>
   8 #include <linux/module.h>
   9 #include <linux/mod_devicetable.h>
  10 #include <linux/platform_device.h>
  11
  12 #include <soc/tegra/bpmp.h>
  13
  14 struct tegra186_emc_dvfs {
  15         unsigned long latency;
  16         unsigned long rate;
  17 };
  18
  19 struct tegra186_emc {
  20         struct tegra_bpmp *bpmp;
  21         struct device *dev;
  22         struct clk *clk;
  23
  24         struct tegra186_emc_dvfs *dvfs;
  25         unsigned int num_dvfs;
  26
  27         struct {
  28                 struct dentry *root;
  29                 unsigned long min_rate;
  30                 unsigned long max_rate;
  31         } debugfs;
  32 };
  33
  34 /*
  35  * debugfs interface
  36  *
  37  * The memory controller driver exposes some files in debugfs that can be used
  38  * to control the EMC frequency. The top-level directory can be found here:
  39  *
  40  *   /sys/kernel/debug/emc
  41  *
  42  * It contains the following files:
  43  *
  44  *   - available_rates: This file contains a list of valid, space-separated
  45  *     EMC frequencies.
  46  *
  47  *   - min_rate: Writing a value to this file sets the given frequency as the
  48  *       floor of the permitted range. If this is higher than the currently
  49  *       configured EMC frequency, this will cause the frequency to be
  50  *       increased so that it stays within the valid range.
  51  *
  52  *   - max_rate: Similarily to the min_rate file, writing a value to this file
  53  *       sets the given frequency as the ceiling of the permitted range. If
  54  *       the value is lower than the currently configured EMC frequency, this
  55  *       will cause the frequency to be decreased so that it stays within the
  56  *       valid range.
  57  */
  58
  59 static bool tegra186_emc_validate_rate(struct tegra186_emc *emc,
  60                                        unsigned long rate)
  61 {
  62         unsigned int i;
  63
  64         for (i = 0; i < emc->num_dvfs; i++)
  65                 if (rate == emc->dvfs[i].rate)
  66                         return true;
  67
  68         return false;
  69 }
  70
  71 static int tegra186_emc_debug_available_rates_show(struct seq_file *s,
  72                                                    void *data)
  73 {
  74         struct tegra186_emc *emc = s->private;
  75         const char *prefix = "";
  76         unsigned int i;
  77
  78         for (i = 0; i < emc->num_dvfs; i++) {
  79                 seq_printf(s, "%s%lu", prefix, emc->dvfs[i].rate);
  80                 prefix = " ";
  81         }
  82
  83         seq_puts(s, "\n");
  84
  85         return 0;
  86 }
  87
  88 static int tegra186_emc_debug_available_rates_open(struct inode *inode,
  89                                                    struct file *file)
  90 {
  91         return single_open(file, tegra186_emc_debug_available_rates_show,
  92                            inode->i_private);
  93 }
  94
  95 static const struct file_operations tegra186_emc_debug_available_rates_fops = {
  96         .open = tegra186_emc_debug_available_rates_open,
  97         .read = seq_read,
  98         .llseek = seq_lseek,
  99         .release = single_release,
 100 };
 101
 102 static int tegra186_emc_debug_min_rate_get(void *data, u64 *rate)
 103 {
 104         struct tegra186_emc *emc = data;
 105
 106         *rate = emc->debugfs.min_rate;
 107
 108         return 0;
 109 }
 110
 111 static int tegra186_emc_debug_min_rate_set(void *data, u64 rate)
 112 {
 113         struct tegra186_emc *emc = data;
 114         int err;
 115
 116         if (!tegra186_emc_validate_rate(emc, rate))
 117                 return -EINVAL;
 118
 119         err = clk_set_min_rate(emc->clk, rate);
 120         if (err < 0)
 121                 return err;
 122
 123         emc->debugfs.min_rate = rate;
 124
 125         return 0;
 126 }
 127
 128 DEFINE_SIMPLE_ATTRIBUTE(tegra186_emc_debug_min_rate_fops,
 129                         tegra186_emc_debug_min_rate_get,
 130                         tegra186_emc_debug_min_rate_set, "%llu\n");
 131
 132 static int tegra186_emc_debug_max_rate_get(void *data, u64 *rate)
 133 {
 134         struct tegra186_emc *emc = data;
 135
 136         *rate = emc->debugfs.max_rate;
 137
 138         return 0;
 139 }
 140
 141 static int tegra186_emc_debug_max_rate_set(void *data, u64 rate)
 142 {
 143         struct tegra186_emc *emc = data;
 144         int err;
 145
 146         if (!tegra186_emc_validate_rate(emc, rate))
 147                 return -EINVAL;
 148
 149         err = clk_set_max_rate(emc->clk, rate);
 150         if (err < 0)
 151                 return err;
 152
 153         emc->debugfs.max_rate = rate;
 154
 155         return 0;
 156 }
 157
 158 DEFINE_SIMPLE_ATTRIBUTE(tegra186_emc_debug_max_rate_fops,
 159                         tegra186_emc_debug_max_rate_get,
 160                         tegra186_emc_debug_max_rate_set, "%llu\n");
 161
 162 static int tegra186_emc_probe(struct platform_device *pdev)
 163 {
 164         struct mrq_emc_dvfs_latency_response response;
 165         struct tegra_bpmp_message msg;
 166         struct tegra186_emc *emc;
 167         unsigned int i;
 168         int err;
 169
 170         emc = devm_kzalloc(&pdev->dev, sizeof(*emc), GFP_KERNEL);
 171         if (!emc)
 172                 return -ENOMEM;
 173
 174         emc->bpmp = tegra_bpmp_get(&pdev->dev);
 175         if (IS_ERR(emc->bpmp))
 176                 return dev_err_probe(&pdev->dev, PTR_ERR(emc->bpmp), "failed to get BPMP\n");
 177
 178         emc->clk = devm_clk_get(&pdev->dev, "emc");
 179         if (IS_ERR(emc->clk)) {
 180                 err = PTR_ERR(emc->clk);
 181                 dev_err(&pdev->dev, "failed to get EMC clock: %d\n", err);
 182                 goto put_bpmp;
 183         }
 184
 185         platform_set_drvdata(pdev, emc);
 186         emc->dev = &pdev->dev;
 187
 188         memset(&msg, 0, sizeof(msg));
 189         msg.mrq = MRQ_EMC_DVFS_LATENCY;
 190         msg.tx.data = NULL;
 191         msg.tx.size = 0;
 192         msg.rx.data = &response;
 193         msg.rx.size = sizeof(response);
 194
 195         err = tegra_bpmp_transfer(emc->bpmp, &msg);
 196         if (err < 0) {
 197                 dev_err(&pdev->dev, "failed to EMC DVFS pairs: %d\n", err);
 198                 goto put_bpmp;
 199         }
 200
 201         emc->debugfs.min_rate = ULONG_MAX;
 202         emc->debugfs.max_rate = 0;
 203
 204         emc->num_dvfs = response.num_pairs;
 205
 206         emc->dvfs = devm_kmalloc_array(&pdev->dev, emc->num_dvfs,
 207                                        sizeof(*emc->dvfs), GFP_KERNEL);
 208         if (!emc->dvfs) {
 209                 err = -ENOMEM;
 210                 goto put_bpmp;
 211         }
 212
 213         dev_dbg(&pdev->dev, "%u DVFS pairs:\n", emc->num_dvfs);
 214
 215         for (i = 0; i < emc->num_dvfs; i++) {
 216                 emc->dvfs[i].rate = response.pairs[i].freq * 1000;
 217                 emc->dvfs[i].latency = response.pairs[i].latency;
 218
 219                 if (emc->dvfs[i].rate < emc->debugfs.min_rate)
 220                         emc->debugfs.min_rate = emc->dvfs[i].rate;
 221
 222                 if (emc->dvfs[i].rate > emc->debugfs.max_rate)
 223                         emc->debugfs.max_rate = emc->dvfs[i].rate;
 224
 225                 dev_dbg(&pdev->dev, "  %2u: %lu Hz -> %lu us\n", i,
 226                         emc->dvfs[i].rate, emc->dvfs[i].latency);
 227         }
 228
 229         err = clk_set_rate_range(emc->clk, emc->debugfs.min_rate,
 230                                  emc->debugfs.max_rate);
 231         if (err < 0) {
 232                 dev_err(&pdev->dev,
 233                         "failed to set rate range [%lu-%lu] for %pC\n",
 234                         emc->debugfs.min_rate, emc->debugfs.max_rate,
 235                         emc->clk);
 236                 goto put_bpmp;
 237         }
 238
 239         emc->debugfs.root = debugfs_create_dir("emc", NULL);
 240         debugfs_create_file("available_rates", S_IRUGO, emc->debugfs.root,
 241                             emc, &tegra186_emc_debug_available_rates_fops);
 242         debugfs_create_file("min_rate", S_IRUGO | S_IWUSR, emc->debugfs.root,
 243                             emc, &tegra186_emc_debug_min_rate_fops);
 244         debugfs_create_file("max_rate", S_IRUGO | S_IWUSR, emc->debugfs.root,
 245                             emc, &tegra186_emc_debug_max_rate_fops);
 246
 247         return 0;
 248
 249 put_bpmp:
 250         tegra_bpmp_put(emc->bpmp);
 251         return err;
 252 }
 253
 254 static int tegra186_emc_remove(struct platform_device *pdev)
 255 {
 256         struct tegra186_emc *emc = platform_get_drvdata(pdev);
 257
 258         debugfs_remove_recursive(emc->debugfs.root);
 259         tegra_bpmp_put(emc->bpmp);
 260
 261         return 0;
 262 }
 263
 264 static const struct of_device_id tegra186_emc_of_match[] = {
 265 #if defined(CONFIG_ARCH_TEGRA_186_SOC)
 266         { .compatible = "nvidia,tegra186-emc" },
 267 #endif
 268 #if defined(CONFIG_ARCH_TEGRA_194_SOC)
 269         { .compatible = "nvidia,tegra194-emc" },
 270 #endif
 271         { /* sentinel */ }
 272 };
 273 MODULE_DEVICE_TABLE(of, tegra186_emc_of_match);
 274
 275 static struct platform_driver tegra186_emc_driver = {
 276         .driver = {
 277                 .name = "tegra186-emc",
 278                 .of_match_table = tegra186_emc_of_match,
 279                 .suppress_bind_attrs = true,
 280         },
 281         .probe = tegra186_emc_probe,
 282         .remove = tegra186_emc_remove,
 283 };
 284 module_platform_driver(tegra186_emc_driver);
 285
 286 MODULE_AUTHOR("Thierry Reding <treding@nvidia.com>");
 287 MODULE_DESCRIPTION("NVIDIA Tegra186 External Memory Controller driver");
 288 MODULE_LICENSE("GPL v2");