arch/mips/loongson/common/env.c

   1 /*
   2  * Based on Ocelot Linux port, which is
   3  * Copyright 2001 MontaVista Software Inc.
   4  * Author: jsun@mvista.com or jsun@junsun.net
   5  *
   6  * Copyright 2003 ICT CAS
   7  * Author: Michael Guo <guoyi@ict.ac.cn>
   8  *
   9  * Copyright (C) 2007 Lemote Inc. & Insititute of Computing Technology
  10  * Author: Fuxin Zhang, zhangfx@lemote.com
  11  *
  12  * Copyright (C) 2009 Lemote Inc.
  13  * Author: Wu Zhangjin, wuzhangjin@gmail.com
  14  *
  15  * This program is free software; you can redistribute  it and/or modify it
  16  * under  the terms of  the GNU General  Public License as published by the
  17  * Free Software Foundation;  either version 2 of the  License, or (at your
  18  * option) any later version.
  19  */
  20 #include <linux/module.h>
  21 #include <asm/bootinfo.h>
  22 #include <loongson.h>
  23 #include <boot_param.h>
  24 #include <workarounds.h>
  25
  26 u32 cpu_clock_freq;
  27 EXPORT_SYMBOL(cpu_clock_freq);
  28 struct efi_memory_map_loongson *loongson_memmap;
  29 struct loongson_system_configuration loongson_sysconf;
  30
  31 u64 loongson_chipcfg[MAX_PACKAGES] = {0xffffffffbfc00180};
  32 u64 loongson_freqctrl[MAX_PACKAGES];
  33
  34 unsigned long long smp_group[4];
  35
  36 #define parse_even_earlier(res, option, p)                              \
  37 do {                                                                    \
  38         unsigned int tmp __maybe_unused;                                \
  39                                                                         \
  40         if (strncmp(option, (char *)p, strlen(option)) == 0)            \
  41                 tmp = kstrtou32((char *)p + strlen(option"="), 10, &res); \
  42 } while (0)
  43
  44 void __init prom_init_env(void)
  45 {
  46         /* pmon passes arguments in 32bit pointers */
  47         unsigned int processor_id;
  48
  49 #ifndef CONFIG_LEFI_FIRMWARE_INTERFACE
  50         int *_prom_envp;
  51         long l;
  52
  53         /* firmware arguments are initialized in head.S */
  54         _prom_envp = (int *)fw_arg2;
  55
  56         l = (long)*_prom_envp;
  57         while (l != 0) {
  58                 parse_even_earlier(cpu_clock_freq, "cpuclock", l);
  59                 parse_even_earlier(memsize, "memsize", l);
  60                 parse_even_earlier(highmemsize, "highmemsize", l);
  61                 _prom_envp++;
  62                 l = (long)*_prom_envp;
  63         }
  64         if (memsize == 0)
  65                 memsize = 256;
  66         pr_info("memsize=%u, highmemsize=%u\n", memsize, highmemsize);
  67 #else
  68         struct boot_params *boot_p;
  69         struct loongson_params *loongson_p;
  70         struct system_loongson *esys;
  71         struct efi_cpuinfo_loongson *ecpu;
  72         struct irq_source_routing_table *eirq_source;
  73
  74         /* firmware arguments are initialized in head.S */
  75         boot_p = (struct boot_params *)fw_arg2;
  76         loongson_p = &(boot_p->efi.smbios.lp);
  77
  78         esys = (struct system_loongson *)
  79                 ((u64)loongson_p + loongson_p->system_offset);
  80         ecpu = (struct efi_cpuinfo_loongson *)
  81                 ((u64)loongson_p + loongson_p->cpu_offset);
  82         eirq_source = (struct irq_source_routing_table *)
  83                 ((u64)loongson_p + loongson_p->irq_offset);
  84         loongson_memmap = (struct efi_memory_map_loongson *)
  85                 ((u64)loongson_p + loongson_p->memory_offset);
  86
  87         cpu_clock_freq = ecpu->cpu_clock_freq;
  88         loongson_sysconf.cputype = ecpu->cputype;
  89         if (ecpu->cputype == Loongson_3A) {
  90                 loongson_sysconf.cores_per_node = 4;
  91                 loongson_sysconf.cores_per_package = 4;
  92                 smp_group[0] = 0x900000003ff01000;
  93                 smp_group[1] = 0x900010003ff01000;
  94                 smp_group[2] = 0x900020003ff01000;
  95                 smp_group[3] = 0x900030003ff01000;
  96                 loongson_chipcfg[0] = 0x900000001fe00180;
  97                 loongson_chipcfg[1] = 0x900010001fe00180;
  98                 loongson_chipcfg[2] = 0x900020001fe00180;
  99                 loongson_chipcfg[3] = 0x900030001fe00180;
 100                 loongson_sysconf.ht_control_base = 0x90000EFDFB000000;
 101                 loongson_sysconf.workarounds = WORKAROUND_CPUFREQ;
 102         } else if (ecpu->cputype == Loongson_3B) {
 103                 loongson_sysconf.cores_per_node = 4; /* One chip has 2 nodes */
 104                 loongson_sysconf.cores_per_package = 8;
 105                 smp_group[0] = 0x900000003ff01000;
 106                 smp_group[1] = 0x900010003ff05000;
 107                 smp_group[2] = 0x900020003ff09000;
 108                 smp_group[3] = 0x900030003ff0d000;
 109                 loongson_chipcfg[0] = 0x900000001fe00180;
 110                 loongson_chipcfg[1] = 0x900020001fe00180;
 111                 loongson_chipcfg[2] = 0x900040001fe00180;
 112                 loongson_chipcfg[3] = 0x900060001fe00180;
 113                 loongson_freqctrl[0] = 0x900000001fe001d0;
 114                 loongson_freqctrl[1] = 0x900020001fe001d0;
 115                 loongson_freqctrl[2] = 0x900040001fe001d0;
 116                 loongson_freqctrl[3] = 0x900060001fe001d0;
 117                 loongson_sysconf.ht_control_base = 0x90001EFDFB000000;
 118                 loongson_sysconf.workarounds = WORKAROUND_CPUHOTPLUG;
 119         } else {
 120                 loongson_sysconf.cores_per_node = 1;
 121                 loongson_sysconf.cores_per_package = 1;
 122                 loongson_chipcfg[0] = 0x900000001fe00180;
 123         }
 124
 125         loongson_sysconf.nr_cpus = ecpu->nr_cpus;
 126         loongson_sysconf.boot_cpu_id = ecpu->cpu_startup_core_id;
 127         loongson_sysconf.reserved_cpus_mask = ecpu->reserved_cores_mask;
 128         if (ecpu->nr_cpus > NR_CPUS || ecpu->nr_cpus == 0)
 129                 loongson_sysconf.nr_cpus = NR_CPUS;
 130         loongson_sysconf.nr_nodes = (loongson_sysconf.nr_cpus +
 131                 loongson_sysconf.cores_per_node - 1) /
 132                 loongson_sysconf.cores_per_node;
 133
 134         loongson_sysconf.pci_mem_start_addr = eirq_source->pci_mem_start_addr;
 135         loongson_sysconf.pci_mem_end_addr = eirq_source->pci_mem_end_addr;
 136         loongson_sysconf.pci_io_base = eirq_source->pci_io_start_addr;
 137         loongson_sysconf.dma_mask_bits = eirq_source->dma_mask_bits;
 138         if (loongson_sysconf.dma_mask_bits < 32 ||
 139                 loongson_sysconf.dma_mask_bits > 64)
 140                 loongson_sysconf.dma_mask_bits = 32;
 141
 142         loongson_sysconf.restart_addr = boot_p->reset_system.ResetWarm;
 143         loongson_sysconf.poweroff_addr = boot_p->reset_system.Shutdown;
 144         loongson_sysconf.suspend_addr = boot_p->reset_system.DoSuspend;
 145
 146         loongson_sysconf.vgabios_addr = boot_p->efi.smbios.vga_bios;
 147         pr_debug("Shutdown Addr: %llx, Restart Addr: %llx, VBIOS Addr: %llx\n",
 148                 loongson_sysconf.poweroff_addr, loongson_sysconf.restart_addr,
 149                 loongson_sysconf.vgabios_addr);
 150
 151         memset(loongson_sysconf.ecname, 0, 32);
 152         if (esys->has_ec)
 153                 memcpy(loongson_sysconf.ecname, esys->ec_name, 32);
 154         loongson_sysconf.workarounds |= esys->workarounds;
 155
 156         loongson_sysconf.nr_uarts = esys->nr_uarts;
 157         if (esys->nr_uarts < 1 || esys->nr_uarts > MAX_UARTS)
 158                 loongson_sysconf.nr_uarts = 1;
 159         memcpy(loongson_sysconf.uarts, esys->uarts,
 160                 sizeof(struct uart_device) * loongson_sysconf.nr_uarts);
 161
 162         loongson_sysconf.nr_sensors = esys->nr_sensors;
 163         if (loongson_sysconf.nr_sensors > MAX_SENSORS)
 164                 loongson_sysconf.nr_sensors = 0;
 165         if (loongson_sysconf.nr_sensors)
 166                 memcpy(loongson_sysconf.sensors, esys->sensors,
 167                         sizeof(struct sensor_device) * loongson_sysconf.nr_sensors);
 168 #endif
 169         if (cpu_clock_freq == 0) {
 170                 processor_id = (&current_cpu_data)->processor_id;
 171                 switch (processor_id & PRID_REV_MASK) {
 172                 case PRID_REV_LOONGSON2E:
 173                         cpu_clock_freq = 533080000;
 174                         break;
 175                 case PRID_REV_LOONGSON2F:
 176                         cpu_clock_freq = 797000000;
 177                         break;
 178                 case PRID_REV_LOONGSON3A:
 179                         cpu_clock_freq = 900000000;
 180                         break;
 181                 case PRID_REV_LOONGSON3B_R1:
 182                 case PRID_REV_LOONGSON3B_R2:
 183                         cpu_clock_freq = 1000000000;
 184                         break;
 185                 default:
 186                         cpu_clock_freq = 100000000;
 187                         break;
 188                 }
 189         }
 190         pr_info("CpuClock = %u\n", cpu_clock_freq);
 191 }