← Back to branch summary

~ubuntu-branches/ubuntu/precise/linux-lowlatency/precise

« back to all changes in this revision

Viewing changes to arch/cris/arch-v32/kernel/debugport.c

  • Committer: Package Import Robot
  • Author(s): Alessio Igor Bogani
  • Date: 2011-10-26 11:13:05 UTC
  • Revision ID: package-import@ubuntu.com-20111026111305-tz023xykf0i6eosh
Tags: upstream-3.2.0
Import upstream version 3.2.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
arch/cris/arch-v32/kernel/debugport.c
 
1
/*
 
2
 * Copyright (C) 2003, Axis Communications AB.
 
3
 */
 
4
 
 
5
#include <linux/console.h>
 
6
#include <linux/init.h>
 
7
#include <asm/system.h>
 
8
#include <hwregs/reg_rdwr.h>
 
9
#include <hwregs/reg_map.h>
 
10
#include <hwregs/ser_defs.h>
 
11
#include <hwregs/dma_defs.h>
 
12
#include <mach/pinmux.h>
 
13
 
 
14
struct dbg_port
 
15
{
 
16
        unsigned char nbr;
 
17
        unsigned long instance;
 
18
        unsigned int started;
 
19
        unsigned long baudrate;
 
20
        unsigned char parity;
 
21
        unsigned int bits;
 
22
};
 
23
 
 
24
struct dbg_port ports[] =
 
25
{
 
26
  {
 
27
    0,
 
28
    regi_ser0,
 
29
    0,
 
30
    115200,
 
31
    'N',
 
32
    8
 
33
  },
 
34
  {
 
35
    1,
 
36
    regi_ser1,
 
37
    0,
 
38
    115200,
 
39
    'N',
 
40
    8
 
41
  },
 
42
  {
 
43
    2,
 
44
    regi_ser2,
 
45
    0,
 
46
    115200,
 
47
    'N',
 
48
    8
 
49
  },
 
50
  {
 
51
    3,
 
52
    regi_ser3,
 
53
    0,
 
54
    115200,
 
55
    'N',
 
56
    8
 
57
  },
 
58
#if CONFIG_ETRAX_SERIAL_PORTS == 5
 
59
  {
 
60
    4,
 
61
    regi_ser4,
 
62
    0,
 
63
    115200,
 
64
    'N',
 
65
    8
 
66
  },
 
67
#endif
 
68
};
 
69
static struct dbg_port *port =
 
70
#if defined(CONFIG_ETRAX_DEBUG_PORT0)
 
71
        &ports[0];
 
72
#elif defined(CONFIG_ETRAX_DEBUG_PORT1)
 
73
        &ports[1];
 
74
#elif defined(CONFIG_ETRAX_DEBUG_PORT2)
 
75
        &ports[2];
 
76
#elif defined(CONFIG_ETRAX_DEBUG_PORT3)
 
77
        &ports[3];
 
78
#elif defined(CONFIG_ETRAX_DEBUG_PORT4)
 
79
        &ports[4];
 
80
#else
 
81
        NULL;
 
82
#endif
 
83
 
 
84
#ifdef CONFIG_ETRAX_KGDB
 
85
static struct dbg_port *kgdb_port =
 
86
#if defined(CONFIG_ETRAX_KGDB_PORT0)
 
87
        &ports[0];
 
88
#elif defined(CONFIG_ETRAX_KGDB_PORT1)
 
89
        &ports[1];
 
90
#elif defined(CONFIG_ETRAX_KGDB_PORT2)
 
91
        &ports[2];
 
92
#elif defined(CONFIG_ETRAX_KGDB_PORT3)
 
93
        &ports[3];
 
94
#elif defined(CONFIG_ETRAX_KGDB_PORT4)
 
95
        &ports[4];
 
96
#else
 
97
        NULL;
 
98
#endif
 
99
#endif
 
100
 
 
101
static void
 
102
start_port(struct dbg_port* p)
 
