Commit 2eebcef3 authored by Mark Brown's avatar Mark Brown

Merge branch 'topic/fsi' of...

Merge branch 'topic/fsi' of git://git.kernel.org/pub/scm/linux/kernel/git/broonie/sound into asoc-simple-card
parents f89983ef fd974e52
...@@ -657,14 +657,8 @@ static struct platform_device lcdc_device = { ...@@ -657,14 +657,8 @@ static struct platform_device lcdc_device = {
/* FSI */ /* FSI */
#define IRQ_FSI evt2irq(0x1840) #define IRQ_FSI evt2irq(0x1840)
static struct sh_fsi_platform_info fsi_info = { static struct sh_fsi_platform_info fsi_info = {
.port_a = {
.flags = SH_FSI_BRS_INV,
},
.port_b = { .port_b = {
.flags = SH_FSI_BRS_INV | .flags = SH_FSI_CLK_CPG |
SH_FSI_BRM_INV |
SH_FSI_LRS_INV |
SH_FSI_CLK_CPG |
SH_FSI_FMT_SPDIF, SH_FSI_FMT_SPDIF,
}, },
}; };
...@@ -816,7 +810,8 @@ static struct platform_device lcdc1_device = { ...@@ -816,7 +810,8 @@ static struct platform_device lcdc1_device = {
}; };
static struct asoc_simple_dai_init_info fsi2_hdmi_init_info = { static struct asoc_simple_dai_init_info fsi2_hdmi_init_info = {
.cpu_daifmt = SND_SOC_DAIFMT_CBM_CFM, .cpu_daifmt = SND_SOC_DAIFMT_CBM_CFM |
SND_SOC_DAIFMT_IB_NF,
}; };
static struct asoc_simple_card_info fsi2_hdmi_info = { static struct asoc_simple_card_info fsi2_hdmi_info = {
......
...@@ -503,7 +503,8 @@ static struct platform_device hdmi_lcdc_device = { ...@@ -503,7 +503,8 @@ static struct platform_device hdmi_lcdc_device = {
}; };
static struct asoc_simple_dai_init_info fsi2_hdmi_init_info = { static struct asoc_simple_dai_init_info fsi2_hdmi_init_info = {
.cpu_daifmt = SND_SOC_DAIFMT_CBM_CFM, .cpu_daifmt = SND_SOC_DAIFMT_CBM_CFM |
SND_SOC_DAIFMT_IB_NF,
}; };
static struct asoc_simple_card_info fsi2_hdmi_info = { static struct asoc_simple_card_info fsi2_hdmi_info = {
...@@ -858,16 +859,12 @@ static struct platform_device leds_device = { ...@@ -858,16 +859,12 @@ static struct platform_device leds_device = {
#define IRQ_FSI evt2irq(0x1840) #define IRQ_FSI evt2irq(0x1840)
static struct sh_fsi_platform_info fsi_info = { static struct sh_fsi_platform_info fsi_info = {
.port_a = { .port_a = {
.flags = SH_FSI_BRS_INV,
.tx_id = SHDMA_SLAVE_FSIA_TX, .tx_id = SHDMA_SLAVE_FSIA_TX,
.rx_id = SHDMA_SLAVE_FSIA_RX, .rx_id = SHDMA_SLAVE_FSIA_RX,
}, },
.port_b = { .port_b = {
.flags = SH_FSI_BRS_INV | .flags = SH_FSI_CLK_CPG |
SH_FSI_BRM_INV | SH_FSI_FMT_SPDIF,
SH_FSI_LRS_INV |
SH_FSI_CLK_CPG |
SH_FSI_FMT_SPDIF,
} }
}; };
......
...@@ -877,12 +877,6 @@ static struct platform_device camera_devices[] = { ...@@ -877,12 +877,6 @@ static struct platform_device camera_devices[] = {
}; };
/* FSI */ /* FSI */
static struct sh_fsi_platform_info fsi_info = {
.port_b = {
.flags = SH_FSI_BRS_INV,
},
};
static struct resource fsi_resources[] = { static struct resource fsi_resources[] = {
[0] = { [0] = {
.name = "FSI", .name = "FSI",
...@@ -901,15 +895,13 @@ static struct platform_device fsi_device = { ...@@ -901,15 +895,13 @@ static struct platform_device fsi_device = {
.id = 0, .id = 0,
.num_resources = ARRAY_SIZE(fsi_resources), .num_resources = ARRAY_SIZE(fsi_resources),
.resource = fsi_resources, .resource = fsi_resources,
.dev = {
.platform_data = &fsi_info,
},
}; };
static struct asoc_simple_dai_init_info fsi_da7210_init_info = { static struct asoc_simple_dai_init_info fsi_da7210_init_info = {
.fmt = SND_SOC_DAIFMT_I2S, .fmt = SND_SOC_DAIFMT_I2S,
.codec_daifmt = SND_SOC_DAIFMT_CBM_CFM, .codec_daifmt = SND_SOC_DAIFMT_CBM_CFM,
.cpu_daifmt = SND_SOC_DAIFMT_CBS_CFS, .cpu_daifmt = SND_SOC_DAIFMT_CBS_CFS |
SND_SOC_DAIFMT_IB_NF,
}; };
static struct asoc_simple_card_info fsi_da7210_info = { static struct asoc_simple_card_info fsi_da7210_info = {
......
...@@ -279,12 +279,6 @@ static struct platform_device ceu1_device = { ...@@ -279,12 +279,6 @@ static struct platform_device ceu1_device = {
/* FSI */ /* FSI */
/* change J20, J21, J22 pin to 1-2 connection to use slave mode */ /* change J20, J21, J22 pin to 1-2 connection to use slave mode */
static struct sh_fsi_platform_info fsi_info = {
.port_a = {
.flags = SH_FSI_BRS_INV,
},
};
static struct resource fsi_resources[] = { static struct resource fsi_resources[] = {
[0] = { [0] = {
.name = "FSI", .name = "FSI",
...@@ -303,15 +297,13 @@ static struct platform_device fsi_device = { ...@@ -303,15 +297,13 @@ static struct platform_device fsi_device = {
.id = 0, .id = 0,
.num_resources = ARRAY_SIZE(fsi_resources), .num_resources = ARRAY_SIZE(fsi_resources),
.resource = fsi_resources, .resource = fsi_resources,
.dev = {
.platform_data = &fsi_info,
},
}; };
static struct asoc_simple_dai_init_info fsi2_ak4642_init_info = { static struct asoc_simple_dai_init_info fsi2_ak4642_init_info = {
.fmt = SND_SOC_DAIFMT_LEFT_J, .fmt = SND_SOC_DAIFMT_LEFT_J,
.codec_daifmt = SND_SOC_DAIFMT_CBM_CFM, .codec_daifmt = SND_SOC_DAIFMT_CBM_CFM,
.cpu_daifmt = SND_SOC_DAIFMT_CBS_CFS, .cpu_daifmt = SND_SOC_DAIFMT_CBS_CFS |
SND_SOC_DAIFMT_IB_NF,
.sysclk = 11289600, .sysclk = 11289600,
}; };
......
...@@ -11,82 +11,20 @@ ...@@ -11,82 +11,20 @@
* it under the terms of the GNU General Public License version 2 as * it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation. * published by the Free Software Foundation.
*/ */
#define FSI_PORT_A 0
#define FSI_PORT_B 1
#include <linux/clk.h> #include <linux/clk.h>
#include <sound/soc.h> #include <sound/soc.h>
/* /*
* flags format * flags
*
* 0x00000CBA
*
* A: inversion
* B: format mode
* C: chip specific
* D: clock selecter if master mode
*/ */
#define SH_FSI_FMT_SPDIF (1 << 0) /* spdif for HDMI */
/* A: clock inversion */ #define SH_FSI_ENABLE_STREAM_MODE (1 << 1) /* for 16bit data */
#define SH_FSI_INVERSION_MASK 0x0000000F #define SH_FSI_CLK_CPG (1 << 2) /* FSIxCK + FSI-DIV */
#define SH_FSI_LRM_INV (1 << 0)
#define SH_FSI_BRM_INV (1 << 1)
#define SH_FSI_LRS_INV (1 << 2)
#define SH_FSI_BRS_INV (1 << 3)
/* B: format mode */
#define SH_FSI_FMT_MASK 0x000000F0
#define SH_FSI_FMT_DAI (0 << 4)
#define SH_FSI_FMT_SPDIF (1 << 4)
/* C: chip specific */
#define SH_FSI_OPTION_MASK 0x00000F00
#define SH_FSI_ENABLE_STREAM_MODE (1 << 8) /* for 16bit data */
/* D: clock selecter if master mode */
#define SH_FSI_CLK_MASK 0x0000F000
#define SH_FSI_CLK_EXTERNAL (0 << 12)
#define SH_FSI_CLK_CPG (1 << 12) /* FSIxCK + FSI-DIV */
/*
* set_rate return value
*
* see ACKMD/BPFMD on
* ACK_MD (FSI2)
* CKG1 (FSI)
*
* err : return value < 0
* no change : return value == 0
* change xMD : return value > 0
*
* 0x-00000AB
*
* A: ACKMD value
* B: BPFMD value
*/
#define SH_FSI_ACKMD_MASK (0xF << 0)
#define SH_FSI_ACKMD_512 (1 << 0)
#define SH_FSI_ACKMD_256 (2 << 0)
#define SH_FSI_ACKMD_128 (3 << 0)
#define SH_FSI_ACKMD_64 (4 << 0)
#define SH_FSI_ACKMD_32 (5 << 0)
#define SH_FSI_BPFMD_MASK (0xF << 4)
#define SH_FSI_BPFMD_512 (1 << 4)
#define SH_FSI_BPFMD_256 (2 << 4)
#define SH_FSI_BPFMD_128 (3 << 4)
#define SH_FSI_BPFMD_64 (4 << 4)
#define SH_FSI_BPFMD_32 (5 << 4)
#define SH_FSI_BPFMD_16 (6 << 4)
struct sh_fsi_port_info { struct sh_fsi_port_info {
unsigned long flags; unsigned long flags;
int tx_id; int tx_id;
int rx_id; int rx_id;
int (*set_rate)(struct device *dev, int rate, int enable);
}; };
struct sh_fsi_platform_info { struct sh_fsi_platform_info {
......
...@@ -131,8 +131,6 @@ ...@@ -131,8 +131,6 @@
#define FSI_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE) #define FSI_FMTS (SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S16_LE)
typedef int (*set_rate_func)(struct device *dev, int rate, int enable);
/* /*
* bus options * bus options
* *
...@@ -244,8 +242,7 @@ struct fsi_clk { ...@@ -244,8 +242,7 @@ struct fsi_clk {
struct clk *ick; struct clk *ick;
struct clk *div; struct clk *div;
int (*set_rate)(struct device *dev, int (*set_rate)(struct device *dev,
struct fsi_priv *fsi, struct fsi_priv *fsi);
unsigned long rate);
unsigned long rate; unsigned long rate;
unsigned int count; unsigned int count;
...@@ -254,7 +251,6 @@ struct fsi_clk { ...@@ -254,7 +251,6 @@ struct fsi_clk {
struct fsi_priv { struct fsi_priv {
void __iomem *base; void __iomem *base;
struct fsi_master *master; struct fsi_master *master;
struct sh_fsi_port_info *info;
struct fsi_stream playback; struct fsi_stream playback;
struct fsi_stream capture; struct fsi_stream capture;
...@@ -270,8 +266,6 @@ struct fsi_priv { ...@@ -270,8 +266,6 @@ struct fsi_priv {
int enable_stream:1; int enable_stream:1;
int bit_clk_inv:1; int bit_clk_inv:1;
int lr_clk_inv:1; int lr_clk_inv:1;
long rate;
}; };
struct fsi_stream_handler { struct fsi_stream_handler {
...@@ -431,22 +425,6 @@ static struct fsi_priv *fsi_get_priv(struct snd_pcm_substream *substream) ...@@ -431,22 +425,6 @@ static struct fsi_priv *fsi_get_priv(struct snd_pcm_substream *substream)
return fsi_get_priv_frm_dai(fsi_get_dai(substream)); return fsi_get_priv_frm_dai(fsi_get_dai(substream));
} }
static set_rate_func fsi_get_info_set_rate(struct fsi_priv *fsi)
{
if (!fsi->info)
return NULL;
return fsi->info->set_rate;
}
static u32 fsi_get_info_flags(struct fsi_priv *fsi)
{
if (!fsi->info)
return 0;
return fsi->info->flags;
}
static u32 fsi_get_port_shift(struct fsi_priv *fsi, struct fsi_stream *io) static u32 fsi_get_port_shift(struct fsi_priv *fsi, struct fsi_stream *io)
{ {
int is_play = fsi_stream_is_play(fsi, io); int is_play = fsi_stream_is_play(fsi, io);
...@@ -757,8 +735,7 @@ static int fsi_clk_init(struct device *dev, ...@@ -757,8 +735,7 @@ static int fsi_clk_init(struct device *dev,
int ick, int ick,
int div, int div,
int (*set_rate)(struct device *dev, int (*set_rate)(struct device *dev,
struct fsi_priv *fsi, struct fsi_priv *fsi))
unsigned long rate))
{ {
struct fsi_clk *clock = &fsi->clock; struct fsi_clk *clock = &fsi->clock;
int is_porta = fsi_is_port_a(fsi); int is_porta = fsi_is_port_a(fsi);
...@@ -829,8 +806,7 @@ static int fsi_clk_is_valid(struct fsi_priv *fsi) ...@@ -829,8 +806,7 @@ static int fsi_clk_is_valid(struct fsi_priv *fsi)
} }
static int fsi_clk_enable(struct device *dev, static int fsi_clk_enable(struct device *dev,
struct fsi_priv *fsi, struct fsi_priv *fsi)
unsigned long rate)
{ {
struct fsi_clk *clock = &fsi->clock; struct fsi_clk *clock = &fsi->clock;
int ret = -EINVAL; int ret = -EINVAL;
...@@ -839,7 +815,7 @@ static int fsi_clk_enable(struct device *dev, ...@@ -839,7 +815,7 @@ static int fsi_clk_enable(struct device *dev,
return ret; return ret;
if (0 == clock->count) { if (0 == clock->count) {
ret = clock->set_rate(dev, fsi, rate); ret = clock->set_rate(dev, fsi);
if (ret < 0) { if (ret < 0) {
fsi_clk_invalid(fsi); fsi_clk_invalid(fsi);
return ret; return ret;
...@@ -946,11 +922,11 @@ static int fsi_clk_set_ackbpf(struct device *dev, ...@@ -946,11 +922,11 @@ static int fsi_clk_set_ackbpf(struct device *dev,
} }
static int fsi_clk_set_rate_external(struct device *dev, static int fsi_clk_set_rate_external(struct device *dev,
struct fsi_priv *fsi, struct fsi_priv *fsi)
unsigned long rate)
{ {
struct clk *xck = fsi->clock.xck; struct clk *xck = fsi->clock.xck;
struct clk *ick = fsi->clock.ick; struct clk *ick = fsi->clock.ick;
unsigned long rate = fsi->clock.rate;
unsigned long xrate; unsigned long xrate;
int ackmd, bpfmd; int ackmd, bpfmd;
int ret = 0; int ret = 0;
...@@ -978,11 +954,11 @@ static int fsi_clk_set_rate_external(struct device *dev, ...@@ -978,11 +954,11 @@ static int fsi_clk_set_rate_external(struct device *dev,
} }
static int fsi_clk_set_rate_cpg(struct device *dev, static int fsi_clk_set_rate_cpg(struct device *dev,
struct fsi_priv *fsi, struct fsi_priv *fsi)
unsigned long rate)
{ {
struct clk *ick = fsi->clock.ick; struct clk *ick = fsi->clock.ick;
struct clk *div = fsi->clock.div; struct clk *div = fsi->clock.div;
unsigned long rate = fsi->clock.rate;
unsigned long target = 0; /* 12288000 or 11289600 */ unsigned long target = 0; /* 12288000 or 11289600 */
unsigned long actual, cout; unsigned long actual, cout;
unsigned long diff, min; unsigned long diff, min;
...@@ -1063,85 +1039,6 @@ static int fsi_clk_set_rate_cpg(struct device *dev, ...@@ -1063,85 +1039,6 @@ static int fsi_clk_set_rate_cpg(struct device *dev,
return ret; return ret;
} }
static int fsi_set_master_clk(struct device *dev, struct fsi_priv *fsi,
long rate, int enable)
{
set_rate_func set_rate = fsi_get_info_set_rate(fsi);
int ret;
/*
* CAUTION
*
* set_rate will be deleted
*/
if (!set_rate) {
if (enable)
return fsi_clk_enable(dev, fsi, rate);
else
return fsi_clk_disable(dev, fsi);
}
ret = set_rate(dev, rate, enable);
if (ret < 0) /* error */
return ret;
if (!enable)
return 0;
if (ret > 0) {
u32 data = 0;
switch (ret & SH_FSI_ACKMD_MASK) {
default:
/* FALL THROUGH */
case SH_FSI_ACKMD_512:
data |= (0x0 << 12);
break;
case SH_FSI_ACKMD_256:
data |= (0x1 << 12);
break;
case SH_FSI_ACKMD_128:
data |= (0x2 << 12);
break;
case SH_FSI_ACKMD_64:
data |= (0x3 << 12);
break;
case SH_FSI_ACKMD_32:
data |= (0x4 << 12);
break;
}
switch (ret & SH_FSI_BPFMD_MASK) {
default:
/* FALL THROUGH */
case SH_FSI_BPFMD_32:
data |= (0x0 << 8);
break;
case SH_FSI_BPFMD_64:
data |= (0x1 << 8);
break;
case SH_FSI_BPFMD_128:
data |= (0x2 << 8);
break;
case SH_FSI_BPFMD_256:
data |= (0x3 << 8);
break;
case SH_FSI_BPFMD_512:
data |= (0x4 << 8);
break;
case SH_FSI_BPFMD_16:
data |= (0x7 << 8);
break;
}
fsi_reg_mask_set(fsi, CKG1, (ACKMD_MASK | BPFMD_MASK) , data);
udelay(10);
ret = 0;
}
return ret;
}
/* /*
* pio data transfer handler * pio data transfer handler
*/ */
...@@ -1637,7 +1534,6 @@ static int fsi_hw_startup(struct fsi_priv *fsi, ...@@ -1637,7 +1534,6 @@ static int fsi_hw_startup(struct fsi_priv *fsi,
struct fsi_stream *io, struct fsi_stream *io,
struct device *dev) struct device *dev)
{ {
u32 flags = fsi_get_info_flags(fsi);
u32 data = 0; u32 data = 0;
/* clock setting */ /* clock setting */
...@@ -1654,19 +1550,6 @@ static int fsi_hw_startup(struct fsi_priv *fsi, ...@@ -1654,19 +1550,6 @@ static int fsi_hw_startup(struct fsi_priv *fsi,
data |= (1 << 4); data |= (1 << 4);
if (fsi_is_clk_master(fsi)) if (fsi_is_clk_master(fsi))
data <<= 8; data <<= 8;
/* FIXME
*
* SH_FSI_xxx_INV style will be removed
*/
if (SH_FSI_LRM_INV & flags)
data |= 1 << 12;
if (SH_FSI_BRM_INV & flags)
data |= 1 << 8;
if (SH_FSI_LRS_INV & flags)
data |= 1 << 4;
if (SH_FSI_BRS_INV & flags)
data |= 1 << 0;
fsi_reg_write(fsi, CKG2, data); fsi_reg_write(fsi, CKG2, data);
/* spdif ? */ /* spdif ? */
...@@ -1698,7 +1581,7 @@ static int fsi_hw_startup(struct fsi_priv *fsi, ...@@ -1698,7 +1581,7 @@ static int fsi_hw_startup(struct fsi_priv *fsi,
/* start master clock */ /* start master clock */
if (fsi_is_clk_master(fsi)) if (fsi_is_clk_master(fsi))
return fsi_set_master_clk(dev, fsi, fsi->rate, 1); return fsi_clk_enable(dev, fsi);
return 0; return 0;
} }
...@@ -1708,7 +1591,7 @@ static int fsi_hw_shutdown(struct fsi_priv *fsi, ...@@ -1708,7 +1591,7 @@ static int fsi_hw_shutdown(struct fsi_priv *fsi,
{ {
/* stop master clock */ /* stop master clock */
if (fsi_is_clk_master(fsi)) if (fsi_is_clk_master(fsi))
return fsi_set_master_clk(dev, fsi, fsi->rate, 0); return fsi_clk_disable(dev, fsi);
return 0; return 0;
} }
...@@ -1719,7 +1602,6 @@ static int fsi_dai_startup(struct snd_pcm_substream *substream, ...@@ -1719,7 +1602,6 @@ static int fsi_dai_startup(struct snd_pcm_substream *substream,
struct fsi_priv *fsi = fsi_get_priv(substream); struct fsi_priv *fsi = fsi_get_priv(substream);
fsi_clk_invalid(fsi); fsi_clk_invalid(fsi);
fsi->rate = 0;
return 0; return 0;
} }
...@@ -1730,7 +1612,6 @@ static void fsi_dai_shutdown(struct snd_pcm_substream *substream, ...@@ -1730,7 +1612,6 @@ static void fsi_dai_shutdown(struct snd_pcm_substream *substream,
struct fsi_priv *fsi = fsi_get_priv(substream); struct fsi_priv *fsi = fsi_get_priv(substream);
fsi_clk_invalid(fsi); fsi_clk_invalid(fsi);
fsi->rate = 0;
} }
static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd, static int fsi_dai_trigger(struct snd_pcm_substream *substream, int cmd,
...@@ -1795,7 +1676,6 @@ static int fsi_set_fmt_spdif(struct fsi_priv *fsi) ...@@ -1795,7 +1676,6 @@ static int fsi_set_fmt_spdif(struct fsi_priv *fsi)
static int fsi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) static int fsi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
{ {
struct fsi_priv *fsi = fsi_get_priv_frm_dai(dai); struct fsi_priv *fsi = fsi_get_priv_frm_dai(dai);
set_rate_func set_rate = fsi_get_info_set_rate(fsi);
int ret; int ret;
/* set master/slave audio interface */ /* set master/slave audio interface */
...@@ -1831,14 +1711,6 @@ static int fsi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) ...@@ -1831,14 +1711,6 @@ static int fsi_dai_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
} }
if (fsi_is_clk_master(fsi)) { if (fsi_is_clk_master(fsi)) {
/*
* CAUTION
*
* set_rate will be deleted
*/
if (set_rate)
dev_warn(dai->dev, "set_rate will be removed soon\n");
if (fsi->clk_cpg) if (fsi->clk_cpg)
fsi_clk_init(dai->dev, fsi, 0, 1, 1, fsi_clk_init(dai->dev, fsi, 0, 1, 1,
fsi_clk_set_rate_cpg); fsi_clk_set_rate_cpg);
...@@ -1862,10 +1734,8 @@ static int fsi_dai_hw_params(struct snd_pcm_substream *substream, ...@@ -1862,10 +1734,8 @@ static int fsi_dai_hw_params(struct snd_pcm_substream *substream,
{ {
struct fsi_priv *fsi = fsi_get_priv(substream); struct fsi_priv *fsi = fsi_get_priv(substream);
if (fsi_is_clk_master(fsi)) { if (fsi_is_clk_master(fsi))
fsi->rate = params_rate(params); fsi_clk_valid(fsi, params_rate(params));
fsi_clk_valid(fsi, fsi->rate);
}
return 0; return 0;
} }
...@@ -2048,16 +1918,15 @@ static int fsi_probe(struct platform_device *pdev) ...@@ -2048,16 +1918,15 @@ static int fsi_probe(struct platform_device *pdev)
{ {
struct fsi_master *master; struct fsi_master *master;
const struct platform_device_id *id_entry; const struct platform_device_id *id_entry;
struct sh_fsi_platform_info *info = pdev->dev.platform_data; struct sh_fsi_platform_info info;
struct sh_fsi_port_info nul_info, *pinfo;
struct fsi_priv *fsi; struct fsi_priv *fsi;
struct resource *res; struct resource *res;
unsigned int irq; unsigned int irq;
int ret; int ret;
nul_info.flags = 0; memset(&info, 0, sizeof(info));
nul_info.tx_id = 0; if (pdev->dev.platform_data)
nul_info.rx_id = 0; memcpy(&info, pdev->dev.platform_data, sizeof(info));
id_entry = pdev->id_entry; id_entry = pdev->id_entry;
if (!id_entry) { if (!id_entry) {
...@@ -2091,13 +1960,11 @@ static int fsi_probe(struct platform_device *pdev) ...@@ -2091,13 +1960,11 @@ static int fsi_probe(struct platform_device *pdev)
spin_lock_init(&master->lock); spin_lock_init(&master->lock);
/* FSI A setting */ /* FSI A setting */
pinfo = (info) ? &info->port_a : &nul_info;
fsi = &master->fsia; fsi = &master->fsia;
fsi->base = master->base; fsi->base = master->base;
fsi->master = master; fsi->master = master;
fsi->info = pinfo; fsi_port_info_init(fsi, &info.port_a);
fsi_port_info_init(fsi, pinfo); fsi_handler_init(fsi, &info.port_a);
fsi_handler_init(fsi, pinfo);
ret = fsi_stream_probe(fsi, &pdev->dev); ret = fsi_stream_probe(fsi, &pdev->dev);
if (ret < 0) { if (ret < 0) {
dev_err(&pdev->dev, "FSIA stream probe failed\n"); dev_err(&pdev->dev, "FSIA stream probe failed\n");
...@@ -2105,13 +1972,11 @@ static int fsi_probe(struct platform_device *pdev) ...@@ -2105,13 +1972,11 @@ static int fsi_probe(struct platform_device *pdev)
} }
/* FSI B setting */ /* FSI B setting */
pinfo = (info) ? &info->port_b : &nul_info;
fsi = &master->fsib; fsi = &master->fsib;
fsi->base = master->base + 0x40; fsi->base = master->base + 0x40;
fsi->master = master; fsi->master = master;
fsi->info = pinfo; fsi_port_info_init(fsi, &info.port_b);
fsi_port_info_init(fsi, pinfo); fsi_handler_init(fsi, &info.port_b);
fsi_handler_init(fsi, pinfo);
ret = fsi_stream_probe(fsi, &pdev->dev); ret = fsi_stream_probe(fsi, &pdev->dev);
if (ret < 0) { if (ret < 0) {
dev_err(&pdev->dev, "FSIB stream probe failed\n"); dev_err(&pdev->dev, "FSIB stream probe failed\n");
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment