/*
 * arch/arm/mach-tegra/board-colibri_t30-panel.c
 *
 * Copyright (c) 2012, Toradex, Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * 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, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 */

#include <asm/atomic.h>
#include <asm/mach-types.h>

#include <linux/delay.h>
#include <linux/earlysuspend.h>
#include <linux/gpio.h>
#include <linux/ion.h>
#include <linux/nvhost.h>
#include <linux/nvmap.h>
#include <linux/platform_device.h>
#include <linux/pwm_backlight.h>
#include <linux/regulator/consumer.h>
#include <linux/resource.h>
#include <linux/tegra_ion.h>

#include <mach/dc.h>
#include <mach/fb.h>
#include <mach/iomap.h>
#include <mach/irqs.h>
#include <mach/smmu.h>

#include "board.h"
#include "board-colibri_t30.h"
#include "devices.h"
#include "gpio-names.h"
#include "tegra3_host1x_devices.h"

#ifndef COLIBRI_T30_VI
#define colibri_t30_bl_enb	TEGRA_GPIO_PV2	/* BL_ON */
#endif
#define colibri_t30_hdmi_hpd	TEGRA_GPIO_PN7	/* HDMI_INT_N */

static struct regulator *colibri_t30_hdmi_pll = NULL;
static struct regulator *colibri_t30_hdmi_reg = NULL;
static struct regulator *colibri_t30_hdmi_vddio = NULL;

#ifndef COLIBRI_T30_VI
static int colibri_t30_backlight_init(struct device *dev) {
	int ret;

	ret = gpio_request(colibri_t30_bl_enb, "BL_ON");
	if (ret < 0)
		return ret;

	ret = gpio_direction_output(colibri_t30_bl_enb, 1);
	if (ret < 0)
		gpio_free(colibri_t30_bl_enb);

	return ret;
};

static void colibri_t30_backlight_exit(struct device *dev) {
	gpio_set_value(colibri_t30_bl_enb, 0);
	gpio_free(colibri_t30_bl_enb);
}

static int colibri_t30_backlight_notify(struct device *dev, int brightness)
{
	struct platform_pwm_backlight_data *pdata = dev->platform_data;

	gpio_set_value(colibri_t30_bl_enb, !!brightness);

	/* Unified TFT interface displays (e.g. EDT ET070080DH6) LEDCTRL pin
	   with inverted behaviour (e.g. 0V brightest vs. 3.3V darkest)
	   Note: brightness polarity display model specific */
	if (brightness)	return pdata->max_brightness - brightness;
	else return brightness;
}

static int colibri_t30_disp1_check_fb(struct device *dev, struct fb_info *info);

static struct platform_pwm_backlight_data colibri_t30_backlight_data = {
	.pwm_id		= 0,
	.max_brightness	= 255,
	.dft_brightness	= 127,
	.pwm_period_ns	= 1000000, /* 1 kHz */
	.init		= colibri_t30_backlight_init,
	.exit		= colibri_t30_backlight_exit,
	.notify		= colibri_t30_backlight_notify,
	/* Only toggle backlight on fb blank notifications for disp1 */
	.check_fb	= colibri_t30_disp1_check_fb,
};

static struct platform_device colibri_t30_backlight_device = {
	.name	= "pwm-backlight",
	.id	= -1,
	.dev	= {
		.platform_data = &colibri_t30_backlight_data,
	},
};
#endif /* !COLIBRI_T30_VI */

static int colibri_t30_panel_enable(void)
{
	return 0;
}

static int colibri_t30_panel_disable(void)
{
	return 0;
}

#ifdef CONFIG_TEGRA_DC
static int colibri_t30_hdmi_vddio_enable(void)
{
	int ret;
	if (!colibri_t30_hdmi_vddio) {
		colibri_t30_hdmi_vddio = regulator_get(NULL, "vdd_hdmi_con");
		if (IS_ERR_OR_NULL(colibri_t30_hdmi_vddio)) {
			ret = PTR_ERR(colibri_t30_hdmi_vddio);
			pr_err("hdmi: couldn't get regulator vdd_hdmi_con\n");
			colibri_t30_hdmi_vddio = NULL;
			return ret;
		}
	}
	ret = regulator_enable(colibri_t30_hdmi_vddio);
	if (ret < 0) {
		pr_err("hdmi: couldn't enable regulator vdd_hdmi_con\n");
		regulator_put(colibri_t30_hdmi_vddio);
		colibri_t30_hdmi_vddio = NULL;
		return ret;
	}
	return ret;
}

