static void rsnd_dvc_volume_update(struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); u32 zcmcr = 0; u32 vrpdr = 0; u32 vrdbr = 0; int i; for (i = 0; i < dvc->mute.cfg.size; i++) zcmcr |= (!!dvc->mute.cfg.val[i]) << i; if (dvc->ren.val) { vrpdr = rsnd_dvc_get_vrpdr(dvc); vrdbr = rsnd_dvc_get_vrdbr(dvc); } /* Disable DVC Register access */ rsnd_mod_write(mod, DVC_DVUER, 0); /* Zero Cross Mute Function */ rsnd_mod_write(mod, DVC_ZCMCR, zcmcr); /* Volume Ramp Function */ rsnd_mod_write(mod, DVC_VRPDR, vrpdr); rsnd_mod_write(mod, DVC_VRDBR, vrdbr); /* add DVC_VRWTR here */ /* Digital Volume Function Parameter */ rsnd_dvc_volume_parameter(io, mod); /* Enable DVC Register access */ rsnd_mod_write(mod, DVC_DVUER, 1); }
static void rsnd_dvc_volume_parameter(struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); u32 val[RSND_MAX_CHANNELS]; int i; /* Enable Ramp */ if (dvc->ren.val) for (i = 0; i < RSND_MAX_CHANNELS; i++) val[i] = dvc->volume.cfg.max; else for (i = 0; i < RSND_MAX_CHANNELS; i++) val[i] = dvc->volume.val[i]; /* Enable Digital Volume */ rsnd_mod_write(mod, DVC_VOL0R, val[0]); rsnd_mod_write(mod, DVC_VOL1R, val[1]); rsnd_mod_write(mod, DVC_VOL2R, val[2]); rsnd_mod_write(mod, DVC_VOL3R, val[3]); rsnd_mod_write(mod, DVC_VOL4R, val[4]); rsnd_mod_write(mod, DVC_VOL5R, val[5]); rsnd_mod_write(mod, DVC_VOL6R, val[6]); rsnd_mod_write(mod, DVC_VOL7R, val[7]); }
static int rsnd_dvc_pcm_new(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct snd_soc_pcm_runtime *rtd) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); int is_play = rsnd_io_is_play(io); int slots = rsnd_get_slot(io); int ret; /* Volume */ ret = rsnd_kctrl_new_m(mod, io, rtd, is_play ? "DVC Out Playback Volume" : "DVC In Capture Volume", rsnd_dvc_volume_update, &dvc->volume, slots, 0x00800000 - 1); if (ret < 0) return ret; /* Mute */ ret = rsnd_kctrl_new_m(mod, io, rtd, is_play ? "DVC Out Mute Switch" : "DVC In Mute Switch", rsnd_dvc_volume_update, &dvc->mute, slots, 1); if (ret < 0) return ret; /* Ramp */ ret = rsnd_kctrl_new_s(mod, io, rtd, is_play ? "DVC Out Ramp Switch" : "DVC In Ramp Switch", rsnd_dvc_volume_update, &dvc->ren, 1); if (ret < 0) return ret; ret = rsnd_kctrl_new_e(mod, io, rtd, is_play ? "DVC Out Ramp Up Rate" : "DVC In Ramp Up Rate", &dvc->rup, rsnd_dvc_volume_update, dvc_ramp_rate, ARRAY_SIZE(dvc_ramp_rate)); if (ret < 0) return ret; ret = rsnd_kctrl_new_e(mod, io, rtd, is_play ? "DVC Out Ramp Down Rate" : "DVC In Ramp Down Rate", &dvc->rdown, rsnd_dvc_volume_update, dvc_ramp_rate, ARRAY_SIZE(dvc_ramp_rate)); if (ret < 0) return ret; return 0; }
static int rsnd_dvc_remove_(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); rsnd_kctrl_remove(dvc->volume); rsnd_kctrl_remove(dvc->mute); rsnd_kctrl_remove(dvc->ren); rsnd_kctrl_remove(dvc->rup); rsnd_kctrl_remove(dvc->rdown); return 0; }
static void rsnd_dvc_volume_init(struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); u32 adinr = 0; u32 dvucr = 0; u32 vrctr = 0; u32 vrpdr = 0; u32 vrdbr = 0; adinr = rsnd_get_adinr_bit(mod, io) | rsnd_runtime_channel_after_ctu(io); /* Enable Digital Volume, Zero Cross Mute Mode */ dvucr |= 0x101; /* Enable Ramp */ if (dvc->ren.val) { dvucr |= 0x10; /* * FIXME !! * use scale-downed Digital Volume * as Volume Ramp * 7F FFFF -> 3FF */ vrctr = 0xff; vrpdr = rsnd_dvc_get_vrpdr(dvc); vrdbr = rsnd_dvc_get_vrdbr(dvc); } /* Initialize operation */ rsnd_mod_write(mod, DVC_DVUIR, 1); /* General Information */ rsnd_mod_write(mod, DVC_ADINR, adinr); rsnd_mod_write(mod, DVC_DVUCR, dvucr); /* Volume Ramp Parameter */ rsnd_mod_write(mod, DVC_VRCTR, vrctr); rsnd_mod_write(mod, DVC_VRPDR, vrpdr); rsnd_mod_write(mod, DVC_VRDBR, vrdbr); /* Digital Volume Function Parameter */ rsnd_dvc_volume_parameter(io, mod); /* cancel operation */ rsnd_mod_write(mod, DVC_DVUIR, 0); }
static void rsnd_dvc_volume_update(struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_dvc *dvc = rsnd_mod_to_dvc(mod); u32 val[RSND_DVC_CHANNELS]; u32 dvucr = 0; u32 mute = 0; int i; for (i = 0; i < dvc->mute.cfg.size; i++) mute |= (!!dvc->mute.cfg.val[i]) << i; /* Disable DVC Register access */ rsnd_mod_write(mod, DVC_DVUER, 0); /* Enable Ramp */ if (dvc->ren.val) { dvucr |= 0x10; /* Digital Volume Max */ for (i = 0; i < RSND_DVC_CHANNELS; i++) val[i] = dvc->volume.cfg.max; rsnd_mod_write(mod, DVC_VRCTR, 0xff); rsnd_mod_write(mod, DVC_VRPDR, dvc->rup.val << 8 | dvc->rdown.val); /* * FIXME !! * use scale-downed Digital Volume * as Volume Ramp * 7F FFFF -> 3FF */ rsnd_mod_write(mod, DVC_VRDBR, 0x3ff - (dvc->volume.val[0] >> 13)); } else {