[mirror_qemu.git] / hw / sh_timer.c

/*
 * SuperH Timer modules.
 *
 * Copyright (c) 2007 Magnus Damm
 * Based on arm_timer.c by Paul Brook
 * Copyright (c) 2005-2006 CodeSourcery.
 *
 * This code is licenced under the GPL.
 */

#include "hw.h"
#include "sh.h"
#include "qemu-timer.h"

//#define DEBUG_TIMER

#define TIMER_TCR_TPSC          (7 << 0)
#define TIMER_TCR_CKEG          (3 << 3)
#define TIMER_TCR_UNIE          (1 << 5)
#define TIMER_TCR_ICPE          (3 << 6)
#define TIMER_TCR_UNF           (1 << 8)
#define TIMER_TCR_ICPF          (1 << 9)
#define TIMER_TCR_RESERVED      (0x3f << 10)

#define TIMER_FEAT_CAPT   (1 << 0)
#define TIMER_FEAT_EXTCLK (1 << 1)

typedef struct {
    ptimer_state *timer;
    uint32_t tcnt;
    uint32_t tcor;
    uint32_t tcr;
    uint32_t tcpr;
    int freq;
    int int_level;
    int old_level;
    int feat;
    int enabled;
    struct intc_source *irq;
} sh_timer_state;

/* Check all active timers, and schedule the next timer interrupt. */

static void sh_timer_update(sh_timer_state *s)
{
    int new_level = s->int_level && (s->tcr & TIMER_TCR_UNIE);

    if (new_level != s->old_level)
      sh_intc_toggle_source(s->irq, 0, new_level ? 1 : -1);

    s->old_level = s->int_level;
    s->int_level = new_level;
}

static uint32_t sh_timer_read(void *opaque, target_phys_addr_t offset)
{
    sh_timer_state *s = (sh_timer_state *)opaque;

    switch (offset >> 2) {
    case 0:
        return s->tcor;
    case 1:
        return ptimer_get_count(s->timer);
    case 2:
        return s->tcr | (s->int_level ? TIMER_TCR_UNF : 0);
    case 3:
        if (s->feat & TIMER_FEAT_CAPT)
            return s->tcpr;
    default:
        cpu_abort (cpu_single_env, "sh_timer_read: Bad offset %x\n",
                   (int)offset);
        return 0;
    }
}

static void sh_timer_write(void *opaque, target_phys_addr_t offset,
                            uint32_t value)
{
    sh_timer_state *s = (sh_timer_state *)opaque;
    int freq;

    switch (offset >> 2) {
    case 0:
        s->tcor = value;
        ptimer_set_limit(s->timer, s->tcor, 0);
        break;
    case 1:
        s->tcnt = value;
        ptimer_set_count(s->timer, s->tcnt);
        break;
    case 2:
        if (s->enabled) {
            /* Pause the timer if it is running.  This may cause some
               inaccuracy dure to rounding, but avoids a whole lot of other
               messyness.  */
            ptimer_stop(s->timer);
        }
        freq = s->freq;
        /* ??? Need to recalculate expiry time after changing divisor.  */
        switch (value & TIMER_TCR_TPSC) {
        case 0: freq >>= 2; break;
        case 1: freq >>= 4; break;
        case 2: freq >>= 6; break;
        case 3: freq >>= 8; break;
        case 4: freq >>= 10; break;
	case 6:
	case 7: if (s->feat & TIMER_FEAT_EXTCLK) break;
	default: cpu_abort (cpu_single_env,
			   "sh_timer_write: Reserved TPSC value\n"); break;
        }
        switch ((value & TIMER_TCR_CKEG) >> 3) {
	case 0: break;
        case 1:
        case 2:
        case 3: if (s->feat & TIMER_FEAT_EXTCLK) break;
	default: cpu_abort (cpu_single_env,
			   "sh_timer_write: Reserved CKEG value\n"); break;
        }
        switch ((value & TIMER_TCR_ICPE) >> 6) {
	case 0: break;
        case 2:
        case 3: if (s->feat & TIMER_FEAT_CAPT) break;
	default: cpu_abort (cpu_single_env,
			   "sh_timer_write: Reserved ICPE value\n"); break;
        }
	if ((value & TIMER_TCR_UNF) == 0)
            s->int_level = 0;

	value &= ~TIMER_TCR_UNF;

	if ((value & TIMER_TCR_ICPF) && (!(s->feat & TIMER_FEAT_CAPT)))
            cpu_abort (cpu_single_env,
		       "sh_timer_write: Reserved ICPF value\n");

	value &= ~TIMER_TCR_ICPF; /* capture not supported */

	if (value & TIMER_TCR_RESERVED)
            cpu_abort (cpu_single_env,
		       "sh_timer_write: Reserved TCR bits set\n");
        s->tcr = value;
        ptimer_set_limit(s->timer, s->tcor, 0);
        ptimer_set_freq(s->timer, freq);
        if (s->enabled) {
            /* Restart the timer if still enabled.  */
            ptimer_run(s->timer, 0);
        }
        break;
    case 3:
        if (s->feat & TIMER_FEAT_CAPT) {
            s->tcpr = value;
	    break;
	}
    default:
        cpu_abort (cpu_single_env, "sh_timer_write: Bad offset %x\n",
                   (int)offset);
    }
    sh_timer_update(s);
}