static int colibri_t30_hdmi_vddio_disable(void)
{
	if (colibri_t30_hdmi_vddio) {
		regulator_disable(colibri_t30_hdmi_vddio);
		regulator_put(colibri_t30_hdmi_vddio);
		colibri_t30_hdmi_vddio = NULL;
	}
	return 0;
}

static int colibri_t30_hdmi_enable(void)
{
	int ret;
	if (!colibri_t30_hdmi_reg) {
		colibri_t30_hdmi_reg = regulator_get(NULL, "avdd_hdmi");
		if (IS_ERR_OR_NULL(colibri_t30_hdmi_reg)) {
			pr_err("hdmi: couldn't get regulator avdd_hdmi\n");
			colibri_t30_hdmi_reg = NULL;
			return PTR_ERR(colibri_t30_hdmi_reg);
		}
	}
	ret = regulator_enable(colibri_t30_hdmi_reg);
	if (ret < 0) {
		pr_err("hdmi: couldn't enable regulator avdd_hdmi\n");
		return ret;
	}
	if (!colibri_t30_hdmi_pll) {
		colibri_t30_hdmi_pll = regulator_get(NULL, "avdd_hdmi_pll");
		if (IS_ERR_OR_NULL(colibri_t30_hdmi_pll)) {
			pr_err("hdmi: couldn't get regulator avdd_hdmi_pll\n");
			colibri_t30_hdmi_pll = NULL;
			regulator_put(colibri_t30_hdmi_reg);
			colibri_t30_hdmi_reg = NULL;
			return PTR_ERR(colibri_t30_hdmi_pll);
		}
	}
	ret = regulator_enable(colibri_t30_hdmi_pll);
	if (ret < 0) {
		pr_err("hdmi: couldn't enable regulator avdd_hdmi_pll\n");
		return ret;
	}
	return 0;
}

static int colibri_t30_hdmi_disable(void)
{
	regulator_disable(colibri_t30_hdmi_reg);
	regulator_put(colibri_t30_hdmi_reg);
	colibri_t30_hdmi_reg = NULL;

	regulator_disable(colibri_t30_hdmi_pll);
	regulator_put(colibri_t30_hdmi_pll);
	colibri_t30_hdmi_pll = NULL;
	return 0;
}
static struct resource colibri_t30_disp1_resources[] = {
	{
		.name	= "irq",
		.start	= INT_DISPLAY_GENERAL,
		.end	= INT_DISPLAY_GENERAL,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "regs",
		.start	= TEGRA_DISPLAY_BASE,
		.end	= TEGRA_DISPLAY_BASE + TEGRA_DISPLAY_SIZE-1,
		.flags	= IORESOURCE_MEM,
	},
	{
		.name	= "fbmem",
		.start	= 0,	/* Filled in by colibri_t30_panel_init() */
		.end	= 0,	/* Filled in by colibri_t30_panel_init() */
		.flags	= IORESOURCE_MEM,
	},
};

static struct resource colibri_t30_disp2_resources[] = {
	{
		.name	= "irq",
		.start	= INT_DISPLAY_B_GENERAL,
		.end	= INT_DISPLAY_B_GENERAL,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "regs",
		.start	= TEGRA_DISPLAY2_BASE,
		.end	= TEGRA_DISPLAY2_BASE + TEGRA_DISPLAY2_SIZE - 1,
		.flags	= IORESOURCE_MEM,
	},
	{
		.name	= "fbmem",
		.flags	= IORESOURCE_MEM,
		.start	= 0,
		.end	= 0,
	},
	{
		.name	= "hdmi_regs",
		.start	= TEGRA_HDMI_BASE,
		.end	= TEGRA_HDMI_BASE + TEGRA_HDMI_SIZE - 1,
		.flags	= IORESOURCE_MEM,
	},
};
#endif /* CONFIG_TEGRA_DC */

