[qemu.git] / hw / tmp105.c

/*
 * Texas Instruments TMP105 temperature sensor.
 *
 * Copyright (C) 2008 Nokia Corporation
 * Written by Andrzej Zaborowski <andrew@openedhand.com>
 *
 * 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 or
 * (at your option) version 3 of the License.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */

#include "hw.h"
#include "i2c.h"

struct tmp105_s {
    i2c_slave i2c;
    int len;
    uint8_t buf[2];
    qemu_irq pin;

    uint8_t pointer;
    uint8_t config;
    int16_t temperature;
    int16_t limit[2];
    int faults;
    int alarm;
};

static void tmp105_interrupt_update(struct tmp105_s *s)
{
    qemu_set_irq(s->pin, s->alarm ^ ((~s->config >> 2) & 1));	/* POL */
}

static void tmp105_alarm_update(struct tmp105_s *s)
{
    if ((s->config >> 0) & 1) {					/* SD */
        if ((s->config >> 7) & 1)				/* OS */
            s->config &= ~(1 << 7);				/* OS */
        else
            return;
    }

    if ((s->config >> 1) & 1) {					/* TM */
        if (s->temperature >= s->limit[1])
            s->alarm = 1;
        else if (s->temperature < s->limit[0])
            s->alarm = 1;
    } else {
        if (s->temperature >= s->limit[1])
            s->alarm = 1;
        else if (s->temperature < s->limit[0])
            s->alarm = 0;
    }

    tmp105_interrupt_update(s);
}

/* Units are 0.001 centigrades relative to 0 C.  */
void tmp105_set(i2c_slave *i2c, int temp)
{
    struct tmp105_s *s = (struct tmp105_s *) i2c;

    if (temp >= 128000 || temp < -128000) {
        fprintf(stderr, "%s: values is out of range (%i.%03i C)\n",
                        __FUNCTION__, temp / 1000, temp % 1000);
        exit(-1);
    }

    s->temperature = ((int16_t) (temp * 0x800 / 128000)) << 4;

    tmp105_alarm_update(s);
}

static const int tmp105_faultq[4] = { 1, 2, 4, 6 };

static void tmp105_read(struct tmp105_s *s)
{
    s->len = 0;

    if ((s->config >> 1) & 1) {					/* TM */
        s->alarm = 0;
        tmp105_interrupt_update(s);
    }

    switch (s->pointer & 3) {
    case 0:	/* Temperature */
        s->buf[s->len ++] = (((uint16_t) s->temperature) >> 8);
        s->buf[s->len ++] = (((uint16_t) s->temperature) >> 0) &
                (0xf0 << ((~s->config >> 5) & 3));		/* R */
        break;

    case 1:	/* Configuration */
        s->buf[s->len ++] = s->config;
        break;

    case 2:	/* T_LOW */
        s->buf[s->len ++] = ((uint16_t) s->limit[0]) >> 8;
        s->buf[s->len ++] = ((uint16_t) s->limit[0]) >> 0;
        break;

    case 3:	/* T_HIGH */
        s->buf[s->len ++] = ((uint16_t) s->limit[1]) >> 8;
        s->buf[s->len ++] = ((uint16_t) s->limit[1]) >> 0;
        break;
    }
}

static void tmp105_write(struct tmp105_s *s)
{
    switch (s->pointer & 3) {
    case 0:	/* Temperature */
        break;

    case 1:	/* Configuration */
        if (s->buf[0] & ~s->config & (1 << 0))			/* SD */
            printf("%s: TMP105 shutdown\n", __FUNCTION__);
        s->config = s->buf[0];
        s->faults = tmp105_faultq[(s->config >> 3) & 3];	/* F */
        tmp105_alarm_update(s);
        break;

    case 2:	/* T_LOW */
    case 3:	/* T_HIGH */
        if (s->len >= 3)
            s->limit[s->pointer & 1] = (int16_t)
                    ((((uint16_t) s->buf[0]) << 8) | s->buf[1]);
        tmp105_alarm_update(s);
        break;
    }
}

