sound/soc/sh/fsi.c

   1 /*
   2  * Fifo-attached Serial Interface (FSI) support for SH7724
   3  *
   4  * Copyright (C) 2009 Renesas Solutions Corp.
   5  * Kuninori Morimoto <morimoto.kuninori@renesas.com>
   6  *
   7  * Based on ssi.c
   8  * Copyright (c) 2007 Manuel Lauss <mano@roarinelk.homelinux.net>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License version 2 as
  12  * published by the Free Software Foundation.
  13  */
  14
  15 #include <linux/init.h>
  16 #include <linux/module.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/delay.h>
  19 #include <linux/list.h>
  20 #include <linux/pm_runtime.h>
  21 #include <linux/io.h>
  22 #include <sound/core.h>
  23 #include <sound/pcm.h>
  24 #include <sound/initval.h>
  25 #include <sound/soc.h>
  26 #include <sound/pcm_params.h>
  27 #include <sound/sh_fsi.h>
  28 #include <asm/atomic.h>
  29
  30 #define DO_FMT          0x0000
  31 #define DOFF_CTL        0x0004
  32 #define DOFF_ST         0x0008
  33 #define DI_FMT          0x000C
  34 #define DIFF_CTL        0x0010
  35 #define DIFF_ST         0x0014
  36 #define CKG1            0x0018
  37 #define CKG2            0x001C
  38 #define DIDT            0x0020
  39 #define DODT            0x0024
  40 #define MUTE_ST         0x0028
  41 #define REG_END         MUTE_ST
  42
  43 #define INT_ST          0x0200
  44 #define IEMSK           0x0204
  45 #define IMSK            0x0208
  46 #define MUTE            0x020C
  47 #define CLK_RST         0x0210
  48 #define SOFT_RST        0x0214
  49 #define MREG_START      INT_ST
  50 #define MREG_END        SOFT_RST
  51
  52 /* DO_FMT */
  53 /* DI_FMT */
  54 #define CR_FMT(param) ((param) << 4)
  55 # define CR_MONO        0x0
  56 # define CR_MONO_D      0x1
  57 # define CR_PCM         0x2
  58 # define CR_I2S         0x3
  59 # define CR_TDM         0x4
  60 # define CR_TDM_D       0x5
  61
  62 /* DOFF_CTL */
  63 /* DIFF_CTL */
  64 #define IRQ_HALF        0x00100000
  65 #define FIFO_CLR        0x00000001
  66
  67 /* DOFF_ST */
  68 #define ERR_OVER        0x00000010
  69 #define ERR_UNDER       0x00000001
  70 #define ST_ERR          (ERR_OVER | ERR_UNDER)
  71
  72 /* CLK_RST */
  73 #define B_CLK           0x00000010
  74 #define A_CLK           0x00000001
  75
  76 /* INT_ST */
  77 #define INT_B_IN        (1 << 12)
  78 #define INT_B_OUT       (1 << 8)
  79 #define INT_A_IN        (1 << 4)
  80 #define INT_A_OUT       (1 << 0)
  81
  82 /* SOFT_RST */
  83 #define PBSR            (1 << 12) /* Port B Software Reset */
  84 #define PASR            (1 <<  8) /* Port A Software Reset */
  85 #define IR              (1 <<  4) /* Interrupt Reset */
  86 #define FSISR           (1 <<  0) /* Software Reset */
  87
  88 #define FSI_RATES SNDRV_PCM_RATE_8000_96000
  89
  90 #define FSI_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
  91
  92 /************************************************************************
  93
  94
  95                 struct
  96
  97
  98 ************************************************************************/
  99 struct fsi_priv {
 100         void __iomem *base;
 101         struct snd_pcm_substream *substream;
 102         struct fsi_master *master;
 103
 104         int fifo_max;
 105         int chan;
 106
 107         int byte_offset;
 108         int period_len;
 109         int buffer_len;
 110         int periods;
 111 };
 112
 113 struct fsi_master {
 114         void __iomem *base;
 115         int irq;
 116         struct fsi_priv fsia;
 117         struct fsi_priv fsib;
 118         struct sh_fsi_platform_info *info;
 119         spinlock_t lock;
 120 };
 121
 122 /************************************************************************
 123
 124
 125                 basic read write function
 126
 127
 128 ************************************************************************/
 129 static void __fsi_reg_write(u32 reg, u32 data)
 130 {
 131         /* valid data area is 24bit */
 132         data &= 0x00ffffff;
 133
 134         __raw_writel(data, reg);
 135 }
 136
 137 static u32 __fsi_reg_read(u32 reg)
 138 {
 139         return __raw_readl(reg);
 140 }
 141
 142 static void __fsi_reg_mask_set(u32 reg, u32 mask, u32 data)
 143 {
 144         u32 val = __fsi_reg_read(reg);
 145
 146         val &= ~mask;
 147         val |= data & mask;
 148
 149         __fsi_reg_write(reg, val);
 150 }
 151
 152 static void fsi_reg_write(struct fsi_priv *fsi, u32 reg, u32 data)
 153 {
 154         if (reg > REG_END)
 155                 return;
 156
 157         __fsi_reg_write((u32)(fsi->base + reg), data);
 158 }
 159
 160 static u32 fsi_reg_read(struct fsi_priv *fsi, u32 reg)
 161 {
 162         if (reg > REG_END)
 163                 return 0;
 164
 165         return __fsi_reg_read((u32)(fsi->base + reg));
 166 }
 167
 168 static void fsi_reg_mask_set(struct fsi_priv *fsi, u32 reg, u32 mask, u32 data)
 169 {
 170         if (reg > REG_END)
 171                 return;
 172
 173         __fsi_reg_mask_set((u32)(fsi->base + reg), mask, data);
 174 }
 175
 176 static void fsi_master_write(struct fsi_master *master, u32 reg, u32 data)
 177 {
 178         unsigned long flags;
 179
 180         if ((reg < MREG_START) ||
 181             (reg > MREG_END))
 182                 return;
 183
 184         spin_lock_irqsave(&master->lock, flags);
 185         __fsi_reg_write((u32)(master->base + reg), data);
 186         spin_unlock_irqrestore(&master->lock, flags);
 187 }
 188
 189 static u32 fsi_master_read(struct fsi_master *master, u32 reg)
 190 {
 191         u32 ret;
 192         unsigned long flags;
 193
 194         if ((reg < MREG_START) ||
 195             (reg > MREG_END))
 196                 return 0;
 197
 198         spin_lock_irqsave(&master->lock, flags);
 199         ret = __fsi_reg_read((u32)(master->base + reg));
 200         spin_unlock_irqrestore(&master->lock, flags);
 201
 202         return ret;
 203 }
 204
 205 static void fsi_master_mask_set(struct fsi_master *master,
 206                                u32 reg, u32 mask, u32 data)
 207 {
 208         unsigned long flags;
 209
 210         if ((reg < MREG_START) ||
 211             (reg > MREG_END))
 212                 return;
 213
 214         spin_lock_irqsave(&master->lock, flags);
 215         __fsi_reg_mask_set((u32)(master->base + reg), mask, data);
 216         spin_unlock_irqrestore(&master->lock, flags);
 217 }
 218
 219 /************************************************************************
 220
 221
 222                 basic function
 223
 224
 225 ************************************************************************/
 226 static struct fsi_master *fsi_get_master(struct fsi_priv *fsi)
 227 {
 228         return fsi->master;
 229 }
 230
 231 static int fsi_is_port_a(struct fsi_priv *fsi)
 232 {
 233         return fsi->master->base == fsi->base;
 234 }
 235
 236 static struct snd_soc_dai *fsi_get_dai(struct snd_pcm_substream *substream)
 237 {
 238         struct snd_soc_pcm_runtime *rtd = substream->private_data;
 239         struct snd_soc_dai_link *machine = rtd->dai;
 240
 241         return  machine->cpu_dai;
 242 }
 243
 244 static struct fsi_priv *fsi_get_priv(struct snd_pcm_substream *substream)
 245 {
 246         struct snd_soc_dai *dai = fsi_get_dai(substream);
 247
 248         return dai->private_data;
 249 }
 250
 251 static u32 fsi_get_info_flags(struct fsi_priv *fsi)
 252 {
 253         int is_porta = fsi_is_port_a(fsi);
 254         struct fsi_master *master = fsi_get_master(fsi);
 255
 256         return is_porta ? master->info->porta_flags :
 257                 master->info->portb_flags;
 258 }
 259
 260 static int fsi_is_master_mode(struct fsi_priv *fsi, int is_play)
 261 {
 262         u32 mode;
 263         u32 flags = fsi_get_info_flags(fsi);
 264
 265         mode = is_play ? SH_FSI_OUT_SLAVE_MODE : SH_FSI_IN_SLAVE_MODE;
 266
 267         /* return
 268          * 1 : master mode
 269          * 0 : slave mode
 270          */
 271
 272         return (mode & flags) != mode;
 273 }
 274
 275 static u32 fsi_port_ab_io_bit(struct fsi_priv *fsi, int is_play)
 276 {
 277         int is_porta = fsi_is_port_a(fsi);
 278         u32 data;
 279
 280         if (is_porta)
 281                 data = is_play ? (1 << 0) : (1 << 4);
 282         else
 283                 data = is_play ? (1 << 8) : (1 << 12);
 284
 285         return data;
 286 }
 287
 288 static void fsi_stream_push(struct fsi_priv *fsi,
 289                             struct snd_pcm_substream *substream,
 290                             u32 buffer_len,
 291                             u32 period_len)
 292 {
 293         fsi->substream          = substream;
 294         fsi->buffer_len         = buffer_len;
 295         fsi->period_len         = period_len;
 296         fsi->byte_offset        = 0;
 297         fsi->periods            = 0;
 298 }
 299
 300 static void fsi_stream_pop(struct fsi_priv *fsi)
 301 {
 302         fsi->substream          = NULL;
 303         fsi->buffer_len         = 0;
 304         fsi->period_len         = 0;
 305         fsi->byte_offset        = 0;
 306         fsi->periods            = 0;
 307 }
 308
 309 static int fsi_get_fifo_residue(struct fsi_priv *fsi, int is_play)
 310 {
 311         u32 status;
 312         u32 reg = is_play ? DOFF_ST : DIFF_ST;
 313         int residue;
 314
 315         status = fsi_reg_read(fsi, reg);
 316         residue = 0x1ff & (status >> 8);
 317         residue *= fsi->chan;
 318
 319         return residue;
 320 }
 321
 322 /************************************************************************
 323
 324
 325                 ctrl function
 326
 327
 328 ************************************************************************/
 329 static void fsi_irq_enable(struct fsi_priv *fsi, int is_play)
 330 {
 331         u32 data = fsi_port_ab_io_bit(fsi, is_play);
 332         struct fsi_master *master = fsi_get_master(fsi);
 333
 334         fsi_master_mask_set(master, IMSK,  data, data);
 335         fsi_master_mask_set(master, IEMSK, data, data);
 336 }
 337
 338 static void fsi_irq_disable(struct fsi_priv *fsi, int is_play)
 339 {
 340         u32 data = fsi_port_ab_io_bit(fsi, is_play);
 341         struct fsi_master *master = fsi_get_master(fsi);
 342
 343         fsi_master_mask_set(master, IMSK,  data, 0);
 344         fsi_master_mask_set(master, IEMSK, data, 0);
 345 }
 346
 347 static void fsi_clk_ctrl(struct fsi_priv *fsi, int enable)
 348 {
 349         u32 val = fsi_is_port_a(fsi) ? (1 << 0) : (1 << 4);
 350         struct fsi_master *master = fsi_get_master(fsi);
 351
 352         if (enable)
 353                 fsi_master_mask_set(master, CLK_RST, val, val);
 354         else
 355                 fsi_master_mask_set(master, CLK_RST, val, 0);
 356 }
 357
 358 static void fsi_irq_init(struct fsi_priv *fsi, int is_play)
 359 {
 360         u32 data;
 361         u32 ctrl;
 362
 363         data = fsi_port_ab_io_bit(fsi, is_play);
 364         ctrl = is_play ? DOFF_CTL : DIFF_CTL;
 365
 366         /* set IMSK */
 367         fsi_irq_disable(fsi, is_play);
 368
 369         /* set interrupt generation factor */
 370         fsi_reg_write(fsi, ctrl, IRQ_HALF);
 371
 372         /* clear FIFO */
 373         fsi_reg_mask_set(fsi, ctrl, FIFO_CLR, FIFO_CLR);
 374
 375         /* clear interrupt factor */
 376         fsi_master_mask_set(fsi_get_master(fsi), INT_ST, data, 0);
 377 }
 378
 379 static void fsi_soft_all_reset(struct fsi_master *master)
 380 {
 381         /* port AB reset */
 382         fsi_master_mask_set(master, SOFT_RST, PASR | PBSR, 0);
 383         mdelay(10);
 384
 385         /* soft reset */
 386         fsi_master_mask_set(master, SOFT_RST, FSISR, 0);
 387         fsi_master_mask_set(master, SOFT_RST, FSISR, FSISR);
 388         mdelay(10);
 389 }
 390
 391 /* playback interrupt */
 392 static int fsi_data_push(struct fsi_priv *fsi, int startup)
 393 {
 394         struct snd_pcm_runtime *runtime;
 395         struct snd_pcm_substream *substream = NULL;
 396         u32 status;
 397         int send;
 398         int fifo_free;
 399         int width;
 400         u8 *start;
 401         int i, over_period;
 402
 403         if (!fsi                        ||
 404             !fsi->substream             ||
 405             !fsi->substream->runtime)
 406                 return -EINVAL;
 407
 408         over_period     = 0;
 409         substream       = fsi->substream;
 410         runtime         = substream->runtime;
 411
 412         /* FSI FIFO has limit.
 413          * So, this driver can not send periods data at a time
 414          */
 415         if (fsi->byte_offset >=
 416             fsi->period_len * (fsi->periods + 1)) {
 417
 418                 over_period = 1;
 419                 fsi->periods = (fsi->periods + 1) % runtime->periods;
 420
 421                 if (0 == fsi->periods)
 422                         fsi->byte_offset = 0;
 423         }
 424
 425         /* get 1 channel data width */
 426         width = frames_to_bytes(runtime, 1) / fsi->chan;
 427
 428         /* get send size for alsa */
 429         send = (fsi->buffer_len - fsi->byte_offset) / width;
 430
 431         /*  get FIFO free size */
 432         fifo_free = (fsi->fifo_max * fsi->chan) - fsi_get_fifo_residue(fsi, 1);
 433
 434         /* size check */
 435         if (fifo_free < send)
 436                 send = fifo_free;
 437
 438         start = runtime->dma_area;
 439         start += fsi->byte_offset;
 440
 441         switch (width) {
 442         case 2:
 443                 for (i = 0; i < send; i++)
 444                         fsi_reg_write(fsi, DODT,
 445                                       ((u32)*((u16 *)start + i) << 8));
 446                 break;
 447         case 4:
 448                 for (i = 0; i < send; i++)
 449                         fsi_reg_write(fsi, DODT, *((u32 *)start + i));
 450                 break;
 451         default:
 452                 return -EINVAL;
 453         }
 454
 455         fsi->byte_offset += send * width;
 456
 457         status = fsi_reg_read(fsi, DOFF_ST);
 458         if (!startup) {
 459                 struct snd_soc_dai *dai = fsi_get_dai(substream);
 460
 461                 if (status & ERR_OVER)
 462                         dev_err(dai->dev, "over run\n");
 463                 if (status & ERR_UNDER)
 464                         dev_err(dai->dev, "under run\n");
 465         }
 466         fsi_reg_write(fsi, DOFF_ST, 0);
 467
 468         fsi_irq_enable(fsi, 1);
 469
 470         if (over_period)
 471                 snd_pcm_period_elapsed(substream);
 472
 473         return 0;
 474 }
 475
 476 static int fsi_data_pop(struct fsi_priv *fsi, int startup)
 477 {
 478         struct snd_pcm_runtime *runtime;
 479         struct snd_pcm_substream *substream = NULL;
 480         u32 status;
 481         int free;
 482         int fifo_fill;
 483         int width;
 484         u8 *start;
 485         int i, over_period;
 486
 487         if (!fsi                        ||
 488             !fsi->substream             ||
 489             !fsi->substream->runtime)
 490                 return -EINVAL;
 491
 492         over_period     = 0;
 493         substream       = fsi->substream;
 494         runtime         = substream->runtime;
 495
 496         /* FSI FIFO has limit.
 497          * So, this driver can not send periods data at a time
 498          */
 499         if (fsi->byte_offset >=
 500             fsi->period_len * (fsi->periods + 1)) {
 501
 502                 over_period = 1;
 503                 fsi->periods = (fsi->periods + 1) % runtime->periods;
 504
 505                 if (0 == fsi->periods)
 506                         fsi->byte_offset = 0;
 507         }
 508
 509         /* get 1 channel data width */
 510         width = frames_to_bytes(runtime, 1) / fsi->chan;
 511
 512         /* get free space for alsa */
 513         free = (fsi->buffer_len - fsi->byte_offset) / width;
 514
 515         /* get recv size */
 516         fifo_fill = fsi_get_fifo_residue(fsi, 0);
 517
 518         if (free < fifo_fill)
 519                 fifo_fill = free;
 520
 521         start = runtime->dma_area;
 522         start += fsi->byte_offset;
 523
 524         switch (width) {
 525         case 2:
 526                 for (i = 0; i < fifo_fill; i++)
 527                         *((u16 *)start + i) =
 528                                 (u16)(fsi_reg_read(fsi, DIDT) >> 8);
 529                 break;
 530         case 4:
 531                 for (i = 0; i < fifo_fill; i++)
 532                         *((u32 *)start + i) = fsi_reg_read(fsi, DIDT);
 533                 break;
 534         default:
 535                 return -EINVAL;
 536         }
 537
 538         fsi->byte_offset += fifo_fill * width;
 539
 540         status = fsi_reg_read(fsi, DIFF_ST);
 541         if (!startup) {
 542                 struct snd_soc_dai *dai = fsi_get_dai(substream);
 543
 544                 if (status & ERR_OVER)
 545                         dev_err(dai->dev, "over run\n");
 546                 if (status & ERR_UNDER)
 547                         dev_err(dai->dev, "under run\n");
 548         }
 549         fsi_reg_write(fsi, DIFF_ST, 0);
 550
 551         fsi_irq_enable(fsi, 0);
 552
 553         if (over_period)
 554                 snd_pcm_period_elapsed(substream);
 555
 556         return 0;
 557 }
 558
 559 static irqreturn_t fsi_interrupt(int irq, void *data)
 560 {
 561         struct fsi_master *master = data;
 562         u32 int_st = fsi_master_read(master, INT_ST);
 563
 564         /* clear irq status */
 565         fsi_master_mask_set(master, SOFT_RST, IR, 0);
 566         fsi_master_mask_set(master, SOFT_RST, IR, IR);
 567
 568         if (int_st & INT_A_OUT)
 569                 fsi_data_push(&master->fsia, 0);
 570         if (int_st & INT_B_OUT)
 571                 fsi_data_push(&master->fsib, 0);
 572         if (int_st & INT_A_IN)
 573                 fsi_data_pop(&master->fsia, 0);
 574         if (int_st & INT_B_IN)
 575                 fsi_data_pop(&master->fsib, 0);
 576
 577         fsi_master_write(master, INT_ST, 0x0000000);
 578
 579         return IRQ_HANDLED;
 580 }
 581
 582 /************************************************************************
 583
 584
 585                 dai ops
 586
 587
 588 ************************************************************************/
 589 static int fsi_dai_startup(struct snd_pcm_substream *substream,
 590                            struct snd_soc_dai *dai)
 591 {
 592         struct fsi_priv *fsi = fsi_get_priv(substream);
 593         const char *msg;
 594         u32 flags = fsi_get_info_flags(fsi);
 595         u32 fmt;
 596         u32 reg;
 597         u32 data;
 598         int is_play = (substream->stream == SNDRV_PCM_STREAM_PLAYBACK);
 599         int is_master;
 600         int ret = 0;
 601
 602         pm_runtime_get_sync(dai->dev);
 603
 604         /* CKG1 */
 605         data = is_play ? (1 << 0) : (1 << 4);
 606         is_master = fsi_is_master_mode(fsi, is_play);
 607         if (is_master)
 608                 fsi_reg_mask_set(fsi, CKG1, data, data);
 609         else
 610                 fsi_reg_mask_set(fsi, CKG1, data, 0);
 611
 612         /* clock inversion (CKG2) */
 613         data = 0;
 614         switch (SH_FSI_INVERSION_MASK & flags) {
 615         case SH_FSI_LRM_INV:
 616                 data = 1 << 12;
 617                 break;
 618         case SH_FSI_BRM_INV:
 619                 data = 1 << 8;
 620                 break;
 621         case SH_FSI_LRS_INV:
 622                 data = 1 << 4;
 623                 break;
 624         case SH_FSI_BRS_INV:
 625                 data = 1 << 0;
 626                 break;
 627         }
 628         fsi_reg_write(fsi, CKG2, data);
 629
 630         /* do fmt, di fmt */
 631         data = 0;
 632         reg = is_play ? DO_FMT : DI_FMT;
 633         fmt = is_play ? SH_FSI_GET_OFMT(flags) : SH_FSI_GET_IFMT(flags);
 634         switch (fmt) {
 635         case SH_FSI_FMT_MONO:
 636                 msg = "MONO";
 637                 data = CR_FMT(CR_MONO);
 638                 fsi->chan = 1;
 639                 break;
 640         case SH_FSI_FMT_MONO_DELAY:
 641                 msg = "MONO Delay";
 642                 data = CR_FMT(CR_MONO_D);
 643                 fsi->chan = 1;
 644                 break;
 645         case SH_FSI_FMT_PCM:
 646                 msg = "PCM";
 647                 data = CR_FMT(CR_PCM);
 648                 fsi->chan = 2;
 649                 break;
 650         case SH_FSI_FMT_I2S:
 651                 msg = "I2S";
 652                 data = CR_FMT(CR_I2S);
 653                 fsi->chan = 2;
 654                 break;
 655         case SH_FSI_FMT_TDM:
 656                 msg = "TDM";
 657                 data = CR_FMT(CR_TDM) | (fsi->chan - 1);
 658                 fsi->chan = is_play ?
 659                         SH_FSI_GET_CH_O(flags) : SH_FSI_GET_CH_I(flags);
 660                 break;
 661         case SH_FSI_FMT_TDM_DELAY:
 662                 msg = "TDM Delay";
 663                 data = CR_FMT(CR_TDM_D) | (fsi->chan - 1);
 664                 fsi->chan = is_play ?
 665                         SH_FSI_GET_CH_O(flags) : SH_FSI_GET_CH_I(flags);
 666                 break;
 667         default:
 668                 dev_err(dai->dev, "unknown format.\n");
 669                 return -EINVAL;
 670         }
 671
 672         switch (fsi->chan) {
 673         case 1:
 674                 fsi->fifo_max = 256;
 675                 break;
 676         case 2:
 677                 fsi->fifo_max = 128;
 678                 break;
 679         case 3:
 680         case 4:
 681                 fsi->fifo_max = 64;
 682                 break;
 683         case 5:
 684         case 6:
 685         case 7:
 686         case 8:
 687                 fsi->fifo_max = 32;
 688                 break;
 689         default:
 690                 dev_err(dai->dev, "channel size error.\n");
 691                 return -EINVAL;
 692         }
 693
 694         fsi_reg_write(fsi, reg, data);
 695
 696         /*
 697          * clear clk reset if master mode
 698          */
 699         if (is_master)
 700                 fsi_clk_ctrl(fsi, 1);
 701
 702         /* irq setting */
 703         fsi_irq_init(fsi, is_play);
 704
 705         return ret;
 706 }
 707
 708 static void fsi_dai_shutdown(struct snd_pcm_substream *substream,
 709                              struct snd_soc_dai *dai)
 710 {
 711         struct fsi_priv *fsi = fsi_get_priv(substream);
 712         int is_play = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
 713
 714         fsi_irq_disable(fsi, is_play);
 715         fsi_clk_ctrl(fsi, 0);
 716
 717         pm_runtime_put_sync(dai->dev);
 718 }
 719
 720 static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd,
 721                            struct snd_soc_dai *dai)
 722 {
 723         struct fsi_priv *fsi = fsi_get_priv(substream);
 724         struct snd_pcm_runtime *runtime = substream->runtime;
 725         int is_play = substream->stream == SNDRV_PCM_STREAM_PLAYBACK;
 726         int ret = 0;
 727
 728         switch (cmd) {
 729         case SNDRV_PCM_TRIGGER_START:
 730                 fsi_stream_push(fsi, substream,
 731                                 frames_to_bytes(runtime, runtime->buffer_size),
 732                                 frames_to_bytes(runtime, runtime->period_size));
 733                 ret = is_play ? fsi_data_push(fsi, 1) : fsi_data_pop(fsi, 1);
 734                 break;
 735         case SNDRV_PCM_TRIGGER_STOP:
 736                 fsi_irq_disable(fsi, is_play);
 737                 fsi_stream_pop(fsi);
 738                 break;
 739         }
 740
 741         return ret;
 742 }
 743
 744 static struct snd_soc_dai_ops fsi_dai_ops = {
 745         .startup        = fsi_dai_startup,
 746         .shutdown       = fsi_dai_shutdown,
 747         .trigger        = fsi_dai_trigger,
 748 };
 749
 750 /************************************************************************
 751
 752
 753                 pcm ops
 754
 755
 756 ************************************************************************/
 757 static struct snd_pcm_hardware fsi_pcm_hardware = {
 758         .info =         SNDRV_PCM_INFO_INTERLEAVED      |
 759                         SNDRV_PCM_INFO_MMAP             |
 760                         SNDRV_PCM_INFO_MMAP_VALID       |
 761                         SNDRV_PCM_INFO_PAUSE,
 762         .formats                = FSI_FMTS,
 763         .rates                  = FSI_RATES,
 764         .rate_min               = 8000,
 765         .rate_max               = 192000,
 766         .channels_min           = 1,
 767         .channels_max           = 2,
 768         .buffer_bytes_max       = 64 * 1024,
 769         .period_bytes_min       = 32,
 770         .period_bytes_max       = 8192,
 771         .periods_min            = 1,
 772         .periods_max            = 32,
 773         .fifo_size              = 256,
 774 };
 775
 776 static int fsi_pcm_open(struct snd_pcm_substream *substream)
 777 {
 778         struct snd_pcm_runtime *runtime = substream->runtime;
 779         int ret = 0;
 780
 781         snd_soc_set_runtime_hwparams(substream, &fsi_pcm_hardware);
 782
 783         ret = snd_pcm_hw_constraint_integer(runtime,
 784                                             SNDRV_PCM_HW_PARAM_PERIODS);
 785
 786         return ret;
 787 }
 788
 789 static int fsi_hw_params(struct snd_pcm_substream *substream,
 790                          struct snd_pcm_hw_params *hw_params)
 791 {
 792         return snd_pcm_lib_malloc_pages(substream,
 793                                         params_buffer_bytes(hw_params));
 794 }
 795
 796 static int fsi_hw_free(struct snd_pcm_substream *substream)
 797 {
 798         return snd_pcm_lib_free_pages(substream);
 799 }
 800
 801 static snd_pcm_uframes_t fsi_pointer(struct snd_pcm_substream *substream)
 802 {
 803         struct snd_pcm_runtime *runtime = substream->runtime;
 804         struct fsi_priv *fsi = fsi_get_priv(substream);
 805         long location;
 806
 807         location = (fsi->byte_offset - 1);
 808         if (location < 0)
 809                 location = 0;
 810
 811         return bytes_to_frames(runtime, location);
 812 }
 813
 814 static struct snd_pcm_ops fsi_pcm_ops = {
 815         .open           = fsi_pcm_open,
 816         .ioctl          = snd_pcm_lib_ioctl,
 817         .hw_params      = fsi_hw_params,
 818         .hw_free        = fsi_hw_free,
 819         .pointer        = fsi_pointer,
 820 };
 821
 822 /************************************************************************
 823
 824
 825                 snd_soc_platform
 826
 827
 828 ************************************************************************/
 829 #define PREALLOC_BUFFER         (32 * 1024)
 830 #define PREALLOC_BUFFER_MAX     (32 * 1024)
 831
 832 static void fsi_pcm_free(struct snd_pcm *pcm)
 833 {
 834         snd_pcm_lib_preallocate_free_for_all(pcm);
 835 }
 836
 837 static int fsi_pcm_new(struct snd_card *card,
 838                        struct snd_soc_dai *dai,
 839                        struct snd_pcm *pcm)
 840 {
 841         /*
 842          * dont use SNDRV_DMA_TYPE_DEV, since it will oops the SH kernel
 843          * in MMAP mode (i.e. aplay -M)
 844          */
 845         return snd_pcm_lib_preallocate_pages_for_all(
 846                 pcm,
 847                 SNDRV_DMA_TYPE_CONTINUOUS,
 848                 snd_dma_continuous_data(GFP_KERNEL),
 849                 PREALLOC_BUFFER, PREALLOC_BUFFER_MAX);
 850 }
 851
 852 /************************************************************************
 853
 854
 855                 alsa struct
 856
 857
 858 ************************************************************************/
 859 struct snd_soc_dai fsi_soc_dai[] = {
 860         {
 861                 .name                   = "FSIA",
 862                 .id                     = 0,
 863                 .playback = {
 864                         .rates          = FSI_RATES,
 865                         .formats        = FSI_FMTS,
 866                         .channels_min   = 1,
 867                         .channels_max   = 8,
 868                 },
 869                 .capture = {
 870                         .rates          = FSI_RATES,
 871                         .formats        = FSI_FMTS,
 872                         .channels_min   = 1,
 873                         .channels_max   = 8,
 874                 },
 875                 .ops = &fsi_dai_ops,
 876         },
 877         {
 878                 .name                   = "FSIB",
 879                 .id                     = 1,
 880                 .playback = {
 881                         .rates          = FSI_RATES,
 882                         .formats        = FSI_FMTS,
 883                         .channels_min   = 1,
 884                         .channels_max   = 8,
 885                 },
 886                 .capture = {
 887                         .rates          = FSI_RATES,
 888                         .formats        = FSI_FMTS,
 889                         .channels_min   = 1,
 890                         .channels_max   = 8,
 891                 },
 892                 .ops = &fsi_dai_ops,
 893         },
 894 };
 895 EXPORT_SYMBOL_GPL(fsi_soc_dai);
 896
 897 struct snd_soc_platform fsi_soc_platform = {
 898         .name           = "fsi-pcm",
 899         .pcm_ops        = &fsi_pcm_ops,
 900         .pcm_new        = fsi_pcm_new,
 901         .pcm_free       = fsi_pcm_free,
 902 };
 903 EXPORT_SYMBOL_GPL(fsi_soc_platform);
 904
 905 /************************************************************************
 906
 907
 908                 platform function
 909
 910
 911 ************************************************************************/
 912 static int fsi_probe(struct platform_device *pdev)
 913 {
 914         struct fsi_master *master;
 915         struct resource *res;
 916         unsigned int irq;
 917         int ret;
 918
 919         if (0 != pdev->id) {
 920                 dev_err(&pdev->dev, "current fsi support id 0 only now\n");
 921                 return -ENODEV;
 922         }
 923
 924         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 925         irq = platform_get_irq(pdev, 0);
 926         if (!res || (int)irq <= 0) {
 927                 dev_err(&pdev->dev, "Not enough FSI platform resources.\n");
 928                 ret = -ENODEV;
 929                 goto exit;
 930         }
 931
 932         master = kzalloc(sizeof(*master), GFP_KERNEL);
 933         if (!master) {
 934                 dev_err(&pdev->dev, "Could not allocate master\n");
 935                 ret = -ENOMEM;
 936                 goto exit;
 937         }
 938
 939         master->base = ioremap_nocache(res->start, resource_size(res));
 940         if (!master->base) {
 941                 ret = -ENXIO;
 942                 dev_err(&pdev->dev, "Unable to ioremap FSI registers.\n");
 943                 goto exit_kfree;
 944         }
 945
 946         master->irq             = irq;
 947         master->info            = pdev->dev.platform_data;
 948         master->fsia.base       = master->base;
 949         master->fsia.master     = master;
 950         master->fsib.base       = master->base + 0x40;
 951         master->fsib.master     = master;
 952         spin_lock_init(&master->lock);
 953
 954         pm_runtime_enable(&pdev->dev);
 955         pm_runtime_resume(&pdev->dev);
 956
 957         fsi_soc_dai[0].dev              = &pdev->dev;
 958         fsi_soc_dai[0].private_data     = &master->fsia;
 959         fsi_soc_dai[1].dev              = &pdev->dev;
 960         fsi_soc_dai[1].private_data     = &master->fsib;
 961
 962         fsi_soft_all_reset(master);
 963
 964         ret = request_irq(irq, &fsi_interrupt, IRQF_DISABLED, "fsi", master);
 965         if (ret) {
 966                 dev_err(&pdev->dev, "irq request err\n");
 967                 goto exit_iounmap;
 968         }
 969
 970         ret = snd_soc_register_platform(&fsi_soc_platform);
 971         if (ret < 0) {
 972                 dev_err(&pdev->dev, "cannot snd soc register\n");
 973                 goto exit_free_irq;
 974         }
 975
 976         return snd_soc_register_dais(fsi_soc_dai, ARRAY_SIZE(fsi_soc_dai));
 977
 978 exit_free_irq:
 979         free_irq(irq, master);
 980 exit_iounmap:
 981         iounmap(master->base);
 982         pm_runtime_disable(&pdev->dev);
 983 exit_kfree:
 984         kfree(master);
 985         master = NULL;
 986 exit:
 987         return ret;
 988 }
 989
 990 static int fsi_remove(struct platform_device *pdev)
 991 {
 992         struct fsi_master *master;
 993
 994         master = fsi_get_master(fsi_soc_dai[0].private_data);
 995
 996         snd_soc_unregister_dais(fsi_soc_dai, ARRAY_SIZE(fsi_soc_dai));
 997         snd_soc_unregister_platform(&fsi_soc_platform);
 998
 999         pm_runtime_disable(&pdev->dev);
1000
1001         free_irq(master->irq, master);
1002
1003         iounmap(master->base);
1004         kfree(master);
1005
1006         fsi_soc_dai[0].dev              = NULL;
1007         fsi_soc_dai[0].private_data     = NULL;
1008         fsi_soc_dai[1].dev              = NULL;
1009         fsi_soc_dai[1].private_data     = NULL;
1010
1011         return 0;
1012 }
1013
1014 static int fsi_runtime_nop(struct device *dev)
1015 {
1016         /* Runtime PM callback shared between ->runtime_suspend()
1017          * and ->runtime_resume(). Simply returns success.
1018          *
1019          * This driver re-initializes all registers after
1020          * pm_runtime_get_sync() anyway so there is no need
1021          * to save and restore registers here.
1022          */
1023         return 0;
1024 }
1025
1026 static struct dev_pm_ops fsi_pm_ops = {
1027         .runtime_suspend        = fsi_runtime_nop,
1028         .runtime_resume         = fsi_runtime_nop,
1029 };
1030
1031 static struct platform_driver fsi_driver = {
1032         .driver         = {
1033                 .name   = "sh_fsi",
1034                 .pm     = &fsi_pm_ops,
1035         },
1036         .probe          = fsi_probe,
1037         .remove         = fsi_remove,
1038 };
1039
1040 static int __init fsi_mobile_init(void)
1041 {
1042         return platform_driver_register(&fsi_driver);
1043 }
1044
1045 static void __exit fsi_mobile_exit(void)
1046 {
1047         platform_driver_unregister(&fsi_driver);
1048 }
1049 module_init(fsi_mobile_init);
1050 module_exit(fsi_mobile_exit);
1051
1052 MODULE_LICENSE("GPL");
1053 MODULE_DESCRIPTION("SuperH onchip FSI audio driver");
1054 MODULE_AUTHOR("Kuninori Morimoto <morimoto.kuninori@renesas.com>");