static struct tegra_dc_mode colibri_t30_panel_modes[] = {
#ifdef TEGRA_FB_VGA
	{
		/* 640x480p 60hz: EIA/CEA-861-B Format 1 */
		.pclk		= 25175000,	/* pixclock */
		.h_ref_to_sync	= 8,
		.v_ref_to_sync	= 2,
		.h_sync_width	= 96,		/* hsync_len */
		.v_sync_width	= 2,		/* vsync_len */
		.h_back_porch	= 48,		/* left_margin */
		.v_back_porch	= 33,		/* upper_margin */
		.h_active	= 640,
		.v_active	= 480,
		.h_front_porch	= 16,		/* right_margin */
		.v_front_porch	= 10,		/* lower_margin */
	},
#else /* TEGRA_FB_VGA */
	{
		/* 800x480@60 (e.g. EDT ET070080DH6) */
		.pclk		= 32460000,
		.h_ref_to_sync	= 1,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 64,
		.v_sync_width	= 3,
		.h_back_porch	= 128,
		.v_back_porch	= 22,
		.h_active	= 800,
		.v_active	= 480,
		.h_front_porch	= 64,
		.v_front_porch	= 20,
	},
	{
		/* 800x600@60 */
		.pclk		= 39272727,
		.h_sync_width	= 80,
		.v_sync_width	= 2,
		.h_back_porch	= 160,
		.v_back_porch	= 21,
		.h_active	= 800,
		.v_active	= 600,
		.h_front_porch	= 16,
		.v_front_porch	= 1,
	},
	{
		/* TouchRevolution Fusion 10 aka Chunghwa Picture Tubes
		   CLAA101NC05 10.1 inch 1024x600 single channel LVDS panel */
		.pclk		= 48000000,
		.h_sync_width	= 5,
		.v_sync_width	= 5,
		.h_back_porch	= 104,
		.v_back_porch	= 24,
		.h_active	= 1024,
		.v_active	= 600,
		.h_front_porch	= 43,
		.v_front_porch	= 20,
	},
	{
		/* 1024x768@60 */
		.pclk		= 78800000,
		.h_sync_width	= 96,
		.v_sync_width	= 3,
		.h_back_porch	= 176,
		.v_back_porch	= 28,
		.h_active	= 1024,
		.v_active	= 768,
		.h_front_porch	= 16,
		.v_front_porch	= 1,
	},
	{
		/* 1024x768@75 */
		.pclk		= 82000000,
		.h_sync_width	= 104,
		.v_sync_width	= 4,
		.h_back_porch	= 168,
		.v_back_porch	= 34,
		.h_active	= 1024,
		.v_active	= 768,
		.h_front_porch	= 64,
		.v_front_porch	= 3,
	},
	{
		/* 1280x720@60 */
		.pclk		= 74250000,
		.h_ref_to_sync	= 1,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 40,
		.v_sync_width	= 5,
		.h_back_porch	= 220,
		.v_back_porch	= 20,
		.h_active	= 1280,
		.v_active	= 720,
		.h_front_porch	= 110,
		.v_front_porch	= 5,
//high active sync polarities
	},
	{
		/* 1280x1024@60 */
		.pclk		= 108000000,
//		.h_ref_to_sync	= 1,
//		.v_ref_to_sync	= 1,
		.h_sync_width	= 144,
		.v_sync_width	= 3,
		.h_back_porch	= 248,
		.v_back_porch	= 38,
		.h_active	= 1280,
		.v_active	= 1024,
		.h_front_porch	= 16,
		.v_front_porch	= 1,
//high active sync polarities
	},
	{
		/* 1366x768@60 */
		.pclk		= 72072000,
		.h_ref_to_sync	= 11,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 58,
		.v_sync_width	= 4,
		.h_back_porch	= 58,
		.v_back_porch	= 4,
		.h_active	= 1366,
		.v_active	= 768,
		.h_front_porch	= 58,
		.v_front_porch	= 4,
	},
	{
		/* 1600x1200@60 */
		.pclk		= 162000000,
//		.h_ref_to_sync	= 1,
//		.v_ref_to_sync	= 1,
		.h_sync_width	= 192,
		.v_sync_width	= 3,
		.h_back_porch	= 304,
		.v_back_porch	= 46,
		.h_active	= 1600,
		.v_active	= 1200,
		.h_front_porch	= 64,
		.v_front_porch	= 1,
//high active sync polarities
	},
	{
		.pclk		= 119000000,
		.h_ref_to_sync	= 1,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 32,
		.v_sync_width	= 6,
		.h_back_porch	= 80,
		.v_back_porch	= 21,
		.h_active	= 1680,
		.v_active	= 1050,
		.h_front_porch	= 48,
		.v_front_porch	= 3,
	},
	{
		/* 1680x1050@60 */
		.pclk		= 147140000,
//		.h_ref_to_sync	= 1,
//		.v_ref_to_sync	= 1,
		.h_sync_width	= 184,
		.v_sync_width	= 3,
		.h_back_porch	= 288,
		.v_back_porch	= 33,
		.h_active	= 1680,
		.v_active	= 1050,
		.h_front_porch	= 104,
		.v_front_porch	= 1,
//high active vertical sync polarity
	},
	{
		/* 1920x1080p 59.94/60hz EIA/CEA-861-B Format 16 */
		.pclk		= 148500000,
		.h_ref_to_sync	= 11,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 44,
		.v_sync_width	= 5,
		.h_back_porch	= 148,
		.v_back_porch	= 36,
		.h_active	= 1920,
		.v_active	= 1080,
		.h_front_porch	= 88,
		.v_front_porch	= 4,
//high active sync polarities
	},
	{
		.pclk		= 154000000,
		.h_ref_to_sync	= 11,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 32,
		.v_sync_width	= 6,
		.h_back_porch	= 80,
		.v_back_porch	= 26,
		.h_active	= 1920,
		.v_active	= 1200,
		.h_front_porch	= 48,
		.v_front_porch	= 3,
	},