static int tmp105_rx(i2c_slave *i2c)
{
    struct tmp105_s *s = (struct tmp105_s *) i2c;

    if (s->len < 2)
        return s->buf[s->len ++];
    else
        return 0xff;
}

static int tmp105_tx(i2c_slave *i2c, uint8_t data)
{
    struct tmp105_s *s = (struct tmp105_s *) i2c;

    if (!s->len ++)
        s->pointer = data;
    else {
        if (s->len <= 2)
            s->buf[s->len - 1] = data;
        tmp105_write(s);
    }

    return 0;
}

static void tmp105_event(i2c_slave *i2c, enum i2c_event event)
{
    struct tmp105_s *s = (struct tmp105_s *) i2c;

    if (event == I2C_START_RECV)
        tmp105_read(s);

    s->len = 0;
}

static void tmp105_save(QEMUFile *f, void *opaque)
{
    struct tmp105_s *s = (struct tmp105_s *) opaque;

    qemu_put_byte(f, s->len);
    qemu_put_8s(f, &s->buf[0]);
    qemu_put_8s(f, &s->buf[1]);

    qemu_put_8s(f, &s->pointer);
    qemu_put_8s(f, &s->config);
    qemu_put_sbe16s(f, &s->temperature);
    qemu_put_sbe16s(f, &s->limit[0]);
    qemu_put_sbe16s(f, &s->limit[1]);
    qemu_put_byte(f, s->alarm);
    s->faults = tmp105_faultq[(s->config >> 3) & 3];		/* F */

    i2c_slave_save(f, &s->i2c);
}

static int tmp105_load(QEMUFile *f, void *opaque, int version_id)
{
    struct tmp105_s *s = (struct tmp105_s *) opaque;

    s->len = qemu_get_byte(f);
    qemu_get_8s(f, &s->buf[0]);
    qemu_get_8s(f, &s->buf[1]);

    qemu_get_8s(f, &s->pointer);
    qemu_get_8s(f, &s->config);
    qemu_get_sbe16s(f, &s->temperature);
    qemu_get_sbe16s(f, &s->limit[0]);
    qemu_get_sbe16s(f, &s->limit[1]);
    s->alarm = qemu_get_byte(f);

    tmp105_interrupt_update(s);

    i2c_slave_load(f, &s->i2c);
    return 0;
}

void tmp105_reset(i2c_slave *i2c)
{
    struct tmp105_s *s = (struct tmp105_s *) i2c;

    s->temperature = 0;
    s->pointer = 0;
    s->config = 0;
    s->faults = tmp105_faultq[(s->config >> 3) & 3];
    s->alarm = 0;

    tmp105_interrupt_update(s);
}

struct i2c_slave *tmp105_init(i2c_bus *bus, qemu_irq alarm)
{
    struct tmp105_s *s = (struct tmp105_s *)
            i2c_slave_init(bus, 0, sizeof(struct tmp105_s));

    s->i2c.event = tmp105_event;
    s->i2c.recv = tmp105_rx;
    s->i2c.send = tmp105_tx;
    s->pin = alarm;

    tmp105_reset(&s->i2c);

    register_savevm("TMP105", -1, 0, tmp105_save, tmp105_load, s);

