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
|
/*
* $Id: branch_pci.c,v 1.9 2009-06-03 11:34:02 vrsieh Exp $
*
* Copyright (C) 2003-2009 FAUmachine Team <info@faumachine.org>.
* This program is free software. You can redistribute it and/or modify it
* under the terms of the GNU General Public License, either version 2 of
* the License, or (at your option) any later version. See COPYING.
*/
#include <assert.h>
#include <stdio.h>
#include <stdlib.h>
#include "branch_pci.h"
struct cpssp {
unsigned int generic_idsel;
struct sig_pci_bus_idsel *port_idsel;
};
static int
branch_pci_c0r(
void *_f,
uint32_t addr,
unsigned int bs,
uint32_t *valp
)
{
struct cpssp *f = (struct cpssp *) _f;
if ((addr >> (11 + f->generic_idsel)) & 1) {
return sig_pci_bus_idsel_c0r(f->port_idsel, f, addr, bs, valp);
} else {
return 1;
}
}
static int
branch_pci_c0w(
void *_f,
uint32_t addr,
unsigned int bs,
uint32_t val
)
{
struct cpssp *f = (struct cpssp *) _f;
if ((addr >> (11 + f->generic_idsel)) & 1) {
return sig_pci_bus_idsel_c0w(f->port_idsel, f, addr, bs, val);
} else {
return 1;
}
}
void *
branch_pci_create(
const char *name,
const char *generic_idsel,
struct sig_manage *port_manage,
struct sig_pci_bus_main *port_pci_bus,
struct sig_pci_bus_idsel *port_idsel
)
{
static const struct sig_pci_bus_main_funcs pci_bus_funcs = {
.c0r = branch_pci_c0r,
.c0w = branch_pci_c0w,
};
struct cpssp *cpssp;
assert(generic_idsel);
cpssp = malloc(sizeof(*cpssp));
assert(cpssp);
cpssp->generic_idsel = atoi(generic_idsel);
/* Out */
/* Call */
sig_pci_bus_main_connect(port_pci_bus, cpssp, &pci_bus_funcs);
cpssp->port_idsel = port_idsel;
/* In */
return cpssp;
}
void
branch_pci_destroy(void *_cpssp)
{
struct cpssp *cpssp = _cpssp;
free(cpssp);
}
|
