Statistics
| Branch: | Revision:

root / hw / max111x.c @ 5dcb6b91

History | View | Annotate | Download (2.7 kB)

1 c824cacd balrog
/*
2 c824cacd balrog
 * Maxim MAX1110/1111 ADC chip emulation.
3 c824cacd balrog
 *
4 c824cacd balrog
 * Copyright (c) 2006 Openedhand Ltd.
5 c824cacd balrog
 * Written by Andrzej Zaborowski <balrog@zabor.org>
6 c824cacd balrog
 *
7 c824cacd balrog
 * This code is licensed under the GNU GPLv2.
8 c824cacd balrog
 */
9 c824cacd balrog
10 c824cacd balrog
#include <vl.h>
11 c824cacd balrog
12 c824cacd balrog
struct max111x_s {
13 c824cacd balrog
    qemu_irq interrupt;
14 c824cacd balrog
    uint8_t tb1, rb2, rb3;
15 c824cacd balrog
    int cycle;
16 c824cacd balrog
17 c824cacd balrog
    int input[8];
18 c824cacd balrog
    int inputs, com;
19 c824cacd balrog
};
20 c824cacd balrog
21 c824cacd balrog
/* Control-byte bitfields */
22 c824cacd balrog
#define CB_PD0                (1 << 0)
23 c824cacd balrog
#define CB_PD1                (1 << 1)
24 c824cacd balrog
#define CB_SGL                (1 << 2)
25 c824cacd balrog
#define CB_UNI                (1 << 3)
26 c824cacd balrog
#define CB_SEL0                (1 << 4)
27 c824cacd balrog
#define CB_SEL1                (1 << 5)
28 c824cacd balrog
#define CB_SEL2                (1 << 6)
29 c824cacd balrog
#define CB_START        (1 << 7)
30 c824cacd balrog
31 c824cacd balrog
#define CHANNEL_NUM(v, b0, b1, b2)        \
32 c824cacd balrog
                        ((((v) >> (2 + (b0))) & 4) |        \
33 c824cacd balrog
                         (((v) >> (3 + (b1))) & 2) |        \
34 c824cacd balrog
                         (((v) >> (4 + (b2))) & 1))
35 c824cacd balrog
36 c824cacd balrog
uint32_t max111x_read(void *opaque)
37 c824cacd balrog
{
38 c824cacd balrog
    struct max111x_s *s = (struct max111x_s *) opaque;
39 c824cacd balrog
40 c824cacd balrog
    if (!s->tb1)
41 c824cacd balrog
        return 0;
42 c824cacd balrog
43 c824cacd balrog
    switch (s->cycle ++) {
44 c824cacd balrog
    case 1:
45 c824cacd balrog
        return s->rb2;
46 c824cacd balrog
    case 2:
47 c824cacd balrog
        return s->rb3;
48 c824cacd balrog
    }
49 c824cacd balrog
50 c824cacd balrog
    return 0;
51 c824cacd balrog
}
52 c824cacd balrog
53 c824cacd balrog
/* Interpret a control-byte */
54 c824cacd balrog
void max111x_write(void *opaque, uint32_t value)
55 c824cacd balrog
{
56 c824cacd balrog
    struct max111x_s *s = (struct max111x_s *) opaque;
57 c824cacd balrog
    int measure, chan;
58 c824cacd balrog
59 c824cacd balrog
    /* Ignore the value if START bit is zero */
60 c824cacd balrog
    if (!(value & CB_START))
61 c824cacd balrog
        return;
62 c824cacd balrog
63 c824cacd balrog
    s->cycle = 0;
64 c824cacd balrog
65 c824cacd balrog
    if (!(value & CB_PD1)) {
66 c824cacd balrog
        s->tb1 = 0;
67 c824cacd balrog
        return;
68 c824cacd balrog
    }
69 c824cacd balrog
70 c824cacd balrog
    s->tb1 = value;
71 c824cacd balrog
72 c824cacd balrog
    if (s->inputs == 8)
73 c824cacd balrog
        chan = CHANNEL_NUM(value, 1, 0, 2);
74 c824cacd balrog
    else
75 c824cacd balrog
        chan = CHANNEL_NUM(value & ~CB_SEL0, 0, 1, 2);
76 c824cacd balrog
77 c824cacd balrog
    if (value & CB_SGL)
78 c824cacd balrog
        measure = s->input[chan] - s->com;
79 c824cacd balrog
    else
80 c824cacd balrog
        measure = s->input[chan] - s->input[chan ^ 1];
81 c824cacd balrog
82 c824cacd balrog
    if (!(value & CB_UNI))
83 c824cacd balrog
        measure ^= 0x80;
84 c824cacd balrog
85 c824cacd balrog
    s->rb2 = (measure >> 2) & 0x3f;
86 c824cacd balrog
    s->rb3 = (measure << 6) & 0xc0;
87 c824cacd balrog
88 c824cacd balrog
    if (s->interrupt)
89 c824cacd balrog
        qemu_irq_raise(s->interrupt);
90 c824cacd balrog
}
91 c824cacd balrog
92 c824cacd balrog
static struct max111x_s *max111x_init(qemu_irq cb)
93 c824cacd balrog
{
94 c824cacd balrog
    struct max111x_s *s;
95 c824cacd balrog
    s = (struct max111x_s *)
96 c824cacd balrog
            qemu_mallocz(sizeof(struct max111x_s));
97 c824cacd balrog
    memset(s, 0, sizeof(struct max111x_s));
98 c824cacd balrog
99 c824cacd balrog
    s->interrupt = cb;
100 c824cacd balrog
101 c824cacd balrog
    /* TODO: add a user interface for setting these */
102 c824cacd balrog
    s->input[0] = 0xf0;
103 c824cacd balrog
    s->input[1] = 0xe0;
104 c824cacd balrog
    s->input[2] = 0xd0;
105 c824cacd balrog
    s->input[3] = 0xc0;
106 c824cacd balrog
    s->input[4] = 0xb0;
107 c824cacd balrog
    s->input[5] = 0xa0;
108 c824cacd balrog
    s->input[6] = 0x90;
109 c824cacd balrog
    s->input[7] = 0x80;
110 c824cacd balrog
    s->com = 0;
111 c824cacd balrog
    return s;
112 c824cacd balrog
}
113 c824cacd balrog
114 c824cacd balrog
struct max111x_s *max1110_init(qemu_irq cb)
115 c824cacd balrog
{
116 c824cacd balrog
    struct max111x_s *s = max111x_init(cb);
117 c824cacd balrog
    s->inputs = 8;
118 c824cacd balrog
    return s;
119 c824cacd balrog
}
120 c824cacd balrog
121 c824cacd balrog
struct max111x_s *max1111_init(qemu_irq cb)
122 c824cacd balrog
{
123 c824cacd balrog
    struct max111x_s *s = max111x_init(cb);
124 c824cacd balrog
    s->inputs = 4;
125 c824cacd balrog
    return s;
126 c824cacd balrog
}
127 c824cacd balrog
128 c824cacd balrog
void max111x_set_input(struct max111x_s *s, int line, uint8_t value)
129 c824cacd balrog
{
130 c824cacd balrog
    if (line >= s->inputs) {
131 c824cacd balrog
        printf("%s: There's no input %i\n", __FUNCTION__, line);
132 c824cacd balrog
        return;
133 c824cacd balrog
    }
134 c824cacd balrog
135 c824cacd balrog
    s->input[line] = value;
136 c824cacd balrog
}