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
126
|
/*
* 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.
*
* SNI specific PCI support for RM200/RM300.
*/
#include <linux/config.h>
#include <linux/bios32.h>
#include <linux/pci.h>
#include <linux/types.h>
#include <asm/byteorder.h>
#include <asm/pci.h>
#include <asm/sni.h>
#ifdef CONFIG_PCI
extern inline u32 mkaddr(unsigned char bus, unsigned char dev_fn,
unsigned char where)
{
return (((bus & 0xff) << 0x10) |
((dev_fn & 0xff) << 0x08) |
((where & 0xfc)));
}
static unsigned long sni_rm200_pcibios_fixup (unsigned long memory_start,
unsigned long memory_end)
{
/* I guess it's ok to do exactly nothing. */
return memory_start;
}
static int sni_rm200_pcibios_read_config_byte (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned char *val)
{
u32 res;
*(volatile u32 *)PCIMT_CONFIG_ADDRESS = mkaddr(bus, dev_fn, where);
res = *(volatile u32 *)PCIMT_CONFIG_DATA;
res = le32_to_cpu(res);
*val = res;
return PCIBIOS_SUCCESSFUL;
}
static int sni_rm200_pcibios_read_config_word (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned short *val)
{
u32 res;
if (where & 1)
return PCIBIOS_BAD_REGISTER_NUMBER;
*(volatile u32 *)PCIMT_CONFIG_ADDRESS = mkaddr(bus, dev_fn, where);
res = *(volatile u32 *)PCIMT_CONFIG_DATA;
res = le32_to_cpu(res);
*val = res;
return PCIBIOS_SUCCESSFUL;
}
static int sni_rm200_pcibios_read_config_dword (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned int *val)
{
u32 res;
if (where & 3)
return PCIBIOS_BAD_REGISTER_NUMBER;
*(volatile u32 *)PCIMT_CONFIG_ADDRESS = mkaddr(bus, dev_fn, where);
res = *(volatile u32 *)PCIMT_CONFIG_DATA;
res = le32_to_cpu(res);
*val = res;
return PCIBIOS_SUCCESSFUL;
}
static int sni_rm200_pcibios_write_config_byte (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned char val)
{
/* To do */
return PCIBIOS_SUCCESSFUL;
}
static int sni_rm200_pcibios_write_config_word (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned short val)
{
/* To do */
return PCIBIOS_SUCCESSFUL;
}
static int sni_rm200_pcibios_write_config_dword (unsigned char bus,
unsigned char dev_fn,
unsigned char where,
unsigned int val)
{
if (where & 3)
return PCIBIOS_BAD_REGISTER_NUMBER;
*(volatile u32 *)PCIMT_CONFIG_ADDRESS = mkaddr(bus, dev_fn, where);
*(volatile u32 *)PCIMT_CONFIG_DATA = le32_to_cpu(val);
return PCIBIOS_SUCCESSFUL;
}
unsigned long sni_rm200_pcibios_init(unsigned long memory_start, unsigned long memory_end)
{
_pcibios_fixup = sni_rm200_pcibios_fixup;
_pcibios_read_config_byte = sni_rm200_pcibios_read_config_byte;
_pcibios_read_config_word = sni_rm200_pcibios_read_config_word;
_pcibios_read_config_dword = sni_rm200_pcibios_read_config_dword;
_pcibios_write_config_byte = sni_rm200_pcibios_write_config_byte;
_pcibios_write_config_word = sni_rm200_pcibios_write_config_word;
_pcibios_write_config_dword = sni_rm200_pcibios_write_config_dword;
return memory_start;
}
#endif /* CONFIG_PCI */
|