static void sh_timer_start_stop(void *opaque, int enable)
{
    sh_timer_state *s = (sh_timer_state *)opaque;

#ifdef DEBUG_TIMER
    printf("sh_timer_start_stop %d (%d)\n", enable, s->enabled);
#endif

    if (s->enabled && !enable) {
        ptimer_stop(s->timer);
    }
    if (!s->enabled && enable) {
        ptimer_run(s->timer, 0);
    }
    s->enabled = !!enable;

#ifdef DEBUG_TIMER
    printf("sh_timer_start_stop done %d\n", s->enabled);
#endif
}

static void sh_timer_tick(void *opaque)
{
    sh_timer_state *s = (sh_timer_state *)opaque;
    s->int_level = s->enabled;
    sh_timer_update(s);
}

static void *sh_timer_init(uint32_t freq, int feat, struct intc_source *irq)
{
    sh_timer_state *s;
    QEMUBH *bh;

    s = (sh_timer_state *)qemu_mallocz(sizeof(sh_timer_state));
    s->freq = freq;
    s->feat = feat;
    s->tcor = 0xffffffff;
    s->tcnt = 0xffffffff;
    s->tcpr = 0xdeadbeef;
    s->tcor = 0;
    s->enabled = 0;
    s->irq = irq;

    bh = qemu_bh_new(sh_timer_tick, s);
    s->timer = ptimer_init(bh);
    /* ??? Save/restore.  */
    return s;
}

typedef struct {
    void *timer[3];
    int level[3];
    uint32_t tocr;
    uint32_t tstr;
    target_phys_addr_t base;
    int feat;
} tmu012_state;

static uint32_t tmu012_read(void *opaque, target_phys_addr_t offset)
{
    tmu012_state *s = (tmu012_state *)opaque;

#ifdef DEBUG_TIMER
    printf("tmu012_read 0x%lx\n", (unsigned long) offset);
#endif
    offset -= s->base;

    if (offset >= 0x20) {
        if (!(s->feat & TMU012_FEAT_3CHAN))
	    cpu_abort (cpu_single_env, "tmu012_write: Bad channel offset %x\n",
		       (int)offset);
        return sh_timer_read(s->timer[2], offset - 0x20);
    }

    if (offset >= 0x14)
        return sh_timer_read(s->timer[1], offset - 0x14);

    if (offset >= 0x08)
        return sh_timer_read(s->timer[0], offset - 0x08);

    if (offset == 4)
        return s->tstr;

    if ((s->feat & TMU012_FEAT_TOCR) && offset == 0)
        return s->tocr;

    cpu_abort (cpu_single_env, "tmu012_write: Bad offset %x\n",
	       (int)offset);
    return 0;
}