	/* portrait modes */

	{
		.pclk		= 18000000,
		.h_ref_to_sync	= 8,
		.v_ref_to_sync	= 2,
		.h_sync_width	= 4,
		.v_sync_width	= 1,
		.h_back_porch	= 20,
		.v_back_porch	= 7,
		.h_active	= 480,
		.v_active	= 640,
		.h_front_porch	= 8,
		.v_front_porch	= 8,
	},
	{
		.pclk		= 10000000,
		.h_ref_to_sync	= 4,
		.v_ref_to_sync	= 1,
		.h_sync_width	= 16,
		.v_sync_width	= 1,
		.h_back_porch	= 32,
		.v_back_porch	= 1,
		.h_active	= 540,
		.v_active	= 960,
		.h_front_porch	= 32,
		.v_front_porch	= 2,
	},
	{
		.pclk		= 61417000,
		.h_ref_to_sync	= 2,
		.v_ref_to_sync	= 2,
		.h_sync_width	= 4,
		.v_sync_width	= 4,
		.h_back_porch	= 100,
		.v_back_porch	= 14,
		.h_active	= 720,
		.v_active	= 1280,
		.h_front_porch	= 4,
		.v_front_porch	= 4,
	},
#endif /* TEGRA_FB_VGA */
};

#ifdef CONFIG_TEGRA_DC
static struct tegra_fb_data colibri_t30_fb_data = {
	.win		= 0,
#ifdef TEGRA_FB_VGA
	.xres		= 640,
	.yres		= 480,
#else /* TEGRA_FB_VGA */
	.xres		= 800,
	.yres		= 480,
#endif /* TEGRA_FB_VGA */
#ifndef CONFIG_ANDROID
	.bits_per_pixel	= 16,
#else
	.bits_per_pixel	= 32,
#endif
	.flags		= TEGRA_FB_FLIP_ON_PROBE,
};

