1 /*
2 * Copyright (C) 2006-2009 Anders Gavare. All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * 1. Redistributions of source code must retain the above copyright
8 * notice, this list of conditions and the following disclaimer.
9 * 2. Redistributions in binary form must reproduce the above copyright
10 * notice, this list of conditions and the following disclaimer in the
11 * documentation and/or other materials provided with the distribution.
12 * 3. The name of the author may not be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 *
27 *
28 * COMMENT: IQ80321 LED device
29 *
30 * Should work with NetBSD's iq80321_7seg.c.
31 *
32 * TODO: Graphical output of LED lines?
33 */
34
35 #include <stdio.h>
36 #include <stdlib.h>
37 #include <string.h>
38
39 #include "cpu.h"
40 #include "device.h"
41 #include "machine.h"
42 #include "memory.h"
43 #include "misc.h"
44
45
46 struct iq80321_7seg_data {
47 uint8_t msb, lsb;
48 };
49
50
DEVICE_ACCESS(iq80321_7seg)51 DEVICE_ACCESS(iq80321_7seg)
52 {
53 struct iq80321_7seg_data *d = (struct iq80321_7seg_data *) extra;
54 uint64_t idata = 0, odata = 0;
55
56 if (writeflag == MEM_WRITE)
57 idata = memory_readmax64(cpu, data, len);
58
59 switch (relative_addr) {
60
61 case 0: if (writeflag == MEM_READ)
62 odata = d->msb;
63 else {
64 d->msb = idata;
65 debug("[ iq80321_7seg: setting MSB to 0x%02x ]\n",
66 (int)idata);
67 }
68 break;
69
70 case 0x10000:
71 if (writeflag == MEM_READ)
72 odata = d->lsb;
73 else {
74 d->lsb = idata;
75 debug("[ iq80321_7seg: setting LSB to 0x%02x ]\n",
76 (int)idata);
77 }
78 break;
79
80 default:if (writeflag == MEM_READ) {
81 fatal("[ iq80321_7seg: read from 0x%x ]\n",
82 (int)relative_addr);
83 } else {
84 fatal("[ iq80321_7seg: write to 0x%x: 0x%llx ]\n",
85 (int)relative_addr, (long long)idata);
86 }
87 exit(1);
88 }
89
90 if (writeflag == MEM_READ)
91 memory_writemax64(cpu, data, len, odata);
92
93 return 1;
94 }
95
96
DEVINIT(iq80321_7seg)97 DEVINIT(iq80321_7seg)
98 {
99 struct iq80321_7seg_data *d;
100
101 CHECK_ALLOCATION(d = (struct iq80321_7seg_data *) malloc(sizeof(struct iq80321_7seg_data)));
102 memset(d, 0, sizeof(struct iq80321_7seg_data));
103
104 /* 0xfe840000 and 0xfe850000 */
105 memory_device_register(devinit->machine->memory, devinit->name,
106 devinit->addr, 0x10004, dev_iq80321_7seg_access, d,
107 DM_DEFAULT, NULL);
108
109 return 1;
110 }
111
112
113