Statistics
| Branch: | Revision:

scoutos / prex-0.9.0 / bsp / drv / dev / base / init.c @ 03e9c04a

History | View | Annotate | Download (3.47 KB)

1
/*-
2
 * Copyright (c) 2005-2009, Kohsuke Ohtani
3
 * All rights reserved.
4
 *
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
7
 * are met:
8
 * 1. Redistributions of source code must retain the above copyright
9
 *    notice, this list of conditions and the following disclaimer.
10
 * 2. Redistributions in binary form must reproduce the above copyright
11
 *    notice, this list of conditions and the following disclaimer in the
12
 *    documentation and/or other materials provided with the distribution.
13
 * 3. Neither the name of the author nor the names of any co-contributors
14
 *    may be used to endorse or promote products derived from this software
15
 *    without specific prior written permission.
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27
 * SUCH DAMAGE.
28
 */
29

    
30
/*
31
 * init.c - driver initialization routine
32
 */
33

    
34
#include <driver.h>
35
#include <cons.h>
36
#include <dki.h>
37
#include <kd.h>
38
#include <conf/drvtab.h>
39

    
40
#ifdef DEBUG
41
#define DPRINTF(a) printf a
42
#else
43
#define DPRINTF(a)
44
#endif
45

    
46
#define NDRIVERS        (int)(sizeof(driver_table) / sizeof(driver_table[0]))
47

    
48

    
49
/*
50
 * Call xxx_probe routine for all drivers.
51
 */
52
void
53
driver_probe(void)
54
{
55
        struct driver *dp;
56
        int i;
57

    
58
        DPRINTF(("Probing devices...\n"));
59

    
60
        for (i = 0; i < NDRIVERS; i++) {
61
                dp = driver_table[i];
62
                ASSERT(dp != NULL);
63

    
64
                if (dp->probe != NULL) {
65
                        if (dp->probe(dp) == 0)
66
                                dp->flags |= DS_ALIVE;
67
                } else {
68
                        /*
69
                         * No probe method. Mark it alive.
70
                         */
71
                        dp->flags |= DS_ALIVE;
72
                }
73
        }
74
}
75

    
76
/*
77
 * Call xxx_init routine for all living drivers.
78
 */
79
void
80
driver_init(void)
81
{
82
        struct driver *dp;
83
        int i;
84

    
85
        for (i = 0; i < NDRIVERS; i++) {
86
                dp = driver_table[i];
87

    
88
                /* All drivers must have init method */
89
                ASSERT(dp->init != NULL);
90

    
91
                if (dp->flags & DS_ALIVE) {
92
                        DPRINTF(("Initializing %s\n", dp->name));
93
                        if (dp->init(dp) == 0)
94
                                dp->flags |= DS_ACTIVE;
95
                }
96
        }
97
}
98

    
99
/*
100
 * Call xxx_unload routine for all active drivers.
101
 */
102
void
103
driver_shutdown(void)
104
{
105
        struct driver *dp;
106
        int i;
107

    
108
        DPRINTF(("Shutting down...\n"));
109
        for (i = NDRIVERS - 1; i >= 0; i--) {
110
                dp = driver_table[i];
111
                if (dp == NULL)
112
                        break;
113
                /*
114
                 * Process only active drivers.
115
                 */
116
                if (dp->flags & DS_ACTIVE) {
117
                        DPRINTF(("Unloading %s\n", dp->name));
118
                        if (dp->unload != NULL)
119
                                dp->unload(dp);
120
                }
121
        }
122
}
123

    
124
#if defined(DEBUG) && defined(CONFIG_KD)
125
void
126
driver_dump(void)
127
{
128
        struct driver *dp;
129
        int i = 0;
130

    
131
        printf("Driver table:\n");
132
        printf(" probe    init     unload   devops   flags    name\n");
133
        printf(" -------- -------- -------- -------- -------- -----------\n");
134

    
135
        for (i = 0; i < NDRIVERS; i++) {
136
                dp = driver_table[i];
137
                printf(" %08lx %08lx %08lx %08lx %08lx %s\n",
138
                       (long)dp->probe, (long)dp->init, (long)dp->unload,
139
                       (long)dp->devops,(long) dp->flags, dp->name);
140
        }
141
}
142
#endif