drivers/soc/tegra/fuse/speedo-tegra20.c

   1 /*
   2  * Copyright (c) 2012-2014, NVIDIA CORPORATION.  All rights reserved.
   3  *
   4  * This program is free software; you can redistribute it and/or modify it
   5  * under the terms and conditions of the GNU General Public License,
   6  * version 2, as published by the Free Software Foundation.
   7  *
   8  * This program is distributed in the hope it will be useful, but WITHOUT
   9  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  10  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  11  * more details.
  12  *
  13  * You should have received a copy of the GNU General Public License
  14  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  15  */
  16
  17 #include <linux/bug.h>
  18 #include <linux/device.h>
  19 #include <linux/kernel.h>
  20
  21 #include <soc/tegra/fuse.h>
  22
  23 #include "fuse.h"
  24
  25 #define CPU_SPEEDO_LSBIT                20
  26 #define CPU_SPEEDO_MSBIT                29
  27 #define CPU_SPEEDO_REDUND_LSBIT         30
  28 #define CPU_SPEEDO_REDUND_MSBIT         39
  29 #define CPU_SPEEDO_REDUND_OFFS  (CPU_SPEEDO_REDUND_MSBIT - CPU_SPEEDO_MSBIT)
  30
  31 #define SOC_SPEEDO_LSBIT                40
  32 #define SOC_SPEEDO_MSBIT                47
  33 #define SOC_SPEEDO_REDUND_LSBIT         48
  34 #define SOC_SPEEDO_REDUND_MSBIT         55
  35 #define SOC_SPEEDO_REDUND_OFFS  (SOC_SPEEDO_REDUND_MSBIT - SOC_SPEEDO_MSBIT)
  36
  37 #define SPEEDO_MULT                     4
  38
  39 #define PROCESS_CORNERS_NUM             4
  40
  41 #define SPEEDO_ID_SELECT_0(rev)         ((rev) <= 2)
  42 #define SPEEDO_ID_SELECT_1(sku)         \
  43         (((sku) != 20) && ((sku) != 23) && ((sku) != 24) && \
  44          ((sku) != 27) && ((sku) != 28))
  45
  46 enum {
  47         SPEEDO_ID_0,
  48         SPEEDO_ID_1,
  49         SPEEDO_ID_2,
  50         SPEEDO_ID_COUNT,
  51 };
  52
  53 static const u32 __initconst cpu_process_speedos[][PROCESS_CORNERS_NUM] = {
  54         {315, 366, 420, UINT_MAX},
  55         {303, 368, 419, UINT_MAX},
  56         {316, 331, 383, UINT_MAX},
  57 };
  58
  59 static const u32 __initconst soc_process_speedos[][PROCESS_CORNERS_NUM] = {
  60         {165, 195, 224, UINT_MAX},
  61         {165, 195, 224, UINT_MAX},
  62         {165, 195, 224, UINT_MAX},
  63 };
  64
  65 void __init tegra20_init_speedo_data(struct tegra_sku_info *sku_info)
  66 {
  67         u32 reg;
  68         u32 val;
  69         int i;
  70
  71         BUILD_BUG_ON(ARRAY_SIZE(cpu_process_speedos) != SPEEDO_ID_COUNT);
  72         BUILD_BUG_ON(ARRAY_SIZE(soc_process_speedos) != SPEEDO_ID_COUNT);
  73
  74         if (SPEEDO_ID_SELECT_0(sku_info->revision))
  75                 sku_info->soc_speedo_id = SPEEDO_ID_0;
  76         else if (SPEEDO_ID_SELECT_1(sku_info->sku_id))
  77                 sku_info->soc_speedo_id = SPEEDO_ID_1;
  78         else
  79                 sku_info->soc_speedo_id = SPEEDO_ID_2;
  80
  81         val = 0;
  82         for (i = CPU_SPEEDO_MSBIT; i >= CPU_SPEEDO_LSBIT; i--) {
  83                 reg = tegra_fuse_read_spare(i) |
  84                         tegra_fuse_read_spare(i + CPU_SPEEDO_REDUND_OFFS);
  85                 val = (val << 1) | (reg & 0x1);
  86         }
  87         val = val * SPEEDO_MULT;
  88         pr_debug("Tegra CPU speedo value %u\n", val);
  89
  90         for (i = 0; i < (PROCESS_CORNERS_NUM - 1); i++) {
  91                 if (val <= cpu_process_speedos[sku_info->soc_speedo_id][i])
  92                         break;
  93         }
  94         sku_info->cpu_process_id = i;
  95
  96         val = 0;
  97         for (i = SOC_SPEEDO_MSBIT; i >= SOC_SPEEDO_LSBIT; i--) {
  98                 reg = tegra_fuse_read_spare(i) |
  99                         tegra_fuse_read_spare(i + SOC_SPEEDO_REDUND_OFFS);
 100                 val = (val << 1) | (reg & 0x1);
 101         }
 102         val = val * SPEEDO_MULT;
 103         pr_debug("Core speedo value %u\n", val);
 104
 105         for (i = 0; i < (PROCESS_CORNERS_NUM - 1); i++) {
 106                 if (val <= soc_process_speedos[sku_info->soc_speedo_id][i])
 107                         break;
 108         }
 109         sku_info->soc_process_id = i;
 110 }