static struct tegra_fb_data colibri_t30_hdmi_fb_data = {
	.win		= 0,
#ifndef CONFIG_ANDROID
	.xres		= 640,
	.yres		= 480,
	.bits_per_pixel	= 16,
#else /* CONFIG_ANDROID */
	.xres		= 1920,
	.yres		= 1080,
	.bits_per_pixel	= 32,
#endif /* !CONFIG_ANDROID */
	.flags		= TEGRA_FB_FLIP_ON_PROBE,
};

static struct tegra_dc_out_pin colibri_t30_dc_out_pins[] = {
	{
		.name	= TEGRA_DC_OUT_PIN_H_SYNC,
		.pol	= TEGRA_DC_OUT_PIN_POL_LOW,
	},
	{
		.name	= TEGRA_DC_OUT_PIN_V_SYNC,
		.pol	= TEGRA_DC_OUT_PIN_POL_LOW,
	},
	{
		.name	= TEGRA_DC_OUT_PIN_PIXEL_CLOCK,
		.pol	= TEGRA_DC_OUT_PIN_POL_LOW,
	},
};

static struct tegra_dc_out colibri_t30_disp1_out = {
	.type			= TEGRA_DC_OUT_RGB,
	.parent_clk		= "pll_d_out0",
	.parent_clk_backup	= "pll_d2_out0",

	.align			= TEGRA_DC_ALIGN_MSB,
	.order			= TEGRA_DC_ORDER_RED_BLUE,
	.depth			= 18,
	.dither			= TEGRA_DC_ORDERED_DITHER,

	.modes			= colibri_t30_panel_modes,
	.n_modes		= ARRAY_SIZE(colibri_t30_panel_modes),

	.out_pins		= colibri_t30_dc_out_pins,
	.n_out_pins		= ARRAY_SIZE(colibri_t30_dc_out_pins),

	.enable			= colibri_t30_panel_enable,
	.disable		= colibri_t30_panel_disable,
};

static struct tegra_dc_out colibri_t30_disp2_out = {
	.type		= TEGRA_DC_OUT_HDMI,
	.flags		= TEGRA_DC_OUT_HOTPLUG_HIGH,
	.parent_clk	= "pll_d2_out0",

	.dcc_bus	= 3,
	.hotplug_gpio	= colibri_t30_hdmi_hpd,

	.max_pixclock	= KHZ2PICOS(148500),

	.align		= TEGRA_DC_ALIGN_MSB,
	.order		= TEGRA_DC_ORDER_RED_BLUE,

	.enable		= colibri_t30_hdmi_enable,
	.disable	= colibri_t30_hdmi_disable,

	.postsuspend	= colibri_t30_hdmi_vddio_disable,
	.hotplug_init	= colibri_t30_hdmi_vddio_enable,
};

static struct tegra_dc_platform_data colibri_t30_disp1_pdata = {
	.flags		= TEGRA_DC_FLAG_ENABLED,
	.default_out	= &colibri_t30_disp1_out,
	.emc_clk_rate	= 300000000,
	.fb		= &colibri_t30_fb_data,
};

static struct tegra_dc_platform_data colibri_t30_disp2_pdata = {
	.flags		= TEGRA_DC_FLAG_ENABLED,
	.default_out	= &colibri_t30_disp2_out,
	.fb		= &colibri_t30_hdmi_fb_data,
	.emc_clk_rate	= 300000000,
};

static struct nvhost_device colibri_t30_disp1_device = {
	.name		= "tegradc",
	.id		= 0,
	.resource	= colibri_t30_disp1_resources,
	.num_resources	= ARRAY_SIZE(colibri_t30_disp1_resources),
	.dev = {
		.platform_data = &colibri_t30_disp1_pdata,
	},
};

#ifndef COLIBRI_T30_VI
static int colibri_t30_disp1_check_fb(struct device *dev, struct fb_info *info)
{
	return info->device == &colibri_t30_disp1_device.dev;
}
#endif /* !COLIBRI_T30_VI */

