hc
2023-02-13 e440ec23c5a540cdd3f7464e8779219be6fd3d95
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
/*
 * Based on linux/arch/mips/txx9/rbtx4938/setup.c,
 *        and RBTX49xx patch from CELF patch archive.
 *
 * Copyright 2001, 2003-2005 MontaVista Software Inc.
 * Copyright (C) 2004 by Ralf Baechle (ralf@linux-mips.org)
 * (C) Copyright TOSHIBA CORPORATION 2000-2001, 2004-2007
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 */
#include <linux/init.h>
#include <linux/pci.h>
#include <linux/kernel.h>
#include <linux/interrupt.h>
#include <asm/txx9/generic.h>
#include <asm/txx9/tx4927.h>
 
int __init tx4927_report_pciclk(void)
{
   int pciclk = 0;
 
   pr_info("PCIC --%s PCICLK:",
       (__raw_readq(&tx4927_ccfgptr->ccfg) & TX4927_CCFG_PCI66) ?
       " PCI66" : "");
   if (__raw_readq(&tx4927_ccfgptr->pcfg) & TX4927_PCFG_PCICLKEN_ALL) {
       u64 ccfg = __raw_readq(&tx4927_ccfgptr->ccfg);
       switch ((unsigned long)ccfg &
           TX4927_CCFG_PCIDIVMODE_MASK) {
       case TX4927_CCFG_PCIDIVMODE_2_5:
           pciclk = txx9_cpu_clock * 2 / 5; break;
       case TX4927_CCFG_PCIDIVMODE_3:
           pciclk = txx9_cpu_clock / 3; break;
       case TX4927_CCFG_PCIDIVMODE_5:
           pciclk = txx9_cpu_clock / 5; break;
       case TX4927_CCFG_PCIDIVMODE_6:
           pciclk = txx9_cpu_clock / 6; break;
       }
       pr_cont("Internal(%u.%uMHz)",
           (pciclk + 50000) / 1000000,
           ((pciclk + 50000) / 100000) % 10);
   } else {
       pr_cont("External");
       pciclk = -1;
   }
   pr_cont("\n");
   return pciclk;
}
 
int __init tx4927_pciclk66_setup(void)
{
   int pciclk;
 
   /* Assert M66EN */
   tx4927_ccfg_set(TX4927_CCFG_PCI66);
   /* Double PCICLK (if possible) */
   if (__raw_readq(&tx4927_ccfgptr->pcfg) & TX4927_PCFG_PCICLKEN_ALL) {
       unsigned int pcidivmode = 0;
       u64 ccfg = __raw_readq(&tx4927_ccfgptr->ccfg);
       pcidivmode = (unsigned long)ccfg &
           TX4927_CCFG_PCIDIVMODE_MASK;
       switch (pcidivmode) {
       case TX4927_CCFG_PCIDIVMODE_5:
       case TX4927_CCFG_PCIDIVMODE_2_5:
           pcidivmode = TX4927_CCFG_PCIDIVMODE_2_5;
           pciclk = txx9_cpu_clock * 2 / 5;
           break;
       case TX4927_CCFG_PCIDIVMODE_6:
       case TX4927_CCFG_PCIDIVMODE_3:
       default:
           pcidivmode = TX4927_CCFG_PCIDIVMODE_3;
           pciclk = txx9_cpu_clock / 3;
       }
       tx4927_ccfg_change(TX4927_CCFG_PCIDIVMODE_MASK,
                  pcidivmode);
       pr_debug("PCICLK: ccfg:%08lx\n",
            (unsigned long)__raw_readq(&tx4927_ccfgptr->ccfg));
   } else
       pciclk = -1;
   return pciclk;
}
 
void __init tx4927_setup_pcierr_irq(void)
{
   if (request_irq(TXX9_IRQ_BASE + TX4927_IR_PCIERR,
           tx4927_pcierr_interrupt,
           0, "PCI error",
           (void *)TX4927_PCIC_REG))
       pr_warn("Failed to request irq for PCIERR\n");
}