103
{
 
104
        if (!p)
 
105
                return;
 
106
 
 
107
        if (p->started)
 
108
                return;
 
109
        p->started = 1;
 
110
 
 
111
        if (p->nbr == 1)
 
112
                crisv32_pinmux_alloc_fixed(pinmux_ser1);
 
113
        else if (p->nbr == 2)
 
114
                crisv32_pinmux_alloc_fixed(pinmux_ser2);
 
115
        else if (p->nbr == 3)
 
116
                crisv32_pinmux_alloc_fixed(pinmux_ser3);
 
117
#if CONFIG_ETRAX_SERIAL_PORTS == 5
 
118
        else if (p->nbr == 4)
 
119
                crisv32_pinmux_alloc_fixed(pinmux_ser4);
 
120
#endif
 
121
 
 
122
        /* Set up serial port registers */
 
123
        reg_ser_rw_tr_ctrl tr_ctrl = {0};
 
124
        reg_ser_rw_tr_dma_en tr_dma_en = {0};
 
125
 
 
126
        reg_ser_rw_rec_ctrl rec_ctrl = {0};
 
127
        reg_ser_rw_tr_baud_div tr_baud_div = {0};
 
128
        reg_ser_rw_rec_baud_div rec_baud_div = {0};
 
129
 
 
130
        tr_ctrl.base_freq = rec_ctrl.base_freq = regk_ser_f29_493;
 
131
        tr_dma_en.en = rec_ctrl.dma_mode = regk_ser_no;
 
132
        tr_baud_div.div = rec_baud_div.div = 29493000 / p->baudrate / 8;
 
133
        tr_ctrl.en = rec_ctrl.en = 1;
 
134
 
 
135
        if (p->parity == 'O')
 
136
        {
 
137
                tr_ctrl.par_en = regk_ser_yes;
 
138
                tr_ctrl.par = regk_ser_odd;
 
139
                rec_ctrl.par_en = regk_ser_yes;
 
140
                rec_ctrl.par = regk_ser_odd;
 
141
        }
 
142
        else if (p->parity == 'E')
 
143
        {
 
144
                tr_ctrl.par_en = regk_ser_yes;
 
145
                tr_ctrl.par = regk_ser_even;
 
146
                rec_ctrl.par_en = regk_ser_yes;
 
147
                rec_ctrl.par = regk_ser_odd;
 
148
        }
 
149
 
 
150
        if (p->bits == 7)
 
151
        {
 
152
                tr_ctrl.data_bits = regk_ser_bits7;
 
153
                rec_ctrl.data_bits = regk_ser_bits7;
 
154
        }
 
155
 
 
156
        REG_WR (ser, p->instance, rw_tr_baud_div, tr_baud_div);
 
157
        REG_WR (ser, p->instance, rw_rec_baud_div, rec_baud_div);
 
158
        REG_WR (ser, p->instance, rw_tr_dma_en, tr_dma_en);
 
159
        REG_WR (ser, p->instance, rw_tr_ctrl, tr_ctrl);
 
160
        REG_WR (ser, p->instance, rw_rec_ctrl, rec_ctrl);
 
161
}
 
162
 
 
163
#ifdef CONFIG_ETRAX_KGDB
 
164
/* Use polling to get a single character from the kernel debug port */
 
165
int
 
166
getDebugChar(void)
 
167
{
 
168
        reg_ser_rs_stat_din stat;
 
169
        reg_ser_rw_ack_intr ack_intr = { 0 };
 
170
 
 
171
        do {
 
172
                stat = REG_RD(ser, kgdb_port->instance, rs_stat_din);
 
173
        } while (!stat.dav);
 
174
 
 
175
        /* Ack the data_avail interrupt. */
 
176
        ack_intr.dav = 1;
 
177
        REG_WR(ser, kgdb_port->instance, rw_ack_intr, ack_intr);
 
178
 
 
179
        return stat.data;
 
180
}
 
181
 
 
182
/* Use polling to put a single character to the kernel debug port */
 
183
void
 
184
putDebugChar(int val)
 
185
{
 
186
        reg_ser_r_stat_din stat;
 
187
        do {
 
188
                stat = REG_RD(ser, kgdb_port->instance, r_stat_din);
 
189
        } while (!stat.tr_rdy);
 
190
        REG_WR_INT(ser, kgdb_port->instance, rw_dout, val);
 
191
}
 
192
#endif /* CONFIG_ETRAX_KGDB */
 
193
 
 
194
/* Register console for printk's, etc. */
 
195
int __init
 
196
init_etrax_debug(void)
 
197
{
 
198
        start_port(port);
 
199
 
 
200
#ifdef CONFIG_ETRAX_KGDB
 
201
        start_port(kgdb_port);
 
202
#endif /* CONFIG_ETRAX_KGDB */
 
203
        return 0;
 
204
}