[qemu.git] / hw / max111x.c

/*
 * Maxim MAX1110/1111 ADC chip emulation.
 *
 * Copyright (c) 2006 Openedhand Ltd.
 * Written by Andrzej Zaborowski <balrog@zabor.org>
 *
 * This code is licensed under the GNU GPLv2.
 */

#include <vl.h>

struct max111x_s {
    qemu_irq interrupt;
    uint8_t tb1, rb2, rb3;
    int cycle;

    int input[8];
    int inputs, com;
};

/* Control-byte bitfields */
#define CB_PD0		(1 << 0)
#define CB_PD1		(1 << 1)
#define CB_SGL		(1 << 2)
#define CB_UNI		(1 << 3)
#define CB_SEL0		(1 << 4)
#define CB_SEL1		(1 << 5)
#define CB_SEL2		(1 << 6)
#define CB_START	(1 << 7)

#define CHANNEL_NUM(v, b0, b1, b2)	\
			((((v) >> (2 + (b0))) & 4) |	\
			 (((v) >> (3 + (b1))) & 2) |	\
			 (((v) >> (4 + (b2))) & 1))

uint32_t max111x_read(void *opaque)
{
    struct max111x_s *s = (struct max111x_s *) opaque;

    if (!s->tb1)
        return 0;

    switch (s->cycle ++) {
    case 1:
        return s->rb2;
    case 2:
        return s->rb3;
    }

    return 0;
}

/* Interpret a control-byte */
void max111x_write(void *opaque, uint32_t value)
{
    struct max111x_s *s = (struct max111x_s *) opaque;
    int measure, chan;

    /* Ignore the value if START bit is zero */
    if (!(value & CB_START))
        return;

    s->cycle = 0;

    if (!(value & CB_PD1)) {
        s->tb1 = 0;
        return;
    }

    s->tb1 = value;

    if (s->inputs == 8)
        chan = CHANNEL_NUM(value, 1, 0, 2);
    else
        chan = CHANNEL_NUM(value & ~CB_SEL0, 0, 1, 2);

    if (value & CB_SGL)
        measure = s->input[chan] - s->com;
    else
        measure = s->input[chan] - s->input[chan ^ 1];

    if (!(value & CB_UNI))
        measure ^= 0x80;

    s->rb2 = (measure >> 2) & 0x3f;
    s->rb3 = (measure << 6) & 0xc0;

    if (s->interrupt)
        qemu_irq_raise(s->interrupt);
}

static struct max111x_s *max111x_init(qemu_irq cb)
{
    struct max111x_s *s;
    s = (struct max111x_s *)
            qemu_mallocz(sizeof(struct max111x_s));
    memset(s, 0, sizeof(struct max111x_s));

    s->interrupt = cb;

    /* TODO: add a user interface for setting these */
    s->input[0] = 0xf0;
    s->input[1] = 0xe0;
    s->input[2] = 0xd0;
    s->input[3] = 0xc0;
    s->input[4] = 0xb0;
    s->input[5] = 0xa0;
    s->input[6] = 0x90;
    s->input[7] = 0x80;
    s->com = 0;
    return s;
}

struct max111x_s *max1110_init(qemu_irq cb)
{
    struct max111x_s *s = max111x_init(cb);
    s->inputs = 8;
    return s;
}

struct max111x_s *max1111_init(qemu_irq cb)
{
    struct max111x_s *s = max111x_init(cb);
    s->inputs = 4;
    return s;
}

void max111x_set_input(struct max111x_s *s, int line, uint8_t value)
{
    if (line >= s->inputs) {
        printf("%s: There's no input %i\n", __FUNCTION__, line);
        return;
    }

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