hc
2024-08-12 233ab1bd4c5697f5cdec94e60206e8c6ac609b4c
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
124
125
/*
 * Copyright (C) 2013 Imagination Technologies
 * Author: Paul Burton <paul.burton@imgtec.com>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <msc01.h>
#include <pci.h>
#include <pci_msc01.h>
#include <asm/io.h>
 
#define PCI_ACCESS_READ  0
#define PCI_ACCESS_WRITE 1
 
struct msc01_pci_controller {
   struct pci_controller hose;
   void *base;
};
 
static inline struct msc01_pci_controller *
hose_to_msc01(struct pci_controller *hose)
{
   return container_of(hose, struct msc01_pci_controller, hose);
}
 
static int msc01_config_access(struct msc01_pci_controller *msc01,
                  unsigned char access_type, pci_dev_t bdf,
                  int where, u32 *data)
{
   const u32 aborts = MSC01_PCI_INTSTAT_MA_MSK | MSC01_PCI_INTSTAT_TA_MSK;
   void *intstat = msc01->base + MSC01_PCI_INTSTAT_OFS;
   void *cfgdata = msc01->base + MSC01_PCI_CFGDATA_OFS;
   unsigned int bus = PCI_BUS(bdf);
   unsigned int dev = PCI_DEV(bdf);
   unsigned int devfn = PCI_DEV(bdf) << 3 | PCI_FUNC(bdf);
 
   /* clear abort status */
   __raw_writel(aborts, intstat);
 
   /* setup address */
   __raw_writel((bus << MSC01_PCI_CFGADDR_BNUM_SHF) |
            (dev << MSC01_PCI_CFGADDR_DNUM_SHF) |
            (devfn << MSC01_PCI_CFGADDR_FNUM_SHF) |
            ((where / 4) << MSC01_PCI_CFGADDR_RNUM_SHF),
            msc01->base + MSC01_PCI_CFGADDR_OFS);
 
   /* perform access */
   if (access_type == PCI_ACCESS_WRITE)
       __raw_writel(*data, cfgdata);
   else
       *data = __raw_readl(cfgdata);
 
   /* check for aborts */
   if (__raw_readl(intstat) & aborts) {
       /* clear abort status */
       __raw_writel(aborts, intstat);
       return -1;
   }
 
   return 0;
}
 
static int msc01_read_config_dword(struct pci_controller *hose, pci_dev_t dev,
                  int where, u32 *value)
{
   struct msc01_pci_controller *msc01 = hose_to_msc01(hose);
 
   *value = 0xffffffff;
   return msc01_config_access(msc01, PCI_ACCESS_READ, dev, where, value);
}
 
static int msc01_write_config_dword(struct pci_controller *hose, pci_dev_t dev,
                   int where, u32 value)
{
   struct msc01_pci_controller *gt = hose_to_msc01(hose);
   u32 data = value;
 
   return msc01_config_access(gt, PCI_ACCESS_WRITE, dev, where, &data);
}
 
void msc01_pci_init(void *base, unsigned long sys_bus, unsigned long sys_phys,
           unsigned long sys_size, unsigned long mem_bus,
           unsigned long mem_phys, unsigned long mem_size,
           unsigned long io_bus, unsigned long io_phys,
           unsigned long io_size)
{
   static struct msc01_pci_controller global_msc01;
   struct msc01_pci_controller *msc01;
   struct pci_controller *hose;
 
   msc01 = &global_msc01;
   msc01->base = base;
 
   hose = &msc01->hose;
 
   hose->first_busno = 0;
   hose->last_busno = 0;
 
   /* System memory space */
   pci_set_region(&hose->regions[0], sys_bus, sys_phys, sys_size,
              PCI_REGION_MEM | PCI_REGION_SYS_MEMORY);
 
   /* PCI memory space */
   pci_set_region(&hose->regions[1], mem_bus, mem_phys, mem_size,
              PCI_REGION_MEM);
 
   /* PCI I/O space */
   pci_set_region(&hose->regions[2], io_bus, io_phys, io_size,
              PCI_REGION_IO);
 
   hose->region_count = 3;
 
   pci_set_ops(hose,
           pci_hose_read_config_byte_via_dword,
           pci_hose_read_config_word_via_dword,
           msc01_read_config_dword,
           pci_hose_write_config_byte_via_dword,
           pci_hose_write_config_word_via_dword,
           msc01_write_config_dword);
 
   pci_register_hose(hose);
   hose->last_busno = pci_hose_scan(hose);
}