    return &s->i2c;
}
Commit	Line	Data
7e7c5e4c AZ	1	/*
	2	* Texas Instruments TMP105 temperature sensor.
	3	*
	4	* Copyright (C) 2008 Nokia Corporation
	5	* Written by Andrzej Zaborowski <andrew@openedhand.com>
	6	*
	7	* This program is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU General Public License as
	9	* published by the Free Software Foundation; either version 2 or
	10	* (at your option) version 3 of the License.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
fad6cb1a AJ	17	* You should have received a copy of the GNU General Public License along
	18	* with this program; if not, write to the Free Software Foundation, Inc.,
	19	* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
7e7c5e4c AZ	20	*/
	21
	22	#include "hw.h"
	23	#include "i2c.h"
	24
	25	struct tmp105_s {
	26	i2c_slave i2c;
	27	int len;
	28	uint8_t buf[2];
	29	qemu_irq pin;
	30
	31	uint8_t pointer;
	32	uint8_t config;
	33	int16_t temperature;
	34	int16_t limit[2];
	35	int faults;
	36	int alarm;
	37	};
	38
	39	static void tmp105_interrupt_update(struct tmp105_s *s)
	40	{
	41	qemu_set_irq(s->pin, s->alarm ^ ((~s->config >> 2) & 1)); /* POL */
	42	}
	43
	44	static void tmp105_alarm_update(struct tmp105_s *s)
	45	{
	46	if ((s->config >> 0) & 1) { /* SD */
	47	if ((s->config >> 7) & 1) /* OS */
	48	s->config &= ~(1 << 7); /* OS */
	49	else
	50	return;
	51	}
	52
	53	if ((s->config >> 1) & 1) { /* TM */
	54	if (s->temperature >= s->limit[1])
	55	s->alarm = 1;
	56	else if (s->temperature < s->limit[0])
	57	s->alarm = 1;
	58	} else {
	59	if (s->temperature >= s->limit[1])
	60	s->alarm = 1;
	61	else if (s->temperature < s->limit[0])
	62	s->alarm = 0;
	63	}
	64
	65	tmp105_interrupt_update(s);
	66	}
	67
	68	/* Units are 0.001 centigrades relative to 0 C. */
	69	void tmp105_set(i2c_slave *i2c, int temp)
	70	{
	71	struct tmp105_s s = (struct tmp105_s ) i2c;
	72
	73	if (temp >= 128000 \|\| temp < -128000) {
	74	fprintf(stderr, "%s: values is out of range (%i.%03i C)\n",
	75	__FUNCTION__, temp / 1000, temp % 1000);
	76	exit(-1);
	77	}
	78
	79	s->temperature = ((int16_t) (temp * 0x800 / 128000)) << 4;
	80
	81	tmp105_alarm_update(s);
	82	}
	83
