sgsmix.c revision 1.1 1 1.1 macallan /* $NetBSD: sgsmix.c,v 1.1 2007/01/17 23:32:10 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (C) 2005 Michael Lorenz.
5 1.1 macallan *
6 1.1 macallan * Redistribution and use in source and binary forms, with or without
7 1.1 macallan * modification, are permitted provided that the following conditions
8 1.1 macallan * are met:
9 1.1 macallan * 1. Redistributions of source code must retain the above copyright
10 1.1 macallan * notice, this list of conditions and the following disclaimer.
11 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 macallan * notice, this list of conditions and the following disclaimer in the
13 1.1 macallan * documentation and/or other materials provided with the distribution.
14 1.1 macallan * 3. The name of the author may not be used to endorse or promote products
15 1.1 macallan * derived from this software without specific prior written permission.
16 1.1 macallan *
17 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 1.1 macallan * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 1.1 macallan * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 1.1 macallan * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 1.1 macallan * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 1.1 macallan * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 1.1 macallan * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 1.1 macallan * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 1.1 macallan * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 1.1 macallan * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 1.1 macallan */
28 1.1 macallan
29 1.1 macallan /*
30 1.1 macallan * a driver for the SGS TDA7433 mixer chip found in Beige PowerMac G3 and
31 1.1 macallan * probably others
32 1.1 macallan */
33 1.1 macallan
34 1.1 macallan
35 1.1 macallan #include <sys/cdefs.h>
36 1.1 macallan __KERNEL_RCSID(0, "$NetBSD: sgsmix.c,v 1.1 2007/01/17 23:32:10 macallan Exp $");
37 1.1 macallan
38 1.1 macallan #include <sys/param.h>
39 1.1 macallan #include <sys/systm.h>
40 1.1 macallan #include <sys/kernel.h>
41 1.1 macallan #include <sys/device.h>
42 1.1 macallan #include <sys/malloc.h>
43 1.1 macallan #include <sys/sysctl.h>
44 1.1 macallan
45 1.1 macallan #include <uvm/uvm_extern.h>
46 1.1 macallan
47 1.1 macallan #include <dev/i2c/i2cvar.h>
48 1.1 macallan
49 1.1 macallan #include <machine/autoconf.h>
50 1.1 macallan #include <dev/i2c/sgsmixvar.h>
51 1.1 macallan
52 1.1 macallan #ifdef SGSMIX_DEBUG
53 1.1 macallan #define DPRINTF printf
54 1.1 macallan #else
55 1.1 macallan #define DPRINTF while (0) printf
56 1.1 macallan #endif
57 1.1 macallan
58 1.1 macallan struct sgsmix_softc {
59 1.1 macallan struct device sc_dev;
60 1.1 macallan struct device *sc_parent;
61 1.1 macallan struct i2c_controller *sc_i2c;
62 1.1 macallan int sc_node, sc_address;
63 1.1 macallan uint8_t sc_regs[7];
64 1.1 macallan };
65 1.1 macallan
66 1.1 macallan #define SGSREG_INPUT_SELECT 0
67 1.1 macallan #define SGSREG_MASTER_GAIN 1
68 1.1 macallan #define SGSREG_BASS_TREBLE 2
69 1.1 macallan #define SGSREG_SPEAKER_L 3
70 1.1 macallan #define SGSREG_HEADPHONES_L 4
71 1.1 macallan #define SGSREG_SPEAKER_R 5
72 1.1 macallan #define SGSREG_HEADPHONES_R 6
73 1.1 macallan
74 1.1 macallan static void sgsmix_attach(struct device *, struct device *, void *);
75 1.1 macallan static int sgsmix_match(struct device *, struct cfdata *, void *);
76 1.1 macallan static void sgsmix_setup(struct sgsmix_softc *);
77 1.1 macallan static void sgsmix_writereg(struct sgsmix_softc *, int, uint8_t);
78 1.1 macallan
79 1.1 macallan CFATTACH_DECL(sgsmix, sizeof(struct sgsmix_softc),
80 1.1 macallan sgsmix_match, sgsmix_attach, NULL, NULL);
81 1.1 macallan
82 1.1 macallan static int
83 1.1 macallan sgsmix_match(struct device *parent, struct cfdata *cf, void *aux)
84 1.1 macallan {
85 1.1 macallan struct i2c_attach_args *args = aux;
86 1.1 macallan int ret = -1;
87 1.1 macallan uint8_t out[2] = {1, 0x20};
88 1.1 macallan
89 1.1 macallan /* see if we can talk to something at address 0x8a */
90 1.1 macallan if (args->ia_addr == 0x8a) {
91 1.1 macallan iic_acquire_bus(args->ia_tag, 0);
92 1.1 macallan ret = iic_exec(args->ia_tag, I2C_OP_WRITE, args->ia_addr,
93 1.1 macallan out, 2, NULL, 0, 0);
94 1.1 macallan iic_release_bus(args->ia_tag, 0);
95 1.1 macallan }
96 1.1 macallan return (ret >= 0);
97 1.1 macallan }
98 1.1 macallan
99 1.1 macallan static void
100 1.1 macallan sgsmix_attach(struct device *parent, struct device *self, void *aux)
101 1.1 macallan {
102 1.1 macallan struct sgsmix_softc *sc = device_private(self);
103 1.1 macallan struct i2c_attach_args *args = aux;
104 1.1 macallan
105 1.1 macallan sc->sc_parent = parent;
106 1.1 macallan sc->sc_address = args->ia_addr;
107 1.1 macallan printf(": SGS TDA7433 Basic Audio Processor\n");
108 1.1 macallan sc->sc_i2c = (struct i2c_controller *)args->ia_tag;
109 1.1 macallan sgsmix_setup(sc);
110 1.1 macallan }
111 1.1 macallan
112 1.1 macallan static void
113 1.1 macallan sgsmix_setup(struct sgsmix_softc *sc)
114 1.1 macallan {
115 1.1 macallan int i;
116 1.1 macallan uint8_t out[2];
117 1.1 macallan
118 1.1 macallan sc->sc_regs[0] = 9; /* input 1 */
119 1.1 macallan sc->sc_regs[1] = 0x20; /* master gain 0dB */
120 1.1 macallan sc->sc_regs[2] = 0x77; /* flat bass / treble */
121 1.1 macallan sc->sc_regs[3] = 0; /* all speakers full volume */
122 1.1 macallan sc->sc_regs[4] = 0;
123 1.1 macallan sc->sc_regs[5] = 0;
124 1.1 macallan sc->sc_regs[6] = 0;
125 1.1 macallan
126 1.1 macallan iic_acquire_bus(sc->sc_i2c, 0);
127 1.1 macallan
128 1.1 macallan for (i = 0; i < 7; i++) {
129 1.1 macallan out[0] = i;
130 1.1 macallan out[1] = sc->sc_regs[i];
131 1.1 macallan iic_exec(sc->sc_i2c, I2C_OP_WRITE, sc->sc_address, out, 2,
132 1.1 macallan NULL, 0, 0);
133 1.1 macallan }
134 1.1 macallan
135 1.1 macallan iic_release_bus(sc->sc_i2c, 0);
136 1.1 macallan }
137 1.1 macallan
138 1.1 macallan static void
139 1.1 macallan sgsmix_writereg(struct sgsmix_softc *sc, int reg, uint8_t val)
140 1.1 macallan {
141 1.1 macallan uint8_t out[2] = {reg, val};
142 1.1 macallan
143 1.1 macallan if ((reg < 0) || (reg >= 7))
144 1.1 macallan return;
145 1.1 macallan
146 1.1 macallan if (sc->sc_regs[reg] == val)
147 1.1 macallan return;
148 1.1 macallan
149 1.1 macallan if (iic_exec(sc->sc_i2c, I2C_OP_WRITE, sc->sc_address, out, 2, NULL,
150 1.1 macallan 0, 0) == 0) {
151 1.1 macallan sc->sc_regs[reg] = val;
152 1.1 macallan }
153 1.1 macallan }
154 1.1 macallan
155 1.1 macallan void
156 1.1 macallan sgsmix_set_speaker_vol(void *cookie, int left, int right)
157 1.1 macallan {
158 1.1 macallan struct sgsmix_softc *sc = cookie;
159 1.1 macallan
160 1.1 macallan if (left == 0) {
161 1.1 macallan sgsmix_writereg(sc, SGSREG_SPEAKER_L, 0x20);
162 1.1 macallan } else {
163 1.1 macallan sgsmix_writereg(sc, SGSREG_SPEAKER_L,
164 1.1 macallan ((255 - left) >> 3) & 0x1f);
165 1.1 macallan }
166 1.1 macallan
167 1.1 macallan if (right == 0) {
168 1.1 macallan sgsmix_writereg(sc, SGSREG_SPEAKER_R, 0x20);
169 1.1 macallan } else {
170 1.1 macallan sgsmix_writereg(sc, SGSREG_SPEAKER_R,
171 1.1 macallan ((255 - right) >> 3) & 0x1f);
172 1.1 macallan }
173 1.1 macallan }
174 1.1 macallan
175 1.1 macallan void
176 1.1 macallan sgsmix_set_headphone_vol(void *cookie, int left, int right)
177 1.1 macallan {
178 1.1 macallan struct sgsmix_softc *sc = cookie;
179 1.1 macallan
180 1.1 macallan if (left == 0) {
181 1.1 macallan sgsmix_writereg(sc, SGSREG_HEADPHONES_L, 0x20);
182 1.1 macallan } else {
183 1.1 macallan sgsmix_writereg(sc, SGSREG_HEADPHONES_L,
184 1.1 macallan ((255 - left) >> 3) & 0x1f);
185 1.1 macallan }
186 1.1 macallan
187 1.1 macallan if (right == 0) {
188 1.1 macallan sgsmix_writereg(sc, SGSREG_HEADPHONES_R, 0x20);
189 1.1 macallan } else {
190 1.1 macallan sgsmix_writereg(sc, SGSREG_HEADPHONES_R,
191 1.1 macallan ((255 - right) >> 3) & 0x1f);
192 1.1 macallan }
193 1.1 macallan }
194 1.1 macallan
195 1.1 macallan void
196 1.1 macallan sgsmix_set_bass_treble(void *cookie, int bass, int treble)
197 1.1 macallan {
198 1.1 macallan struct sgsmix_softc *sc = cookie;
199 1.1 macallan uint8_t b, t;
200 1.1 macallan
201 1.1 macallan t = (treble >> 4) & 0xf;
202 1.1 macallan if (t & 0x8)
203 1.1 macallan t ^= 7;
204 1.1 macallan b = bass & 0xf0;
205 1.1 macallan if (b & 0x80)
206 1.1 macallan b ^= 0x70;
207 1.1 macallan DPRINTF("%s: bass/treble %02x %02x\n", sc->sc_dev.dv_xname, b, t);
208 1.1 macallan sgsmix_writereg(sc, SGSREG_BASS_TREBLE, b | t);
209 1.1 macallan }
210