* Tomi Valkeinen <[email protected]> [090805 17:19]:
> Signed-off-by: Tomi Valkeinen <[email protected]>
> ---
> drivers/video/omap2/dss/sdi.c | 370
> +++++++++++++++++++++++++++++++++++++++++
> 1 files changed, 370 insertions(+), 0 deletions(-)
> create mode 100644 drivers/video/omap2/dss/sdi.c
>
> diff --git a/drivers/video/omap2/dss/sdi.c b/drivers/video/omap2/dss/sdi.c
> new file mode 100644
> index 0000000..2f4d226
> --- /dev/null
> +++ b/drivers/video/omap2/dss/sdi.c
> @@ -0,0 +1,370 @@
> +/*
> + * linux/drivers/video/omap2/dss/sdi.c
> + *
> + * Copyright (C) 2009 Nokia Corporation
> + * Author: Tomi Valkeinen <[email protected]>
> + *
> + * This program is free software; you can redistribute it and/or modify it
> + * under the terms of the GNU General Public License version 2 as published
> by
> + * the Free Software Foundation.
> + *
> + * This program is distributed in the hope that it will be useful, but
> WITHOUT
> + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
> + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
> + * more details.
> + *
> + * You should have received a copy of the GNU General Public License along
> with
> + * this program. If not, see <http://www.gnu.org/licenses/>.
> + */
> +
> +#define DSS_SUBSYS_NAME "SDI"
> +
> +#include <linux/kernel.h>
> +#include <linux/clk.h>
> +#include <linux/delay.h>
> +#include <linux/err.h>
> +#include <linux/io.h>
> +
> +#include <mach/board.h>
> +#include <mach/display.h>
> +#include "dss.h"
> +
> +#define CONTROL_PADCONF_BASE 0x48002000
> +
> +#define OMAP_SDI_PAD_DIS(pe, pu) ((7 << 0) | /* MODE 7 = safe */ \
> + (((pe) ? 1 : 0) << 3) | /* PULL_ENA */ \
> + (((pu) ? 1 : 0) << 4) | /* PULL_UP */ \
> + (1 << 8)) /* INPUT_EN */
> +
> +#define OMAP_SDI_PAD_EN (1 << 0) /* MODE 1 =
> SDI_xx */
> +
> +#define OMAP_SDI_PAD_MASK OMAP_SDI_PAD_DIS(1, 1)
> +
> +static struct {
> + bool skip_init;
> + bool update_enabled;
> +} sdi;
> +
> +/* CONTROL_PADCONF_DSS_DATAXX */
> +static const u16 sdi_pads[] =
> +{
> + 0x0f0, /* 10[ 7..0]:SDI_DAT1N */
> + 0x0f2, /* 10[15..0]:SDI_DAT1P */
> + 0x0f4, /* 12[ 7..0]:SDI_DAT2N */
> + 0x0f6, /* 12[15..0]:SDI_DAT2P */
> + 0x0f8, /* 14[ 7..0]:SDI_DAT3N */
> + 0x0fa, /* 14[15..0]:SDI_DAT3P */
> + 0x108, /* 22[ 7..0]:SDI_CLKN */
> + 0x10a, /* 22[15..0]:SDI_CLKP */
> +};
Aaargh, NAK for custom pin muxing. Please do it in mux.[ch], see
arch/arm/mach-omap2/mux.c.
> +
> +/*
> + * Check if bootloader / platform code has configured the SDI pads properly.
> + * This means it either configured all required pads for SDI mode, or that it
> + * left all the required pads unconfigured.
> + */
> +static int sdi_pad_init(struct omap_dss_device *dssdev)
> +{
> + unsigned req_map;
> + bool configured = false;
> + bool unconfigured = false;
> + int data_pairs;
> + int i;
> +
> + data_pairs = dssdev->phy.sdi.datapairs;
> + req_map = (1 << (data_pairs * 2)) - 1; /* data lanes */
> + req_map |= 3 << 6; /* clk lane */
> + for (i = 0; i < ARRAY_SIZE(sdi_pads); i++) {
> + u32 reg;
> + u32 val;
> +
> + if (!((1 << i) & req_map))
> + /* Ignore unneded pads. */
> + continue;
> + reg = CONTROL_PADCONF_BASE + sdi_pads[i];
> + val = omap_readw(reg);
> + switch (val & 0x07) { /* pad mode */
> + case 1:
> + if (unconfigured)
> + break;
> + /* Is the pull configuration ok for SDI mode? */
> + if ((val & OMAP_SDI_PAD_MASK) != OMAP_SDI_PAD_EN)
> + break;
> + configured = true;
> + break;
> + case 0:
> + case 7:
> + if (configured)
> + break;
> + unconfigured = true;
> + break;
> + default:
> + break;
> + }
> + }
> + if (i != ARRAY_SIZE(sdi_pads)) {
> + DSSERR("SDI: invalid pad configuration\n");
> + return -1;
> + }
> +
> + return 0;
> +}
> +
> +static void sdi_pad_config(struct omap_dss_device *dssdev, bool enable)
> +{
> + int data_pairs;
> + bool pad_off_pe, pad_off_pu;
> + unsigned req_map;
> + int i;
> +
> + data_pairs = dssdev->phy.sdi.datapairs;
> + pad_off_pe = dssdev->phy.sdi.pad_off_pe;
> + pad_off_pu = dssdev->phy.sdi.pad_off_pu;
> + req_map = (1 << (data_pairs * 2)) - 1; /* data lanes */
> + req_map |= 3 << 6; /* clk lane */
> + for (i = 0; i < ARRAY_SIZE(sdi_pads); i++) {
> + u32 reg;
> + u16 val;
> +
> + if (!((1 << i) & req_map))
> + continue;
> + if (enable)
> + val = OMAP_SDI_PAD_EN;
> + else
> + val = OMAP_SDI_PAD_DIS(pad_off_pe, pad_off_pu);
> + reg = CONTROL_PADCONF_BASE + sdi_pads[i];
> + omap_writew(val, reg);
> + }
> +}
> +
Looks like you can do all this with mux.[ch]. If not, we need to improve
the generic mux code.
Regards,
Tony
--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to [email protected]
More majordomo info at http://vger.kernel.org/majordomo-info.html
