Home | History | Annotate | Line # | Download | only in i2c
sgsmix.c revision 1.9
      1 /*	$NetBSD: sgsmix.c,v 1.9 2018/06/16 21:22:13 thorpej 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.9 2018/06/16 21:22:13 thorpej 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 	int match_result;
     85 
     86 	if (iic_use_direct_match(args, cf, NULL, &match_result))
     87 		return match_result;
     88 
     89 	/* see if we can talk to something at address 0x8a */
     90 	if (args->ia_addr != 0x8a)
     91 		return 0;
     92 
     93 	iic_acquire_bus(args->ia_tag, 0);
     94 	ret = iic_exec(args->ia_tag, I2C_OP_WRITE, args->ia_addr,
     95 	    out, 2, NULL, 0, 0);
     96 	iic_release_bus(args->ia_tag, 0);
     97 
     98 	return (ret >= 0) ? I2C_MATCH_ADDRESS_AND_PROBE : 0;
     99 }
    100 
    101 static void
    102 sgsmix_attach(device_t parent, device_t self, void *aux)
    103 {
    104 	struct sgsmix_softc *sc = device_private(self);
    105 	struct i2c_attach_args *args = aux;
    106 
    107 	sc->sc_dev = self;
    108 	sc->sc_parent = parent;
    109 	sc->sc_address = args->ia_addr;
    110 	aprint_normal(": SGS TDA7433 Basic Audio Processor\n");
    111 	sc->sc_i2c = args->ia_tag;
    112 	sgsmix_setup(sc);
    113 }
    114 
    115 static void
    116 sgsmix_setup(struct sgsmix_softc *sc)
    117 {
    118 	int i;
    119 	uint8_t out[2];
    120 
    121 	sc->sc_regs[0] = 9;	/* input 1 */
    122 	sc->sc_regs[1] = 0x20;	/* master gain 0dB */
    123 	sc->sc_regs[2] = 0x77;	/* flat bass / treble */
    124 	sc->sc_regs[3] = 0;	/* all speakers full volume */
    125 	sc->sc_regs[4] = 0;
    126 	sc->sc_regs[5] = 0;
    127 	sc->sc_regs[6] = 0;
    128 
    129 	iic_acquire_bus(sc->sc_i2c, 0);
    130 
    131 	for (i = 0; i < 7; i++) {
    132 		out[0] = i;
    133 		out[1] = sc->sc_regs[i];
    134 		iic_exec(sc->sc_i2c, I2C_OP_WRITE, sc->sc_address, out, 2,
    135 		    NULL, 0, 0);
    136 	}
    137 
    138 	iic_release_bus(sc->sc_i2c, 0);
    139 }
    140 
    141 static void
    142 sgsmix_writereg(struct sgsmix_softc *sc, int reg, uint8_t val)
    143 {
    144 	uint8_t out[2] = {reg, val};
    145 
    146 	if ((reg < 0) || (reg >= 7))
    147 		return;
    148 
    149 	if (sc->sc_regs[reg] == val)
    150 		return;
    151 
    152 	if (iic_exec(sc->sc_i2c, I2C_OP_WRITE, sc->sc_address, out, 2, NULL,
    153 	    0, 0) == 0) {
    154 	    	sc->sc_regs[reg] = val;
    155 	}
    156 }
    157 
    158 void
    159 sgsmix_set_speaker_vol(void *cookie, int left, int right)
    160 {
    161 	struct sgsmix_softc *sc = device_private((device_t)cookie);
    162 
    163 	DPRINTF("%s: speaker %d %d\n", device_xname(sc->sc_dev), left, right);
    164 	if (left == 0) {
    165 		sgsmix_writereg(sc, SGSREG_SPEAKER_L, 0x20);
    166 	} else {
    167 		sgsmix_writereg(sc, SGSREG_SPEAKER_L,
    168 		    ((255 - left) >> 3) & 0x1f);
    169 	}
    170 
    171 	if (right == 0) {
    172 		sgsmix_writereg(sc, SGSREG_SPEAKER_R, 0x20);
    173 	} else {
    174 		sgsmix_writereg(sc, SGSREG_SPEAKER_R,
    175 		    ((255 - right) >> 3) & 0x1f);
    176 	}
    177 }
    178 
    179 void
    180 sgsmix_set_headphone_vol(void *cookie, int left, int right)
    181 {
    182 	struct sgsmix_softc *sc = device_private((device_t)cookie);
    183 
    184 	DPRINTF("%s: headphones %d %d\n", device_xname(sc->sc_dev), left, right);
    185 	if (left == 0) {
    186 		sgsmix_writereg(sc, SGSREG_HEADPHONES_L, 0x20);
    187 	} else {
    188 		sgsmix_writereg(sc, SGSREG_HEADPHONES_L,
    189 		    ((255 - left) >> 3) & 0x1f);
    190 	}
    191 
    192 	if (right == 0) {
    193 		sgsmix_writereg(sc, SGSREG_HEADPHONES_R, 0x20);
    194 	} else {
    195 		sgsmix_writereg(sc, SGSREG_HEADPHONES_R,
    196 		    ((255 - right) >> 3) & 0x1f);
    197 	}
    198 }
    199 
    200 void
    201 sgsmix_set_bass_treble(void *cookie, int bass, int treble)
    202 {
    203 	struct sgsmix_softc *sc = device_private((device_t)cookie);
    204 	uint8_t b, t;
    205 
    206 	t = (treble >> 4) & 0xf;
    207 	if (t & 0x8)
    208 		t ^= 7;
    209 	b = bass & 0xf0;
    210 	if (b & 0x80)
    211 		b ^= 0x70;
    212 	DPRINTF("%s: bass/treble %02x %02x\n", device_xname(sc->sc_dev), b, t);
    213 	sgsmix_writereg(sc, SGSREG_BASS_TREBLE, b | t);
    214 }
    215