imx6_ssi.c revision 299069
11558Srgrimes/*-
2187814Srwatson * Copyright (c) 2015 Ruslan Bukin <br@bsdpad.com>
3187814Srwatson * All rights reserved.
4187814Srwatson *
5187814Srwatson * Redistribution and use in source and binary forms, with or without
6187814Srwatson * modification, are permitted provided that the following conditions
7187814Srwatson * are met:
898542Smckusick * 1. Redistributions of source code must retain the above copyright
998542Smckusick *    notice, this list of conditions and the following disclaimer.
1098542Smckusick * 2. Redistributions in binary form must reproduce the above copyright
1198542Smckusick *    notice, this list of conditions and the following disclaimer in the
1298542Smckusick *    documentation and/or other materials provided with the distribution.
1398542Smckusick *
1498542Smckusick * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15110884Smckusick * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1698542Smckusick * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
171558Srgrimes * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
181558Srgrimes * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
191558Srgrimes * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
201558Srgrimes * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
211558Srgrimes * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
221558Srgrimes * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
231558Srgrimes * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
241558Srgrimes * SUCH DAMAGE.
251558Srgrimes */
261558Srgrimes
271558Srgrimes/*
281558Srgrimes * i.MX6 Synchronous Serial Interface (SSI)
291558Srgrimes *
301558Srgrimes * Chapter 61, i.MX 6Dual/6Quad Applications Processor Reference Manual,
311558Srgrimes * Rev. 1, 04/2013
321558Srgrimes */
331558Srgrimes
341558Srgrimes#include <sys/cdefs.h>
351558Srgrimes__FBSDID("$FreeBSD: head/sys/arm/freescale/imx/imx6_ssi.c 299069 2016-05-04 15:48:59Z pfg $");
361558Srgrimes
371558Srgrimes#include <sys/param.h>
381558Srgrimes#include <sys/systm.h>
391558Srgrimes#include <sys/bus.h>
401558Srgrimes#include <sys/kernel.h>
411558Srgrimes#include <sys/module.h>
421558Srgrimes#include <sys/malloc.h>
431558Srgrimes#include <sys/rman.h>
441558Srgrimes#include <sys/timeet.h>
451558Srgrimes#include <sys/timetc.h>
4636998Scharnier
471558Srgrimes#include <dev/sound/pcm/sound.h>
481558Srgrimes#include <dev/sound/chip.h>
491558Srgrimes#include <mixer_if.h>
501558Srgrimes
511558Srgrimes#include <dev/fdt/fdt_common.h>
5236998Scharnier#include <dev/ofw/openfirm.h>
5323673Speter#include <dev/ofw/ofw_bus.h>
5436998Scharnier#include <dev/ofw/ofw_bus_subr.h>
5536998Scharnier
5650476Speter#include <machine/bus.h>
571558Srgrimes#include <machine/cpu.h>
581558Srgrimes#include <machine/intr.h>
591558Srgrimes
601558Srgrimes#include <arm/freescale/imx/imx6_sdma.h>
6196478Sphk#include <arm/freescale/imx/imx6_anatopvar.h>
621558Srgrimes#include <arm/freescale/imx/imx_ccmvar.h>
6398542Smckusick
641558Srgrimes#define	READ4(_sc, _reg)	\
651558Srgrimes	bus_space_read_4(_sc->bst, _sc->bsh, _reg)
6623673Speter#define	WRITE4(_sc, _reg, _val)	\
67105741Sjmallett	bus_space_write_4(_sc->bst, _sc->bsh, _reg, _val)
681558Srgrimes
691558Srgrimes#define	SSI_NCHANNELS	1
7099826Sjmallett
71224025Sdelphij/* i.MX6 SSI registers */
72109525Sjmallett
731558Srgrimes#define	SSI_STX0	0x00 /* Transmit Data Register n */
741558Srgrimes#define	SSI_STX1	0x04 /* Transmit Data Register n */
7523673Speter#define	SSI_SRX0	0x08 /* Receive Data Register n */
761558Srgrimes#define	SSI_SRX1	0x0C /* Receive Data Register n */
7799826Sjmallett#define	SSI_SCR		0x10 /* Control Register */
78109510Sjmallett#define	 SCR_I2S_MODE_S	5    /* I2S Mode Select. */
791558Srgrimes#define	 SCR_I2S_MODE_M	0x3
80227081Sed#define	 SCR_SYN	(1 << 4)
811558Srgrimes#define	 SCR_NET       	(1 << 3)  /* Network mode */
82228458Sed#define	 SCR_RE		(1 << 2)  /* Receive Enable. */
83228458Sed#define	 SCR_TE		(1 << 1)  /* Transmit Enable. */
84228458Sed#define	 SCR_SSIEN	(1 << 0)  /* SSI Enable */
85228458Sed#define	SSI_SISR	0x14      /* Interrupt Status Register */
86228458Sed#define	SSI_SIER	0x18      /* Interrupt Enable Register */
87228458Sed#define	 SIER_RDMAE	(1 << 22) /* Receive DMA Enable. */
88228458Sed#define	 SIER_RIE	(1 << 21) /* Receive Interrupt Enable. */
89228458Sed#define	 SIER_TDMAE	(1 << 20) /* Transmit DMA Enable. */
90228458Sed#define	 SIER_TIE	(1 << 19) /* Transmit Interrupt Enable. */
91228458Sed#define	 SIER_TDE0IE	(1 << 12) /* Transmit Data Register Empty 0. */
921558Srgrimes#define	 SIER_TUE0IE	(1 << 8)  /* Transmitter Underrun Error 0. */
931558Srgrimes#define	 SIER_TFE0IE	(1 << 0)  /* Transmit FIFO Empty 0 IE. */
9492839Simp#define	SSI_STCR	0x1C	  /* Transmit Configuration Register */
951558Srgrimes#define	 STCR_TXBIT0	(1 << 9)  /* Transmit Bit 0 shift MSB/LSB */
96109525Sjmallett#define	 STCR_TFEN1	(1 << 8)  /* Transmit FIFO Enable 1. */
97224004Sdelphij#define	 STCR_TFEN0	(1 << 7)  /* Transmit FIFO Enable 0. */
981558Srgrimes#define	 STCR_TFDIR	(1 << 6)  /* Transmit Frame Direction. */
99224004Sdelphij#define	 STCR_TXDIR	(1 << 5)  /* Transmit Clock Direction. */
100109507Sjmallett#define	 STCR_TSHFD	(1 << 4)  /* Transmit Shift Direction. */
101224004Sdelphij#define	 STCR_TSCKP	(1 << 3)  /* Transmit Clock Polarity. */
102109525Sjmallett#define	 STCR_TFSI	(1 << 2)  /* Transmit Frame Sync Invert. */
103187814Srwatson#define	 STCR_TFSL	(1 << 1)  /* Transmit Frame Sync Length. */
104187814Srwatson#define	 STCR_TEFS	(1 << 0)  /* Transmit Early Frame Sync. */
105187814Srwatson#define	SSI_SRCR	0x20      /* Receive Configuration Register */
106109525Sjmallett#define	SSI_STCCR	0x24      /* Transmit Clock Control Register */
107109525Sjmallett#define	 STCCR_DIV2	(1 << 18) /* Divide By 2. */
108109525Sjmallett#define	 STCCR_PSR	(1 << 17) /* Divide clock by 8. */
109224004Sdelphij#define	 WL3_WL0_S	13
110224004Sdelphij#define	 WL3_WL0_M	0xf
111224004Sdelphij#define	 DC4_DC0_S	8
112109525Sjmallett#define	 DC4_DC0_M	0x1f
113109525Sjmallett#define	 PM7_PM0_S	0
114109525Sjmallett#define	 PM7_PM0_M	0xff
115109525Sjmallett#define	SSI_SRCCR	0x28	/* Receive Clock Control Register */
116109525Sjmallett#define	SSI_SFCSR	0x2C	/* FIFO Control/Status Register */
1171558Srgrimes#define	 SFCSR_RFWM1_S	20	/* Receive FIFO Empty WaterMark 1 */
1181558Srgrimes#define	 SFCSR_RFWM1_M	0xf
1191558Srgrimes#define	 SFCSR_TFWM1_S	16	/* Transmit FIFO Empty WaterMark 1 */
1201558Srgrimes#define	 SFCSR_TFWM1_M	0xf
1211558Srgrimes#define	 SFCSR_RFWM0_S	4	/* Receive FIFO Empty WaterMark 0 */
122187814Srwatson#define	 SFCSR_RFWM0_M	0xf
123187814Srwatson#define	 SFCSR_TFWM0_S	0	/* Transmit FIFO Empty WaterMark 0 */
124187814Srwatson#define	 SFCSR_TFWM0_M	0xf
125187814Srwatson#define	SSI_SACNT	0x38	/* AC97 Control Register */
1261558Srgrimes#define	SSI_SACADD	0x3C	/* AC97 Command Address Register */
127109525Sjmallett#define	SSI_SACDAT	0x40	/* AC97 Command Data Register */
128109525Sjmallett#define	SSI_SATAG	0x44	/* AC97 Tag Register */
129109525Sjmallett#define	SSI_STMSK	0x48	/* Transmit Time Slot Mask Register */
130109525Sjmallett#define	SSI_SRMSK	0x4C	/* Receive Time Slot Mask Register */
131109525Sjmallett#define	SSI_SACCST	0x50	/* AC97 Channel Status Register */
132109525Sjmallett#define	SSI_SACCEN	0x54	/* AC97 Channel Enable Register */
133187814Srwatson#define	SSI_SACCDIS	0x58	/* AC97 Channel Disable Register */
134187814Srwatson
135187814Srwatsonstatic MALLOC_DEFINE(M_SSI, "ssi", "ssi audio");
136109525Sjmallett
137224004Sdelphijuint32_t ssi_dma_intr(void *arg, int chn);
138224004Sdelphij
139109525Sjmallettstruct ssi_rate {
140109525Sjmallett	uint32_t speed;
141109525Sjmallett	uint32_t mfi; /* PLL4 Multiplication Factor Integer */
142109525Sjmallett	uint32_t mfn; /* PLL4 Multiplication Factor Numerator */
1431558Srgrimes	uint32_t mfd; /* PLL4 Multiplication Factor Denominator */
1441558Srgrimes	/* More dividers to configure can be added here */
1451558Srgrimes};
146228458Sed
147224004Sdelphijstatic struct ssi_rate rate_map[] = {
148224004Sdelphij	{ 192000, 49, 152, 1000 }, /* PLL4 49.152 Mhz */
149224004Sdelphij	/* TODO: add more frequences */
150224025Sdelphij	{ 0, 0 },
151224004Sdelphij};
152224004Sdelphij
153224004Sdelphij/*
154228458Sed *  i.MX6 example bit clock formula
15592839Simp *
1561558Srgrimes *  BCLK = 2 channels * 192000 hz * 24 bit = 9216000 hz =
157109532Sjmallett *     (24000000 * (49 + 152/1000.0) / 4 / 4 / 2 / 2 / 2 / 1 / 1)
15898542Smckusick *             ^     ^     ^      ^    ^   ^   ^   ^   ^   ^   ^
159109767Snjl *             |     |     |      |    |   |   |   |   |   |   |
16099827Sjmallett *  Fref ------/     |     |      |    |   |   |   |   |   |   |
1611558Srgrimes *  PLL4 div select -/     |      |    |   |   |   |   |   |   |
162101688Sjmallett *  PLL4 num --------------/      |    |   |   |   |   |   |   |
163101688Sjmallett *  PLL4 denom -------------------/    |   |   |   |   |   |   |
16498542Smckusick *  PLL4 post div ---------------------/   |   |   |   |   |   |
165109532Sjmallett *  CCM ssi pre div (CCM_CS1CDR) ----------/   |   |   |   |   |
16698542Smckusick *  CCM ssi post div (CCM_CS1CDR) -------------/   |   |   |   |
167109532Sjmallett *  SSI PM7_PM0_S ---------------------------------/   |   |   |
168283899Sae *  SSI Fixed divider ---------------------------------/   |   |
169122670Sjohan *  SSI DIV2 ----------------------------------------------/   |
170122670Sjohan *  SSI PSR (prescaler /1 or /8) ------------------------------/
171122670Sjohan *
172101688Sjmallett *  MCLK (Master clock) depends on DAC, usually BCLK * 4
173101688Sjmallett */
17498542Smckusick
175109532Sjmallettstruct sc_info {
17698542Smckusick	struct resource		*res[2];
177109532Sjmallett	bus_space_tag_t		bst;
178201647Sgavin	bus_space_handle_t	bsh;
179122670Sjohan	device_t		dev;
180122670Sjohan	struct mtx		*lock;
181101688Sjmallett	void			*ih;
182101688Sjmallett	int			pos;
183109532Sjmallett	int			dma_size;
18498542Smckusick	bus_dma_tag_t		dma_tag;
1851558Srgrimes	bus_dmamap_t		dma_map;
1861558Srgrimes	bus_addr_t		buf_base_phys;
1871558Srgrimes	uint32_t		*buf_base;
1881558Srgrimes	struct sdma_conf	*conf;
1891558Srgrimes	struct ssi_rate		*sr;
1901558Srgrimes	struct sdma_softc	*sdma_sc;
19198542Smckusick	int			sdma_ev_rx;
1921558Srgrimes	int			sdma_ev_tx;
19398542Smckusick	int			sdma_channel;
194101688Sjmallett};
195101688Sjmallett
19698542Smckusick/* Channel registers */
19798542Smckusickstruct sc_chinfo {
19898542Smckusick	struct snd_dbuf		*buffer;
199122670Sjohan	struct pcm_channel	*channel;
200250708Smckusick	struct sc_pcminfo	*parent;
201122670Sjohan
202250708Smckusick	/* Channel information */
203122670Sjohan	uint32_t	dir;
204163844Spjd	uint32_t	format;
205163844Spjd
206163844Spjd	/* Flags */
207122670Sjohan	uint32_t	run;
208250708Smckusick};
209122670Sjohan
210109532Sjmallett/* PCM device private data */
211109532Sjmallettstruct sc_pcminfo {
212109532Sjmallett	device_t		dev;
213101688Sjmallett	uint32_t		(*ih)(struct sc_pcminfo *scp);
214101688Sjmallett	uint32_t		chnum;
21598542Smckusick	struct sc_chinfo	chan[SSI_NCHANNELS];
21698542Smckusick	struct sc_info		*sc;
21798542Smckusick};
21898542Smckusick
21998542Smckusickstatic struct resource_spec ssi_spec[] = {
22098542Smckusick	{ SYS_RES_MEMORY,	0,	RF_ACTIVE },
22198542Smckusick	{ SYS_RES_IRQ,		0,	RF_ACTIVE },
22298542Smckusick	{ -1, 0 }
223122670Sjohan};
22498542Smckusick
225122670Sjohanstatic int setup_dma(struct sc_pcminfo *scp);
22698542Smckusickstatic void setup_ssi(struct sc_info *);
22798542Smckusickstatic void ssi_configure_clock(struct sc_info *);
22898542Smckusick
22998542Smckusick/*
23098542Smckusick * Mixer interface.
23198542Smckusick */
23298542Smckusick
23398542Smckusickstatic int
23498542Smckusickssimixer_init(struct snd_mixer *m)
23598542Smckusick{
236101688Sjmallett	struct sc_pcminfo *scp;
237101688Sjmallett	struct sc_info *sc;
238109532Sjmallett	int mask;
23998542Smckusick
2401558Srgrimes	scp = mix_getdevinfo(m);
2411558Srgrimes	sc = scp->sc;
2422154Sdg
2432154Sdg	if (sc == NULL)
244248623Smckusick		return -1;
245248623Smckusick
24648875Smpp	mask = SOUND_MASK_PCM;
247109767Snjl	mask |= SOUND_MASK_VOLUME;
248109767Snjl
249109767Snjl	snd_mtxlock(sc->lock);
250109767Snjl	pcm_setflags(scp->dev, pcm_getflags(scp->dev) | SD_F_SOFTPCMVOL);
251109767Snjl	mix_setdevs(m, mask);
25248875Smpp	snd_mtxunlock(sc->lock);
253109767Snjl
254109767Snjl	return (0);
255109767Snjl}
256207141Sjeff
257109767Snjlstatic int
258109767Snjlssimixer_set(struct snd_mixer *m, unsigned dev,
259109767Snjl    unsigned left, unsigned right)
260109767Snjl{
261109767Snjl	struct sc_pcminfo *scp;
262109767Snjl
263109767Snjl	scp = mix_getdevinfo(m);
264109767Snjl
265163844Spjd	/* Here we can configure hardware volume on our DAC */
266163844Spjd
267109767Snjl#if 1
268109767Snjl	device_printf(scp->dev, "ssimixer_set() %d %d\n",
269200796Strasz	    left, right);
270200796Strasz#endif
271216798Skib
272216798Skib	return (0);
273109767Snjl}
274200796Strasz
275216798Skibstatic kobj_method_t ssimixer_methods[] = {
276109767Snjl	KOBJMETHOD(mixer_init,      ssimixer_init),
277109767Snjl	KOBJMETHOD(mixer_set,       ssimixer_set),
27848875Smpp	KOBJMETHOD_END
279110174Sgordon};
280242379StraszMIXER_DECLARE(ssimixer);
281242379Strasz
282242379Strasz
2831558Srgrimes/*
28471073Siedowse * Channel interface.
285101688Sjmallett */
28698542Smckusick
2871558Srgrimesstatic void *
2881558Srgrimesssichan_init(kobj_t obj, void *devinfo, struct snd_dbuf *b,
2891558Srgrimes    struct pcm_channel *c, int dir)
2901558Srgrimes{
2911558Srgrimes	struct sc_pcminfo *scp;
2921558Srgrimes	struct sc_chinfo *ch;
2931558Srgrimes	struct sc_info *sc;
2941558Srgrimes
29598542Smckusick	scp = (struct sc_pcminfo *)devinfo;
296101688Sjmallett	sc = scp->sc;
29798542Smckusick
29898542Smckusick	snd_mtxlock(sc->lock);
29998542Smckusick	ch = &scp->chan[0];
300109532Sjmallett	ch->dir = dir;
301109532Sjmallett	ch->run = 0;
3021558Srgrimes	ch->buffer = b;
303109519Sjmallett	ch->channel = c;
304109519Sjmallett	ch->parent = scp;
3051558Srgrimes	snd_mtxunlock(sc->lock);
306109519Sjmallett
3071558Srgrimes	if (sndbuf_setup(ch->buffer, sc->buf_base, sc->dma_size) != 0) {
3081558Srgrimes		device_printf(scp->dev, "Can't setup sndbuf.\n");
309109525Sjmallett		return NULL;
3101558Srgrimes	}
31199827Sjmallett
3121558Srgrimes	return ch;
313228458Sed}
314109519Sjmallett
3151558Srgrimesstatic int
316109532Sjmallettssichan_free(kobj_t obj, void *data)
3171558Srgrimes{
3181558Srgrimes	struct sc_chinfo *ch = data;
3191558Srgrimes	struct sc_pcminfo *scp = ch->parent;
320109519Sjmallett	struct sc_info *sc = scp->sc;
321109519Sjmallett
322101688Sjmallett#if 0
323101688Sjmallett	device_printf(scp->dev, "ssichan_free()\n");
324109532Sjmallett#endif
325122670Sjohan
326122670Sjohan	snd_mtxlock(sc->lock);
327163844Spjd	/* TODO: free channel buffer */
328163844Spjd	snd_mtxunlock(sc->lock);
329163844Spjd
330101688Sjmallett	return (0);
331101688Sjmallett}
332109532Sjmallett
333122670Sjohanstatic int
334122670Sjohanssichan_setformat(kobj_t obj, void *data, uint32_t format)
33598542Smckusick{
33698542Smckusick	struct sc_chinfo *ch = data;
33798542Smckusick
338101688Sjmallett	ch->format = format;
339101688Sjmallett
340101688Sjmallett	return (0);
34198542Smckusick}
3421558Srgrimes
3431558Srgrimesstatic uint32_t
3441558Srgrimesssichan_setspeed(kobj_t obj, void *data, uint32_t speed)
3451558Srgrimes{
3461558Srgrimes	struct sc_pcminfo *scp;
3471558Srgrimes	struct sc_chinfo *ch;
3481558Srgrimes	struct ssi_rate *sr;
3491558Srgrimes	struct sc_info *sc;
3501558Srgrimes	int threshold;
3511558Srgrimes	int i;
3521558Srgrimes
3531558Srgrimes	ch = data;
3541558Srgrimes	scp = ch->parent;
3551558Srgrimes	sc = scp->sc;
3561558Srgrimes
3571558Srgrimes	sr = NULL;
3581558Srgrimes
3591558Srgrimes	/* First look for equal frequency. */
3601558Srgrimes	for (i = 0; rate_map[i].speed != 0; i++) {
3611558Srgrimes		if (rate_map[i].speed == speed)
3621558Srgrimes			sr = &rate_map[i];
3631558Srgrimes	}
3641558Srgrimes
3651558Srgrimes	/* If no match, just find nearest. */
3661558Srgrimes	if (sr == NULL) {
36798542Smckusick		for (i = 0; rate_map[i].speed != 0; i++) {
3681558Srgrimes			sr = &rate_map[i];
36998542Smckusick			threshold = sr->speed + ((rate_map[i + 1].speed != 0) ?
3701558Srgrimes			    ((rate_map[i + 1].speed - sr->speed) >> 1) : 0);
3711558Srgrimes			if (speed < threshold)
37299827Sjmallett				break;
3731558Srgrimes		}
374228458Sed	}
375187814Srwatson
376187814Srwatson	sc->sr = sr;
377187814Srwatson
378187814Srwatson	ssi_configure_clock(sc);
379187814Srwatson
380187814Srwatson	return (sr->speed);
381187814Srwatson}
382187814Srwatson
383187814Srwatsonstatic void
384187814Srwatsonssi_configure_clock(struct sc_info *sc)
385187814Srwatson{
386187814Srwatson	struct ssi_rate *sr;
387187814Srwatson
388187814Srwatson	sr = sc->sr;
389187814Srwatson
390228458Sed	pll4_configure_output(sr->mfi, sr->mfn, sr->mfd);
391187814Srwatson
392187814Srwatson	/* Configure other dividers here, if any */
393187814Srwatson}
394187814Srwatson
395187814Srwatsonstatic uint32_t
396187814Srwatsonssichan_setblocksize(kobj_t obj, void *data, uint32_t blocksize)
397187814Srwatson{
398228458Sed	struct sc_chinfo *ch = data;
399109525Sjmallett	struct sc_pcminfo *scp = ch->parent;
400109525Sjmallett	struct sc_info *sc = scp->sc;
401109525Sjmallett
402109525Sjmallett	sndbuf_resize(ch->buffer, sc->dma_size / blocksize, blocksize);
403109525Sjmallett
404109525Sjmallett	setup_dma(scp);
405109525Sjmallett
406109525Sjmallett	return (sndbuf_getblksz(ch->buffer));
407116083Sjmallett}
408116083Sjmallett
409109525Sjmallettuint32_t
410109525Sjmallettssi_dma_intr(void *arg, int chn)
411109525Sjmallett{
412109525Sjmallett	struct sc_pcminfo *scp;
413109525Sjmallett	struct sdma_conf *conf;
414109525Sjmallett	struct sc_chinfo *ch;
415109525Sjmallett	struct sc_info *sc;
416109525Sjmallett	int bufsize;
417109525Sjmallett
418109525Sjmallett	scp = arg;
419109525Sjmallett	ch = &scp->chan[0];
420250710Smckusick	sc = scp->sc;
421250710Smckusick	conf = sc->conf;
422219899Sjmallett
423219899Sjmallett	bufsize = sndbuf_getsize(ch->buffer);
424241842Seadler
425241842Seadler	sc->pos += conf->period;
426250710Smckusick	if (sc->pos >= bufsize)
427250710Smckusick		sc->pos -= bufsize;
428250710Smckusick
429109525Sjmallett	if (ch->run)
430109525Sjmallett		chn_intr(ch->channel);
431109525Sjmallett
432109525Sjmallett	return (0);
433109525Sjmallett}
434109525Sjmallett
435109525Sjmallettstatic int
436109525Sjmallettfind_sdma_controller(struct sc_info *sc)
437109525Sjmallett{
438109525Sjmallett	struct sdma_softc *sdma_sc;
439109525Sjmallett	phandle_t node, sdma_node;
440109525Sjmallett	device_t sdma_dev;
441109525Sjmallett	int dts_value[8];
442109525Sjmallett	int len;
443109525Sjmallett
444198231Sru	if ((node = ofw_bus_get_node(sc->dev)) == -1)
445219899Sjmallett		return (ENXIO);
446219899Sjmallett
447109525Sjmallett	if ((len = OF_getproplen(node, "dmas")) <= 0)
448109525Sjmallett		return (ENXIO);
449109525Sjmallett
450109525Sjmallett	OF_getprop(node, "dmas", &dts_value, len);
451109525Sjmallett
452109525Sjmallett	sc->sdma_ev_rx = fdt32_to_cpu(dts_value[1]);
453228458Sed	sc->sdma_ev_tx = fdt32_to_cpu(dts_value[5]);
45492839Simp
4551558Srgrimes	sdma_node = OF_node_from_xref(fdt32_to_cpu(dts_value[0]));
45692806Sobrien
45792806Sobrien	sdma_sc = NULL;
4581558Srgrimes
4591558Srgrimes	sdma_dev = devclass_get_device(devclass_find("sdma"), 0);
4601558Srgrimes	if (sdma_dev)
4611558Srgrimes		sdma_sc = device_get_softc(sdma_dev);
4621558Srgrimes
4631558Srgrimes	if (sdma_sc == NULL) {
4641558Srgrimes		device_printf(sc->dev, "No sDMA found. Can't operate\n");
4651558Srgrimes		return (ENXIO);
4661558Srgrimes	}
4671558Srgrimes
4681558Srgrimes	sc->sdma_sc = sdma_sc;
4691558Srgrimes
4701558Srgrimes	return (0);
4711558Srgrimes};
4721558Srgrimes
4731558Srgrimesstatic int
4741558Srgrimessetup_dma(struct sc_pcminfo *scp)
475228458Sed{
476187814Srwatson	struct sdma_conf *conf;
477187814Srwatson	struct sc_chinfo *ch;
478187814Srwatson	struct sc_info *sc;
479187814Srwatson	int fmt;
480187814Srwatson
481187814Srwatson	ch = &scp->chan[0];
482187814Srwatson	sc = scp->sc;
483187814Srwatson	conf = sc->conf;
484187814Srwatson
485187814Srwatson	conf->ih = ssi_dma_intr;
486187814Srwatson	conf->ih_user = scp;
487187814Srwatson	conf->saddr = sc->buf_base_phys;
488187814Srwatson	conf->daddr = rman_get_start(sc->res[0]) + SSI_STX0;
489187820Srwatson	conf->event = sc->sdma_ev_tx; /* SDMA TX event */
490187814Srwatson	conf->period = sndbuf_getblksz(ch->buffer);
491187814Srwatson	conf->num_bd = sndbuf_getblkcnt(ch->buffer);
492187814Srwatson
493187814Srwatson	/*
494187814Srwatson	 * Word Length
495187814Srwatson	 * Can be 32, 24, 16 or 8 for sDMA.
496228458Sed	 *
497109525Sjmallett	 * SSI supports 24 at max.
498109525Sjmallett	 */
499109525Sjmallett
500109525Sjmallett	fmt = sndbuf_getfmt(ch->buffer);
501109525Sjmallett
502109525Sjmallett	if (fmt & AFMT_16BIT) {
503109525Sjmallett		conf->word_length = 16;
504109525Sjmallett		conf->command = CMD_2BYTES;
505228458Sed	} else if (fmt & AFMT_24BIT) {
50692839Simp		conf->word_length = 24;
5071558Srgrimes		conf->command = CMD_3BYTES;
508228898Sbrueffer	} else {
5091558Srgrimes		device_printf(sc->dev, "Unknown format\n");
5101558Srgrimes		return (-1);
511	}
512
513	return (0);
514}
515
516static int
517ssi_start(struct sc_pcminfo *scp)
518{
519	struct sc_info *sc;
520	int reg;
521
522	sc = scp->sc;
523
524	if (sdma_configure(sc->sdma_channel, sc->conf) != 0) {
525		device_printf(sc->dev, "Can't configure sDMA\n");
526		return (-1);
527	}
528
529	/* Enable DMA interrupt */
530	reg = (SIER_TDMAE);
531	WRITE4(sc, SSI_SIER, reg);
532
533	sdma_start(sc->sdma_channel);
534
535	return (0);
536}
537
538static int
539ssi_stop(struct sc_pcminfo *scp)
540{
541	struct sc_info *sc;
542	int reg;
543
544	sc = scp->sc;
545
546	reg = READ4(sc, SSI_SIER);
547	reg &= ~(SIER_TDMAE);
548	WRITE4(sc, SSI_SIER, reg);
549
550	sdma_stop(sc->sdma_channel);
551
552	bzero(sc->buf_base, sc->dma_size);
553
554	return (0);
555}
556
557static int
558ssichan_trigger(kobj_t obj, void *data, int go)
559{
560	struct sc_pcminfo *scp;
561	struct sc_chinfo *ch;
562	struct sc_info *sc;
563
564	ch = data;
565	scp = ch->parent;
566	sc = scp->sc;
567
568	snd_mtxlock(sc->lock);
569
570	switch (go) {
571	case PCMTRIG_START:
572#if 0
573		device_printf(scp->dev, "trigger start\n");
574#endif
575		ch->run = 1;
576
577		ssi_start(scp);
578
579		break;
580
581	case PCMTRIG_STOP:
582	case PCMTRIG_ABORT:
583#if 0
584		device_printf(scp->dev, "trigger stop or abort\n");
585#endif
586		ch->run = 0;
587
588		ssi_stop(scp);
589
590		break;
591	}
592
593	snd_mtxunlock(sc->lock);
594
595	return (0);
596}
597
598static uint32_t
599ssichan_getptr(kobj_t obj, void *data)
600{
601	struct sc_pcminfo *scp;
602	struct sc_chinfo *ch;
603	struct sc_info *sc;
604
605	ch = data;
606	scp = ch->parent;
607	sc = scp->sc;
608
609	return (sc->pos);
610}
611
612static uint32_t ssi_pfmt[] = {
613	SND_FORMAT(AFMT_S24_LE, 2, 0),
614	0
615};
616
617static struct pcmchan_caps ssi_pcaps = {44100, 192000, ssi_pfmt, 0};
618
619static struct pcmchan_caps *
620ssichan_getcaps(kobj_t obj, void *data)
621{
622
623	return (&ssi_pcaps);
624}
625
626static kobj_method_t ssichan_methods[] = {
627	KOBJMETHOD(channel_init,         ssichan_init),
628	KOBJMETHOD(channel_free,         ssichan_free),
629	KOBJMETHOD(channel_setformat,    ssichan_setformat),
630	KOBJMETHOD(channel_setspeed,     ssichan_setspeed),
631	KOBJMETHOD(channel_setblocksize, ssichan_setblocksize),
632	KOBJMETHOD(channel_trigger,      ssichan_trigger),
633	KOBJMETHOD(channel_getptr,       ssichan_getptr),
634	KOBJMETHOD(channel_getcaps,      ssichan_getcaps),
635	KOBJMETHOD_END
636};
637CHANNEL_DECLARE(ssichan);
638
639static int
640ssi_probe(device_t dev)
641{
642
643	if (!ofw_bus_status_okay(dev))
644		return (ENXIO);
645
646	if (!ofw_bus_is_compatible(dev, "fsl,imx6q-ssi"))
647		return (ENXIO);
648
649	device_set_desc(dev, "i.MX6 Synchronous Serial Interface (SSI)");
650	return (BUS_PROBE_DEFAULT);
651}
652
653static void
654ssi_intr(void *arg)
655{
656	struct sc_pcminfo *scp;
657	struct sc_chinfo *ch;
658	struct sc_info *sc;
659
660	scp = arg;
661	sc = scp->sc;
662	ch = &scp->chan[0];
663
664	/* We don't use SSI interrupt */
665#if 0
666	device_printf(sc->dev, "SSI Intr 0x%08x\n",
667	    READ4(sc, SSI_SISR));
668#endif
669}
670
671static void
672setup_ssi(struct sc_info *sc)
673{
674	int reg;
675
676	reg = READ4(sc, SSI_STCCR);
677	reg &= ~(WL3_WL0_M << WL3_WL0_S);
678	reg |= (0xb << WL3_WL0_S); /* 24 bit */
679	reg &= ~(DC4_DC0_M << DC4_DC0_S);
680	reg |= (1 << DC4_DC0_S); /* 2 words per frame */
681	reg &= ~(STCCR_DIV2); /* Divide by 1 */
682	reg &= ~(STCCR_PSR); /* Divide by 1 */
683	reg &= ~(PM7_PM0_M << PM7_PM0_S);
684	reg |= (1 << PM7_PM0_S); /* Divide by 2 */
685	WRITE4(sc, SSI_STCCR, reg);
686
687	reg = READ4(sc, SSI_SFCSR);
688	reg &= ~(SFCSR_TFWM0_M << SFCSR_TFWM0_S);
689	reg |= (8 << SFCSR_TFWM0_S); /* empty slots */
690	WRITE4(sc, SSI_SFCSR, reg);
691
692	reg = READ4(sc, SSI_STCR);
693	reg |= (STCR_TFEN0);
694	reg &= ~(STCR_TFEN1);
695	reg &= ~(STCR_TSHFD); /* MSB */
696	reg |= (STCR_TXBIT0);
697	reg |= (STCR_TXDIR | STCR_TFDIR);
698	reg |= (STCR_TSCKP); /* falling edge */
699	reg |= (STCR_TFSI);
700	reg &= ~(STCR_TFSI); /* active high frame sync */
701	reg &= ~(STCR_TFSL);
702	reg |= STCR_TEFS;
703	WRITE4(sc, SSI_STCR, reg);
704
705	reg = READ4(sc, SSI_SCR);
706	reg &= ~(SCR_I2S_MODE_M << SCR_I2S_MODE_S); /* Not master */
707	reg |= (SCR_SSIEN | SCR_TE);
708	reg |= (SCR_NET);
709	reg |= (SCR_SYN);
710	WRITE4(sc, SSI_SCR, reg);
711}
712
713static void
714ssi_dmamap_cb(void *arg, bus_dma_segment_t *segs, int nseg, int err)
715{
716	bus_addr_t *addr;
717
718	if (err)
719		return;
720
721	addr = (bus_addr_t*)arg;
722	*addr = segs[0].ds_addr;
723}
724
725static int
726ssi_attach(device_t dev)
727{
728	char status[SND_STATUSLEN];
729	struct sc_pcminfo *scp;
730	struct sc_info *sc;
731	int err;
732
733	sc = malloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
734	sc->dev = dev;
735	sc->sr = &rate_map[0];
736	sc->pos = 0;
737	sc->conf = malloc(sizeof(struct sdma_conf), M_DEVBUF, M_WAITOK | M_ZERO);
738
739	sc->lock = snd_mtxcreate(device_get_nameunit(dev), "ssi softc");
740	if (sc->lock == NULL) {
741		device_printf(dev, "Can't create mtx\n");
742		return (ENXIO);
743	}
744
745	if (bus_alloc_resources(dev, ssi_spec, sc->res)) {
746		device_printf(dev, "could not allocate resources\n");
747		return (ENXIO);
748	}
749
750	/* Memory interface */
751	sc->bst = rman_get_bustag(sc->res[0]);
752	sc->bsh = rman_get_bushandle(sc->res[0]);
753
754	/* SDMA */
755	if (find_sdma_controller(sc)) {
756		device_printf(dev, "could not find active SDMA\n");
757		return (ENXIO);
758	}
759
760	/* Setup PCM */
761	scp = malloc(sizeof(struct sc_pcminfo), M_DEVBUF, M_NOWAIT | M_ZERO);
762	scp->sc = sc;
763	scp->dev = dev;
764
765	/*
766	 * Maximum possible DMA buffer.
767	 * Will be used partially to match 24 bit word.
768	 */
769	sc->dma_size = 131072;
770
771	/*
772	 * Must use dma_size boundary as modulo feature required.
773	 * Modulo feature allows setup circular buffer.
774	 */
775
776	err = bus_dma_tag_create(
777	    bus_get_dma_tag(sc->dev),
778	    4, sc->dma_size,		/* alignment, boundary */
779	    BUS_SPACE_MAXADDR_32BIT,	/* lowaddr */
780	    BUS_SPACE_MAXADDR,		/* highaddr */
781	    NULL, NULL,			/* filter, filterarg */
782	    sc->dma_size, 1,		/* maxsize, nsegments */
783	    sc->dma_size, 0,		/* maxsegsize, flags */
784	    NULL, NULL,			/* lockfunc, lockarg */
785	    &sc->dma_tag);
786
787	err = bus_dmamem_alloc(sc->dma_tag, (void **)&sc->buf_base,
788	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT, &sc->dma_map);
789	if (err) {
790		device_printf(dev, "cannot allocate framebuffer\n");
791		return (ENXIO);
792	}
793
794	err = bus_dmamap_load(sc->dma_tag, sc->dma_map, sc->buf_base,
795	    sc->dma_size, ssi_dmamap_cb, &sc->buf_base_phys, BUS_DMA_NOWAIT);
796	if (err) {
797		device_printf(dev, "cannot load DMA map\n");
798		return (ENXIO);
799	}
800
801	bzero(sc->buf_base, sc->dma_size);
802
803	/* Setup interrupt handler */
804	err = bus_setup_intr(dev, sc->res[1], INTR_MPSAFE | INTR_TYPE_AV,
805	    NULL, ssi_intr, scp, &sc->ih);
806	if (err) {
807		device_printf(dev, "Unable to alloc interrupt resource.\n");
808		return (ENXIO);
809	}
810
811	pcm_setflags(dev, pcm_getflags(dev) | SD_F_MPSAFE);
812
813	err = pcm_register(dev, scp, 1, 0);
814	if (err) {
815		device_printf(dev, "Can't register pcm.\n");
816		return (ENXIO);
817	}
818
819	scp->chnum = 0;
820	pcm_addchan(dev, PCMDIR_PLAY, &ssichan_class, scp);
821	scp->chnum++;
822
823	snprintf(status, SND_STATUSLEN, "at simplebus");
824	pcm_setstatus(dev, status);
825
826	mixer_init(dev, &ssimixer_class, scp);
827	setup_ssi(sc);
828
829	imx_ccm_ssi_configure(dev);
830
831	sc->sdma_channel = sdma_alloc();
832	if (sc->sdma_channel < 0) {
833		device_printf(sc->dev, "Can't get sDMA channel\n");
834		return (1);
835	}
836
837	return (0);
838}
839
840static device_method_t ssi_pcm_methods[] = {
841	DEVMETHOD(device_probe,		ssi_probe),
842	DEVMETHOD(device_attach,	ssi_attach),
843	{ 0, 0 }
844};
845
846static driver_t ssi_pcm_driver = {
847	"pcm",
848	ssi_pcm_methods,
849	PCM_SOFTC_SIZE,
850};
851
852DRIVER_MODULE(ssi, simplebus, ssi_pcm_driver, pcm_devclass, 0, 0);
853MODULE_DEPEND(ssi, sound, SOUND_MINVER, SOUND_PREFVER, SOUND_MAXVER);
854MODULE_VERSION(ssi, 1);
855