CHROMIUM: video: tegra: Implement tegra_dc_hdmi_set_audio_sample_rate

drivers/video/tegra/dc/hdmi.c

 /*
  * drivers/video/tegra/dc/hdmi.c
  *
  * Copyright (C) 2010 Google, Inc.
  * Author: Erik Gilling <konkers@android.com>
  *
  * This software is licensed under the terms of the GNU General Public
  * License version 2, as published by the Free Software Foundation, and
  * may be copied, distributed, and modified under those terms.
  *
@@ skipping 667 matching lines @@
                 else
                         delta = 9;
 
                 eight_half = (8 * HDMI_AUDIOCLK_FREQ) / (f * 128);
                 tegra_hdmi_writel(hdmi, AUDIO_FS_LOW(eight_half - delta) |
                                   AUDIO_FS_HIGH(eight_half + delta),
                                   HDMI_NV_PDISP_AUDIO_FS(i));
         }
 }
 
-static int tegra_dc_hdmi_setup_audio(struct tegra_dc *dc)
+static int tegra_dc_hdmi_setup_audio(struct tegra_dc *dc, unsigned audio_freq)
 {
         struct tegra_dc_hdmi_data *hdmi = tegra_dc_get_outdata(dc);
         const struct tegra_hdmi_audio_config *config;
         unsigned long audio_n;
-        unsigned audio_freq = 44100; /* TODO: find some way of configuring this */
 
         tegra_hdmi_writel(hdmi,
                           AUDIO_CNTRL0_ERROR_TOLERANCE(6) |
                           AUDIO_CNTRL0_FRAMES_PER_BLOCK(0xc0) |
                           AUDIO_CNTRL0_SOURCE_SELECT_AUTO,
                           HDMI_NV_PDISP_AUDIO_CNTRL0);
 
         config = tegra_hdmi_get_audio_config(audio_freq, dc->mode.pclk);
         if (!config) {
                 dev_err(&dc->ndev->dev,
@@ skipping 19 matching lines @@
                           HDMI_NV_PDISP_HDMI_SPARE);
 
         audio_n &= ~AUDIO_N_RESETF;
         tegra_hdmi_writel(hdmi, audio_n, HDMI_NV_PDISP_AUDIO_N);
 
         tegra_dc_hdmi_setup_audio_fs_tables(dc);
 
         return 0;
 }
 
+int tegra_dc_hdmi_set_audio_sample_rate(unsigned audio_freq)
+{
+        int i, ret;
+        struct tegra_dc *dc;
+        struct tegra_dc_hdmi_data *hdmi;
+
+        for (i = 0; i < TEGRA_MAX_DC; i++) {
+                dc = tegra_dc_get_dc(i);
+                if (!dc)
+                        continue;
+                hdmi = tegra_dc_get_outdata(dc);
+                if (!hdmi)
+                        continue;
+                ret = tegra_dc_hdmi_setup_audio(dc, audio_freq);
+                if (ret)
+                        return ret;
+        }
+
+        return 0;
+}
+EXPORT_SYMBOL(tegra_dc_hdmi_set_audio_sample_rate);
+
 static void tegra_dc_hdmi_write_infopack(struct tegra_dc *dc, int header_reg,
                                          u8 type, u8 version, void *data, int len)
 {
         struct tegra_dc_hdmi_data *hdmi = tegra_dc_get_outdata(dc);
         u32 subpack[2];  /* extra byte for zero padding of subpack */
         int i;
         u8 csum;
 
         /* first byte of data is the checksum */
         csum = type + version + len - 1;
@@ skipping 187 matching lines @@
 
         clk_disable(hdmi->disp1_clk);
         clk_disable(hdmi->disp2_clk);
 
         dispclk_div_8_2 = clk_get_rate(hdmi->clk) / 1000000 * 4;
         tegra_hdmi_writel(hdmi,
                           SOR_REFCLK_DIV_INT(dispclk_div_8_2 >> 2) |
                           SOR_REFCLK_DIV_FRAC(dispclk_div_8_2),
                           HDMI_NV_PDISP_SOR_REFCLK);
 
-        err = tegra_dc_hdmi_setup_audio(dc);
+        err = tegra_dc_hdmi_setup_audio(dc, 44100);
         if (err < 0)
                 dvi = true;
 
         rekey = HDMI_REKEY_DEFAULT;
         val = HDMI_CTRL_REKEY(rekey);
         val |= HDMI_CTRL_MAX_AC_PACKET((dc->mode.h_sync_width +
                                         dc->mode.h_back_porch +
                                         dc->mode.h_front_porch -
                                         rekey - 18) / 32);
         if (!dvi)
@@ skipping 149 matching lines @@
 struct tegra_dc_out_ops tegra_dc_hdmi_ops = {
         .init = tegra_dc_hdmi_init,
         .destroy = tegra_dc_hdmi_destroy,
         .enable = tegra_dc_hdmi_enable,
         .disable = tegra_dc_hdmi_disable,
         .detect = tegra_dc_hdmi_detect,
         .suspend = tegra_dc_hdmi_suspend,
         .resume = tegra_dc_hdmi_resume,
 };