static void tmu012_write(void *opaque, target_phys_addr_t offset,
                        uint32_t value)
{
    tmu012_state *s = (tmu012_state *)opaque;

#ifdef DEBUG_TIMER
    printf("tmu012_write 0x%lx 0x%08x\n", (unsigned long) offset, value);
#endif
    offset -= s->base;

    if (offset >= 0x20) {
        if (!(s->feat & TMU012_FEAT_3CHAN))
	    cpu_abort (cpu_single_env, "tmu012_write: Bad channel offset %x\n",
		       (int)offset);
        sh_timer_write(s->timer[2], offset - 0x20, value);
	return;
    }

    if (offset >= 0x14) {
        sh_timer_write(s->timer[1], offset - 0x14, value);
	return;
    }

    if (offset >= 0x08) {
        sh_timer_write(s->timer[0], offset - 0x08, value);
	return;
    }

    if (offset == 4) {
        sh_timer_start_stop(s->timer[0], value & (1 << 0));
        sh_timer_start_stop(s->timer[1], value & (1 << 1));
        if (s->feat & TMU012_FEAT_3CHAN)
            sh_timer_start_stop(s->timer[2], value & (1 << 2));
	else
            if (value & (1 << 2))
                cpu_abort (cpu_single_env, "tmu012_write: Bad channel\n");

	s->tstr = value;
	return;
    }

    if ((s->feat & TMU012_FEAT_TOCR) && offset == 0) {
        s->tocr = value & (1 << 0);
    }
}

static CPUReadMemoryFunc *tmu012_readfn[] = {
    tmu012_read,
    tmu012_read,
    tmu012_read
};

static CPUWriteMemoryFunc *tmu012_writefn[] = {
    tmu012_write,
    tmu012_write,
    tmu012_write
};

void tmu012_init(target_phys_addr_t base, int feat, uint32_t freq,
		 struct intc_source *ch0_irq, struct intc_source *ch1_irq,
		 struct intc_source *ch2_irq0, struct intc_source *ch2_irq1)
{
    int iomemtype;
    tmu012_state *s;
    int timer_feat = (feat & TMU012_FEAT_EXTCLK) ? TIMER_FEAT_EXTCLK : 0;

    s = (tmu012_state *)qemu_mallocz(sizeof(tmu012_state));
    s->base = base;
    s->feat = feat;
    s->timer[0] = sh_timer_init(freq, timer_feat, ch0_irq);
    s->timer[1] = sh_timer_init(freq, timer_feat, ch1_irq);
    if (feat & TMU012_FEAT_3CHAN)
        s->timer[2] = sh_timer_init(freq, timer_feat | TIMER_FEAT_CAPT,
				    ch2_irq0); /* ch2_irq1 not supported */
    iomemtype = cpu_register_io_memory(0, tmu012_readfn,
                                       tmu012_writefn, s);
    cpu_register_physical_memory(base, 0x00001000, iomemtype);
    /* ??? Save/restore.  */
}
Commit	Line	Data
cd1a3f68 TS	1	/*
	2	* SuperH Timer modules.
	3	*
	4	* Copyright (c) 2007 Magnus Damm
	5	* Based on arm_timer.c by Paul Brook
	6	* Copyright (c) 2005-2006 CodeSourcery.
	7	*
	8	* This code is licenced under the GPL.
	9	*/
	10
87ecb68b PB	11	#include "hw.h"
	12	#include "sh.h"
	13	#include "qemu-timer.h"