static struct nvhost_device colibri_t30_disp2_device = {
	.name		= "tegradc",
	.id		= 1,
	.resource	= colibri_t30_disp2_resources,
	.num_resources	= ARRAY_SIZE(colibri_t30_disp2_resources),
	.dev = {
		.platform_data = &colibri_t30_disp2_pdata,
	},
};
#else /* CONFIG_TEGRA_DC */
static int colibri_t30_disp1_check_fb(struct device *dev, struct fb_info *info)
{
	return 0;
}
#endif /* CONFIG_TEGRA_DC */

#if defined(CONFIG_TEGRA_NVMAP)
static struct nvmap_platform_carveout colibri_t30_carveouts[] = {
	[0] = NVMAP_HEAP_CARVEOUT_IRAM_INIT,
	[1] = {
		.name		= "generic-0",
		.usage_mask	= NVMAP_HEAP_CARVEOUT_GENERIC,
		.base		= 0,	/* Filled in by colibri_t30_panel_init() */
		.size		= 0,	/* Filled in by colibri_t30_panel_init() */
		.buddy_size	= SZ_32K,
	},
};

static struct nvmap_platform_data colibri_t30_nvmap_data = {
	.carveouts	= colibri_t30_carveouts,
	.nr_carveouts	= ARRAY_SIZE(colibri_t30_carveouts),
};

static struct platform_device colibri_t30_nvmap_device = {
	.name	= "tegra-nvmap",
	.id	= -1,
	.dev	= {
		.platform_data = &colibri_t30_nvmap_data,
	},
};
#endif /* CONFIG_TEGRA_NVMAP */

#if defined(CONFIG_ION_TEGRA)
static struct platform_device tegra_iommu_device = {
	.name = "tegra_iommu_device",
	.id = -1,
	.dev = {
		.platform_data = (void *)((1 << HWGRP_COUNT) - 1),
	},
};

static struct ion_platform_data tegra_ion_data = {
	.nr = 4,
	.heaps = {
		{
			.type = ION_HEAP_TYPE_CARVEOUT,
			.id = TEGRA_ION_HEAP_CARVEOUT,
			.name = "carveout",
			.base = 0,
			.size = 0,
		},
		{
			.type = ION_HEAP_TYPE_CARVEOUT,
			.id = TEGRA_ION_HEAP_IRAM,
			.name = "iram",
			.base = TEGRA_IRAM_BASE + TEGRA_RESET_HANDLER_SIZE,
			.size = TEGRA_IRAM_SIZE - TEGRA_RESET_HANDLER_SIZE,
		},
		{
			.type = ION_HEAP_TYPE_CARVEOUT,
			.id = TEGRA_ION_HEAP_VPR,
			.name = "vpr",
			.base = 0,
			.size = 0,
		},
		{
			.type = ION_HEAP_TYPE_IOMMU,
			.id = TEGRA_ION_HEAP_IOMMU,
			.name = "iommu",
			.base = TEGRA_SMMU_BASE,
			.size = TEGRA_SMMU_SIZE,
			.priv = &tegra_iommu_device.dev,
		},
	},
};

static struct platform_device tegra_ion_device = {
	.name = "ion-tegra",
	.id = -1,
	.dev = {
		.platform_data = &tegra_ion_data,
	},
};
#endif /* CONFIG_ION_TEGRA */

static struct platform_device *colibri_t30_gfx_devices[] __initdata = {
#if defined(CONFIG_TEGRA_NVMAP)
	&colibri_t30_nvmap_device,
#endif
#if defined(CONFIG_ION_TEGRA)
	&tegra_ion_device,
#endif
#ifndef COLIBRI_T30_VI
	&tegra_pwfm0_device,
	&colibri_t30_backlight_device,
#endif /* !COLIBRI_T30_VI */
};

#ifdef CONFIG_HAS_EARLYSUSPEND
/* put early_suspend/late_resume handlers here for the display in order
 * to keep the code out of the display driver, keeping it closer to upstream
 */
struct early_suspend colibri_t30_panel_early_suspender;

static void colibri_t30_panel_early_suspend(struct early_suspend *h)
{
	/* power down LCD, add use a black screen for HDMI */
	if (num_registered_fb > 0)
		fb_blank(registered_fb[0], FB_BLANK_POWERDOWN);
	if (num_registered_fb > 1)
		fb_blank(registered_fb[1], FB_BLANK_NORMAL);
}

