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