84	static const int tmp105_faultq[4] = { 1, 2, 4, 6 };
85
86	static void tmp105_read(struct tmp105_s *s)
87	{
88	s->len = 0;
89
90	if ((s->config >> 1) & 1) { /* TM */
91	s->alarm = 0;
92	tmp105_interrupt_update(s);
93	}
94
95	switch (s->pointer & 3) {
96	case 0: /* Temperature */
97	s->buf[s->len ++] = (((uint16_t) s->temperature) >> 8);
98	s->buf[s->len ++] = (((uint16_t) s->temperature) >> 0) &
99	(0xf0 << ((~s->config >> 5) & 3)); /* R */
100	break;
101
102	case 1: /* Configuration */
103	s->buf[s->len ++] = s->config;
104	break;
105
106	case 2: /* T_LOW */
107	s->buf[s->len ++] = ((uint16_t) s->limit[0]) >> 8;
108	s->buf[s->len ++] = ((uint16_t) s->limit[0]) >> 0;
109	break;
110
111	case 3: /* T_HIGH */
112	s->buf[s->len ++] = ((uint16_t) s->limit[1]) >> 8;
113	s->buf[s->len ++] = ((uint16_t) s->limit[1]) >> 0;
114	break;
115	}
116	}
117
118	static void tmp105_write(struct tmp105_s *s)
119	{
120	switch (s->pointer & 3) {
121	case 0: /* Temperature */
122	break;
123
124	case 1: /* Configuration */
125	if (s->buf[0] & ~s->config & (1 << 0)) /* SD */
126	printf("%s: TMP105 shutdown\n", __FUNCTION__);
127	s->config = s->buf[0];
128	s->faults = tmp105_faultq[(s->config >> 3) & 3]; /* F */
129	tmp105_alarm_update(s);
130	break;
131
132	case 2: /* T_LOW */
133	case 3: /* T_HIGH */
134	if (s->len >= 3)
135	s->limit[s->pointer & 1] = (int16_t)
136	((((uint16_t) s->buf[0]) << 8) \| s->buf[1]);
137	tmp105_alarm_update(s);
138	break;
139	}
140	}
141
142	static int tmp105_rx(i2c_slave *i2c)
143	{
144	struct tmp105_s s = (struct tmp105_s ) i2c;
145
146	if (s->len < 2)
147	return s->buf[s->len ++];
148	else
149	return 0xff;
150	}
151
152	static int tmp105_tx(i2c_slave *i2c, uint8_t data)
153	{
154	struct tmp105_s s = (struct tmp105_s ) i2c;
155
156	if (!s->len ++)
157	s->pointer = data;
158	else {
159	if (s->len <= 2)
160	s->buf[s->len - 1] = data;
161	tmp105_write(s);
162	}
163
164	return 0;
165	}
166
167	static void tmp105_event(i2c_slave *i2c, enum i2c_event event)
168	{
169	struct tmp105_s s = (struct tmp105_s ) i2c;
170
171	if (event == I2C_START_RECV)
172	tmp105_read(s);
173
174	s->len = 0;
175	}
176
177	static void tmp105_save(QEMUFile f, void opaque)
178	{
179	struct tmp105_s s = (struct tmp105_s ) opaque;
180
181	qemu_put_byte(f, s->len);
182	qemu_put_8s(f, &s->buf[0]);
183	qemu_put_8s(f, &s->buf[1]);
184
185	qemu_put_8s(f, &s->pointer);
186	qemu_put_8s(f, &s->config);
b6c4f71f BS	187	qemu_put_sbe16s(f, &s->temperature);
	188	qemu_put_sbe16s(f, &s->limit[0]);
	189	qemu_put_sbe16s(f, &s->limit[1]);
7e7c5e4c AZ	190	qemu_put_byte(f, s->alarm);
	191	s->faults = tmp105_faultq[(s->config >> 3) & 3]; /* F */
	192
	193	i2c_slave_save(f, &s->i2c);
	194	}
	195
	196	static int tmp105_load(QEMUFile f, void opaque, int version_id)
	197	{
	198	struct tmp105_s s = (struct tmp105_s ) opaque;
	199
	200	s->len = qemu_get_byte(f);
	201	qemu_get_8s(f, &s->buf[0]);
	202	qemu_get_8s(f, &s->buf[1]);
	203
	204	qemu_get_8s(f, &s->pointer);
	205	qemu_get_8s(f, &s->config);
b6c4f71f BS	206	qemu_get_sbe16s(f, &s->temperature);
	207	qemu_get_sbe16s(f, &s->limit[0]);
	208	qemu_get_sbe16s(f, &s->limit[1]);
7e7c5e4c AZ	209	s->alarm = qemu_get_byte(f);
	210
	211	tmp105_interrupt_update(s);
	212
	213	i2c_slave_load(f, &s->i2c);
	214	return 0;
	215	}
	216
	217	void tmp105_reset(i2c_slave *i2c)
	218	{
	219	struct tmp105_s s = (struct tmp105_s ) i2c;
	220
	221	s->temperature = 0;
	222	s->pointer = 0;
	223	s->config = 0;
	224	s->faults = tmp105_faultq[(s->config >> 3) & 3];
	225	s->alarm = 0;
	226
	227	tmp105_interrupt_update(s);
	228	}
	229
7e7c5e4c AZ	230	struct i2c_slave tmp105_init(i2c_bus bus, qemu_irq alarm)
	231	{
	232	struct tmp105_s s = (struct tmp105_s )
	233	i2c_slave_init(bus, 0, sizeof(struct tmp105_s));
	234
	235	s->i2c.event = tmp105_event;
	236	s->i2c.recv = tmp105_rx;
	237	s->i2c.send = tmp105_tx;
	238	s->pin = alarm;
	239
	240	tmp105_reset(&s->i2c);
	241
18be5187	242	register_savevm("TMP105", -1, 0, tmp105_save, tmp105_load, s);
7e7c5e4c AZ	243
	244	return &s->i2c;
	245	}