static void colibri_t30_panel_late_resume(struct early_suspend *h)
{
	unsigned i;
	for (i = 0; i < num_registered_fb; i++)
		fb_blank(registered_fb[i], FB_BLANK_UNBLANK);
}
#endif /* CONFIG_HAS_EARLYSUSPEND */

int __init colibri_t30_panel_init(void)
{
	int err = 0;
	struct resource *res;
	void __iomem *to_io;

	/* enable hdmi hotplug gpio for hotplug detection */
	gpio_request(colibri_t30_hdmi_hpd, "hdmi_hpd");
	gpio_direction_input(colibri_t30_hdmi_hpd);

#ifdef CONFIG_HAS_EARLYSUSPEND
	colibri_t30_panel_early_suspender.suspend = colibri_t30_panel_early_suspend;
	colibri_t30_panel_early_suspender.resume = colibri_t30_panel_late_resume;
	colibri_t30_panel_early_suspender.level = EARLY_SUSPEND_LEVEL_DISABLE_FB;
	register_early_suspend(&colibri_t30_panel_early_suspender);
#endif /* CONFIG_HAS_EARLYSUSPEND */

#ifdef CONFIG_TEGRA_NVMAP
	colibri_t30_carveouts[1].base = tegra_carveout_start;
	colibri_t30_carveouts[1].size = tegra_carveout_size;
#endif /* CONFIG_TEGRA_NVMAP */

#ifdef CONFIG_ION_TEGRA
	tegra_ion_data.heaps[0].base = tegra_carveout_start;
	tegra_ion_data.heaps[0].size = tegra_carveout_size;
#endif /* CONFIG_ION_TEGRA */

#ifdef CONFIG_TEGRA_GRHOST
	err = tegra3_register_host1x_devices();
	if (err)
		return err;
#endif /* CONFIG_TEGRA_GRHOST */

	err = platform_add_devices(colibri_t30_gfx_devices,
				ARRAY_SIZE(colibri_t30_gfx_devices));

#if defined(CONFIG_TEGRA_GRHOST) && defined(CONFIG_TEGRA_DC)
	res = nvhost_get_resource_byname(&colibri_t30_disp1_device,
					 IORESOURCE_MEM, "fbmem");
	res->start = tegra_fb_start;
	res->end = tegra_fb_start + tegra_fb_size - 1;

	res = nvhost_get_resource_byname(&colibri_t30_disp2_device,
					 IORESOURCE_MEM, "fbmem");
	res->start = tegra_fb2_start;
	res->end = tegra_fb2_start + tegra_fb2_size - 1;
#endif /* CONFIG_TEGRA_GRHOST & CONFIG_TEGRA_DC */

	/* Make sure LVDS framebuffer is cleared. */
	to_io = ioremap(tegra_fb_start, tegra_fb_size);
	if (to_io) {
		memset(to_io, 0, tegra_fb_size);
		iounmap(to_io);
	} else pr_err("%s: Failed to map LVDS framebuffer\n", __func__);

	/* Make sure HDMI framebuffer is cleared.
	   Note: this seems to fix a tegradc.1 initialisation race in case of
	   framebuffer console as well. */
	to_io = ioremap(tegra_fb2_start, tegra_fb2_size);
	if (to_io) {
		memset(to_io, 0, tegra_fb2_size);
		iounmap(to_io);
	} else pr_err("%s: Failed to map HDMI framebuffer\n", __func__);

#if defined(CONFIG_TEGRA_GRHOST) && defined(CONFIG_TEGRA_DC)
	if (!err)
		err = nvhost_device_register(&colibri_t30_disp1_device);

	if (!err)
		err = nvhost_device_register(&colibri_t30_disp2_device);
#endif /* CONFIG_TEGRA_GRHOST & CONFIG_TEGRA_DC */

#if defined(CONFIG_TEGRA_GRHOST) && defined(CONFIG_TEGRA_NVAVP)
	if (!err)
		err = nvhost_device_register(&nvavp_device);
#endif
	return err;
}