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
|
/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2007 Catalin Patulea <cat@vv.carleton.ca>
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version 2
* of the License, or (at your option) any later version.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include "config.h"
#include "cpu.h"
#include "system.h"
#include "debug.h"
#include "string.h"
#include "file.h"
#include "dsp-target.h"
#include "dsp/ipc.h"
#ifdef DEBUG
static void dsp_status(void)
{
unsigned short hpib_ctl = IO_DSPC_HPIB_CONTROL;
unsigned short hpib_stat = IO_DSPC_HPIB_STATUS;
char buffer1[80], buffer2[80];
DEBUGF("dsp_status(): clkc_hpib=%u clkc_dsp=%u",
!!(IO_CLK_MOD0 & (1 << 11)), !!(IO_CLK_MOD0 & (1 << 10)));
DEBUGF("dsp_status(): irq_dsphint=%u 7fff=%04x scratch_status=%04x"
" acked=%04x",
(IO_INTC_IRQ0 >> IRQ_DSPHINT) & 1, DSP_(0x7fff), DSP_(_status),
DSP_(_acked));
#define B(f,w,b,m) if ((w & (1 << b)) == 0) \
strcat(f, "!"); \
strcat(f, #m "|");
strcpy(buffer1, "");
B(buffer1, hpib_ctl, 0, EN);
B(buffer1, hpib_ctl, 3, NMI);
B(buffer1, hpib_ctl, 5, EXCHG);
B(buffer1, hpib_ctl, 7, DINT0);
B(buffer1, hpib_ctl, 8, DRST);
B(buffer1, hpib_ctl, 9, DHOLD);
B(buffer1, hpib_ctl, 10, BIO);
strcpy(buffer2, "");
B(buffer2, hpib_stat, 8, HOLDA);
B(buffer2, hpib_stat, 12, DXF);
DEBUGF("dsp_status(): hpib: ctl=%s stat=%s", buffer1, buffer2);
#undef B
}
#endif
void dsp_reset(void)
{
DSP_(0x7fff) = 0xdead;
IO_DSPC_HPIB_CONTROL &= ~(1 << 8);
/* HPIB bus cycles will lock up the ARM in here. Don't touch DSP RAM. */
nop; nop;
IO_DSPC_HPIB_CONTROL |= 1 << 8;
/* TODO: Timeout. */
while (DSP_(0x7fff) != 0);
}
void dsp_wake(void)
{
/* If this is called concurrently, we may overlap setting and resetting the
bit, which causes lost interrupts to the DSP. */
int old_level = disable_irq_save();
/* The first time you INT0 the DSP, the ROM loader will branch to your RST
handler. Subsequent times, your INT0 handler will get executed. */
IO_DSPC_HPIB_CONTROL &= ~(1 << 7);
nop; nop;
IO_DSPC_HPIB_CONTROL |= 1 << 7;
restore_irq(old_level);
}
void dsp_load(const struct dsp_section *im)
{
while (im->raw_data_size_half) {
volatile unsigned short *data_ptr = &DSP_(im->physical_addr);
unsigned int i;
/* Use 16-bit writes. */
if (im->raw_data) {
DEBUGF("dsp_load(): loading %u words at 0x%04x (0x%08lx)",
im->raw_data_size_half, im->physical_addr,
(unsigned long)data_ptr);
for (i = 0; i < im->raw_data_size_half; i++) {
data_ptr[i] = im->raw_data[i];
}
} else {
DEBUGF("dsp_load(): clearing %u words at 0x%04x (0x%08lx)",
im->raw_data_size_half, im->physical_addr,
(unsigned long)data_ptr);
for (i = 0; i < im->raw_data_size_half; i++) {
data_ptr[i] = 0;
}
}
im++;
}
}
|