cd1a3f68 TS	14
	15	//#define DEBUG_TIMER
	16
	17	#define TIMER_TCR_TPSC (7 << 0)
	18	#define TIMER_TCR_CKEG (3 << 3)
	19	#define TIMER_TCR_UNIE (1 << 5)
	20	#define TIMER_TCR_ICPE (3 << 6)
	21	#define TIMER_TCR_UNF (1 << 8)
	22	#define TIMER_TCR_ICPF (1 << 9)
	23	#define TIMER_TCR_RESERVED (0x3f << 10)
	24
	25	#define TIMER_FEAT_CAPT (1 << 0)
	26	#define TIMER_FEAT_EXTCLK (1 << 1)
	27
	28	typedef struct {
	29	ptimer_state *timer;
	30	uint32_t tcnt;
	31	uint32_t tcor;
	32	uint32_t tcr;
	33	uint32_t tcpr;
	34	int freq;
	35	int int_level;
703243a0	36	int old_level;
cd1a3f68 TS	37	int feat;
cd1a3f68 TS	38	int enabled;
703243a0	39	struct intc_source *irq;
cd1a3f68 TS	40	} sh_timer_state;
	41
	42	/* Check all active timers, and schedule the next timer interrupt. */
	43
	44	static void sh_timer_update(sh_timer_state *s)
	45	{
703243a0 AZ	46	int new_level = s->int_level && (s->tcr & TIMER_TCR_UNIE);
	47
	48	if (new_level != s->old_level)
	49	sh_intc_toggle_source(s->irq, 0, new_level ? 1 : -1);
	50
	51	s->old_level = s->int_level;
	52	s->int_level = new_level;
cd1a3f68 TS	53	}
cd1a3f68 TS	54
9596ebb7	55	static uint32_t sh_timer_read(void *opaque, target_phys_addr_t offset)
cd1a3f68 TS	56	{
	57	sh_timer_state s = (sh_timer_state )opaque;
	58
	59	switch (offset >> 2) {
	60	case 0:
	61	return s->tcor;
	62	case 1:
	63	return ptimer_get_count(s->timer);
	64	case 2:
	65	return s->tcr \| (s->int_level ? TIMER_TCR_UNF : 0);
	66	case 3:
	67	if (s->feat & TIMER_FEAT_CAPT)
	68	return s->tcpr;
	69	default:
	70	cpu_abort (cpu_single_env, "sh_timer_read: Bad offset %x\n",
	71	(int)offset);
	72	return 0;
	73	}
	74	}
	75
	76	static void sh_timer_write(void *opaque, target_phys_addr_t offset,
	77	uint32_t value)
	78	{
	79	sh_timer_state s = (sh_timer_state )opaque;
	80	int freq;
	81
	82	switch (offset >> 2) {
	83	case 0:
	84	s->tcor = value;
	85	ptimer_set_limit(s->timer, s->tcor, 0);
	86	break;
	87	case 1:
	88	s->tcnt = value;
	89	ptimer_set_count(s->timer, s->tcnt);
	90	break;
	91	case 2:
	92	if (s->enabled) {
	93	/* Pause the timer if it is running. This may cause some
	94	inaccuracy dure to rounding, but avoids a whole lot of other
	95	messyness. */
	96	ptimer_stop(s->timer);
	97	}
	98	freq = s->freq;
	99	/* ??? Need to recalculate expiry time after changing divisor. */
	100	switch (value & TIMER_TCR_TPSC) {
	101	case 0: freq >>= 2; break;
	102	case 1: freq >>= 4; break;
	103	case 2: freq >>= 6; break;
	104	case 3: freq >>= 8; break;
	105	case 4: freq >>= 10; break;
	106	case 6:
	107	case 7: if (s->feat & TIMER_FEAT_EXTCLK) break;
	108	default: cpu_abort (cpu_single_env,
	109	"sh_timer_write: Reserved TPSC value\n"); break;
	110	}
	111	switch ((value & TIMER_TCR_CKEG) >> 3) {
	112	case 0: break;
	113	case 1:
	114	case 2:
	115	case 3: if (s->feat & TIMER_FEAT_EXTCLK) break;
	116	default: cpu_abort (cpu_single_env,
	117	"sh_timer_write: Reserved CKEG value\n"); break;
	118	}
	119	switch ((value & TIMER_TCR_ICPE) >> 6) {
120	case 0: break;
121	case 2:
122	case 3: if (s->feat & TIMER_FEAT_CAPT) break;
123	default: cpu_abort (cpu_single_env,
124	"sh_timer_write: Reserved ICPE value\n"); break;
125	}
126	if ((value & TIMER_TCR_UNF) == 0)
127	s->int_level = 0;
128
129	value &= ~TIMER_TCR_UNF;
130
131	if ((value & TIMER_TCR_ICPF) && (!(s->feat & TIMER_FEAT_CAPT)))
132	cpu_abort (cpu_single_env,
133	"sh_timer_write: Reserved ICPF value\n");
134
135	value &= ~TIMER_TCR_ICPF; /* capture not supported */
136
137	if (value & TIMER_TCR_RESERVED)
138	cpu_abort (cpu_single_env,
139	"sh_timer_write: Reserved TCR bits set\n");
140	s->tcr = value;
141	ptimer_set_limit(s->timer, s->tcor, 0);
142	ptimer_set_freq(s->timer, freq);
143	if (s->enabled) {
144	/* Restart the timer if still enabled. */
145	ptimer_run(s->timer, 0);
146	}
147	break;
148	case 3:
149	if (s->feat & TIMER_FEAT_CAPT) {
150	s->tcpr = value;
151	break;
152	}
153	default:
154	cpu_abort (cpu_single_env, "sh_timer_write: Bad offset %x\n",
155	(int)offset);
156	}
157	sh_timer_update(s);
158	}
159
160	static void sh_timer_start_stop(void *opaque, int enable)
161	{
162	sh_timer_state s = (sh_timer_state )opaque;
163
164	#ifdef DEBUG_TIMER
165	printf("sh_timer_start_stop %d (%d)\n", enable, s->enabled);
166	#endif
167
168	if (s->enabled && !enable) {
169	ptimer_stop(s->timer);
170	}
171	if (!s->enabled && enable) {
172	ptimer_run(s->timer, 0);
173	}
174	s->enabled = !!enable;
175
176	#ifdef DEBUG_TIMER
177	printf("sh_timer_start_stop done %d\n", s->enabled);
178	#endif
179	}
180
181	static void sh_timer_tick(void *opaque)
182	{
183	sh_timer_state s = (sh_timer_state )opaque;
184	s->int_level = s->enabled;
185	sh_timer_update(s);
186	}
187
703243a0	188	static void sh_timer_init(uint32_t freq, int feat, struct intc_source irq)
cd1a3f68 TS	189	{
	190	sh_timer_state *s;
	191	QEMUBH *bh;
	192
	193	s = (sh_timer_state *)qemu_mallocz(sizeof(sh_timer_state));
	194	s->freq = freq;
	195	s->feat = feat;
	196	s->tcor = 0xffffffff;
	197	s->tcnt = 0xffffffff;
	198	s->tcpr = 0xdeadbeef;
	199	s->tcor = 0;
	200	s->enabled = 0;
703243a0	201	s->irq = irq;
cd1a3f68 TS	202
	203	bh = qemu_bh_new(sh_timer_tick, s);
	204	s->timer = ptimer_init(bh);
	205	/* ??? Save/restore. */
	206	return s;
	207	}
	208
	209	typedef struct {
	210	void *timer[3];
	211	int level[3];
	212	uint32_t tocr;
	213	uint32_t tstr;
	214	target_phys_addr_t base;
	215	int feat;
	216	} tmu012_state;
	217
	218	static uint32_t tmu012_read(void *opaque, target_phys_addr_t offset)
	219	{
	220	tmu012_state s = (tmu012_state )opaque;
	221
	222	#ifdef DEBUG_TIMER
	223	printf("tmu012_read 0x%lx\n", (unsigned long) offset);
	224	#endif
	225	offset -= s->base;
	226
	227	if (offset >= 0x20) {
	228	if (!(s->feat & TMU012_FEAT_3CHAN))
	229	cpu_abort (cpu_single_env, "tmu012_write: Bad channel offset %x\n",
	230	(int)offset);
	231	return sh_timer_read(s->timer[2], offset - 0x20);
	232	}
	233
	234	if (offset >= 0x14)
	235	return sh_timer_read(s->timer[1], offset - 0x14);
	236
	237	if (offset >= 0x08)
	238	return sh_timer_read(s->timer[0], offset - 0x08);
	239
	240	if (offset == 4)
	241	return s->tstr;
	242
	243	if ((s->feat & TMU012_FEAT_TOCR) && offset == 0)
	244	return s->tocr;
	245
	246	cpu_abort (cpu_single_env, "tmu012_write: Bad offset %x\n",
	247	(int)offset);
	248	return 0;
	249	}
	250
	251	static void tmu012_write(void *opaque, target_phys_addr_t offset,
	252	uint32_t value)
	253	{
	254	tmu012_state s = (tmu012_state )opaque;
	255
	256	#ifdef DEBUG_TIMER
	257	printf("tmu012_write 0x%lx 0x%08x\n", (unsigned long) offset, value);
	258	#endif
	259	offset -= s->base;
	260
	261	if (offset >= 0x20) {
	262	if (!(s->feat & TMU012_FEAT_3CHAN))
	263	cpu_abort (cpu_single_env, "tmu012_write: Bad channel offset %x\n",
	264	(int)offset);
	265	sh_timer_write(s->timer[2], offset - 0x20, value);
266	return;
267	}
268
269	if (offset >= 0x14) {
270	sh_timer_write(s->timer[1], offset - 0x14, value);
271	return;
272	}
273
274	if (offset >= 0x08) {
275	sh_timer_write(s->timer[0], offset - 0x08, value);
276	return;
277	}
278
279	if (offset == 4) {
280	sh_timer_start_stop(s->timer[0], value & (1 << 0));
281	sh_timer_start_stop(s->timer[1], value & (1 << 1));
282	if (s->feat & TMU012_FEAT_3CHAN)
283	sh_timer_start_stop(s->timer[2], value & (1 << 2));
284	else
285	if (value & (1 << 2))
286	cpu_abort (cpu_single_env, "tmu012_write: Bad channel\n");
287
288	s->tstr = value;
289	return;
290	}
291
292	if ((s->feat & TMU012_FEAT_TOCR) && offset == 0) {
293	s->tocr = value & (1 << 0);
294	}
295	}
296
297	static CPUReadMemoryFunc *tmu012_readfn[] = {
298	tmu012_read,
299	tmu012_read,
300	tmu012_read
301	};
302
303	static CPUWriteMemoryFunc *tmu012_writefn[] = {
304	tmu012_write,
305	tmu012_write,
306	tmu012_write
307	};
308
703243a0 AZ	309	void tmu012_init(target_phys_addr_t base, int feat, uint32_t freq,
	310	struct intc_source ch0_irq, struct intc_source ch1_irq,
	311	struct intc_source ch2_irq0, struct intc_source ch2_irq1)
cd1a3f68 TS	312	{
	313	int iomemtype;
	314	tmu012_state *s;
	315	int timer_feat = (feat & TMU012_FEAT_EXTCLK) ? TIMER_FEAT_EXTCLK : 0;
	316
	317	s = (tmu012_state *)qemu_mallocz(sizeof(tmu012_state));
	318	s->base = base;
	319	s->feat = feat;
703243a0 AZ	320	s->timer[0] = sh_timer_init(freq, timer_feat, ch0_irq);
703243a0 AZ	321	s->timer[1] = sh_timer_init(freq, timer_feat, ch1_irq);
cd1a3f68	322	if (feat & TMU012_FEAT_3CHAN)
703243a0 AZ	323	s->timer[2] = sh_timer_init(freq, timer_feat \| TIMER_FEAT_CAPT,
703243a0 AZ	324	ch2_irq0); /* ch2_irq1 not supported */
cd1a3f68 TS	325	iomemtype = cpu_register_io_memory(0, tmu012_readfn,
	326	tmu012_writefn, s);
	327	cpu_register_physical_memory(base, 0x00001000, iomemtype);
	328	/* ??? Save/restore. */
	329	}