switch to 3.12, enable support for AM33xx/OMAP3
authorImre Kaloz <kaloz@openwrt.org>
Fri, 8 Nov 2013 12:44:38 +0000 (12:44 +0000)
committerImre Kaloz <kaloz@openwrt.org>
Fri, 8 Nov 2013 12:44:38 +0000 (12:44 +0000)
Signed-off-by: Imre Kaloz <kaloz@openwrt.org>
SVN-Revision: 38692

package/kernel/linux/modules/crypto.mk
package/kernel/linux/modules/usb.mk
target/linux/omap/Makefile
target/linux/omap/base-files/etc/inittab
target/linux/omap/config-default
target/linux/omap/image/Makefile
target/linux/omap/image/boot.script
target/linux/omap/patches-3.12/001-ti_git.patch [new file with mode: 0644]

index bb5bb2854bedd60a21d5b87c507c25db02c1276d..7996d03fd39d794c291989ba8d8875b43e0b8949 100644 (file)
@@ -205,6 +205,28 @@ endef
 $(eval $(call KernelPackage,crypto-hw-ppc4xx))
 
 
+define KernelPackage/crypto-hw-omap
+  TITLE:=TI OMAP hardware crypto modules
+  DEPENDS:=@TARGET_omap4
+  KCONFIG:= \
+       CONFIG_CRYPTO_DEV_OMAP_AES \
+       CONFIG_CRYPTO_DEV_OMAP_DES \
+       CONFIG_CRYPTO_DEV_OMAP_SHAM
+  FILES:= \
+       $(LINUX_DIR)/drivers/crypto/omap-aes.ko \
+       $(LINUX_DIR)/drivers/crypto/omap-des.ko \
+       $(LINUX_DIR)/drivers/crypto/omap-sham.ko
+  AUTOLOAD:=$(call AutoLoad,90,omap-aes omap-des omap-sham)
+  $(call AddDepends/crypto,+kmod-crypto-manager +kmod-crypto-hash)
+endef
+
+define KernelPackage/crypto-hw-omap/description
+  Kernel support for the TI OMAP HW crypto engine.
+endef
+
+$(eval $(call KernelPackage,crypto-hw-omap))
+
+
 define KernelPackage/crypto-aes
   TITLE:=AES cipher CryptoAPI module
   KCONFIG:=CONFIG_CRYPTO_AES CONFIG_CRYPTO_AES_586
index bec9f6bd8feeb13d818a1de5b2dde4c2658f92fc..e1611aaa2891a60b4b6fd0cdd14c4464773cc7c4 100644 (file)
@@ -112,6 +112,7 @@ define KernelPackage/usb-ohci
        CONFIG_USB_OHCI_ATH79=y \
        CONFIG_USB_OHCI_BCM63XX=y \
        CONFIG_USB_OCTEON_OHCI=y \
+       CONFIG_USB_OHCI_HCD_OMAP3=y \
        CONFIG_USB_OHCI_HCD_PLATFORM=y
   FILES:=$(LINUX_DIR)/drivers/usb/host/ohci-hcd.ko
   AUTOLOAD:=$(call AutoLoad,50,ohci-hcd,1)
index 3a62911ca393f5957805a6f36f2a5f4f0b9e9553..78361fc3032a64c13bc10085e8f1c2023e0d34c8 100644 (file)
@@ -13,11 +13,11 @@ FEATURES:=usb targz audio display
 CPU_TYPE:=cortex-a9
 CPU_SUBTYPE:=vfpv3
 
-LINUX_VERSION:=3.3.8
+LINUX_VERSION:=3.12
 
 MAINTAINER:=Imre Kaloz <kaloz@openwrt.org>
 
-KERNELNAME:="uImage"
+KERNELNAME:="zImage dtbs"
 
 DEFAULT_PACKAGES += uboot-omap-am335x_evm uboot-omap-omap3_beagle uboot-omap-omap3_overo uboot-omap-omap4_panda
 
index cc6c31a129e8f89b87142158f63fce9a76a87414..502c6f87afaf5f6366b930765b8c7f93438b7ff2 100644 (file)
@@ -1,4 +1,5 @@
 ::sysinit:/etc/init.d/rcS S boot
 ::shutdown:/etc/init.d/rcS K shutdown
+ttyO0::askfirst:/bin/ash --login
 ttyO2::askfirst:/bin/ash --login
 tty1::askfirst:/bin/ash --login
index d51ebc47de2d7b0f22ce534522b349816cf41dbf..a0cc53eb2daab8365427c87a7f550f3d3ffbc98e 100644 (file)
@@ -1,39 +1,67 @@
 CONFIG_ALIGNMENT_TRAP=y
+CONFIG_AM335X_CONTROL_USB=y
+CONFIG_AM335X_PHY_USB=y
 # CONFIG_APM_EMULATION is not set
 CONFIG_ARCH_BINFMT_ELF_RANDOMIZE_PIE=y
+CONFIG_ARCH_HAS_ATOMIC64_DEC_IF_POSITIVE=y
+CONFIG_ARCH_HAS_BANDGAP=y
 CONFIG_ARCH_HAS_BARRIERS=y
 CONFIG_ARCH_HAS_CPUFREQ=y
-CONFIG_ARCH_HAS_CPU_IDLE_WAIT=y
 CONFIG_ARCH_HAS_HOLES_MEMORYMODEL=y
 CONFIG_ARCH_HAS_OPP=y
-CONFIG_ARCH_NR_GPIO=0
+CONFIG_ARCH_HAS_RESET_CONTROLLER=y
+CONFIG_ARCH_HAS_TICK_BROADCAST=y
+CONFIG_ARCH_HAVE_CUSTOM_GPIO_H=y
+# CONFIG_ARCH_MULTI_CPU_AUTO is not set
+CONFIG_ARCH_MULTI_V6_V7=y
+CONFIG_ARCH_MULTI_V7=y
+CONFIG_ARCH_NEEDS_CPU_IDLE_COUPLED=y
+CONFIG_ARCH_NR_GPIO=192
 CONFIG_ARCH_OMAP=y
-# CONFIG_ARCH_OMAP1 is not set
-# CONFIG_ARCH_OMAP2 is not set
 CONFIG_ARCH_OMAP2PLUS=y
 CONFIG_ARCH_OMAP2PLUS_TYPICAL=y
-# CONFIG_ARCH_OMAP3 is not set
+CONFIG_ARCH_OMAP3=y
 CONFIG_ARCH_OMAP4=y
 CONFIG_ARCH_REQUIRE_GPIOLIB=y
 # CONFIG_ARCH_SELECT_MEMORY_MODEL is not set
 # CONFIG_ARCH_SPARSEMEM_DEFAULT is not set
 CONFIG_ARCH_SUSPEND_POSSIBLE=y
-# CONFIG_ARCH_USES_GETTIMEOFFSET is not set
+CONFIG_ARCH_WANT_GENERAL_HUGETLB=y
+CONFIG_ARCH_WANT_IPC_PARSE_VERSION=y
 CONFIG_ARM=y
+# CONFIG_ARM_BIG_LITTLE_CPUFREQ is not set
 CONFIG_ARM_CPU_SUSPEND=y
 CONFIG_ARM_ERRATA_720789=y
+CONFIG_ARM_ERRATA_754322=y
+CONFIG_ARM_ERRATA_775420=y
 CONFIG_ARM_GIC=y
+# CONFIG_ARM_KIRKWOOD_CPUFREQ is not set
 CONFIG_ARM_L1_CACHE_SHIFT=6
 CONFIG_ARM_L1_CACHE_SHIFT_6=y
 # CONFIG_ARM_LPAE is not set
 CONFIG_ARM_NR_BANKS=8
+CONFIG_ARM_OMAP2PLUS_CPUFREQ=y
 CONFIG_ARM_PATCH_PHYS_VIRT=y
 CONFIG_ARM_THUMB=y
 # CONFIG_ARM_THUMBEE is not set
-# CONFIG_ATH_COMMON is not set
-# CONFIG_ATMEL_PWM is not set
+CONFIG_ARM_VIRT_EXT=y
+CONFIG_AT803X_PHY=y
+# CONFIG_ATH_CARDS is not set
+CONFIG_AUTO_ZRELADDR=y
 CONFIG_AVERAGE=y
-CONFIG_BCMA_POSSIBLE=y
+# CONFIG_BACKLIGHT_ADP8860 is not set
+# CONFIG_BACKLIGHT_ADP8870 is not set
+# CONFIG_BACKLIGHT_BD6107 is not set
+CONFIG_BACKLIGHT_CLASS_DEVICE=y
+# CONFIG_BACKLIGHT_GENERIC is not set
+# CONFIG_BACKLIGHT_GPIO is not set
+CONFIG_BACKLIGHT_LCD_SUPPORT=y
+# CONFIG_BACKLIGHT_LV5207LP is not set
+# CONFIG_BACKLIGHT_PANDORA is not set
+CONFIG_BACKLIGHT_PWM=y
+# CONFIG_BACKLIGHT_TPS65217 is not set
+CONFIG_BCH=y
+CONFIG_BCH_CONST_M=13
 CONFIG_BOUNCE=y
 CONFIG_CACHE_L2X0=y
 CONFIG_CACHE_PL310=y
@@ -46,6 +74,11 @@ CONFIG_CFG80211_DEFAULT_PS=y
 CONFIG_CFG80211_WEXT=y
 CONFIG_CLKDEV_LOOKUP=y
 CONFIG_CLKSRC_MMIO=y
+CONFIG_CLKSRC_OF=y
+# CONFIG_CLK_TWL6040 is not set
+CONFIG_CLONE_BACKWARDS=y
+CONFIG_CMDLINE="console=ttyO0,115200n8"
+CONFIG_COMMON_CLK=y
 CONFIG_CONSOLE_TRANSLATIONS=y
 CONFIG_CPU_32v6K=y
 CONFIG_CPU_32v7=y
@@ -56,110 +89,196 @@ CONFIG_CPU_CACHE_VIPT=y
 CONFIG_CPU_COPY_V6=y
 CONFIG_CPU_CP15=y
 CONFIG_CPU_CP15_MMU=y
+CONFIG_CPU_FREQ=y
+# CONFIG_CPU_FREQ_DEFAULT_GOV_CONSERVATIVE is not set
+CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y
+# CONFIG_CPU_FREQ_DEFAULT_GOV_PERFORMANCE is not set
+# CONFIG_CPU_FREQ_DEFAULT_GOV_POWERSAVE is not set
+# CONFIG_CPU_FREQ_DEFAULT_GOV_USERSPACE is not set
+CONFIG_CPU_FREQ_GOV_COMMON=y
+# CONFIG_CPU_FREQ_GOV_CONSERVATIVE is not set
+CONFIG_CPU_FREQ_GOV_ONDEMAND=y
+CONFIG_CPU_FREQ_GOV_PERFORMANCE=y
+# CONFIG_CPU_FREQ_GOV_POWERSAVE is not set
+# CONFIG_CPU_FREQ_GOV_USERSPACE is not set
+CONFIG_CPU_FREQ_STAT=y
+# CONFIG_CPU_FREQ_STAT_DETAILS is not set
+CONFIG_CPU_FREQ_TABLE=y
 CONFIG_CPU_HAS_ASID=y
-CONFIG_CPU_HAS_PMU=y
 # CONFIG_CPU_ICACHE_DISABLE is not set
+CONFIG_CPU_IDLE=y
+CONFIG_CPU_IDLE_GOV_LADDER=y
+CONFIG_CPU_IDLE_GOV_MENU=y
 CONFIG_CPU_PABRT_V7=y
+CONFIG_CPU_PM=y
 CONFIG_CPU_RMAP=y
 CONFIG_CPU_TLB_V7=y
 CONFIG_CPU_V7=y
 CONFIG_CRC16=y
-CONFIG_CRYPTO_AES=m
-CONFIG_CRYPTO_ALGAPI=m
-CONFIG_CRYPTO_ALGAPI2=m
+# CONFIG_CROSSBAR is not set
 CONFIG_CRYPTO_ARC4=m
-# CONFIG_DEBUG_HIGHMEM is not set
+CONFIG_CRYPTO_BLKCIPHER=m
+CONFIG_CRYPTO_BLKCIPHER2=m
+CONFIG_CRYPTO_CRC32C=y
+CONFIG_CRYPTO_HASH=y
+CONFIG_CRYPTO_HASH2=y
+CONFIG_CRYPTO_RNG2=m
+CONFIG_CRYPTO_WORKQUEUE=m
+CONFIG_DCACHE_WORD_ACCESS=y
+CONFIG_DDR=y
+CONFIG_DEBUG_LL_INCLUDE="mach/debug-macro.S"
+# CONFIG_DEBUG_UART_8250 is not set
+# CONFIG_DEBUG_UART_PL01X is not set
 # CONFIG_DEBUG_USER is not set
-CONFIG_DECOMPRESS_LZMA=y
+# CONFIG_DISPLAY_DRA_EVM_ENCODER_TPD12S015 is not set
+# CONFIG_DISPLAY_ENCODER_SIL9022 is not set
+CONFIG_DISPLAY_PANEL_DPI=y
+CONFIG_DISPLAY_PANEL_DSI_CM=y
+# CONFIG_DISPLAY_PANEL_NEC_NL8048HL11 is not set
+CONFIG_DISPLAY_PANEL_SHARP_LS037V7DW01=y
+# CONFIG_DISPLAY_PANEL_SONY_ACX565AKM is not set
+# CONFIG_DISPLAY_PANEL_TFCS9700 is not set
+CONFIG_DMADEVICES=y
+CONFIG_DMA_ENGINE=y
+CONFIG_DMA_OF=y
+CONFIG_DMA_OMAP=y
+CONFIG_DMA_VIRTUAL_CHANNELS=y
+CONFIG_DTC=y
 CONFIG_DUMMY_CONSOLE=y
-# CONFIG_DW_WATCHDOG is not set
+# CONFIG_DW_DMAC_CORE is not set
+CONFIG_EEPROM_AT24=y
 CONFIG_EXT4_FS=y
 CONFIG_FB=y
 CONFIG_FB_CFB_COPYAREA=y
 CONFIG_FB_CFB_FILLRECT=y
 CONFIG_FB_CFB_IMAGEBLIT=y
+CONFIG_FB_CFB_REV_PIXELS_IN_BYTE=y
+CONFIG_FB_DA8XX=y
+# CONFIG_FB_DA8XX_TDA998X is not set
 CONFIG_FB_MODE_HELPERS=y
 CONFIG_FB_OMAP2=y
 CONFIG_FB_OMAP2_DEBUG_SUPPORT=y
 CONFIG_FB_OMAP2_NUM_FBS=3
-# CONFIG_FB_OMAP_BOOTLOADER_INIT is not set
-# CONFIG_FB_SM7XX is not set
-CONFIG_FB_TILEBLITTING=y
-# CONFIG_FB_WMT_GE_ROPS is not set
 CONFIG_FIRMWARE_EDID=y
 # CONFIG_FONTS is not set
 CONFIG_FONT_8x16=y
 CONFIG_FONT_8x8=y
+CONFIG_FONT_SUPPORT=y
+CONFIG_FORCE_MAX_ZONEORDER=12
 CONFIG_FRAMEBUFFER_CONSOLE=y
 CONFIG_FRAMEBUFFER_CONSOLE_DETECT_PRIMARY=y
 # CONFIG_FRAMEBUFFER_CONSOLE_ROTATION is not set
 CONFIG_FRAME_POINTER=y
+CONFIG_FREEZER=y
 CONFIG_FS_MBCACHE=y
 CONFIG_GENERIC_BUG=y
 CONFIG_GENERIC_CLOCKEVENTS=y
 CONFIG_GENERIC_CLOCKEVENTS_BROADCAST=y
 CONFIG_GENERIC_CLOCKEVENTS_BUILD=y
-CONFIG_GENERIC_GPIO=y
+# CONFIG_GENERIC_CPUFREQ_CPU0 is not set
+CONFIG_GENERIC_IDLE_POLL_SETUP=y
+CONFIG_GENERIC_IO=y
 CONFIG_GENERIC_IRQ_CHIP=y
 CONFIG_GENERIC_IRQ_SHOW=y
+CONFIG_GENERIC_NET_UTILS=y
 CONFIG_GENERIC_PCI_IOMAP=y
+CONFIG_GENERIC_PHY=y
+CONFIG_GENERIC_PINCONF=y
+CONFIG_GENERIC_SCHED_CLOCK=y
+CONFIG_GENERIC_SMP_IDLE_THREAD=y
+CONFIG_GENERIC_STRNCPY_FROM_USER=y
+CONFIG_GENERIC_STRNLEN_USER=y
 CONFIG_GPIOLIB=y
+CONFIG_GPIO_DEVRES=y
+CONFIG_GPIO_TPS65910=y
 CONFIG_GPIO_TWL4030=y
+# CONFIG_GPIO_TWL6040 is not set
 CONFIG_HARDIRQS_SW_RESEND=y
 CONFIG_HAS_DMA=y
 CONFIG_HAS_IOMEM=y
 CONFIG_HAS_IOPORT=y
-CONFIG_HAVE_AOUT=y
+# CONFIG_HAVE_64BIT_ALIGNED_ACCESS is not set
+CONFIG_HAVE_ARCH_JUMP_LABEL=y
 CONFIG_HAVE_ARCH_KGDB=y
 CONFIG_HAVE_ARCH_PFN_VALID=y
+CONFIG_HAVE_ARCH_SECCOMP_FILTER=y
+CONFIG_HAVE_ARCH_TRACEHOOK=y
 CONFIG_HAVE_ARM_SCU=y
 CONFIG_HAVE_ARM_TWD=y
+# CONFIG_HAVE_BOOTMEM_INFO_NODE is not set
+CONFIG_HAVE_BPF_JIT=y
 CONFIG_HAVE_CLK=y
+CONFIG_HAVE_CLK_PREPARE=y
+CONFIG_HAVE_CONTEXT_TRACKING=y
 CONFIG_HAVE_C_RECORDMCOUNT=y
+CONFIG_HAVE_DEBUG_KMEMLEAK=y
 CONFIG_HAVE_DMA_API_DEBUG=y
+CONFIG_HAVE_DMA_ATTRS=y
+CONFIG_HAVE_DMA_CONTIGUOUS=y
 CONFIG_HAVE_DYNAMIC_FTRACE=y
 CONFIG_HAVE_FTRACE_MCOUNT_RECORD=y
 CONFIG_HAVE_FUNCTION_GRAPH_TRACER=y
 CONFIG_HAVE_FUNCTION_TRACER=y
 CONFIG_HAVE_GENERIC_DMA_COHERENT=y
-CONFIG_HAVE_GENERIC_HARDIRQS=y
-CONFIG_HAVE_IRQ_WORK=y
+CONFIG_HAVE_IRQ_TIME_ACCOUNTING=y
 CONFIG_HAVE_KERNEL_GZIP=y
+CONFIG_HAVE_KERNEL_LZ4=y
 CONFIG_HAVE_KERNEL_LZMA=y
 CONFIG_HAVE_KERNEL_LZO=y
 CONFIG_HAVE_KERNEL_XZ=y
 CONFIG_HAVE_MEMBLOCK=y
+CONFIG_HAVE_NET_DSA=y
 CONFIG_HAVE_OPROFILE=y
 CONFIG_HAVE_PERF_EVENTS=y
 CONFIG_HAVE_PROC_CPU=y
 CONFIG_HAVE_REGS_AND_STACK_ACCESS_API=y
-CONFIG_HAVE_SCHED_CLOCK=y
 CONFIG_HAVE_SMP=y
-CONFIG_HAVE_SPARSE_IRQ=y
+CONFIG_HAVE_SYSCALL_TRACEPOINTS=y
+CONFIG_HAVE_UID16=y
 CONFIG_HIGHMEM=y
 # CONFIG_HIGHPTE is not set
+CONFIG_HOTPLUG_CPU=y
+CONFIG_HWMON=y
 CONFIG_HW_CONSOLE=y
-CONFIG_HZ=128
+CONFIG_HZ_FIXED=0
 CONFIG_I2C=y
 CONFIG_I2C_BOARDINFO=y
+CONFIG_I2C_CHARDEV=y
+CONFIG_I2C_HELPER_AUTO=y
 CONFIG_I2C_OMAP=y
 CONFIG_INITRAMFS_SOURCE=""
 CONFIG_INPUT=y
 CONFIG_INPUT_KEYBOARD=y
+CONFIG_INPUT_MATRIXKMAP=y
+CONFIG_INPUT_TOUCHSCREEN=y
 CONFIG_INPUT_TWL4030_PWRBUTTON=y
 # CONFIG_INPUT_TWL4030_VIBRA is not set
 # CONFIG_INPUT_TWL6040_VIBRA is not set
+CONFIG_IRQCHIP=y
 CONFIG_IRQ_DOMAIN=y
-# CONFIG_IWM is not set
+CONFIG_IRQ_FORCED_THREADING=y
+CONFIG_IRQ_WORK=y
 CONFIG_JBD2=y
 # CONFIG_KEYBOARD_GPIO is not set
-# CONFIG_KEYBOARD_OMAP4 is not set
 CONFIG_KEYBOARD_TWL4030=y
 CONFIG_KTIME_SCALAR=y
-# CONFIG_LEDS is not set
+# CONFIG_LCD_AMS369FG06 is not set
+CONFIG_LCD_CLASS_DEVICE=y
+# CONFIG_LCD_L4F00242T03 is not set
+# CONFIG_LCD_LD9040 is not set
+# CONFIG_LCD_LMS283GF05 is not set
+# CONFIG_LCD_LTV350QV is not set
+# CONFIG_LCD_PLATFORM is not set
+# CONFIG_LCD_S6E63M0 is not set
+# CONFIG_LCD_TDO24M is not set
+# CONFIG_LCD_VGG2432A4 is not set
 CONFIG_LEDS_GPIO=y
+# CONFIG_LEDS_PWM is not set
 # CONFIG_LEDS_REGULATOR is not set
-CONFIG_LOCAL_TIMERS=y
+CONFIG_LOGO=y
+CONFIG_LOGO_LINUX_CLUT224=y
+CONFIG_LOGO_LINUX_MONO=y
+CONFIG_LOGO_LINUX_VGA16=y
 CONFIG_LZO_COMPRESS=y
 CONFIG_LZO_DECOMPRESS=y
 CONFIG_MAC80211=m
@@ -174,191 +293,307 @@ CONFIG_MAC80211_RC_DEFAULT_MINSTREL=y
 CONFIG_MAC80211_RC_MINSTREL=y
 CONFIG_MAC80211_RC_MINSTREL_HT=y
 # CONFIG_MAC80211_RC_PID is not set
-CONFIG_MACH_OMAP4_PANDA=y
-# CONFIG_MACH_OMAP_4430SDP is not set
-# CONFIG_MACH_OMAP_GENERIC is not set
+# CONFIG_MACH_CM_T35 is not set
+# CONFIG_MACH_CM_T3517 is not set
+# CONFIG_MACH_CRANEBOARD is not set
+# CONFIG_MACH_DEVKIT8000 is not set
+# CONFIG_MACH_IGEP0020 is not set
+# CONFIG_MACH_IGEP0030 is not set
+# CONFIG_MACH_NOKIA_RM680 is not set
+# CONFIG_MACH_NOKIA_RX51 is not set
+# CONFIG_MACH_OMAP3517EVM is not set
+# CONFIG_MACH_OMAP3530_LV_SOM is not set
+# CONFIG_MACH_OMAP3EVM is not set
+CONFIG_MACH_OMAP3_BEAGLE=y
+# CONFIG_MACH_OMAP3_PANDORA is not set
+# CONFIG_MACH_OMAP3_TORPEDO is not set
+# CONFIG_MACH_OMAP_3430SDP is not set
+# CONFIG_MACH_OMAP_3630SDP is not set
+CONFIG_MACH_OMAP_GENERIC=y
+# CONFIG_MACH_OMAP_LDP is not set
+# CONFIG_MACH_OMAP_ZOOM2 is not set
+# CONFIG_MACH_OMAP_ZOOM3 is not set
+CONFIG_MACH_OVERO=y
+# CONFIG_MACH_SBC3530 is not set
+# CONFIG_MACH_TOUCHBOOK is not set
+CONFIG_MAILBOX=y
 CONFIG_MDIO_BOARDINFO=y
+CONFIG_MEMORY=y
+CONFIG_MFD_CORE=y
 CONFIG_MFD_OMAP_USB_HOST=y
-# CONFIG_MFD_T7L66XB is not set
-# CONFIG_MFD_TWL4030_AUDIO is not set
+CONFIG_MFD_TI_AM335X_TSCADC=y
+CONFIG_MFD_TPS65217=y
+# CONFIG_MFD_TPS65218 is not set
+CONFIG_MFD_TPS65910=y
+CONFIG_MFD_TWL4030_AUDIO=y
+CONFIG_MIGHT_HAVE_CACHE_L2X0=y
 CONFIG_MMC=y
 CONFIG_MMC_BLOCK=y
-CONFIG_MMC_OMAP=y
+# CONFIG_MMC_OMAP is not set
 CONFIG_MMC_OMAP_HS=y
 CONFIG_MMC_UNSAFE_RESUME=y
-# CONFIG_MPCORE_WATCHDOG is not set
+CONFIG_MODULES_USE_ELF_REL=y
 # CONFIG_MTD_CFI_INTELEXT is not set
 CONFIG_MTD_CMDLINE_PARTS=y
 # CONFIG_MTD_COMPLEX_MAPPINGS is not set
 CONFIG_MTD_DATAFLASH=y
 # CONFIG_MTD_DATAFLASH_OTP is not set
 # CONFIG_MTD_DATAFLASH_WRITE_VERIFY is not set
+CONFIG_MTD_NAND=y
+CONFIG_MTD_NAND_BCH=y
+CONFIG_MTD_NAND_ECC=y
+CONFIG_MTD_NAND_ECC_BCH=y
+CONFIG_MTD_NAND_OMAP2=y
+CONFIG_MTD_NAND_OMAP_BCH=y
 CONFIG_MTD_PHYSMAP=y
+# CONFIG_MTD_PHYSMAP_OF is not set
+# CONFIG_MTD_SM_COMMON is not set
 CONFIG_MULTI_IRQ_HANDLER=y
 CONFIG_MUTEX_SPIN_ON_OWNER=y
 # CONFIG_MWIFIEX is not set
 CONFIG_NEED_DMA_MAP_STATE=y
 CONFIG_NEON=y
+# CONFIG_NET_DMA is not set
+CONFIG_NET_FLOW_LIMIT=y
+CONFIG_NET_RX_BUSY_POLL=y
 # CONFIG_NET_VENDOR_I825XX is not set
 # CONFIG_NL80211_TESTMODE is not set
 CONFIG_NLS=y
+CONFIG_NOP_USB_XCEIV=y
 CONFIG_NO_HZ=y
-CONFIG_NR_CPUS=2
+CONFIG_NO_HZ_COMMON=y
+CONFIG_NO_HZ_IDLE=y
+CONFIG_NR_CPUS=4
+CONFIG_OF=y
+CONFIG_OF_ADDRESS=y
+CONFIG_OF_EARLY_FLATTREE=y
+CONFIG_OF_FLATTREE=y
+CONFIG_OF_GPIO=y
+CONFIG_OF_IRQ=y
+CONFIG_OF_MDIO=y
+CONFIG_OF_MTD=y
+CONFIG_OF_NET=y
+CONFIG_OLD_SIGACTION=y
+CONFIG_OLD_SIGSUSPEND3=y
+CONFIG_OMAP2PLUS_MBOX=y
 CONFIG_OMAP2_DSS=y
-# CONFIG_OMAP2_DSS_COLLECT_IRQ_STATS is not set
-CONFIG_OMAP2_DSS_DEBUG_SUPPORT=y
 CONFIG_OMAP2_DSS_DPI=y
+CONFIG_OMAP2_DSS_DRA7XX_DPI=y
 CONFIG_OMAP2_DSS_DSI=y
-# CONFIG_OMAP2_DSS_FAKE_VSYNC is not set
 CONFIG_OMAP2_DSS_MIN_FCK_PER_PCK=0
-# CONFIG_OMAP2_DSS_RFBI is not set
+CONFIG_OMAP2_DSS_SDI=y
 CONFIG_OMAP2_DSS_SLEEP_AFTER_VENC_RESET=y
 # CONFIG_OMAP2_DSS_VENC is not set
-CONFIG_OMAP2_VRAM=y
-CONFIG_OMAP2_VRAM_SIZE=32
+CONFIG_OMAP2_VRFB=y
+# CONFIG_OMAP3_EMU is not set
+# CONFIG_OMAP3_L2_AUX_SECURE_SAVE_RESTORE is not set
+# CONFIG_OMAP3_SDRC_AC_TIMING is not set
 CONFIG_OMAP4_DSS_HDMI=y
+CONFIG_OMAP4_DSS_HDMI_AUDIO=y
 CONFIG_OMAP4_ERRATA_I688=y
+CONFIG_OMAP5_DSS_HDMI=y
 CONFIG_OMAP_32K_TIMER=y
-CONFIG_OMAP_32K_TIMER_HZ=128
+CONFIG_OMAP_CONTROL_PHY=y
 CONFIG_OMAP_DM_TIMER=y
-# CONFIG_OMAP_MBOX_FWK is not set
-CONFIG_OMAP_MCBSP=y
+CONFIG_OMAP_INTERCONNECT=y
+CONFIG_OMAP_MBOX=y
+CONFIG_OMAP_MBOX_KFIFO_SIZE=256
 CONFIG_OMAP_MUX=y
 # CONFIG_OMAP_MUX_DEBUG is not set
 CONFIG_OMAP_MUX_WARNINGS=y
-CONFIG_OMAP_PACKAGE_CBL=y
-CONFIG_OMAP_PACKAGE_CBS=y
+CONFIG_OMAP_OCP2SCP=y
+CONFIG_OMAP_PACKAGE_CBB=y
+# CONFIG_OMAP_PIPE3 is not set
 CONFIG_OMAP_PM_NOOP=y
 CONFIG_OMAP_RESET_CLOCKS=y
-# CONFIG_OMAP_SMARTREFLEX is not set
-# CONFIG_OMAP_WATCHDOG is not set
+CONFIG_OMAP_USB2=y
+CONFIG_OMAP_WATCHDOG=y
 CONFIG_OUTER_CACHE=y
 CONFIG_OUTER_CACHE_SYNC=y
 CONFIG_PAGEFLAGS_EXTENDED=y
 CONFIG_PAGE_OFFSET=0xC0000000
-CONFIG_PANEL_DVI=y
-CONFIG_PANEL_GENERIC_DPI=y
-# CONFIG_PANEL_LGPHILIPS_LB035Q02 is not set
-# CONFIG_PANEL_PICODLP is not set
-# CONFIG_PANEL_TPO_TD043MTEA1 is not set
 # CONFIG_PCI_SYSCALL is not set
 CONFIG_PERF_USE_VMALLOC=y
 CONFIG_PHYLIB=y
+CONFIG_PINCTRL=y
 CONFIG_PL310_ERRATA_588369=y
 CONFIG_PL310_ERRATA_727915=y
 # CONFIG_PL310_ERRATA_753970 is not set
-CONFIG_PL310_ERRATA_769419=y
+# CONFIG_PL310_ERRATA_769419 is not set
 CONFIG_PM=y
 CONFIG_PM_CLK=y
 # CONFIG_PM_DEBUG is not set
 CONFIG_PM_OPP=y
 CONFIG_PM_RUNTIME=y
+CONFIG_PM_SLEEP=y
+CONFIG_PM_SLEEP_SMP=y
+CONFIG_POWER_AVS=y
+# CONFIG_POWER_AVS_OMAP is not set
+CONFIG_PPS=y
 # CONFIG_PREEMPT_RCU is not set
+CONFIG_PROC_DEVICETREE=y
+CONFIG_PTP_1588_CLOCK=y
+CONFIG_PWM=y
+# CONFIG_PWM_PCA9685 is not set
+CONFIG_PWM_SYSFS=y
+CONFIG_PWM_TIECAP=y
+CONFIG_PWM_TIEHRPWM=y
+CONFIG_PWM_TIPWMSS=y
+# CONFIG_PWM_TWL is not set
+# CONFIG_PWM_TWL_LED is not set
+CONFIG_RCU_STALL_COMMON=y
 CONFIG_REGMAP=y
 CONFIG_REGMAP_I2C=y
+CONFIG_REGMAP_IRQ=y
+CONFIG_REGMAP_MMIO=y
+CONFIG_REGMAP_SPI=y
 CONFIG_REGULATOR=y
-# CONFIG_REGULATOR_AD5398 is not set
 # CONFIG_REGULATOR_DEBUG is not set
-# CONFIG_REGULATOR_DUMMY is not set
+CONFIG_REGULATOR_DUMMY=y
 CONFIG_REGULATOR_FIXED_VOLTAGE=y
-# CONFIG_REGULATOR_ISL6271A is not set
-# CONFIG_REGULATOR_LP3971 is not set
-# CONFIG_REGULATOR_LP3972 is not set
-# CONFIG_REGULATOR_MAX1586 is not set
-# CONFIG_REGULATOR_MAX8649 is not set
-# CONFIG_REGULATOR_MAX8660 is not set
-# CONFIG_REGULATOR_MAX8952 is not set
+CONFIG_REGULATOR_GPIO=y
+CONFIG_REGULATOR_TIAVSCLASS0=y
 CONFIG_REGULATOR_TPS65023=y
 CONFIG_REGULATOR_TPS6507X=y
-# CONFIG_REGULATOR_TPS6524X is not set
+CONFIG_REGULATOR_TPS65217=y
+CONFIG_REGULATOR_TPS65910=y
 CONFIG_REGULATOR_TWL4030=y
 # CONFIG_REGULATOR_USERSPACE_CONSUMER is not set
+CONFIG_RESET_CONTROLLER=y
+CONFIG_RESET_TI=y
 # CONFIG_RFKILL_REGULATOR is not set
 CONFIG_RFS_ACCEL=y
 CONFIG_RPS=y
 CONFIG_RTC_CLASS=y
-# CONFIG_RTC_DRV_PT7C4338 is not set
+CONFIG_RTC_DRV_OMAP=y
+CONFIG_RTC_DRV_TPS65910=y
 CONFIG_RTC_DRV_TWL4030=y
-# CONFIG_RTL8192CU is not set
+CONFIG_SCHED_HRTICK=y
 # CONFIG_SCSI_DMA is not set
-# CONFIG_SERIAL_8250 is not set
+# CONFIG_SENSORS_G762 is not set
+# CONFIG_SENSORS_HTU21 is not set
+CONFIG_SENSORS_LM75=y
+CONFIG_SERIAL_8250_EXTENDED=y
+CONFIG_SERIAL_8250_SHARE_IRQ=y
+CONFIG_SERIAL_OF_PLATFORM=y
 CONFIG_SERIAL_OMAP=y
 CONFIG_SERIAL_OMAP_CONSOLE=y
 CONFIG_SMP=y
 CONFIG_SMP_ON_UP=y
+CONFIG_SMSC911X=y
+# CONFIG_SMSC911X_ARCH_HOOKS is not set
+CONFIG_SND=y
+CONFIG_SND_AM33XX_SOC_EVM=y
+CONFIG_SND_ARM=y
+CONFIG_SND_COMPRESS_OFFLOAD=y
+CONFIG_SND_DAVINCI_SOC=y
+CONFIG_SND_DAVINCI_SOC_MCASP=y
+CONFIG_SND_DMAENGINE_PCM=y
+# CONFIG_SND_EMU10K1_SEQ is not set
+CONFIG_SND_JACK=y
+CONFIG_SND_OMAP_SOC=y
+CONFIG_SND_OMAP_SOC_DMIC=y
+CONFIG_SND_OMAP_SOC_HDMI=y
+CONFIG_SND_OMAP_SOC_MCBSP=y
+CONFIG_SND_OMAP_SOC_MCPDM=y
+CONFIG_SND_OMAP_SOC_OMAP_ABE_TWL6040=y
+CONFIG_SND_OMAP_SOC_OMAP_HDMI=y
+CONFIG_SND_OMAP_SOC_OMAP_TWL4030=y
+# CONFIG_SND_OPL3_LIB_SEQ is not set
+# CONFIG_SND_OPL4_LIB_SEQ is not set
+CONFIG_SND_PCM=y
+CONFIG_SND_PCM_OSS=y
+# CONFIG_SND_RAWMIDI_SEQ is not set
+# CONFIG_SND_SBAWE_SEQ is not set
+CONFIG_SND_SOC=y
+CONFIG_SND_SOC_DMIC=y
+CONFIG_SND_SOC_HDMI_CODEC=y
+CONFIG_SND_SOC_I2C_AND_SPI=y
+CONFIG_SND_SOC_TLV320AIC3X=y
+CONFIG_SND_SOC_TWL4030=y
+CONFIG_SND_SOC_TWL6040=y
+CONFIG_SND_TIMER=y
+# CONFIG_SND_USB_HIFACE is not set
+CONFIG_SOC_AM33XX=y
+CONFIG_SOC_AM43XX=y
+CONFIG_SOC_BUS=y
+CONFIG_SOC_HAS_OMAP2_SDRC=y
+# CONFIG_SOC_OMAP3430 is not set
+# CONFIG_SOC_TI81XX is not set
+CONFIG_SOUND=y
+CONFIG_SOUND_OSS_CORE=y
+CONFIG_SOUND_OSS_CORE_PRECLAIM=y
+CONFIG_SPARSE_IRQ=y
 CONFIG_SPI=y
 CONFIG_SPI_MASTER=y
 # CONFIG_SPI_OMAP24XX is not set
 CONFIG_STOP_MACHINE=y
+CONFIG_SUSPEND=y
+CONFIG_SUSPEND_FREEZER=y
 CONFIG_SWP_EMULATE=y
 CONFIG_SYS_SUPPORTS_APM_EMULATION=y
 # CONFIG_THUMB2_KERNEL is not set
+CONFIG_TICK_CPU_ACCOUNTING=y
+# CONFIG_TIDSPBRIDGE is not set
+CONFIG_TI_CPPI41=y
+CONFIG_TI_CPSW=y
+CONFIG_TI_CPSW_PHY_SEL=y
+CONFIG_TI_CPTS=y
+CONFIG_TI_DAVINCI_CPDMA=y
+# CONFIG_TI_DAVINCI_EMAC is not set
+CONFIG_TI_DAVINCI_MDIO=y
+CONFIG_TI_EDMA=y
+CONFIG_TI_EMIF=y
+CONFIG_TI_PRIV_EDMA=y
+# CONFIG_TOUCHSCREEN_ATMEL_MXT is not set
+# CONFIG_TOUCHSCREEN_AUO_PIXCIR is not set
+# CONFIG_TOUCHSCREEN_BU21013 is not set
+# CONFIG_TOUCHSCREEN_CYTTSP4_CORE is not set
+# CONFIG_TOUCHSCREEN_DYNAPRO is not set
+# CONFIG_TOUCHSCREEN_EGALAX is not set
+# CONFIG_TOUCHSCREEN_HAMPSHIRE is not set
+# CONFIG_TOUCHSCREEN_MAX11801 is not set
+# CONFIG_TOUCHSCREEN_PIXCIR is not set
+# CONFIG_TOUCHSCREEN_ST1232 is not set
+CONFIG_TOUCHSCREEN_TI_AM335X_TSC=y
+# CONFIG_TOUCHSCREEN_TSC2005 is not set
+# CONFIG_TOUCHSCREEN_TSC_SERIO is not set
 CONFIG_TREE_RCU=y
 CONFIG_TWL4030_CORE=y
 # CONFIG_TWL4030_MADC is not set
 CONFIG_TWL4030_POWER=y
-CONFIG_TWL4030_USB=y
 CONFIG_TWL4030_WATCHDOG=y
-# CONFIG_TWL6030_PWM is not set
-CONFIG_TWL6030_USB=y
-# CONFIG_TWL6040_CORE is not set
+CONFIG_TWL6040_CORE=y
 CONFIG_UID16=y
+CONFIG_UNCOMPRESS_INCLUDE="debug/uncompress.h"
 CONFIG_USB=y
-# CONFIG_USB_ARCH_HAS_XHCI is not set
-# CONFIG_USB_CDC_COMPOSITE is not set
+CONFIG_USB_ANNOUNCE_NEW_DEVICES=y
 CONFIG_USB_COMMON=y
-# CONFIG_USB_DUMMY_HCD is not set
-CONFIG_USB_EHCI_HCD=y
-CONFIG_USB_EHCI_HCD_OMAP=y
+CONFIG_USB_EHCI_HCD=m
+CONFIG_USB_EHCI_HCD_OMAP=m
 # CONFIG_USB_EHCI_HCD_PLATFORM is not set
-CONFIG_USB_EHCI_TT_NEWSCHED=y
-# CONFIG_USB_ETH is not set
-# CONFIG_USB_FILE_STORAGE is not set
-# CONFIG_USB_FUNCTIONFS is not set
-# CONFIG_USB_FUSB300 is not set
-CONFIG_USB_GADGET=y
-# CONFIG_USB_GADGETFS is not set
-# CONFIG_USB_GADGET_DEBUG_FILES is not set
-# CONFIG_USB_GADGET_DEBUG_FS is not set
-CONFIG_USB_GADGET_VBUS_DRAW=2
-# CONFIG_USB_G_DBGP is not set
-# CONFIG_USB_G_HID is not set
-# CONFIG_USB_G_NCM is not set
-# CONFIG_USB_G_PRINTER is not set
-# CONFIG_USB_G_SERIAL is not set
-# CONFIG_USB_M66592 is not set
-# CONFIG_USB_MV_UDC is not set
-# CONFIG_USB_NET2272 is not set
 CONFIG_USB_NET_SMSC95XX=y
-# CONFIG_USB_OHCI_BIG_ENDIAN_DESC is not set
-# CONFIG_USB_OHCI_BIG_ENDIAN_MMIO is not set
-CONFIG_USB_OHCI_HCD=y
-CONFIG_USB_OHCI_HCD_OMAP3=y
-# CONFIG_USB_OHCI_HCD_PLATFORM is not set
-CONFIG_USB_OMAP=y
-CONFIG_USB_OTG_UTILS=y
-# CONFIG_USB_R8A66597 is not set
+CONFIG_USB_OTG=y
+CONFIG_USB_PHY=y
 CONFIG_USB_SUPPORT=y
 CONFIG_USB_USBNET=y
-# CONFIG_USB_ZERO is not set
 CONFIG_USE_GENERIC_SMP_HELPERS=y
+CONFIG_USE_OF=y
 CONFIG_VECTORS_BASE=0xffff0000
 CONFIG_VFP=y
 CONFIG_VFPv3=y
+CONFIG_VIDEOMODE_HELPERS=y
 CONFIG_VT=y
 CONFIG_VT_CONSOLE=y
-# CONFIG_VT_HW_CONSOLE_BINDING is not set
+CONFIG_VT_CONSOLE_SLEEP=y
+CONFIG_VT_HW_CONSOLE_BINDING=y
 # CONFIG_W35UND is not set
-# CONFIG_WL1251 is not set
-CONFIG_WL12XX=m
-CONFIG_WL12XX_MENU=m
-CONFIG_WL12XX_PLATFORM_DATA=y
-CONFIG_WL12XX_SDIO=m
-# CONFIG_WL12XX_SPI is not set
+CONFIG_WATCHDOG_CORE=y
+# CONFIG_XEN is not set
 CONFIG_XPS=y
-CONFIG_XZ_DEC=y
 CONFIG_XZ_DEC_ARM=y
 CONFIG_XZ_DEC_BCJ=y
 CONFIG_ZBOOT_ROM_BSS=0
 CONFIG_ZBOOT_ROM_TEXT=0
+# CONFIG_ZBUD is not set
 CONFIG_ZONE_DMA_FLAG=0
index e118122bd49ea40e49c5d717c0e305171d713d04..afd8398e2f142e65468461414a9003d892a7e233 100644 (file)
@@ -1,5 +1,5 @@
 #
-# Copyright (C) 2012 OpenWrt.org
+# Copyright (C) 2012-2013 OpenWrt.org
 #
 # This is free software, licensed under the GNU General Public License v2.
 # See /LICENSE for more information.
@@ -9,7 +9,11 @@ include $(INCLUDE_DIR)/image.mk
 
 define Image/BuildKernel
        mkimage -A arm -O linux -T script -C none -a 0 -e 0 -n 'Boot Image' -d boot.script $(BIN_DIR)/boot.scr
-       cp $(KDIR)/uImage $(BIN_DIR)/openwrt-$(BOARD)-uImage
+       cp $(KDIR)/zImage $(BIN_DIR)/openwrt-$(BOARD)-zImage
+       -mkdir $(BIN_DIR)/dtbs
+       $(CP) $(LINUX_DIR)/arch/arm/boot/dts/am335x*.dtb $(BIN_DIR)/dtbs/
+       $(CP) $(LINUX_DIR)/arch/arm/boot/dts/omap3*.dtb $(BIN_DIR)/dtbs/
+       $(CP) $(LINUX_DIR)/arch/arm/boot/dts/omap4*.dtb $(BIN_DIR)/dtbs/
 endef
 
 define Image/Build
index d884a70195b840617d1d383deaa2382d2ef9bc3e..ecdacfc60a4b97ea031564d63e916c5311f5521b 100644 (file)
@@ -1,3 +1,3 @@
-fatload mmc 0:1 0x80000000 openwrt-omap-uImage
+fatload mmc 0:1 0x80000000 openwrt-omap-zImage
 setenv bootargs vram=32M fixrtc mem=1G@0x80000000 root=/dev/mmcblk0p2 rootfstype=ext4 console=ttyO2,115200n8 rootwait
-bootm 0x80000000
+bootz 0x80000000
diff --git a/target/linux/omap/patches-3.12/001-ti_git.patch b/target/linux/omap/patches-3.12/001-ti_git.patch
new file mode 100644 (file)
index 0000000..9a1b6c2
--- /dev/null
@@ -0,0 +1,82370 @@
+--- a/arch/arm/boot/dts/am335x-boneblack.dts
++++ b/arch/arm/boot/dts/am335x-boneblack.dts
+@@ -15,3 +15,80 @@
+       regulator-max-microvolt = <1800000>;
+       regulator-always-on;
+ };
++
++&mmc1 {
++      vmmc-supply = <&vmmcsd_fixed>;
++};
++
++&mmc2 {
++      vmmc-supply = <&vmmcsd_fixed>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&emmc_pins>;
++      bus-width = <8>;
++      ti,non-removable;
++      status = "okay";
++};
++
++&am33xx_pinmux {
++      nxp_hdmi_bonelt_pins: nxp_hdmi_bonelt_pins {
++              pinctrl-single,pins = <
++                      0x1b0 0x03      /* xdma_event_intr0, OMAP_MUX_MODE3 | AM33XX_PIN_OUTPUT */
++                      0xa0 0x08       /* lcd_data0.lcd_data0, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xa4 0x08       /* lcd_data1.lcd_data1, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xa8 0x08       /* lcd_data2.lcd_data2, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xac 0x08       /* lcd_data3.lcd_data3, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xb0 0x08       /* lcd_data4.lcd_data4, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xb4 0x08       /* lcd_data5.lcd_data5, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xb8 0x08       /* lcd_data6.lcd_data6, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xbc 0x08       /* lcd_data7.lcd_data7, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xc0 0x08       /* lcd_data8.lcd_data8, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xc4 0x08       /* lcd_data9.lcd_data9, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xc8 0x08       /* lcd_data10.lcd_data10, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xcc 0x08       /* lcd_data11.lcd_data11, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xd0 0x08       /* lcd_data12.lcd_data12, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xd4 0x08       /* lcd_data13.lcd_data13, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xd8 0x08       /* lcd_data14.lcd_data14, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xdc 0x08       /* lcd_data15.lcd_data15, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT | AM33XX_PULL_DISA */
++                      0xe0 0x00       /* lcd_vsync.lcd_vsync, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT */
++                      0xe4 0x00       /* lcd_hsync.lcd_hsync, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT */
++                      0xe8 0x00       /* lcd_pclk.lcd_pclk, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT */
++                      0xec 0x00       /* lcd_ac_bias_en.lcd_ac_bias_en, OMAP_MUX_MODE0 | AM33XX_PIN_OUTPUT */
++              >;
++      };
++      nxp_hdmi_bonelt_off_pins: nxp_hdmi_bonelt_off_pins {
++              pinctrl-single,pins = <
++                      0x1b0 0x03      /* xdma_event_intr0, OMAP_MUX_MODE3 | AM33XX_PIN_OUTPUT */
++              >;
++      };
++};
++
++&i2c0 {
++      hdmi1: hdmi@70 {
++            compatible = "nxp,tda998x";
++            reg = <0x70>;
++      };
++};
++
++&lcdc {
++      pinctrl-names = "default", "off";
++      pinctrl-0 = <&nxp_hdmi_bonelt_pins>;
++      pinctrl-1 = <&nxp_hdmi_bonelt_off_pins>;
++      status = "okay";
++      hdmi = <&hdmi1>;
++      display-timings {
++              640x480P60 {
++                 clock-frequency = <25200000>;
++                 hactive = <640>;
++                 vactive = <480>;
++                 hfront-porch = <16>;
++                 hback-porch = <48>;
++                 hsync-len = <96>;
++                 vback-porch = <31>;
++                 vfront-porch = <11>;
++                 vsync-len = <2>;
++                 hsync-active = <0>;
++                 vsync-active = <0>;
++              };
++      };
++};
++
+--- a/arch/arm/boot/dts/am335x-bone-common.dtsi
++++ b/arch/arm/boot/dts/am335x-bone-common.dtsi
+@@ -107,6 +107,27 @@
+                               0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
+                       >;
+               };
++
++              mmc1_pins: pinmux_mmc1_pins {
++                      pinctrl-single,pins = <
++                              0x160 (PIN_INPUT | MUX_MODE7) /* GPIO0_6 */
++                      >;
++              };
++
++              emmc_pins: pinmux_emmc_pins {
++                      pinctrl-single,pins = <
++                              0x80 (PIN_INPUT_PULLUP | MUX_MODE2) /* gpmc_csn1.mmc1_clk */
++                              0x84 (PIN_INPUT_PULLUP | MUX_MODE2) /* gpmc_csn2.mmc1_cmd */
++                              0x00 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad0.mmc1_dat0 */
++                              0x04 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad1.mmc1_dat1 */
++                              0x08 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad2.mmc1_dat2 */
++                              0x0c (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad3.mmc1_dat3 */
++                              0x10 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad4.mmc1_dat4 */
++                              0x14 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad5.mmc1_dat5 */
++                              0x18 (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad6.mmc1_dat6 */
++                              0x1c (PIN_INPUT_PULLUP | MUX_MODE1) /* gpmc_ad7.mmc1_dat7 */
++                      >;
++              };
+       };
+       ocp {
+@@ -183,15 +204,24 @@
+               led@4 {
+                       label = "beaglebone:green:usr2";
+                       gpios = <&gpio1 23 GPIO_ACTIVE_HIGH>;
++                      linux,default-trigger = "cpu0";
+                       default-state = "off";
+               };
+               led@5 {
+                       label = "beaglebone:green:usr3";
+                       gpios = <&gpio1 24 GPIO_ACTIVE_HIGH>;
++                      linux,default-trigger = "mmc1";
+                       default-state = "off";
+               };
+       };
++
++      vmmcsd_fixed: fixedregulator@0 {
++              compatible = "regulator-fixed";
++              regulator-name = "vmmcsd_fixed";
++              regulator-min-microvolt = <3300000>;
++              regulator-max-microvolt = <3300000>;
++      };
+ };
+ /include/ "tps65217.dtsi"
+@@ -260,3 +290,12 @@
+       pinctrl-0 = <&davinci_mdio_default>;
+       pinctrl-1 = <&davinci_mdio_sleep>;
+ };
++
++&mmc1 {
++      status = "okay";
++      bus-width = <0x4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio0 6 GPIO_ACTIVE_HIGH>;
++      cd-inverted;
++};
+--- a/arch/arm/boot/dts/am335x-bone.dts
++++ b/arch/arm/boot/dts/am335x-bone.dts
+@@ -9,3 +9,13 @@
+ #include "am33xx.dtsi"
+ #include "am335x-bone-common.dtsi"
++
++&ldo3_reg {
++      regulator-min-microvolt = <1800000>;
++      regulator-max-microvolt = <3300000>;
++      regulator-always-on;
++};
++
++&mmc1 {
++      vmmc-supply = <&ldo3_reg>;
++};
+--- a/arch/arm/boot/dts/am335x-evm.dts
++++ b/arch/arm/boot/dts/am335x-evm.dts
+@@ -149,6 +149,54 @@
+                               0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
+                       >;
+               };
++
++              mmc1_pins: pinmux_mmc1_pins {
++                      pinctrl-single,pins = <
++                              0x160 (PIN_INPUT | MUX_MODE7) /* spi0_cs1.gpio0_6 */
++                      >;
++              };
++
++              lcd_pins_s0: lcd_pins_s0 {
++                      pinctrl-single,pins = <
++                              0x20 0x01       /* gpmc_ad8.lcd_data16, OUTPUT | MODE1 */
++                              0x24 0x01       /* gpmc_ad9.lcd_data17, OUTPUT | MODE1 */
++                              0x28 0x01       /* gpmc_ad10.lcd_data18, OUTPUT | MODE1 */
++                              0x2c 0x01       /* gpmc_ad11.lcd_data19, OUTPUT | MODE1 */
++                              0x30 0x01       /* gpmc_ad12.lcd_data20, OUTPUT | MODE1 */
++                              0x34 0x01       /* gpmc_ad13.lcd_data21, OUTPUT | MODE1 */
++                              0x38 0x01       /* gpmc_ad14.lcd_data22, OUTPUT | MODE1 */
++                              0x3c 0x01       /* gpmc_ad15.lcd_data23, OUTPUT | MODE1 */
++                              0xa0 0x00       /* lcd_data0.lcd_data0, OUTPUT | MODE0 */
++                              0xa4 0x00       /* lcd_data1.lcd_data1, OUTPUT | MODE0 */
++                              0xa8 0x00       /* lcd_data2.lcd_data2, OUTPUT | MODE0 */
++                              0xac 0x00       /* lcd_data3.lcd_data3, OUTPUT | MODE0 */
++                              0xb0 0x00       /* lcd_data4.lcd_data4, OUTPUT | MODE0 */
++                              0xb4 0x00       /* lcd_data5.lcd_data5, OUTPUT | MODE0 */
++                              0xb8 0x00       /* lcd_data6.lcd_data6, OUTPUT | MODE0 */
++                              0xbc 0x00       /* lcd_data7.lcd_data7, OUTPUT | MODE0 */
++                              0xc0 0x00       /* lcd_data8.lcd_data8, OUTPUT | MODE0 */
++                              0xc4 0x00       /* lcd_data9.lcd_data9, OUTPUT | MODE0 */
++                              0xc8 0x00       /* lcd_data10.lcd_data10, OUTPUT | MODE0 */
++                              0xcc 0x00       /* lcd_data11.lcd_data11, OUTPUT | MODE0 */
++                              0xd0 0x00       /* lcd_data12.lcd_data12, OUTPUT | MODE0 */
++                              0xd4 0x00       /* lcd_data13.lcd_data13, OUTPUT | MODE0 */
++                              0xd8 0x00       /* lcd_data14.lcd_data14, OUTPUT | MODE0 */
++                              0xdc 0x00       /* lcd_data15.lcd_data15, OUTPUT | MODE0 */
++                              0xe0 0x00       /* lcd_vsync.lcd_vsync, OUTPUT | MODE0 */
++                              0xe4 0x00       /* lcd_hsync.lcd_hsync, OUTPUT | MODE0 */
++                              0xe8 0x00       /* lcd_pclk.lcd_pclk, OUTPUT | MODE0 */
++                              0xec 0x00       /* lcd_ac_bias_en.lcd_ac_bias_en, OUTPUT | MODE0 */
++                      >;
++              };
++
++              am335x_evm_audio_pins: am335x_evm_audio_pins {
++                      pinctrl-single,pins = <
++                              0x10c (PIN_INPUT_PULLDOWN | MUX_MODE4) /* mii1_rx_dv.mcasp1_aclkx */
++                              0x110 (PIN_INPUT_PULLDOWN | MUX_MODE4) /* mii1_txd3.mcasp1_fsx */
++                              0x108 (PIN_OUTPUT_PULLDOWN | MUX_MODE4) /* mii1_col.mcasp1_axr2 */
++                              0x144 (PIN_INPUT_PULLDOWN | MUX_MODE4) /* rmii1_ref_clk.mcasp1_axr3 */
++                      >;
++              };
+       };
+       ocp {
+@@ -244,6 +292,18 @@
+                               compatible = "ti,tmp275";
+                               reg = <0x48>;
+                       };
++
++                      tlv320aic3106: tlv320aic3106@1b {
++                              compatible = "ti,tlv320aic3106";
++                              reg = <0x1b>;
++                              status = "okay";
++
++                              /* Regulators */
++                              AVDD-supply = <&vaux2_reg>;
++                              IOVDD-supply = <&vaux2_reg>;
++                              DRVDD-supply = <&vaux2_reg>;
++                              DVDD-supply = <&vbat>;
++                      };
+               };
+               elm: elm@48080000 {
+@@ -268,8 +328,7 @@
+                       nand@0,0 {
+                               reg = <0 0 0>; /* CS0, offset 0 */
+                               nand-bus-width = <8>;
+-                              ti,nand-ecc-opt = "bch8";
+-                              gpmc,device-nand = "true";
++                              ti,nand-ecc-opt= "bch8";
+                               gpmc,device-width = <1>;
+                               gpmc,sync-clk-ps = <0>;
+                               gpmc,cs-on-ns = <0>;
+@@ -293,53 +352,78 @@
+                               gpmc,wait-monitoring-ns = <0>;
+                               gpmc,wr-access-ns = <40>;
+                               gpmc,wr-data-mux-bus-ns = <0>;
+-
+                               #address-cells = <1>;
+                               #size-cells = <1>;
+-                              elm_id = <&elm>;
+-
++                              ti,elm-id = <&elm>;
+                               /* MTD partition table */
+                               partition@0 {
+                                       label = "SPL1";
+                                       reg = <0x00000000 0x000020000>;
+                               };
+-
+                               partition@1 {
+                                       label = "SPL2";
+                                       reg = <0x00020000 0x00020000>;
+                               };
+-
+                               partition@2 {
+                                       label = "SPL3";
+                                       reg = <0x00040000 0x00020000>;
+                               };
+-
+                               partition@3 {
+                                       label = "SPL4";
+                                       reg = <0x00060000 0x00020000>;
+                               };
+-
+                               partition@4 {
+                                       label = "U-boot";
+                                       reg = <0x00080000 0x001e0000>;
+                               };
+-
+                               partition@5 {
+                                       label = "environment";
+                                       reg = <0x00260000 0x00020000>;
+                               };
+-
+                               partition@6 {
+                                       label = "Kernel";
+                                       reg = <0x00280000 0x00500000>;
+                               };
+-
+                               partition@7 {
+                                       label = "File-System";
+                                       reg = <0x00780000 0x0F880000>;
+                               };
+                       };
+               };
++
++              lcdc: lcdc@0x4830e000 {         
++                      pinctrl-names = "default";
++                      pinctrl-0 = <&lcd_pins_s0>;
++                      status = "okay";
++                      display-timings {
++                              800x480p62 {
++                                      clock-frequency = <30000000>;
++                                      hactive = <800>;
++                                      vactive = <480>;
++                                      hfront-porch = <39>;
++                                      hback-porch = <39>;
++                                      hsync-len = <47>;
++                                      vback-porch = <29>;
++                                      vfront-porch = <13>;
++                                      vsync-len = <2>;
++                                      hsync-active = <1>;
++                                      vsync-active = <1>;
++                              };
++                      };
++              };
++
++              sound {
++                      compatible = "ti,da830-evm-audio";
++                      ti,model = "AM335x-EVM";
++                      ti,audio-codec = <&tlv320aic3106>;
++                      ti,mcasp-controller = <&mcasp1>;
++                      ti,codec-clock-rate = <12000000>;
++                      ti,audio-routing =
++                              "Headphone Jack",       "HPLOUT",
++                              "Headphone Jack",       "HPROUT",
++                              "LINE1L",               "Line In",
++                              "LINE1R",               "Line In";
++              };
+       };
+       vbat: fixedregulator@0 {
+@@ -403,10 +487,63 @@
+               brightness-levels = <0 51 53 56 62 75 101 152 255>;
+               default-brightness-level = <8>;
+       };
++
++      panel {
++              compatible = "ti,tilcdc,panel";
++              status = "okay";
++              pinctrl-names = "default";
++              pinctrl-0 = <&lcd_pins_s0>;
++              panel-info {
++                      ac-bias           = <255>;
++                      ac-bias-intrpt    = <0>;
++                      dma-burst-sz      = <16>;
++                      bpp               = <32>;
++                      fdd               = <0x80>;
++                      sync-edge         = <0>;
++                      sync-ctrl         = <1>;
++                      raster-order      = <0>;
++                      fifo-th           = <0>;
++              };
++
++              display-timings {
++                      800x480p62 {
++                              clock-frequency = <30000000>;
++                              hactive = <800>;
++                              vactive = <480>;
++                              hfront-porch = <39>;
++                              hback-porch = <39>;
++                              hsync-len = <47>;
++                              vback-porch = <29>;
++                              vfront-porch = <13>;
++                              vsync-len = <2>;
++                              hsync-active = <1>;
++                              vsync-active = <1>;
++                      };
++              };
++      };
+ };
+ #include "tps65910.dtsi"
++&mcasp1 {
++              pinctrl-names = "default";
++              pinctrl-0 = <&am335x_evm_audio_pins>;
++
++              status = "okay";
++
++              op-mode = <0>;          /* MCASP_IIS_MODE */
++              tdm-slots = <2>;
++              /* 16 serializer */
++              serial-dir = <  /* 0: INACTIVE, 1: TX, 2: RX */
++                      0 0 1 2
++                      0 0 0 0
++                      0 0 0 0
++                      0 0 0 0
++              >;
++              tx-num-evt = <1>;
++              rx-num-evt = <1>;
++};
++
+ &tps {
+       vcc1-supply = <&vbat>;
+       vcc2-supply = <&vbat>;
+@@ -477,6 +614,8 @@
+               };
+               vmmc_reg: regulator@12 {
++                      regulator-min-microvolt = <1800000>;
++                      regulator-max-microvolt = <3300000>;
+                       regulator-always-on;
+               };
+       };
+@@ -509,7 +648,7 @@
+       tsc {
+               ti,wires = <4>;
+               ti,x-plate-resistance = <200>;
+-              ti,coordiante-readouts = <5>;
++              ti,coordinate-readouts = <5>;
+               ti,wire-config = <0x00 0x11 0x22 0x33>;
+       };
+@@ -517,3 +656,12 @@
+               ti,adc-channels = <4 5 6 7>;
+       };
+ };
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&vmmc_reg>;
++      bus-width = <4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio0 6 GPIO_ACTIVE_HIGH>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/am335x-evm-profile2.dts
+@@ -0,0 +1,296 @@
++/*
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ */
++/dts-v1/;
++
++#include "am33xx.dtsi"
++
++/ {
++      model = "TI AM335x EVM";
++      compatible = "ti,am335x-evm", "ti,am33xx";
++
++      cpus {
++              cpu@0 {
++                      cpu0-supply = <&vdd1_reg>;
++              };
++      };
++
++      memory {
++              device_type = "memory";
++              reg = <0x80000000 0x10000000>; /* 256 MB */
++      };
++
++      am33xx_pinmux: pinmux@44e10800 {
++              pinctrl-names = "default";
++              pinctrl-0 = <&matrix_keypad_s0 &clkout2_pin>;
++
++              matrix_keypad_s0: matrix_keypad_s0 {
++                      pinctrl-single,pins = <
++                              0x54 (PIN_OUTPUT_PULLDOWN | MUX_MODE7)  /* gpmc_a5.gpio1_21 */
++                              0x58 (PIN_OUTPUT_PULLDOWN | MUX_MODE7)  /* gpmc_a6.gpio1_22 */
++                              0x64 (PIN_INPUT_PULLDOWN | MUX_MODE7)   /* gpmc_a9.gpio1_25 */
++                              0x68 (PIN_INPUT_PULLDOWN | MUX_MODE7)   /* gpmc_a10.gpio1_26 */
++                              0x6c (PIN_INPUT_PULLDOWN | MUX_MODE7)   /* gpmc_a11.gpio1_27 */
++                      >;
++              };
++
++              i2c0_pins: pinmux_i2c0_pins {
++                      pinctrl-single,pins = <
++                              0x188 (PIN_INPUT_PULLUP | MUX_MODE0)    /* i2c0_sda.i2c0_sda */
++                              0x18c (PIN_INPUT_PULLUP | MUX_MODE0)    /* i2c0_scl.i2c0_scl */
++                      >;
++              };
++
++              spi0_pins: pinmux_spi0_pins {
++                      pinctrl-single,pins = <
++                              0x150 (PIN_INPUT_PULLUP | MUX_MODE0)    /* spi0_clk.spi0_clk */
++                              0x154 (PIN_INPUT_PULLUP | MUX_MODE0)    /* spi0_d0.spi0_d0 */
++                              0x158 (PIN_INPUT_PULLUP | MUX_MODE0)    /* spi0_d1.spi0_d1 */
++                              0x15c (PIN_INPUT_PULLUP | MUX_MODE0)    /* spi0_cs0.spi0_cs0 */
++                      >;
++              };
++
++              uart0_pins: pinmux_uart0_pins {
++                      pinctrl-single,pins = <
++                              0x170 (PIN_INPUT_PULLUP | MUX_MODE0)    /* uart0_rxd.uart0_rxd */
++                              0x174 (PIN_OUTPUT_PULLDOWN | MUX_MODE0) /* uart0_txd.uart0_txd */
++                      >;
++              };
++
++              clkout2_pin: pinmux_clkout2_pin {
++                      pinctrl-single,pins = <
++                              0x1b4 (PIN_OUTPUT_PULLDOWN | MUX_MODE3) /* xdma_event_intr1.clkout2 */
++                      >;
++              };
++
++              cpsw_default: cpsw_default {
++                      pinctrl-single,pins = <
++                              /* Slave 1 */
++                              0x114 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txen.rgmii1_tctl */
++                              0x118 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxdv.rgmii1_rctl */
++                              0x11c (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd3.rgmii1_td3 */
++                              0x120 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd2.rgmii1_td2 */
++                              0x124 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd1.rgmii1_td1 */
++                              0x128 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd0.rgmii1_td0 */
++                              0x12c (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txclk.rgmii1_tclk */
++                              0x130 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxclk.rgmii1_rclk */
++                              0x134 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd3.rgmii1_rd3 */
++                              0x138 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd2.rgmii1_rd2 */
++                              0x13c (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd1.rgmii1_rd1 */
++                              0x140 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd0.rgmii1_rd0 */
++                      >;
++              };
++
++              cpsw_sleep: cpsw_sleep {
++                      pinctrl-single,pins = <
++                              /* Slave 1 reset value */
++                              0x114 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x118 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x11c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x120 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x124 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x128 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x12c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x130 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x134 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x138 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x13c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x140 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      >;
++              };
++
++              davinci_mdio_default: davinci_mdio_default {
++                      pinctrl-single,pins = <
++                              /* MDIO */
++                              0x148 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* mdio_data.mdio_data */
++                              0x14c (PIN_OUTPUT_PULLUP | MUX_MODE0)                   /* mdio_clk.mdio_clk */
++                      >;
++              };
++
++              davinci_mdio_sleep: davinci_mdio_sleep {
++                      pinctrl-single,pins = <
++                              /* MDIO reset value */
++                              0x148 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                              0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      >;
++              };
++      };
++
++      ocp {
++              uart0: serial@44e09000 {
++                      pinctrl-names = "default";
++                      pinctrl-0 = <&uart0_pins>;
++
++                      status = "okay";
++              };
++
++              i2c0: i2c@44e0b000 {
++                      pinctrl-names = "default";
++                      pinctrl-0 = <&i2c0_pins>;
++
++                      status = "okay";
++                      clock-frequency = <400000>;
++
++                      tps: tps@2d {
++                              reg = <0x2d>;
++                      };
++              };
++
++              spi0: spi@48030000 {
++                      pinctrl-names = "default";
++                      pinctrl-0 = <&spi0_pins>;
++
++                      status = "okay";
++                      m25p80@0 {
++                              compatible = "w25q64";
++                              spi-max-frequency = <24000000>;
++                              reg = <0x0>;
++                      };
++              };
++      };
++
++      vbat: fixedregulator@0 {
++              compatible = "regulator-fixed";
++              regulator-name = "vbat";
++              regulator-min-microvolt = <5000000>;
++              regulator-max-microvolt = <5000000>;
++              regulator-boot-on;
++      };
++
++      lis3_reg: fixedregulator@1 {
++              compatible = "regulator-fixed";
++              regulator-name = "lis3_reg";
++              regulator-boot-on;
++      };
++
++      matrix_keypad: matrix_keypad@0 {
++              compatible = "gpio-matrix-keypad";
++              debounce-delay-ms = <5>;
++              col-scan-delay-us = <2>;
++
++              row-gpios = <&gpio1 25 GPIO_ACTIVE_HIGH         /* Bank1, pin25 */
++                           &gpio1 26 GPIO_ACTIVE_HIGH         /* Bank1, pin26 */
++                           &gpio1 27 GPIO_ACTIVE_HIGH>;       /* Bank1, pin27 */
++
++              col-gpios = <&gpio1 21 GPIO_ACTIVE_HIGH         /* Bank1, pin21 */
++                           &gpio1 22 GPIO_ACTIVE_HIGH>;       /* Bank1, pin22 */
++
++              linux,keymap = <0x0000008b      /* MENU */
++                              0x0100009e      /* BACK */
++                              0x02000069      /* LEFT */
++                              0x0001006a      /* RIGHT */
++                              0x0101001c      /* ENTER */
++                              0x0201006c>;    /* DOWN */
++      };
++};
++
++#include "tps65910.dtsi"
++
++&tps {
++      vcc1-supply = <&vbat>;
++      vcc2-supply = <&vbat>;
++      vcc3-supply = <&vbat>;
++      vcc4-supply = <&vbat>;
++      vcc5-supply = <&vbat>;
++      vcc6-supply = <&vbat>;
++      vcc7-supply = <&vbat>;
++      vccio-supply = <&vbat>;
++
++      regulators {
++              vrtc_reg: regulator@0 {
++                      regulator-always-on;
++              };
++
++              vio_reg: regulator@1 {
++                      regulator-always-on;
++              };
++
++              vdd1_reg: regulator@2 {
++                      /* VDD_MPU voltage limits 0.95V - 1.26V with +/-4% tolerance */
++                      regulator-name = "vdd_mpu";
++                      regulator-min-microvolt = <912500>;
++                      regulator-max-microvolt = <1312500>;
++                      regulator-boot-on;
++                      regulator-always-on;
++              };
++
++              vdd2_reg: regulator@3 {
++                      /* VDD_CORE voltage limits 0.95V - 1.1V with +/-4% tolerance */
++                      regulator-name = "vdd_core";
++                      regulator-min-microvolt = <912500>;
++                      regulator-max-microvolt = <1150000>;
++                      regulator-boot-on;
++                      regulator-always-on;
++              };
++
++              vdd3_reg: regulator@4 {
++                      regulator-always-on;
++              };
++
++              vdig1_reg: regulator@5 {
++                      regulator-always-on;
++              };
++
++              vdig2_reg: regulator@6 {
++                      regulator-always-on;
++              };
++
++              vpll_reg: regulator@7 {
++                      regulator-always-on;
++              };
++
++              vdac_reg: regulator@8 {
++                      regulator-always-on;
++              };
++
++              vaux1_reg: regulator@9 {
++                      regulator-always-on;
++              };
++
++              vaux2_reg: regulator@10 {
++                      regulator-always-on;
++              };
++
++              vaux33_reg: regulator@11 {
++                      regulator-always-on;
++              };
++
++              vmmc_reg: regulator@12 {
++                      regulator-min-microvolt = <1800000>;
++                      regulator-max-microvolt = <3300000>;
++                      regulator-always-on;
++              };
++      };
++};
++
++&mac {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&cpsw_default>;
++      pinctrl-1 = <&cpsw_sleep>;
++};
++
++&davinci_mdio {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&davinci_mdio_default>;
++      pinctrl-1 = <&davinci_mdio_sleep>;
++};
++
++&cpsw_emac0 {
++      phy_id = <&davinci_mdio>, <0>;
++      phy-mode = "rgmii-txid";
++};
++
++&cpsw_emac1 {
++      phy_id = <&davinci_mdio>, <1>;
++      phy-mode = "rgmii-txid";
++};
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&vmmc_reg>;
++      bus-width = <4>;
++};
+--- a/arch/arm/boot/dts/am335x-evmsk.dts
++++ b/arch/arm/boot/dts/am335x-evmsk.dts
+@@ -35,6 +35,39 @@
+               pinctrl-names = "default";
+               pinctrl-0 = <&gpio_keys_s0 &clkout2_pin>;
++              lcd_pins_s0: lcd_pins_s0 {
++                      pinctrl-single,pins = <
++                              0x20 0x01       /* gpmc_ad8.lcd_data16, OUTPUT | MODE1 */
++                              0x24 0x01       /* gpmc_ad9.lcd_data17, OUTPUT | MODE1 */
++                              0x28 0x01       /* gpmc_ad10.lcd_data18, OUTPUT | MODE1 */
++                              0x2c 0x01       /* gpmc_ad11.lcd_data19, OUTPUT | MODE1 */
++                              0x30 0x01       /* gpmc_ad12.lcd_data20, OUTPUT | MODE1 */
++                              0x34 0x01       /* gpmc_ad13.lcd_data21, OUTPUT | MODE1 */
++                              0x38 0x01       /* gpmc_ad14.lcd_data22, OUTPUT | MODE1 */
++                              0x3c 0x01       /* gpmc_ad15.lcd_data23, OUTPUT | MODE1 */
++                              0xa0 0x00       /* lcd_data0.lcd_data0, OUTPUT | MODE0 */
++                              0xa4 0x00       /* lcd_data1.lcd_data1, OUTPUT | MODE0 */
++                              0xa8 0x00       /* lcd_data2.lcd_data2, OUTPUT | MODE0 */
++                              0xac 0x00       /* lcd_data3.lcd_data3, OUTPUT | MODE0 */
++                              0xb0 0x00       /* lcd_data4.lcd_data4, OUTPUT | MODE0 */
++                              0xb4 0x00       /* lcd_data5.lcd_data5, OUTPUT | MODE0 */
++                              0xb8 0x00       /* lcd_data6.lcd_data6, OUTPUT | MODE0 */
++                              0xbc 0x00       /* lcd_data7.lcd_data7, OUTPUT | MODE0 */
++                              0xc0 0x00       /* lcd_data8.lcd_data8, OUTPUT | MODE0 */
++                              0xc4 0x00       /* lcd_data9.lcd_data9, OUTPUT | MODE0 */
++                              0xc8 0x00       /* lcd_data10.lcd_data10, OUTPUT | MODE0 */
++                              0xcc 0x00       /* lcd_data11.lcd_data11, OUTPUT | MODE0 */
++                              0xd0 0x00       /* lcd_data12.lcd_data12, OUTPUT | MODE0 */
++                              0xd4 0x00       /* lcd_data13.lcd_data13, OUTPUT | MODE0 */
++                              0xd8 0x00       /* lcd_data14.lcd_data14, OUTPUT | MODE0 */
++                              0xdc 0x00       /* lcd_data15.lcd_data15, OUTPUT | MODE0 */
++                              0xe0 0x00       /* lcd_vsync.lcd_vsync, OUTPUT | MODE0 */
++                              0xe4 0x00       /* lcd_hsync.lcd_hsync, OUTPUT | MODE0 */
++                              0xe8 0x00       /* lcd_pclk.lcd_pclk, OUTPUT | MODE0 */
++                              0xec 0x00       /* lcd_ac_bias_en.lcd_ac_bias_en, OUTPUT | MODE0 */
++                      >;
++              };
++
+               user_leds_s0: user_leds_s0 {
+                       pinctrl-single,pins = <
+                               0x10 (PIN_OUTPUT_PULLDOWN | MUX_MODE7)  /* gpmc_ad4.gpio1_4 */
+@@ -158,6 +191,21 @@
+                               0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
+                       >;
+               };
++
++              mmc1_pins: pinmux_mmc1_pins {
++                      pinctrl-single,pins = <
++                              0x160 (PIN_INPUT | MUX_MODE7) /* spi0_cs1.gpio0_6 */
++                      >;
++              };
++
++              mcasp1_pins: mcasp1_pins {
++                      pinctrl-single,pins = <
++                              0x10c (PIN_INPUT_PULLDOWN | MUX_MODE4) /* mii1_crs.mcasp1_aclkx */
++                              0x110 (PIN_INPUT_PULLDOWN | MUX_MODE4) /* mii1_rxerr.mcasp1_fsx */
++                              0x108 (PIN_OUTPUT_PULLDOWN | MUX_MODE4) /* mii1_col.mcasp1_axr2 */
++                              0x144 (PIN_INPUT_PULLDOWN | MUX_MODE4) /* rmii1_ref_clk.mcasp1_axr3 */
++                      >;
++              };
+       };
+       ocp {
+@@ -206,6 +254,18 @@
+                               st,max-limit-y = <550>;
+                               st,max-limit-z = <750>;
+                       };
++
++                      tlv320aic3106: tlv320aic3106@1b {
++                              compatible = "ti,tlv320aic3106";
++                              reg = <0x1b>;
++                              status = "okay";
++
++                              /* Regulators */
++                              AVDD-supply = <&vaux2_reg>;
++                              IOVDD-supply = <&vaux2_reg>;
++                              DRVDD-supply = <&vaux2_reg>;
++                              DVDD-supply = <&vbat>;
++                      };
+               };
+               musb: usb@47400000 {
+@@ -219,9 +279,22 @@
+                               status = "okay";
+                       };
++                      usb-phy@47401b00 {
++                              status = "okay";
++                      };
++
+                       usb@47401000 {
+                               status = "okay";
+                       };
++
++                      usb@47401800 {
++                              status = "okay";
++                              dr_mode = "host";
++                      };
++
++                      dma-controller@07402000  {
++                              status = "okay";
++                      };
+               };
+               epwmss2: epwmss@48304000 {
+@@ -233,6 +306,38 @@
+                               pinctrl-0 = <&ecap2_pins>;
+                       };
+               };
++
++              lcdc: lcdc@0x4830e000 {
++                      pinctrl-names = "default";
++                      pinctrl-0 = <&lcd_pins_s0>;
++                      status = "okay";
++                      display-timings {
++                              480x272 {
++                                      hactive         = <480>;
++                                      vactive         = <272>;
++                                      hback-porch     = <43>;
++                                      hfront-porch    = <8>;
++                                      hsync-len       = <4>;
++                                      vback-porch     = <12>;
++                                      vfront-porch    = <4>;
++                                      vsync-len       = <10>;
++                                      clock-frequency = <9000000>;
++                                      hsync-active    = <0>;
++                                      vsync-active    = <0>;
++                              };
++                      };
++              };
++
++              sound {
++                      compatible = "ti,da830-evm-audio";
++                      ti,model = "AM335x-EVMSK";
++                      ti,audio-codec = <&tlv320aic3106>;
++                      ti,mcasp-controller = <&mcasp1>;
++                      ti,codec-clock-rate = <24576000>;
++                      ti,audio-routing =
++                              "Headphone Jack",       "HPLOUT",
++                              "Headphone Jack",       "HPROUT";
++              };
+       };
+       vbat: fixedregulator@0 {
+@@ -393,6 +498,8 @@
+               };
+               vmmc_reg: regulator@12 {
++                      regulator-min-microvolt = <1800000>;
++                      regulator-max-microvolt = <3300000>;
+                       regulator-always-on;
+               };
+       };
+@@ -419,3 +526,45 @@
+       phy_id = <&davinci_mdio>, <1>;
+       phy-mode = "rgmii-txid";
+ };
++
++&tscadc {
++      status = "okay";
++      tsc {
++              ti,wires = <4>;
++              ti,x-plate-resistance = <200>;
++              ti,coordinate-readouts = <5>;
++              ti,wire-config = <0x00 0x11 0x22 0x33>;
++      };
++};
++
++&gpio0 {
++      ti,no-reset;
++};
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&vmmc_reg>;
++      bus-width = <4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio0 6 GPIO_ACTIVE_HIGH>;
++};
++
++&mcasp1 {
++              pinctrl-names = "default";
++              pinctrl-0 = <&mcasp1_pins>;
++
++              status = "okay";
++
++              op-mode = <0>;          /* MCASP_IIS_MODE */
++              tdm-slots = <2>;
++              /* 16 serializer */
++              serial-dir = <  /* 0: INACTIVE, 1: TX, 2: RX */
++                      0 0 1 2
++                      0 0 0 0
++                      0 0 0 0
++                      0 0 0 0
++              >;
++              tx-num-evt = <1>;
++              rx-num-evt = <1>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/am33xx-clocks.dtsi
+@@ -0,0 +1,661 @@
++/*
++ * Device Tree Source for AM33xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++clk_32768_ck: clk_32768_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++clk_rc32k_ck: clk_rc32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32000>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_24000000_ck: virt_24000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <24000000>;
++};
++
++virt_25000000_ck: virt_25000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <25000000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++sys_clkin_ck: sys_clkin_ck@44e10040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_19200000_ck>, <&virt_24000000_ck>, <&virt_25000000_ck>, <&virt_26000000_ck>;
++      bit-shift = <22>;
++      reg = <0x44e10040 0x4>;
++      bit-mask = <0x3>;
++};
++
++tclkin_ck: tclkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++dpll_core_ck: dpll_core_ck@44e00490 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-core-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44e00490 0x4>, <0x44e0045c 0x4>, <0x44e00468 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_core_x2_ck: dpll_core_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_core_ck>;
++};
++
++dpll_core_m4_ck: dpll_core_m4_ck@44e00480 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      reg = <0x44e00480 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_core_m5_ck: dpll_core_m5_ck@44e00484 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      reg = <0x44e00484 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_core_m6_ck: dpll_core_m6_ck@44e004d8 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      reg = <0x44e004d8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_mpu_ck: dpll_mpu_ck@44e00488 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44e00488 0x4>, <0x44e00420 0x4>, <0x44e0042c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_mpu_m2_ck: dpll_mpu_m2_ck@44e004a8 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_mpu_ck>;
++      reg = <0x44e004a8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_ddr_ck: dpll_ddr_ck@44e00494 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-no-gate-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44e00494 0x4>, <0x44e00434 0x4>, <0x44e00440 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_ddr_m2_ck: dpll_ddr_m2_ck@44e004a0 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_ddr_ck>;
++      reg = <0x44e004a0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_ddr_m2_div2_ck: dpll_ddr_m2_div2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_ddr_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_disp_ck: dpll_disp_ck@44e00498 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-no-gate-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44e00498 0x4>, <0x44e00448 0x4>, <0x44e00454 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_disp_m2_ck: dpll_disp_m2_ck@44e004a4 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_disp_ck>;
++      reg = <0x44e004a4 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      set-rate-parent;
++};
++
++dpll_per_ck: dpll_per_ck@44e0048c {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-no-gate-j-type-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44e0048c 0x4>, <0x44e00470 0x4>, <0x44e0049c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_per_m2_ck: dpll_per_m2_ck@44e004ac {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_ck>;
++      reg = <0x44e004ac 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_per_m2_div4_wkupdm_ck: dpll_per_m2_div4_wkupdm_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++dpll_per_m2_div4_ck: dpll_per_m2_div4_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++adc_tsc_fck: adc_tsc_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++cefuse_fck: cefuse_fck@44e00a20 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_clkin_ck>;
++      bit-shift = <1>;
++      reg = <0x44e00a20 0x4>;
++};
++
++clk_24mhz: clk_24mhz {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++clkdiv32k_ck: clkdiv32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&clk_24mhz>;
++      clock-mult = <1>;
++      clock-div = <732>;
++};
++
++clkdiv32k_ick: clkdiv32k_ick@44e0014c {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&clkdiv32k_ck>;
++      reg = <0x44e0014c 0x4>;
++      bit-shift = <1>;
++};
++
++dcan0_fck: dcan0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dcan1_fck: dcan1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3_gclk: l3_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++pruss_ocp_gclk: pruss_ocp_gclk@44e00530 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3_gclk>, <&dpll_disp_m2_ck>;
++      reg = <0x44e00530 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcasp0_fck: mcasp0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mcasp1_fck: mcasp1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mmu_fck: mmu_fck@44e00914 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_core_m4_ck>;
++      bit-shift = <1>;
++      reg = <0x44e00914 0x4>;
++};
++
++smartreflex0_fck: smartreflex0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++smartreflex1_fck: smartreflex1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sha0_fck: sha0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++rng_fck: rng_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++aes0_fck: aes0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++timer1_fck: timer1_fck@44e00528 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&clkdiv32k_ick>, <&tclkin_ck>, <&clk_rc32k_ck>, <&clk_32768_ck>;
++      reg = <0x44e00528 0x4>;
++      bit-mask = <0x7>;
++};
++
++timer2_fck: timer2_fck@44e00508 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e00508 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer3_fck: timer3_fck@44e0050c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e0050c 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer4_fck: timer4_fck@44e00510 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e00510 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer5_fck: timer5_fck@44e00518 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e00518 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer6_fck: timer6_fck@44e0051c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e0051c 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer7_fck: timer7_fck@44e00504 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e00504 0x4>;
++      bit-mask = <0x3>;
++};
++
++usbotg_fck: usbotg_fck@44e0047c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_ck>;
++      bit-shift = <8>;
++      reg = <0x44e0047c 0x4>;
++};
++
++dpll_core_m4_div2_ck: dpll_core_m4_div2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++ieee5000_fck: ieee5000_fck@44e000e4 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      bit-shift = <1>;
++      reg = <0x44e000e4 0x4>;
++};
++
++wdt1_fck: wdt1_fck@44e00538 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_rc32k_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e00538 0x4>;
++      bit-mask = <0x3>;
++};
++
++l4_rtc_gclk: l4_rtc_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++l4hs_gclk: l4hs_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3s_gclk: l3s_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l4fw_gclk: l4fw_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l4ls_gclk: l4ls_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sysclk_div_ck: sysclk_div_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++cpsw_125mhz_gclk: cpsw_125mhz_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m5_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++cpsw_cpts_rft_clk: cpsw_cpts_rft_clk@44e00520 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_m5_ck>, <&dpll_core_m4_ck>;
++      reg = <0x44e00520 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpio0_dbclk_mux_ck: gpio0_dbclk_mux_ck@44e0053c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_rc32k_ck>, <&clk_32768_ck>, <&clkdiv32k_ick>;
++      reg = <0x44e0053c 0x4>;
++      bit-mask = <0x3>;
++};
++
++gpio0_dbclk: gpio0_dbclk@44e00408 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpio0_dbclk_mux_ck>;
++      bit-shift = <18>;
++      reg = <0x44e00408 0x4>;
++};
++
++gpio1_dbclk: gpio1_dbclk@44e000ac {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <18>;
++      reg = <0x44e000ac 0x4>;
++};
++
++gpio2_dbclk: gpio2_dbclk@44e000b0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <18>;
++      reg = <0x44e000b0 0x4>;
++};
++
++gpio3_dbclk: gpio3_dbclk@44e000b4 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <18>;
++      reg = <0x44e000b4 0x4>;
++};
++
++lcd_gclk: lcd_gclk@44e00534 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_disp_m2_ck>, <&dpll_core_m5_ck>, <&dpll_per_m2_ck>;
++      reg = <0x44e00534 0x4>;
++      bit-mask = <0x3>;
++      set-rate-parent;
++};
++
++mmc_clk: mmc_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++gfx_fclk_clksel_ck: gfx_fclk_clksel_ck@44e0052c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_m4_ck>, <&dpll_per_m2_ck>;
++      bit-shift = <1>;
++      reg = <0x44e0052c 0x4>;
++      bit-mask = <0x1>;
++};
++
++gfx_fck_div_ck: gfx_fck_div_ck@44e0052c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&gfx_fclk_clksel_ck>;
++      reg = <0x44e0052c 0x4>;
++      table = < 1 0 >, < 2 1 >;
++      bit-mask = <0x1>;
++};
++
++sysclkout_pre_ck: sysclkout_pre_ck@44e00700 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_32768_ck>, <&l3_gclk>, <&dpll_ddr_m2_ck>, <&dpll_per_m2_ck>, <&lcd_gclk>;
++      reg = <0x44e00700 0x4>;
++      bit-mask = <0x7>;
++};
++
++clkout2_div_ck: clkout2_div_ck@44e00700 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sysclkout_pre_ck>;
++      bit-shift = <3>;
++      reg = <0x44e00700 0x4>;
++      table = < 1 0 >, < 2 1 >, < 3 2 >, < 4 3 >, < 5 4 >, < 6 5 >, < 7 6 >, < 8 7 >;
++      bit-mask = <0x7>;
++};
++
++dbg_sysclk_ck: dbg_sysclk_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_clkin_ck>;
++      bit-shift = <19>;
++      reg = <0x44e00414 0x4>;
++};
++
++dbg_clka_ck: dbg_clka_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_core_m4_ck>;
++      bit-shift = <30>;
++      reg = <0x44e00414 0x4>;
++};
++
++stm_pmd_clock_mux_ck: stm_pmd_clock_mux_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dbg_sysclk_ck>, <&dbg_clka_ck>;
++      bit-shift = <22>;
++      reg = <0x44e00414 0x4>;
++      bit-mask = <0x3>;
++};
++
++trace_pmd_clk_mux_ck: trace_pmd_clk_mux_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dbg_sysclk_ck>, <&dbg_clka_ck>;
++      bit-shift = <20>;
++      reg = <0x44e00414 0x4>;
++      bit-mask = <0x3>;
++};
++
++stm_clk_div_ck: stm_clk_div_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&stm_pmd_clock_mux_ck>;
++      bit-shift = <27>;
++      reg = <0x44e00414 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++trace_clk_div_ck: trace_clk_div_ck@44e00414 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&trace_pmd_clk_mux_ck>;
++      bit-shift = <24>;
++      reg = <0x44e00414 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++clkout2_ck: clkout2_ck@44e00700 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkout2_div_ck>;
++      bit-shift = <7>;
++      reg = <0x44e00700 0x4>;
++};
++
++ehrpwm0_tbclk: ehrpwm0_tbclk@44e10664 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_m2_ck>;
++      bit-shift = <0>;
++      reg = <0x44e10664 0x4>;
++};
++
++ehrpwm1_tbclk: ehrpwm1_tbclk@44e10664 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_m2_ck>;
++      bit-shift = <1>;
++      reg = <0x44e10664 0x4>;
++};
++
++ehrpwm2_tbclk: ehrpwm2_tbclk@44e10664 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_m2_ck>;
++      bit-shift = <2>;
++      reg = <0x44e10664 0x4>;
++};
+--- a/arch/arm/boot/dts/am33xx.dtsi
++++ b/arch/arm/boot/dts/am33xx.dtsi
+@@ -18,6 +18,9 @@
+       interrupt-parent = <&intc>;
+       aliases {
++              i2c0 = &i2c0;
++              i2c1 = &i2c1;
++              i2c2 = &i2c2;
+               serial0 = &uart0;
+               serial1 = &uart1;
+               serial2 = &uart2;
+@@ -30,6 +33,8 @@
+               usb1 = &usb1;
+               phy0 = &usb0_phy;
+               phy1 = &usb1_phy;
++              ethernet0 = &cpsw_emac0;
++              ethernet1 = &cpsw_emac1;
+       };
+       cpus {
+@@ -53,6 +58,10 @@
+                               275000  1125000
+                       >;
+                       voltage-tolerance = <2>; /* 2 percentage */
++
++                      clocks = <&dpll_mpu_ck>;
++                      clock-names = "cpu";
++
+                       clock-latency = <300000>; /* From omap-cpufreq driver */
+               };
+       };
+@@ -91,6 +100,8 @@
+               #size-cells = <1>;
+               ranges;
+               ti,hwmods = "l3_main";
++              clocks = <&l3_gclk>;
++              clock-names = "fck";
+               intc: interrupt-controller@48200000 {
+                       compatible = "ti,omap2-intc";
+@@ -100,9 +111,23 @@
+                       reg = <0x48200000 0x1000>;
+               };
++              edma: edma@49000000 {
++                      compatible = "ti,edma3";
++                      ti,hwmods = "tpcc", "tptc0", "tptc1", "tptc2";
++                      reg =   <0x49000000 0x10000>,
++                              <0x44e10f90 0x10>;
++                      interrupts = <12 13 14>;
++                      #dma-cells = <1>;
++                      dma-channels = <64>;
++                      ti,edma-regions = <4>;
++                      ti,edma-slots = <256>;
++              };
++
+               gpio0: gpio@44e07000 {
+                       compatible = "ti,omap4-gpio";
+                       ti,hwmods = "gpio1";
++                      clocks = <&dpll_core_m4_div2_ck>, <&gpio0_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -114,6 +139,8 @@
+               gpio1: gpio@4804c000 {
+                       compatible = "ti,omap4-gpio";
+                       ti,hwmods = "gpio2";
++                      clocks = <&l4ls_gclk>, <&gpio1_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -125,6 +152,8 @@
+               gpio2: gpio@481ac000 {
+                       compatible = "ti,omap4-gpio";
+                       ti,hwmods = "gpio3";
++                      clocks = <&l4ls_gclk>, <&gpio2_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -136,6 +165,8 @@
+               gpio3: gpio@481ae000 {
+                       compatible = "ti,omap4-gpio";
+                       ti,hwmods = "gpio4";
++                      clocks = <&l4ls_gclk>, <&gpio3_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -147,6 +178,8 @@
+               uart0: serial@44e09000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart1";
++                      clocks = <&dpll_per_m2_div4_wkupdm_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x44e09000 0x2000>;
+                       interrupts = <72>;
+@@ -156,6 +189,8 @@
+               uart1: serial@48022000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart2";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x48022000 0x2000>;
+                       interrupts = <73>;
+@@ -165,6 +200,8 @@
+               uart2: serial@48024000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart3";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x48024000 0x2000>;
+                       interrupts = <74>;
+@@ -174,6 +211,8 @@
+               uart3: serial@481a6000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart4";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x481a6000 0x2000>;
+                       interrupts = <44>;
+@@ -183,6 +222,8 @@
+               uart4: serial@481a8000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart5";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x481a8000 0x2000>;
+                       interrupts = <45>;
+@@ -192,6 +233,8 @@
+               uart5: serial@481aa000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart6";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+                       reg = <0x481aa000 0x2000>;
+                       interrupts = <46>;
+@@ -203,6 +246,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c1";
++                      clocks = <&dpll_per_m2_div4_wkupdm_ck>;
++                      clock-names = "fck";
+                       reg = <0x44e0b000 0x1000>;
+                       interrupts = <70>;
+                       status = "disabled";
+@@ -213,6 +258,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c2";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       reg = <0x4802a000 0x1000>;
+                       interrupts = <71>;
+                       status = "disabled";
+@@ -223,14 +270,62 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c3";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
+                       reg = <0x4819c000 0x1000>;
+                       interrupts = <30>;
+                       status = "disabled";
+               };
++              mmc1: mmc@48060000 {
++                      compatible = "ti,omap4-hsmmc";
++                      ti,hwmods = "mmc1";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,dual-volt;
++                      ti,needs-special-reset;
++                      ti,needs-special-hs-handling;
++                      dmas = <&edma 24
++                              &edma 25>;
++                      dma-names = "tx", "rx";
++                      interrupts = <64>;
++                      interrupt-parent = <&intc>;
++                      reg = <0x48060000 0x1000>;
++                      status = "disabled";
++              };
++
++              mmc2: mmc@481d8000 {
++                      compatible = "ti,omap4-hsmmc";
++                      ti,hwmods = "mmc2";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,needs-special-reset;
++                      dmas = <&edma 2
++                              &edma 3>;
++                      dma-names = "tx", "rx";
++                      interrupts = <28>;
++                      interrupt-parent = <&intc>;
++                      reg = <0x481d8000 0x1000>;
++                      status = "disabled";
++              };
++
++              mmc3: mmc@47810000 {
++                      compatible = "ti,omap4-hsmmc";
++                      ti,hwmods = "mmc3";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,needs-special-reset;
++                      interrupts = <29>;
++                      interrupt-parent = <&intc>;
++                      reg = <0x47810000 0x1000>;
++                      status = "disabled";
++              };
++
+               wdt2: wdt@44e35000 {
+                       compatible = "ti,omap3-wdt";
+                       ti,hwmods = "wd_timer2";
++                      clocks = <&wdt1_fck>;
++                      clock-names = "fck";
+                       reg = <0x44e35000 0x1000>;
+                       interrupts = <91>;
+               };
+@@ -238,6 +333,8 @@
+               dcan0: d_can@481cc000 {
+                       compatible = "bosch,d_can";
+                       ti,hwmods = "d_can0";
++                      clocks = <&dcan0_fck>;
++                      clock-names = "fck";
+                       reg = <0x481cc000 0x2000
+                               0x44e10644 0x4>;
+                       interrupts = <52>;
+@@ -247,17 +344,32 @@
+               dcan1: d_can@481d0000 {
+                       compatible = "bosch,d_can";
+                       ti,hwmods = "d_can1";
++                      clocks = <&dcan1_fck>;
++                      clock-names = "fck";
+                       reg = <0x481d0000 0x2000
+                               0x44e10644 0x4>;
+                       interrupts = <55>;
+                       status = "disabled";
+               };
++              mailbox: mailbox@480C8000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x480C8000 0x200>;
++                      interrupts = <77>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <8>;
++                      ti,mbox-names = "wkup_m3";
++                      ti,mbox-data = <0 0 0 0>;
++              };
++
+               timer1: timer@44e31000 {
+                       compatible = "ti,am335x-timer-1ms";
+                       reg = <0x44e31000 0x400>;
+                       interrupts = <67>;
+                       ti,hwmods = "timer1";
++                      clocks = <&timer1_fck>;
++                      clock-names = "fck";
+                       ti,timer-alwon;
+               };
+@@ -266,6 +378,8 @@
+                       reg = <0x48040000 0x400>;
+                       interrupts = <68>;
+                       ti,hwmods = "timer2";
++                      clocks = <&timer2_fck>;
++                      clock-names = "fck";
+               };
+               timer3: timer@48042000 {
+@@ -273,6 +387,8 @@
+                       reg = <0x48042000 0x400>;
+                       interrupts = <69>;
+                       ti,hwmods = "timer3";
++                      clocks = <&timer3_fck>;
++                      clock-names = "fck";
+               };
+               timer4: timer@48044000 {
+@@ -280,6 +396,8 @@
+                       reg = <0x48044000 0x400>;
+                       interrupts = <92>;
+                       ti,hwmods = "timer4";
++                      clocks = <&timer4_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -288,6 +406,8 @@
+                       reg = <0x48046000 0x400>;
+                       interrupts = <93>;
+                       ti,hwmods = "timer5";
++                      clocks = <&timer5_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -296,6 +416,8 @@
+                       reg = <0x48048000 0x400>;
+                       interrupts = <94>;
+                       ti,hwmods = "timer6";
++                      clocks = <&timer6_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -304,6 +426,8 @@
+                       reg = <0x4804a000 0x400>;
+                       interrupts = <95>;
+                       ti,hwmods = "timer7";
++                      clocks = <&timer7_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -313,6 +437,8 @@
+                       interrupts = <75
+                                     76>;
+                       ti,hwmods = "rtc";
++                      clocks = <&clk_32768_ck>;
++                      clock-names = "fck";
+               };
+               spi0: spi@48030000 {
+@@ -323,6 +449,13 @@
+                       interrupts = <65>;
+                       ti,spi-num-cs = <2>;
+                       ti,hwmods = "spi0";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      dmas = <&edma 16
++                              &edma 17
++                              &edma 18
++                              &edma 19>;
++                      dma-names = "tx0", "rx0", "tx1", "rx1";
+                       status = "disabled";
+               };
+@@ -334,6 +467,13 @@
+                       interrupts = <125>;
+                       ti,spi-num-cs = <2>;
+                       ti,hwmods = "spi1";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      dmas = <&edma 42
++                              &edma 43
++                              &edma 44
++                              &edma 45>;
++                      dma-names = "tx0", "rx0", "tx1", "rx1";
+                       status = "disabled";
+               };
+@@ -345,6 +485,8 @@
+                       #size-cells = <1>;
+                       ti,hwmods = "usb_otg_hs";
+                       status = "disabled";
++                      clocks = <&usbotg_fck>;
++                      clock-names = "fck";
+                       ctrl_mod: control@44e10000 {
+                               compatible = "ti,am335x-usb-ctrl-module";
+@@ -469,6 +611,8 @@
+                       compatible = "ti,am33xx-pwmss";
+                       reg = <0x48300000 0x10>;
+                       ti,hwmods = "epwmss0";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       status = "disabled";
+@@ -481,6 +625,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48300100 0x80>;
+                               ti,hwmods = "ecap0";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+@@ -489,6 +635,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48300200 0x80>;
+                               ti,hwmods = "ehrpwm0";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+               };
+@@ -497,6 +645,8 @@
+                       compatible = "ti,am33xx-pwmss";
+                       reg = <0x48302000 0x10>;
+                       ti,hwmods = "epwmss1";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       status = "disabled";
+@@ -509,6 +659,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48302100 0x80>;
+                               ti,hwmods = "ecap1";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+@@ -517,6 +669,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48302200 0x80>;
+                               ti,hwmods = "ehrpwm1";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+               };
+@@ -525,6 +679,8 @@
+                       compatible = "ti,am33xx-pwmss";
+                       reg = <0x48304000 0x10>;
+                       ti,hwmods = "epwmss2";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       status = "disabled";
+@@ -537,6 +693,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48304100 0x80>;
+                               ti,hwmods = "ecap2";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+@@ -545,6 +703,8 @@
+                               #pwm-cells = <3>;
+                               reg = <0x48304200 0x80>;
+                               ti,hwmods = "ehrpwm2";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                               status = "disabled";
+                       };
+               };
+@@ -552,6 +712,8 @@
+               mac: ethernet@4a100000 {
+                       compatible = "ti,cpsw";
+                       ti,hwmods = "cpgmac0";
++                      clocks = <&cpsw_125mhz_gclk>;
++                      clock-names = "fck";
+                       cpdma_channels = <8>;
+                       ale_entries = <1024>;
+                       bd_ram_size = <0x2000>;
+@@ -581,6 +743,8 @@
+                               #address-cells = <1>;
+                               #size-cells = <0>;
+                               ti,hwmods = "davinci_mdio";
++                      clocks = <&cpsw_125mhz_gclk>;
++                      clock-names = "fck";
+                               bus_freq = <1000000>;
+                               reg = <0x4a101000 0x100>;
+                       };
+@@ -594,19 +758,33 @@
+                               /* Filled in by U-Boot */
+                               mac-address = [ 00 00 00 00 00 00 ];
+                       };
++
++                      phy_sel: cpsw-phy-sel@44e10650 {
++                              compatible = "ti,am3352-cpsw-phy-sel";
++                              reg= <0x44e10650 0x4>;
++                              reg-names = "gmii-sel";
++                      };
+               };
+               ocmcram: ocmcram@40300000 {
+                       compatible = "ti,am3352-ocmcram";
+                       reg = <0x40300000 0x10000>;
+                       ti,hwmods = "ocmcram";
++                      clocks = <&l3_gclk>;
++                      clock-names = "fck";
+               };
+               wkup_m3: wkup_m3@44d00000 {
+                       compatible = "ti,am3353-wkup-m3";
+-                      reg = <0x44d00000 0x4000        /* M3 UMEM */
+-                             0x44d80000 0x2000>;      /* M3 DMEM */
++                      reg = <0x44d00000 0x4000
++                             0x44d80000 0x2000
++                             0x44e11324 0x0024>;
++                      reg-names = "m3_umem", "m3_dmem", "ipc_regs";
++                      interrupts = <78>;
+                       ti,hwmods = "wkup_m3";
++                      ti,no-reset;
++                      clocks = <&dpll_core_m4_div2_ck>;
++                      clock-names = "fck";
+               };
+               elm: elm@48080000 {
+@@ -614,6 +792,8 @@
+                       reg = <0x48080000 0x2000>;
+                       interrupts = <4>;
+                       ti,hwmods = "elm";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
+                       status = "disabled";
+               };
+@@ -623,6 +803,8 @@
+                       interrupt-parent = <&intc>;
+                       interrupts = <16>;
+                       ti,hwmods = "adc_tsc";
++                      clocks = <&adc_tsc_fck>;
++                      clock-names = "fck";
+                       status = "disabled";
+                       tsc {
+@@ -637,6 +819,9 @@
+               gpmc: gpmc@50000000 {
+                       compatible = "ti,am3352-gpmc";
+                       ti,hwmods = "gpmc";
++                      ti,no-idle;
++                      clocks = <&l3s_gclk>;
++                      clock-names = "fck";
+                       reg = <0x50000000 0x2000>;
+                       interrupts = <100>;
+                       gpmc,num-cs = <7>;
+@@ -645,5 +830,102 @@
+                       #size-cells = <1>;
+                       status = "disabled";
+               };
++
++              prcm: prcm@44e00000 {
++                      compatible = "ti,am3352-prcm";
++                      reg = <0x44e00000 0x1300>;
++                      #reset-cells = <1>;
++              };
++
++              sham: sham@53100000 {
++                      compatible = "ti,omap4-sham";
++                      ti,hwmods = "sham";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      reg = <0x53100000 0x200>;
++                      interrupt-parent = <&intc>;
++                      interrupts = <109>;
++                      dmas = <&edma 36>;
++                      dma-names = "rx";
++                      clocks = <&l3_gclk>;
++                      clock-names = "fck";
++              };
++
++              aes: aes@53500000 {
++                      compatible = "ti,omap4-aes";
++                      ti,hwmods = "aes";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      reg = <0x53500000 0xa0>;
++                      interrupt-parent = <&intc>;
++                      interrupts = <103>;
++                      dmas = <&edma 6
++                              &edma 5>;
++                      dma-names = "tx", "rx";
++                      clocks = <&aes0_fck>;
++                      clock-names = "fck";
++              };
++
++              rng: rng@48310000 {
++                      compatible = "ti,omap4-rng";
++                      ti,hwmods = "rng";
++                      reg = <0x48310000 0x2000>;
++                      interrupts = <111>;
++                      clocks = <&rng_fck>;
++                      clock-names = "fck";
++              };
++
++              lcdc: lcdc@0x4830e000 {
++                      compatible = "ti,am33xx-tilcdc";
++                      reg = <0x4830e000 0x1000>;
++                      interrupt-parent = <&intc>;
++                      interrupts = <36>;
++                      clocks = <&lcd_gclk>;
++                      clock-names = "fck";
++                      ti,hwmods = "lcdc";
++                      status = "disabled";
++              };
++
++              mcasp0: mcasp@48038000 {
++                      compatible = "ti,omap2-mcasp-audio";
++                      ti,hwmods = "mcasp0";
++                      reg = <0x48038000 0x2000>,
++                            <0x46400000 0x400000>;
++                      reg-names = "mpu", "dma";
++                      interrupts = <80 81>;
++                      interrupts-names = "tx", "rx";
++                      status = "disabled";
++                      dmas = <&edma 8
++                              &edma 9>;
++                      dma-names = "tx", "rx";
++              };
++
++              mcasp1: mcasp@4803C000 {
++                      compatible = "ti,omap2-mcasp-audio";
++                      ti,hwmods = "mcasp1";
++                      reg = <0x4803C000 0x2000>,
++                            <0x46400000 0x400000>;
++                      reg-names = "mpu", "dma";
++                      interrupts = <82 83>;
++                      interrupts-names = "tx", "rx";
++                      status = "disabled";
++                      dmas = <&edma 10
++                              &edma 11>;
++                      dma-names = "tx", "rx";
++              };
++      };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "am33xx-clocks.dtsi"
+       };
++
++       clockdomains {
++               clk_24mhz_clkdm: clk_24mhz_clkdm {
++                       compatible = "ti,clockdomain";
++                       clocks = <&clkdiv32k_ick>;
++               };
++       };
+ };
+--- /dev/null
++++ b/arch/arm/boot/dts/am3517.dtsi
+@@ -0,0 +1,116 @@
++/*
++ * Device Tree Source for AM3517 SoC
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * This file is licensed under the terms of the GNU General Public License
++ * version 2.  This program is licensed "as is" without any warranty of any
++ * kind, whether express or implied.
++ */
++
++#include "omap3.dtsi"
++
++/ {
++      cpus {
++              cpu@0 {
++                      /* OMAP343x/OMAP35xx variants OPP1-5 */
++                      operating-points = <
++                              /* kHz    uV */
++                              125000   975000
++                              250000  1075000
++                              500000  1200000
++                              550000  1270000
++                              600000  1350000
++                      >;
++                      clock-latency = <300000>; /* From legacy driver */
++              };
++      };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "am35xx-clocks.dtsi"
++              /include/ "omap36xx-am35xx-omap3430es2plus-clocks.dtsi"
++      };
++
++      clockdomains {
++              dss_clkdm: dss_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dss1_alwon_fck_3430es2>, <&dss_ick_3430es2>;
++              };
++
++              usbhost_clkdm: usbhost_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&usbhost_48m_fck>, <&usbhost_ick>;
++              };
++
++              core_l4_clkdm: core_l4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&mmchs1_ick>, <&mmchs2_ick>, <&hdq_fck>,
++                               <&uart1_ick>, <&mcspi4_fck>, <&i2c3_fck>,
++                               <&mcspi2_ick>, <&uart2_ick>, <&mcspi3_ick>,
++                               <&i2c1_fck>, <&hdq_ick>, <&sha12_ick>,
++                               <&mcbsp5_ick>, <&mcspi3_fck>, <&aes2_ick>,
++                               <&mcspi1_ick>, <&uart2_fck>, <&mmchs2_fck>,
++                               <&mmchs1_fck>, <&i2c3_ick>, <&mcspi1_fck>,
++                               <&mcspi4_ick>, <&omapctrl_ick>, <&mcbsp1_ick>,
++                               <&mcspi2_fck>, <&gpt10_ick>, <&i2c2_fck>,
++                               <&i2c2_ick>, <&gpt11_ick>, <&i2c1_ick>,
++                               <&uart1_fck>;
++              };
++
++              wkup_clkdm: wkup_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&wdt1_ick>, <&gpt12_ick>, <&gpio1_ick>,
++                               <&gpt1_ick>, <&omap_32ksync_ick>, <&wdt2_ick>,
++                               <&wdt2_fck>;
++              };
++
++              dpll4_clkdm: dpll4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll4_ck>;
++              };
++
++              core_l3_clkdm: core_l3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sdrc_ick>;
++              };
++
++              per_clkdm: per_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&gpt2_ick>, <&uart3_fck>, <&gpio3_ick>,
++                               <&mcbsp2_ick>, <&gpt6_ick>, <&mcbsp4_ick>,
++                               <&gpt4_ick>, <&mcbsp3_ick>, <&gpt8_ick>,
++                               <&uart3_ick>, <&gpt5_ick>, <&gpt7_ick>,
++                               <&gpio2_ick>, <&gpio6_ick>, <&gpt9_ick>,
++                               <&gpt3_ick>, <&gpio5_ick>, <&wdt3_ick>,
++                               <&gpio4_ick>, <&wdt3_fck>, <&uart4_ick>;
++              };
++
++              emu_clkdm: emu_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&emu_src_ck>;
++              };
++
++              sgx_clkdm: sgx_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sgx_ick>;
++              };
++
++              dpll3_clkdm: dpll3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll3_ck>;
++              };
++
++              dpll5_clkdm: dpll5_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll5_ck>;
++              };
++
++              dpll1_clkdm: dpll1_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll1_ck>;
++              };
++      };
++};
+--- a/arch/arm/boot/dts/am3517-evm.dts
++++ b/arch/arm/boot/dts/am3517-evm.dts
+@@ -7,7 +7,7 @@
+  */
+ /dts-v1/;
+-#include "omap34xx.dtsi"
++#include "am3517.dtsi"
+ / {
+       model = "TI AM3517 EVM (AM3517/05)";
+--- a/arch/arm/boot/dts/am3517_mt_ventoux.dts
++++ b/arch/arm/boot/dts/am3517_mt_ventoux.dts
+@@ -7,7 +7,7 @@
+  */
+ /dts-v1/;
+-#include "omap34xx.dtsi"
++#include "am3517.dtsi"
+ / {
+       model = "TeeJet Mt.Ventoux";
+--- /dev/null
++++ b/arch/arm/boot/dts/am35xx-clocks.dtsi
+@@ -0,0 +1,101 @@
++/*
++ * Device Tree Source for AM35xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++ipss_ick: ipss_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,am35xx-interface-clock";
++      clocks = <&core_l3_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <4>;
++};
++
++rmii_ck: rmii_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <50000000>;
++};
++
++pclk_ck: pclk_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <27000000>;
++};
++
++emac_ick: emac_ick@4800259c {
++      #clock-cells = <0>;
++      compatible = "ti,am35xx-gate-clock";
++      clocks = <&ipss_ick>;
++      reg = <0x4800259c 0x4>;
++      ti,enable-bit = <1>;
++};
++
++emac_fck: emac_fck@4800259c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&rmii_ck>;
++      reg = <0x4800259c 0x4>;
++      bit-shift = <9>;
++};
++
++vpfe_ick: vpfe_ick@4800259c {
++      #clock-cells = <0>;
++      compatible = "ti,am35xx-gate-clock";
++      clocks = <&ipss_ick>;
++      reg = <0x4800259c 0x4>;
++      ti,enable-bit = <2>;
++};
++
++vpfe_fck: vpfe_fck@4800259c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&pclk_ck>;
++      reg = <0x4800259c 0x4>;
++      bit-shift = <10>;
++};
++
++hsotgusb_ick: hsotgusb_ick@4800259c {
++      #clock-cells = <0>;
++      compatible = "ti,am35xx-gate-clock";
++      clocks = <&ipss_ick>;
++      reg = <0x4800259c 0x4>;
++      ti,enable-bit = <0>;
++};
++
++hsotgusb_fck_am35xx: hsotgusb_fck_am35xx@4800259c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x4800259c 0x4>;
++      bit-shift = <8>;
++};
++
++hecc_ck: hecc_ck@4800259c {
++      #clock-cells = <0>;
++      compatible = "ti,am35xx-gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x4800259c 0x4>;
++      ti,enable-bit = <3>;
++};
++
++uart4_ick_am35xx: uart4_ick_am35xx@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <23>;
++};
++
++uart4_fck_am35xx: uart4_fck_am35xx@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <23>;
++};
+--- a/arch/arm/boot/dts/am4372.dtsi
++++ b/arch/arm/boot/dts/am4372.dtsi
+@@ -8,6 +8,7 @@
+  * kind, whether express or implied.
+  */
++#include <dt-bindings/gpio/gpio.h>
+ #include <dt-bindings/interrupt-controller/arm-gic.h>
+ #include "skeleton.dtsi"
+@@ -18,12 +19,21 @@
+       aliases {
++              i2c0 = &i2c0;
++              i2c1 = &i2c1;
++              i2c2 = &i2c2;
+               serial0 = &uart0;
++              ethernet0 = &cpsw_emac0;
++              ethernet1 = &cpsw_emac1;
+       };
+       cpus {
++              #address-cells = <1>;
++              #size-cells = <0>;
+               cpu@0 {
+                       compatible = "arm,cortex-a9";
++                      device_type = "cpu";
++                      reg = <0>;
+               };
+       };
+@@ -35,16 +45,124 @@
+                     <0x48240100 0x0100>;
+       };
++      l2-cache-controller@48242000 {
++              compatible = "arm,pl310-cache";
++              reg = <0x48242000 0x1000>;
++              cache-unified;
++              cache-level = <2>;
++      };
++
++      am43xx_pinmux: pinmux@44e10800 {
++              compatible = "pinctrl-single";
++              reg = <0x44e10800 0x31c>;
++              #address-cells = <1>;
++              #size-cells = <0>;
++              pinctrl-single,register-width = <32>;
++              pinctrl-single,function-mask = <0xffffffff>;
++      };
++
+       ocp {
+               compatible = "simple-bus";
+               #address-cells = <1>;
+               #size-cells = <1>;
+               ranges;
++              ti,hwmods = "l3_main";
++              clocks = <&l3_gclk>;
++              clock-names = "fck";
++
++              edma: edma@49000000 {
++                      compatible = "ti,edma3";
++                      ti,hwmods = "tpcc", "tptc0", "tptc1", "tptc2";
++                      reg =   <0x49000000 0x10000>,
++                              <0x44e10f90 0x10>;
++                      interrupts = <GIC_SPI 12 IRQ_TYPE_LEVEL_HIGH>,
++                                      <GIC_SPI 13 IRQ_TYPE_LEVEL_HIGH>,
++                                      <GIC_SPI 14 IRQ_TYPE_LEVEL_HIGH>;
++                      #dma-cells = <1>;
++                      dma-channels = <64>;
++                      ti,edma-regions = <4>;
++                      ti,edma-slots = <256>;
++              };
+               uart0: serial@44e09000 {
+                       compatible = "ti,am4372-uart","ti,omap2-uart";
+                       reg = <0x44e09000 0x2000>;
+                       interrupts = <GIC_SPI 72 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart1";
++                      clocks = <&dpll_per_m2_div4_wkupdm_ck>;
++                      clock-names = "fck";
++              };
++
++              uart1: serial@48022000 {
++                      compatible = "ti,am4372-uart","ti,omap2-uart";
++                      reg = <0x48022000 0x2000>;
++                      interrupts = <GIC_SPI 73 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart2";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              uart2: serial@48024000 {
++                      compatible = "ti,am4372-uart","ti,omap2-uart";
++                      reg = <0x48024000 0x2000>;
++                      interrupts = <GIC_SPI 74 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart3";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              uart3: serial@481a6000 {
++                      compatible = "ti,am4372-uart","ti,omap2-uart";
++                      reg = <0x481a6000 0x2000>;
++                      interrupts = <GIC_SPI 44 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart4";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              uart4: serial@481a8000 {
++                      compatible = "ti,am4372-uart","ti,omap2-uart";
++                      reg = <0x481a8000 0x2000>;
++                      interrupts = <GIC_SPI 45 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart5";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              uart5: serial@481aa000 {
++                      compatible = "ti,am4372-uart","ti,omap2-uart";
++                      reg = <0x481aa000 0x2000>;
++                      interrupts = <GIC_SPI 46 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "uart6";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              mailbox: mailbox@480C8000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x480C8000 0x200>;
++                      interrupts = <GIC_SPI 77 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <8>;
++                      ti,mbox-names = "wkup_m3";
++                      ti,mbox-data = <0 0 0 0>;
++              };
++
++              qspi: qspi@47900000 {
++                      compatible = "ti,am4372-qspi";
++                      reg = <0x47900000 0x100>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "qspi";
++                      interrupts = <0 138 0x4>;
++                      num-cs = <4>;
++                      mmap_read;
+               };
+               timer1: timer@44e31000 {
+@@ -52,17 +170,818 @@
+                       reg = <0x44e31000 0x400>;
+                       interrupts = <GIC_SPI 67 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,timer-alwon;
++                      ti,hwmods = "timer1";
++                      clocks = <&timer1_fck>;
++                      clock-names = "fck";
+               };
+               timer2: timer@48040000  {
+                       compatible = "ti,am4372-timer","ti,am335x-timer";
+                       reg = <0x48040000  0x400>;
+                       interrupts = <GIC_SPI 68 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer2";
++                      clocks = <&timer2_fck>;
++                      clock-names = "fck";
++              };
++
++              timer3: timer@48042000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x48042000 0x400>;
++                      interrupts = <GIC_SPI 69 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer3";
++                      clocks = <&timer3_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer4: timer@48044000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x48044000 0x400>;
++                      interrupts = <GIC_SPI 92 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,timer-pwm;
++                      ti,hwmods = "timer4";
++                      clocks = <&timer4_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer5: timer@48046000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x48046000 0x400>;
++                      interrupts = <GIC_SPI 93 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,timer-pwm;
++                      ti,hwmods = "timer5";
++                      clocks = <&timer5_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer6: timer@48048000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x48048000 0x400>;
++                      interrupts = <GIC_SPI 94 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,timer-pwm;
++                      ti,hwmods = "timer6";
++                      clocks = <&timer6_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer7: timer@4804a000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x4804a000 0x400>;
++                      interrupts = <GIC_SPI 95 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,timer-pwm;
++                      ti,hwmods = "timer7";
++                      clocks = <&timer7_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer8: timer@481c1000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x481c1000 0x400>;
++                      interrupts = <GIC_SPI 131 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer8";
++                      clocks = <&timer8_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer9: timer@4833d000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x4833d000 0x400>;
++                      interrupts = <GIC_SPI 132 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer9";
++                      clocks = <&timer9_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer10: timer@4833f000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x4833f000 0x400>;
++                      interrupts = <GIC_SPI 133 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer10";
++                      clocks = <&timer10_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              timer11: timer@48341000 {
++                      compatible = "ti,am4372-timer","ti,am335x-timer";
++                      reg = <0x48341000 0x400>;
++                      interrupts = <GIC_SPI 134 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "timer11";
++                      clocks = <&timer11_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               counter32k: counter@44e86000 {
+                       compatible = "ti,am4372-counter32k","ti,omap-counter32k";
+                       reg = <0x44e86000 0x40>;
++                      ti,hwmods = "counter_32k";
++                      clocks = <&synctimer_32kclk>;
++                      clock-names = "fck";
++              };
++
++              rtc: rtc@44e3e000 {
++                      compatible = "ti,am4372-rtc","ti,da830-rtc";
++                      reg = <0x44e3e000 0x1000>;
++                      interrupts = <GIC_SPI 75 IRQ_TYPE_LEVEL_HIGH
++                                    GIC_SPI 76 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "rtc";
++                      clocks = <&clk_32768_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              wdt@44e35000 {
++                      compatible = "ti,am4372-wdt","ti,omap3-wdt";
++                      reg = <0x44e35000 0x1000>;
++                      interrupts = <GIC_SPI 91 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "wd_timer2";
++                      clocks = <&wdt1_fck>;
++                      clock-names = "fck";
++              };
++
++              gpio0: gpio@44e07000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x44e07000 0x1000>;
++                      interrupts = <GIC_SPI 96 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio1";
++                      clocks = <&sys_clkin_ck>, <&gpio0_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              gpio1: gpio@4804c000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x4804c000 0x1000>;
++                      interrupts = <GIC_SPI 98 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio2";
++                      clocks = <&l4ls_gclk>, <&gpio1_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              gpio2: gpio@481ac000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x481ac000 0x1000>;
++                      interrupts = <GIC_SPI 32 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio3";
++                      clocks = <&l4ls_gclk>, <&gpio2_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              gpio3: gpio@481ae000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x481ae000 0x1000>;
++                      interrupts = <GIC_SPI 62 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio4";
++                      clocks = <&l4ls_gclk>, <&gpio3_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              gpio4: gpio@48320000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x48320000 0x1000>;
++                      interrupts = <GIC_SPI 106 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio5";
++                      clocks = <&l4ls_gclk>, <&gpio4_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              gpio5: gpio@48322000 {
++                      compatible = "ti,am4372-gpio","ti,omap4-gpio";
++                      reg = <0x48322000 0x1000>;
++                      interrupts = <GIC_SPI 148 IRQ_TYPE_LEVEL_HIGH>;
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <2>;
++                      ti,hwmods = "gpio6";
++                      clocks = <&l4ls_gclk>, <&gpio5_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      status = "disabled";
++              };
++
++              i2c0: i2c@44e0b000 {
++                      compatible = "ti,am4372-i2c","ti,omap4-i2c";
++                      reg = <0x44e0b000 0x1000>;
++                      interrupts = <GIC_SPI 70 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "i2c1";
++                      clocks = <&dpll_per_m2_div4_wkupdm_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++
++                      tps: tps@24 {
++                              reg = <0x24>;
++                      };
++              };
++
++              i2c1: i2c@4802a000 {
++                      compatible = "ti,am4372-i2c","ti,omap4-i2c";
++                      reg = <0x4802a000 0x1000>;
++                      interrupts = <GIC_SPI 71 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "i2c2";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              i2c2: i2c@4819c000 {
++                      compatible = "ti,am4372-i2c","ti,omap4-i2c";
++                      reg = <0x4819c000 0x1000>;
++                      interrupts = <GIC_SPI 30 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "i2c3";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              spi0: spi@48030000 {
++                      compatible = "ti,am4372-mcspi","ti,omap4-mcspi";
++                      reg = <0x48030000 0x400>;
++                      interrupts = <GIC_SPI 65 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "spi0";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
+               };
++
++              mmc1: mmc@48060000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x48060000 0x1000>;
++                      ti,hwmods = "mmc1";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,dual-volt;
++                      ti,needs-special-reset;
++                      dmas = <&edma 24
++                              &edma 25>;
++                      dma-names = "tx", "rx";
++                      interrupts = <GIC_SPI 64 IRQ_TYPE_LEVEL_HIGH>;
++                      status = "disabled";
++              };
++
++              mmc2: mmc@481d8000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x481d8000 0x1000>;
++                      ti,hwmods = "mmc2";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,needs-special-reset;
++                      dmas = <&edma 2
++                              &edma 3>;
++                      dma-names = "tx", "rx";
++                      interrupts = <GIC_SPI 28 IRQ_TYPE_LEVEL_HIGH>;
++                      status = "disabled";
++              };
++
++              mmc3: mmc@47810000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x47810000 0x1000>;
++                      ti,hwmods = "mmc3";
++                      clocks = <&mmc_clk>, <&clkdiv32k_ick>;
++                      clock-names = "fck", "mmchsdb_fck";
++                      ti,needs-special-reset;
++                      interrupts = <GIC_SPI 29 IRQ_TYPE_LEVEL_HIGH>;
++                      status = "disabled";
++              };
++
++              spi1: spi@481a0000 {
++                      compatible = "ti,am4372-mcspi","ti,omap4-mcspi";
++                      reg = <0x481a0000 0x400>;
++                      interrupts = <GIC_SPI 125 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "spi1";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              spi2: spi@481a2000 {
++                      compatible = "ti,am4372-mcspi","ti,omap4-mcspi";
++                      reg = <0x481a2000 0x400>;
++                      interrupts = <GIC_SPI 126 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "spi2";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              spi3: spi@481a4000 {
++                      compatible = "ti,am4372-mcspi","ti,omap4-mcspi";
++                      reg = <0x481a4000 0x400>;
++                      interrupts = <GIC_SPI 136 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "spi3";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              spi4: spi@48345000 {
++                      compatible = "ti,am4372-mcspi","ti,omap4-mcspi";
++                      reg = <0x48345000 0x400>;
++                      interrupts = <GIC_SPI 137 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "spi4";
++                      clocks = <&dpll_per_m2_div4_ck>;
++                      clock-names = "fck";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      status = "disabled";
++              };
++
++              mac: ethernet@4a100000 {
++                      compatible = "ti,am4372-cpsw","ti,cpsw";
++                      reg = <0x4a100000 0x800
++                             0x4a101200 0x100>;
++                      interrupts = <GIC_SPI 40 IRQ_TYPE_LEVEL_HIGH
++                                    GIC_SPI 41 IRQ_TYPE_LEVEL_HIGH
++                                    GIC_SPI 42 IRQ_TYPE_LEVEL_HIGH
++                                    GIC_SPI 43 IRQ_TYPE_LEVEL_HIGH>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ti,hwmods = "cpgmac0";
++                      clocks = <&cpsw_125mhz_gclk>;
++                      clock-names = "fck";
++                      cpdma_channels = <8>;
++                      ale_entries = <1024>;
++                      bd_ram_size = <0x2000>;
++                      no_bd_ram = <0>;
++                      rx_descs = <64>;
++                      mac_control = <0x20>;
++                      slaves = <2>;
++                      active_slave = <0>;
++                      cpts_clock_mult = <0x80000000>;
++                      cpts_clock_shift = <29>;
++                      ranges;
++                      status = "disabled";
++
++                      davinci_mdio: mdio@4a101000 {
++                              compatible = "ti,am4372-mdio","ti,davinci_mdio";
++                              reg = <0x4a101000 0x100>;
++                              #address-cells = <1>;
++                              #size-cells = <0>;
++                              ti,hwmods = "davinci_mdio";
++                              clocks = <&cpsw_125mhz_gclk>;
++                              clock-names = "fck";
++                              bus_freq = <1000000>;
++                              status = "disabled";
++                      };
++
++                      cpsw_emac0: slave@4a100200 {
++                              /* Filled in by U-Boot */
++                              mac-address = [ 00 00 00 00 00 00 ];
++                      };
++
++                      cpsw_emac1: slave@4a100300 {
++                              /* Filled in by U-Boot */
++                              mac-address = [ 00 00 00 00 00 00 ];
++                      };
++
++                      phy_sel: cpsw-phy-sel@44e10650 {
++                              compatible = "ti,am3352-cpsw-phy-sel";
++                              reg= <0x44e10650 0x4>;
++                              reg-names = "gmii-sel";
++                      };
++              };
++
++              epwmss0: epwmss@48300000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x48300000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss0";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ecap0: ecap@48300100 {
++                              compatible = "ti,am4372-ecap","ti,am33xx-ecap";
++                              reg = <0x48300100 0x80>;
++                              ti,hwmods = "ecap0";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++
++                      ehrpwm0: ehrpwm@48300200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x48300200 0x80>;
++                              ti,hwmods = "ehrpwm0";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              epwmss1: epwmss@48302000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x48302000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss1";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ecap1: ecap@48302100 {
++                              compatible = "ti,am4372-ecap","ti,am33xx-ecap";
++                              reg = <0x48302100 0x80>;
++                              ti,hwmods = "ecap1";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++
++                      ehrpwm1: ehrpwm@48302200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x48302200 0x80>;
++                              ti,hwmods = "ehrpwm1";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              epwmss2: epwmss@48304000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x48304000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss2";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ecap2: ecap@48304100 {
++                              compatible = "ti,am4372-ecap","ti,am33xx-ecap";
++                              reg = <0x48304100 0x80>;
++                              ti,hwmods = "ecap2";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++
++                      ehrpwm2: ehrpwm@48304200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x48304200 0x80>;
++                              ti,hwmods = "ehrpwm2";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              epwmss3: epwmss@48306000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x48306000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss3";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ehrpwm3: ehrpwm@48306200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x48306200 0x80>;
++                              ti,hwmods = "ehrpwm3";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              epwmss4: epwmss@48308000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x48308000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss4";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ehrpwm4: ehrpwm@48308200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x48308200 0x80>;
++                              ti,hwmods = "ehrpwm4";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              epwmss5: epwmss@4830a000 {
++                      compatible = "ti,am4372-pwmss","ti,am33xx-pwmss";
++                      reg = <0x4830a000 0x10>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "epwmss5";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++
++                      ehrpwm5: ehrpwm@4830a200 {
++                              compatible = "ti,am4372-ehrpwm","ti,am33xx-ehrpwm";
++                              reg = <0x4830a200 0x80>;
++                              ti,hwmods = "ehrpwm5";
++                              clocks = <&l4ls_gclk>;
++                              clock-names = "fck";
++                              status = "disabled";
++                      };
++              };
++
++              wkup_m3: wkup_m3@44d00000 {
++                      compatible = "ti,am4372-wkup-m3","ti,am3353-wkup-m3";
++                      reg = <0x44d00000 0x4000        /* M3 UMEM */
++                             0x44d80000 0x2000>;      /* M3 DMEM */
++                      ti,hwmods = "wkup_m3";
++                      clocks = <&sys_clkin_ck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              tscadc: tscadc@44e0d000 {
++                      compatible = "ti,am4372-tscadc","ti,am3359-tscadc";
++                      reg = <0x44e0d000 0x1000>;
++                      ti,hwmods = "adc_tsc";
++                      clocks = <&adc_tsc_fck>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              ocmcram: ocmcram@40300000 {
++                      compatible = "ti,am4372-ocmcram","ti,am3352-ocmcram";
++                      reg = <0x40300000 0x40000>;
++                      ti,hwmods = "ocmcram";
++                      clocks = <&l3_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              dcan0: d_can@481cc000 {
++                      compatible = "bosch,d_can";
++                      ti,hwmods = "d_can0";
++                      clocks = <&dcan0_fck>;
++                      clock-names = "fck";
++                      reg = <0x481cc000 0x2000
++                              0x44e10644 0x4>;
++                      status = "disabled";
++              };
++
++              dcan1: d_can@481d0000 {
++                      compatible = "bosch,d_can";
++                      ti,hwmods = "d_can1";
++                      clocks = <&dcan1_fck>;
++                      clock-names = "fck";
++                      reg = <0x481d0000 0x2000
++                              0x44e10644 0x4>;
++                      status = "disabled";
++              };
++
++              elm: elm@48080000 {
++                      compatible = "ti,am4372-elm","ti,am3352-elm";
++                      reg = <0x48080000 0x2000>;
++                      ti,hwmods = "elm";
++                      clocks = <&l4ls_gclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              gpmc: gpmc@50000000 {
++                      compatible = "ti,am4372-gpmc","ti,am3352-gpmc";
++                      ti,hwmods = "gpmc";
++                      clocks = <&l3s_gclk>;
++                      clock-names = "fck";
++                      reg = <0x50000000 0x2000>;
++                      status = "disabled";
++              };
++
++              prcm: prcm@44df0000 {
++                      compatible = "ti,am4372-prcm";
++                      reg = <0x44df0000 0xa000>;
++                      #reset-cells = <1>;
++              };
++
++              rng: rng@48310000 {
++                      compatible = "ti,omap4-rng";
++                      ti,hwmods = "rng";
++                      reg = <0x48310000 0x2000>;
++                      interrupts = <GIC_SPI 111 IRQ_TYPE_LEVEL_HIGH>;
++                      clocks = <&rng_fck>;
++                      clock-names = "fck";
++              };
++
++              sham: sham@53100000 {
++                      compatible = "ti,omap5-sham";
++                      ti,hwmods = "sham";
++                      reg = <0x53100000 0x300>;
++                      dmas = <&edma 36>;
++                      dma-names = "rx";
++                      interrupts = <GIC_SPI 109 IRQ_TYPE_LEVEL_HIGH>;
++                      clocks = <&l3_gclk>;
++                      clock-names = "fck";
++              };
++
++              aes: aes@53501000 {
++                      compatible = "ti,omap4-aes";
++                      ti,hwmods = "aes";
++                      reg = <0x53501000 0xa0>;
++                      interrupts = <GIC_SPI 103 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&edma 6
++                              &edma 5>;
++                      dma-names = "tx", "rx";
++                      clocks = <&aes0_fck>;
++                      clock-names = "fck";
++              };
++
++              des: des@53701000 {
++                      compatible = "ti,omap4-des";
++                      ti,hwmods = "des";
++                      reg = <0x53701000 0xa0>;
++                      interrupts = <GIC_SPI 130 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&edma 34
++                              &edma 33>;
++                      dma-names = "tx", "rx";
++                      clocks = <&l3_gclk>;
++                      clock-names = "fck";
++              };
++
++              am43xx_control_usb2phy1: control-phy@44e10620 {
++                      compatible = "ti,control-phy-am437usb2";
++                      reg = <0x44e10620 0x4>;
++                      reg-names = "power";
++              };
++
++              am43xx_control_usb2phy2: control-phy@0x44e10628 {
++                      compatible = "ti,control-phy-am437usb2";
++                      reg = <0x44e10628 0x4>;
++                      reg-names = "power";
++              };
++
++              ocp2scp0: ocp2scp@483a8000 {
++                      compatible = "ti,omap-ocp2scp";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "ocp2scp0";
++
++                      usb2_phy1: usb2phy1@483a8000 {
++                              compatible = "ti,am437x-usb2";
++                              reg = <0x483a8000 0x8000>;
++                              ctrl-module = <&am43xx_control_usb2phy1>;
++                              clocks = <&clk_32768_ck>,
++                                       <&usb_otg_ss0_refclk960m>;
++                              clock-names =   "wkupclk",
++                                              "refclk";
++                              #phy-cells = <0>;
++                      };
++
++              };
++
++              ocp2scp1: ocp2scp@483e8000 {
++                      compatible = "ti,omap-ocp2scp";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "ocp2scp1";
++
++                      usb2_phy2: usb2phy2@483e8000 {
++                              compatible = "ti,am437x-usb2";
++                              reg = <0x483e8000 0x8000>;
++                              ctrl-module = <&am43xx_control_usb2phy2>;
++                              clocks = <&clk_32768_ck>,
++                                       <&usb_otg_ss1_refclk960m>;
++                              clock-names =   "wkupclk",
++                                              "refclk";
++                              #phy-cells = <0>;
++                      };
++
++              };
++
++              dwc3_1: omap_dwc3_1@48380000 {
++                      compatible = "ti,am437x-dwc3";
++                      ti,hwmods = "usb_otg_ss0";
++                      reg = <0x48380000 0x10000>;
++                      interrupts = <GIC_SPI 172 IRQ_TYPE_LEVEL_HIGH>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <1>;
++                      ranges;
++                      usb1: usb@48390000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x48390000 0x17000>;
++                              interrupts = <GIC_SPI 168 IRQ_TYPE_LEVEL_HIGH>;
++                              phys = <&usb2_phy1>;
++                              phy-names = "usb2-phy";
++                              maximum-speed = "high-speed";
++                              dr_mode = "peripheral";
++                      };
++              };
++
++              dwc3_2: omap_dwc3_2@483c0000 {
++                      compatible = "ti,am437x-dwc3";
++                      ti,hwmods = "usb_otg_ss1";
++                      reg = <0x483c0000 0x10000>;
++                      interrupts = <GIC_SPI 178 IRQ_TYPE_LEVEL_HIGH>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <1>;
++                      ranges;
++                      usb2: usb@483d0000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x483d0000 0x17000>;
++                              interrupts = <GIC_SPI 174 IRQ_TYPE_LEVEL_HIGH>;
++                              phys = <&usb2_phy2>;
++                              phy-names = "usb2-phy";
++                              maximum-speed = "high-speed";
++                              dr_mode = "host";
++                      };
++              };
++
++              dss: dss@4832A000 {
++                      compatible = "ti,omap3-dss", "simple-bus";
++                      reg = <0x4832A000 0x200>;
++                      ti,hwmods = "dss_core";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++
++                      dispc@4832A400 {
++                              compatible = "ti,omap3-dispc";
++                              reg = <0x4832A400 0x400>;
++                              interrupts = <GIC_SPI 127 IRQ_TYPE_LEVEL_HIGH>;
++                              ti,hwmods = "dss_dispc";
++                      };
++
++                      dpi: encoder@0 {
++                              compatible = "ti,omap3-dpi";
++                      };
++
++                      rfbi: rfbi@4832A800 {
++                              compatible = "ti,omap3-rfbi";
++                      reg = <0x4832A800 0x100>;
++                              ti,hwmods = "dss_rfbi";
++                      };
++
++              };
++
+       };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "am43xx-clocks.dtsi"
++      };
++
+ };
++
++/include/ "tps65218.dtsi"
+--- /dev/null
++++ b/arch/arm/boot/dts/am437x-gp-evm.dts
+@@ -0,0 +1,238 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ */
++
++/* AM437x GP EVM */
++
++/dts-v1/;
++
++#include "am43x-common-evm.dtsi"
++#include <dt-bindings/pinctrl/am43xx.h>
++
++/ {
++      model = "TI AM437x gp EVM";
++      compatible = "ti,am437x-gp-evm","ti,am4372","ti,am43";
++
++      vmmcsd_fixed: fixedregulator-sd {
++              compatible = "regulator-fixed";
++              regulator-name = "vmmcsd_fixed";
++              regulator-min-microvolt = <3300000>;
++              regulator-max-microvolt = <3300000>;
++              enable-active-high;
++      };
++
++      aliases {
++              display0 = &lcd0;
++              display1 = &hdmi0;
++      };
++
++      lcd0: display@0 {
++              compatible = "osddisplays,osd057T0559-34ts", "panel-dpi";
++              video-source = <&dpi>;
++              data-lines = <24>;
++              gpios = <0                          /* No Enable GPIO */
++                       &gpio0 7 GPIO_ACTIVE_LOW>; /* LCD backlight GPIO */
++              activelow_backlight;                /* LCD backlight is Active low */
++              panel-timing {
++                      clock-frequency = <33000000>;
++                      hactive = <800>;
++                      vactive = <480>;
++                      hfront-porch = <210>;
++                      hback-porch = <16>;
++                      hsync-len = <30>;
++                      vback-porch = <10>;
++                      vfront-porch = <22>;
++                      vsync-len = <13>;
++                      hsync-active = <0>;
++                      vsync-active = <0>;
++                      de-active = <1>;
++                      pixelclk-active = <1>;
++              };
++      };
++
++      hdmi0: connector@1 {
++              compatible = "ti,hdmi_connector";
++              video-source = <&sii9022>;
++      };
++};
++
++&am43xx_pinmux {
++      pinctrl-names = "default";
++      pinctrl-0 = <&dss_pinctrl>;
++      cpsw_default: cpsw_default {
++              pinctrl-single,pins = <
++                      /* Slave 1 */
++                      0x114 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txen.rgmii1_txen */
++                      0x118 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxdv.rgmii1_rxctl */
++                      0x11c (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd1.rgmii1_txd3 */
++                      0x120 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd0.rgmii1_txd2 */
++                      0x124 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd1.rgmii1_txd1 */
++                      0x128 (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txd0.rgmii1_txd0 */
++                      0x12c (PIN_OUTPUT_PULLDOWN | MUX_MODE2) /* mii1_txclk.rmii1_tclk */
++                      0x130 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxclk.rmii1_rclk */
++                      0x134 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd1.rgmii1_rxd3 */
++                      0x138 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd0.rgmii1_rxd2 */
++                      0x13c (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd1.rgmii1_rxd1 */
++                      0x140 (PIN_INPUT_PULLDOWN | MUX_MODE2)  /* mii1_rxd0.rgmii1_rxd0 */
++              >;
++      };
++
++      cpsw_sleep: cpsw_sleep {
++              pinctrl-single,pins = <
++                      /* Slave 1 reset value */
++                      0x10c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x114 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x118 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x11c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x120 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x124 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x128 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x12c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x130 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x134 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x138 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x13c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x140 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++              >;
++      };
++
++      davinci_mdio_default: davinci_mdio_default {
++              pinctrl-single,pins = <
++                      /* MDIO */
++                      0x148 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* mdio_data.mdio_data */
++                      0x14c (PIN_OUTPUT_PULLUP | MUX_MODE0)                   /* mdio_clk.mdio_clk */
++              >;
++      };
++
++      davinci_mdio_sleep: davinci_mdio_sleep {
++              pinctrl-single,pins = <
++                      /* MDIO reset value */
++                      0x148 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++              >;
++      };
++
++      mmc1_pins: pinmux_mmc1_pins {
++              pinctrl-single,pins = <
++                      0x160 (PIN_INPUT | MUX_MODE7) /* spi0_cs1.gpio0_6 */
++              >;
++      };
++
++      i2c0_pins: pinmux_i2c0_pins {
++              pinctrl-single,pins = <
++                      0x188 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c0_sda.i2c0_sda */
++                      0x18c (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c0_scl.i2c0_scl */
++              >;
++      };
++
++      i2c1_pins: i2c1_pins {
++              pinctrl-single,pins = <
++                      0x15c   (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE2)  /* spi0_cs0.i2c1_scl */
++                      0x158   (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE2)  /* spi0_d1.i2c1_sda */
++              >;
++      };
++
++      dss_pinctrl: dss_pinctrl {
++              pinctrl-single,pins = <
++                      0x020 (PIN_OUTPUT_PULLUP | MUX_MODE1) /*gpmc ad 8 -> DSS DATA 23 */
++                      0x024 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x028 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x02C (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x030 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x034 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x038 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x03C (PIN_OUTPUT_PULLUP | MUX_MODE1) /*gpmc ad 15 -> DSS DATA 16 */
++                      0x0A0 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS DATA 0 */
++                      0x0A4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0A8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0AC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0BC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0CC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0DC (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS DATA 15 */
++                      0x0E0 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS VSYNC */
++                      0x0E4 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS HSYNC */
++                      0x0E8 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS PCLK */
++                      0x0EC (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS AC BIAS EN */
++                      0x238 (PIN_OUTPUT_PULLUP | MUX_MODE7) /* GPIO 5_8 to select LCD / HDMI */
++                      0x164 (PIN_OUTPUT_PULLUP | MUX_MODE7) /* ECAP0_IN_PWM0_OUT -> GPIO 0_7 BACKLIGHT */
++              >;
++      };
++};
++
++&rtc {
++      status = "okay";
++};
++
++&gpio0 {
++      status = "okay";
++};
++
++&gpio5 {
++      status = "okay";
++};
++
++&mac {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&cpsw_default>;
++      pinctrl-1 = <&cpsw_sleep>;
++      status = "okay";
++};
++
++&davinci_mdio {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&davinci_mdio_default>;
++      pinctrl-1 = <&davinci_mdio_sleep>;
++      status = "okay";
++};
++
++&cpsw_emac0 {
++      phy_id = <&davinci_mdio>, <0>;
++      phy-mode = "rgmii";
++};
++
++&cpsw_emac1 {
++      phy_id = <&davinci_mdio>, <1>;
++      phy-mode = "rgmii";
++};
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&vmmcsd_fixed>;
++      bus-width = <4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio0 6 GPIO_ACTIVE_HIGH>;
++};
++
++&i2c0 {
++        status = "okay";
++        pinctrl-names = "default";
++        pinctrl-0 = <&i2c0_pins>;
++};
++
++&i2c1 {
++        status = "okay";
++        pinctrl-names = "default";
++        pinctrl-0 = <&i2c1_pins>;
++
++      sii9022: sii9022@3b {
++              compatible = "sii,sii9022";
++              reg = <0x3b>;
++              reset-gpio = <&gpio5 8 GPIO_ACTIVE_LOW>;/* 'SelLCDorHDMI' Gpio, LOW to select HDMI */
++              video-source = <&dpi>;
++              data-lines = <24>;
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/am43x-common-evm.dtsi
+@@ -0,0 +1,9 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ */
++
++#include "am4372.dtsi"
+--- a/arch/arm/boot/dts/am43x-epos-evm.dts
++++ b/arch/arm/boot/dts/am43x-epos-evm.dts
+@@ -10,9 +10,289 @@
+ /dts-v1/;
+-#include "am4372.dtsi"
++#include "am43x-common-evm.dtsi"
++#include <dt-bindings/pinctrl/am43xx.h>
+ / {
+       model = "TI AM43x EPOS EVM";
+       compatible = "ti,am43x-epos-evm","ti,am4372","ti,am43";
++
++      vmmcsd_fixed: fixedregulator-sd {
++              compatible = "regulator-fixed";
++              regulator-name = "vmmcsd_fixed";
++              regulator-min-microvolt = <3300000>;
++              regulator-max-microvolt = <3300000>;
++              enable-active-high;
++      };
++
++      aliases {
++              display0 = &lcd0;
++              display1 = &hdmi0;
++      };
++
++      lcd0: display@0 {
++              compatible = "osddisplays,osd057T0559-34ts", "panel-dpi";
++              video-source = <&dpi>;
++              data-lines = <24>;
++              gpios = <0                          /* No Enable GPIO */
++                       &gpio0 7 GPIO_ACTIVE_LOW>; /* LCD backlight GPIO */
++              panel-timing {
++                      clock-frequency = <33000000>;
++                      hactive = <800>;
++                      vactive = <480>;
++                      hfront-porch = <210>;
++                      hback-porch = <16>;
++                      hsync-len = <30>;
++                      vback-porch = <10>;
++                      vfront-porch = <22>;
++                      vsync-len = <13>;
++                      hsync-active = <0>;
++                      vsync-active = <0>;
++                      de-active = <1>;
++                      pixelclk-active = <1>;
++              };
++      };
++
++      hdmi0: connector@1 {
++              compatible = "ti,hdmi_connector";
++              video-source = <&sii9022>;
++      };
++};
++
++&am43xx_pinmux {
++      pinctrl-names = "default";
++      pinctrl-0 = <&dss_pinctrl>;
++      cpsw_default: cpsw_default {
++              pinctrl-single,pins = <
++                      /* Slave 1 */
++                      0x10c (PIN_INPUT_PULLDOWN | MUX_MODE1)  /* mii1_crs.rmii1_crs */
++                      0x110 (PIN_INPUT_PULLDOWN | MUX_MODE1)  /* mii1_rxerr.rmii1_rxerr */
++                      0x114 (PIN_OUTPUT_PULLDOWN | MUX_MODE1) /* mii1_txen.rmii1_txen */
++                      0x118 (PIN_INPUT_PULLDOWN | MUX_MODE1)  /* mii1_rxdv.rmii1_rxdv */
++                      0x124 (PIN_OUTPUT_PULLDOWN | MUX_MODE1) /* mii1_txd1.rmii1_txd1 */
++                      0x128 (PIN_OUTPUT_PULLDOWN | MUX_MODE1) /* mii1_txd0.rmii1_txd0 */
++                      0x13c (PIN_INPUT_PULLDOWN | MUX_MODE1)  /* mii1_rxd1.rmii1_rxd1 */
++                      0x140 (PIN_INPUT_PULLDOWN | MUX_MODE1)  /* mii1_rxd0.rmii1_rxd0 */
++                      0x144 (PIN_INPUT_PULLDOWN | MUX_MODE0)  /* rmii1_refclk.rmii1_refclk */
++              >;
++      };
++
++      cpsw_sleep: cpsw_sleep {
++              pinctrl-single,pins = <
++                      /* Slave 1 reset value */
++                      0x10c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x110 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x114 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x118 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x124 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x128 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x13c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x140 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x144 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++              >;
++      };
++
++      davinci_mdio_default: davinci_mdio_default {
++              pinctrl-single,pins = <
++                      /* MDIO */
++                      0x148 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* mdio_data.mdio_data */
++                      0x14c (PIN_OUTPUT_PULLUP | MUX_MODE0)                   /* mdio_clk.mdio_clk */
++              >;
++      };
++
++      davinci_mdio_sleep: davinci_mdio_sleep {
++              pinctrl-single,pins = <
++                      /* MDIO reset value */
++                      0x148 (PIN_INPUT_PULLDOWN | MUX_MODE7)
++                      0x14c (PIN_INPUT_PULLDOWN | MUX_MODE7)
++              >;
++      };
++
++      mmc1_pins: pinmux_mmc1_pins {
++              pinctrl-single,pins = <
++                      0x160 (PIN_INPUT | MUX_MODE7) /* spi0_cs1.gpio0_6 */
++              >;
++      };
++
++      i2c0_pins: pinmux_i2c0_pins {
++              pinctrl-single,pins = <
++                      0x188 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c0_sda.i2c0_sda */
++                      0x18c (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c0_scl.i2c0_scl */
++              >;
++      };
++
++      i2c2_pins: pinmux_i2c2_pins {
++              pinctrl-single,pins = <
++                      0x1c0 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c2_sda.i2c2_sda */
++                      0x1c4 (PIN_INPUT_PULLUP | SLEWCTRL_FAST | MUX_MODE0)    /* i2c2_scl.i2c2_scl */
++              >;
++      };
++
++      spi0_pins: pinmux_spi0_pins {
++              pinctrl-single,pins = <
++                      0x150 (PIN_INPUT | MUX_MODE0)           /* spi0_clk.spi0_clk */
++                      0x154 (PIN_OUTPUT | MUX_MODE0)           /* spi0_d0.spi0_d0 */
++                      0x158 (PIN_INPUT | MUX_MODE0)           /* spi0_d1.spi0_d1 */
++                      0x15c (PIN_OUTPUT | MUX_MODE0)          /* spi0_cs0.spi0_cs0 */
++              >;
++      };
++
++      spi1_pins: pinmux_spi1_pins {
++              pinctrl-single,pins = <
++                      0x190 (PIN_INPUT | MUX_MODE3)           /* mcasp0_aclkx.spi1_clk */
++                      0x194 (PIN_OUTPUT | MUX_MODE3)           /* mcasp0_fsx.spi1_d0 */
++                      0x198 (PIN_INPUT | MUX_MODE3)           /* mcasp0_axr0.spi1_d1 */
++                      0x19c (PIN_OUTPUT | MUX_MODE3)          /* mcasp0_ahclkr.spi1_cs0 */
++              >;
++      };
++
++      pixcir_ts_pins: pixcir_ts_pins {
++              pinctrl-single,pins = <
++                      0x48 (PIN_INPUT_PULLUP | MUX_MODE7)  /* gpmc_a1.gpio1_17 */
++              >;
++      };
++
++      dss_pinctrl: dss_pinctrl {
++              pinctrl-single,pins = <
++                      0x020 (PIN_OUTPUT_PULLUP | MUX_MODE1) /*gpmc ad 8 -> DSS DATA 23 */
++                      0x024 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x028 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x02C (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x030 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x034 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x038 (PIN_OUTPUT_PULLUP | MUX_MODE1)
++                      0x03C (PIN_OUTPUT_PULLUP | MUX_MODE1) /*gpmc ad 15 -> DSS DATA 16 */
++                      0x0A0 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS DATA 0 */
++                      0x0A4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0A8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0AC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0B8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0BC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0C8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0CC (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D0 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D4 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0D8 (PIN_OUTPUT_PULLUP | MUX_MODE0)
++                      0x0DC (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS DATA 15 */
++                      0x0E0 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS VSYNC */
++                      0x0E4 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS HSYNC */
++                      0x0E8 (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS PCLK */
++                      0x0EC (PIN_OUTPUT_PULLUP | MUX_MODE0) /* DSS AC BIAS EN */
++                      0x08C (PIN_OUTPUT_PULLUP | MUX_MODE7) /* GPMC CLK -> GPIO 2_1 to select LCD / HDMI */
++                      0x164 (PIN_OUTPUT_PULLUP | MUX_MODE7) /* ECAP0_IN_PWM0_OUT -> GPIO 0_7 BACKLIGHT */
++              >;
++      };
++};
++
++&gpio0 {
++      status = "okay";
++};
++
++&gpio1 {
++      status = "okay";
++};
++
++&gpio2 {
++      status = "okay";
++};
++
++&qspi {
++      spi-max-frequency = <48000000>;
++      m25p80@0 {
++              compatible = "mx66l51235l";
++              spi-max-frequency = <48000000>;
++              reg = <0>;
++              spi-cpol;
++              spi-cpha;
++              tx-nbits = <1>;
++              rx-nbits = <4>;
++      };
++};
++
++&mac {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&cpsw_default>;
++      pinctrl-1 = <&cpsw_sleep>;
++      status = "okay";
++};
++
++&davinci_mdio {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&davinci_mdio_default>;
++      pinctrl-1 = <&davinci_mdio_sleep>;
++      status = "okay";
++};
++
++&cpsw_emac0 {
++      phy_id = <&davinci_mdio>, <16>;
++      phy-mode = "rmii";
++};
++
++&cpsw_emac1 {
++      phy_id = <&davinci_mdio>, <1>;
++      phy-mode = "rmii";
++};
++
++&phy_sel {
++      rmii-clock-ext;
++};
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&vmmcsd_fixed>;
++      bus-width = <4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio0 6 GPIO_ACTIVE_HIGH>;
++};
++
++&i2c0 {
++      pinctrl-names = "default";
++      pinctrl-0 = <&i2c0_pins>;
++      status = "okay";
++      clock-frequency = <400000>;
++
++      pixcir_ts@5c {
++              compatible = "pixcir,pixcir_tangoc";
++              pinctrl-names = "default";
++              pinctrl-0 = <&pixcir_ts_pins>;
++              reg = <0x5c>;
++              interrupt-parent = <&gpio1>;
++              interrupts = <17 0>;
++
++              attb-gpio = <&gpio1 17 GPIO_ACTIVE_HIGH>;
++
++              x-size = <1024>;
++              y-size = <600>;
++      };
++};
++
++&i2c2 {
++      pinctrl-names = "default";
++      pinctrl-0 = <&i2c2_pins>;
++      status = "okay";
++
++      sii9022: sii9022@3b {
++              compatible = "sii,sii9022";
++              reg = <0x3b>;
++              reset-gpio = <&gpio2 1 GPIO_ACTIVE_LOW>;/* 65'SelLCDorHDMI' Gpio, LOW to select HDMI */
++              video-source = <&dpi>;
++              data-lines = <24>;
++      };
++};
++
++&spi0 {
++      pinctrl-names = "default";
++      pinctrl-0 = <&spi0_pins>;
++      status = "okay";
++};
++
++&spi1 {
++      pinctrl-names = "default";
++      pinctrl-0 = <&spi1_pins>;
++      status = "okay";
+ };
+--- /dev/null
++++ b/arch/arm/boot/dts/am43xx-clocks.dtsi
+@@ -0,0 +1,735 @@
++/*
++ * Device Tree Source for AM43xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++clk_32768_ck: clk_32768_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++clk_rc32k_ck: clk_rc32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_24000000_ck: virt_24000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <24000000>;
++};
++
++virt_25000000_ck: virt_25000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <25000000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++crystal_freq_sel_ck: crystal_freq_sel_ck@44e10040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_19200000_ck>, <&virt_24000000_ck>, <&virt_25000000_ck>, <&virt_26000000_ck>;
++      bit-shift = <29>;
++      reg = <0x44e10040 0x4>;
++      bit-mask = <0x3>;
++};
++
++sysboot_freq_sel_ck: sysboot_freq_sel_ck@44e10040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_19200000_ck>, <&virt_24000000_ck>, <&virt_25000000_ck>, <&virt_26000000_ck>;
++      bit-shift = <22>;
++      reg = <0x44e10040 0x4>;
++      bit-mask = <0x3>;
++};
++
++sys_clkin_ck: sys_clkin_ck@44e10040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sysboot_freq_sel_ck>, <&crystal_freq_sel_ck>;
++      bit-shift = <31>;
++      reg = <0x44e10040 0x4>;
++      bit-mask = <0x1>;
++};
++
++tclkin_ck: tclkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++dpll_core_ck: dpll_core_ck@44df2d20 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-core-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2d20 0x4>, <0x44df2d24 0x4>, <0x44df2d2c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_core_x2_ck: dpll_core_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_core_ck>;
++};
++
++dpll_core_m4_ck: dpll_core_m4_ck@44df2d38 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2d38 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_m5_ck: dpll_core_m5_ck@44df2d3c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2d3c 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_m6_ck: dpll_core_m6_ck@44df2d40 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2d40 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_mpu_ck: dpll_mpu_ck@44df2d60 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2d60 0x4>, <0x44df2d64 0x4>, <0x44df2d6c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_mpu_m2_ck: dpll_mpu_m2_ck@44df2d70 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_mpu_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2d70 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_ddr_ck: dpll_ddr_ck@44df2da0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2da0 0x4>, <0x44df2da4 0x4>, <0x44df2dac 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_ddr_m2_ck: dpll_ddr_m2_ck@44df2db0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_ddr_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2db0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_disp_ck: dpll_disp_ck@44df2e20 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2e20 0x4>, <0x44df2e24 0x4>, <0x44df2e2c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_disp_m2_ck: dpll_disp_m2_ck@44df2e30 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_disp_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2e30 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_ck: dpll_per_ck@44df2de0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-j-type-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2de0 0x4>, <0x44df2de4 0x4>, <0x44df2dec 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_per_m2_ck: dpll_per_m2_ck@44df2df0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2df0 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m2_div4_wkupdm_ck: dpll_per_m2_div4_wkupdm_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++dpll_per_m2_div4_ck: dpll_per_m2_div4_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++adc_tsc_fck: adc_tsc_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++clk_24mhz: clk_24mhz {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++clkdiv32k_ck: clkdiv32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&clk_24mhz>;
++      clock-mult = <1>;
++      clock-div = <732>;
++};
++
++clkdiv32k_ick: clkdiv32k_ick@44df2a38 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ck>;
++      bit-shift = <8>;
++      reg = <0x44df2a38 0x4>;
++};
++
++dcan0_fck: dcan0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dcan1_fck: dcan1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sysclk_div: sysclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++pruss_ocp_gclk: pruss_ocp_gclk@44df4248 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sysclk_div>, <&dpll_disp_m2_ck>;
++      reg = <0x44df4248 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcasp0_fck: mcasp0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mcasp1_fck: mcasp1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++smartreflex0_fck: smartreflex0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++smartreflex1_fck: smartreflex1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sha0_fck: sha0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++rng_fck: rng_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++aes0_fck: aes0_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++clk_32k_tpm_ck: clk_32k_tpm_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++timer1_fck: timer1_fck@44df4200 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&clkdiv32k_ick>, <&tclkin_ck>, <&clk_rc32k_ck>, <&clk_32768_ck>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4200 0x4>;
++      bit-mask = <0x7>;
++};
++
++timer2_fck: timer2_fck@44df4204 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4204 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer3_fck: timer3_fck@44df4208 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4208 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer4_fck: timer4_fck@44df420c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df420c 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer5_fck: timer5_fck@44df4210 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4210 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer6_fck: timer6_fck@44df4214 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4214 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer7_fck: timer7_fck@44df4218 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4218 0x4>;
++      bit-mask = <0x3>;
++};
++
++wdt1_fck: wdt1_fck@44df422c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_rc32k_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df422c 0x4>;
++      bit-mask = <0x1>;
++};
++
++l3_gclk: l3_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_core_m4_div2_ck: dpll_core_m4_div2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sysclk_div>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++l4hs_gclk: l4hs_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3s_gclk: l3s_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l4ls_gclk: l4ls_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4_div2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++cpsw_125mhz_gclk: cpsw_125mhz_gclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m5_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++cpsw_cpts_rft_clk: cpsw_cpts_rft_clk@44df4238 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sysclk_div>, <&dpll_core_m5_ck>, <&dpll_disp_m2_ck>;
++      reg = <0x44df4238 0x4>;
++      bit-mask = <0x3>;
++};
++
++clk_32k_mosc_ck: clk_32k_mosc_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++gpio0_dbclk_mux_ck: gpio0_dbclk_mux_ck@44df4240 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_rc32k_ck>, <&clk_32768_ck>, <&clkdiv32k_ick>, <&clk_32k_mosc_ck>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4240 0x4>;
++      bit-mask = <0x7>;
++};
++
++gpio0_dbclk: gpio0_dbclk@44df2b68 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpio0_dbclk_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x44df2b68 0x4>;
++};
++
++gpio1_dbclk: gpio1_dbclk@44df8c78 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <8>;
++      reg = <0x44df8c78 0x4>;
++};
++
++gpio2_dbclk: gpio2_dbclk@44df8c80 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <8>;
++      reg = <0x44df8c80 0x4>;
++};
++
++gpio3_dbclk: gpio3_dbclk@44df8c88 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <8>;
++      reg = <0x44df8c88 0x4>;
++};
++
++gpio4_dbclk: gpio4_dbclk@44df8c90 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <8>;
++      reg = <0x44df8c90 0x4>;
++};
++
++gpio5_dbclk: gpio5_dbclk@44df8c98 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkdiv32k_ick>;
++      bit-shift = <8>;
++      reg = <0x44df8c98 0x4>;
++};
++
++mmc_clk: mmc_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++gfx_fclk_clksel_ck: gfx_fclk_clksel_ck@44df423c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sysclk_div>, <&dpll_per_m2_ck>;
++      bit-shift = <1>;
++      reg = <0x44df423c 0x4>;
++      bit-mask = <0x1>;
++};
++
++gfx_fck_div_ck: gfx_fck_div_ck@44df423c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&gfx_fclk_clksel_ck>;
++      reg = <0x44df423c 0x4>;
++      bit-mask = <0x1>;
++};
++
++disp_clk: disp_clk@44df4244 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_disp_m2_ck>, <&dpll_core_m5_ck>, <&dpll_per_m2_ck>;
++      reg = <0x44df4244 0x4>;
++      bit-mask = <0x3>;
++};
++
++dpll_extdev_ck: dpll_extdev_ck@44df2e60 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++      reg = <0x44df2e60 0x4>, <0x44df2e64 0x4>, <0x44df2e6c 0x4>;
++      reg-names = "control", "idlest", "mult-div1";
++};
++
++dpll_extdev_m2_ck: dpll_extdev_m2_ck@44df2e70 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_extdev_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2e70 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++mux_synctimer32k_ck: mux_synctimer32k_ck@44df4230 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_32768_ck>, <&clk_32k_tpm_ck>, <&clkdiv32k_ick>;
++      reg = <0x44df4230 0x4>;
++      bit-mask = <0x3>;
++};
++
++synctimer_32kclk: synctimer_32kclk@44df2a30 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mux_synctimer32k_ck>;
++      bit-shift = <8>;
++      reg = <0x44df2a30 0x4>;
++};
++
++timer8_fck: timer8_fck@44df421c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>, <&clk_32k_tpm_ck>;
++      reg = <0x44df421c 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer9_fck: timer9_fck@44df4220 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4220 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer10_fck: timer10_fck@44df4224 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4224 0x4>;
++      bit-mask = <0x3>;
++};
++
++timer11_fck: timer11_fck@44df4228 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&tclkin_ck>, <&sys_clkin_ck>, <&clkdiv32k_ick>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4228 0x4>;
++      bit-mask = <0x3>;
++};
++
++cpsw_50m_clkdiv: cpsw_50m_clkdiv {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m5_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++cpsw_5m_clkdiv: cpsw_5m_clkdiv {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&cpsw_50m_clkdiv>;
++      clock-mult = <1>;
++      clock-div = <10>;
++};
++
++dpll_ddr_x2_ck: dpll_ddr_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_ddr_ck>;
++};
++
++dpll_ddr_m4_ck: dpll_ddr_m4_ck@44df2db8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_ddr_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x44df2db8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_clkdcoldo: dpll_per_clkdcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dll_aging_clk_div: dll_aging_clk_div@44df4250 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin_ck>;
++      reg = <0x44df4250 0x4>;
++      table = < 8 0 >, < 16 1 >, < 32 2 >;
++      bit-mask = <0x3>;
++};
++
++div_core_25m_ck: div_core_25m_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sysclk_div>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++func_12m_clk: func_12m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++vtp_clk_div: vtp_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++usbphy_32khz_clkmux: usbphy_32khz_clkmux@44df4260 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&clk_32768_ck>, <&clk_32k_tpm_ck>;
++      reg = <0x44df4260 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_otg_ss0_refclk960m: usb_otg_ss0_refclk960m@44df8a60 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_clkdcoldo>;
++      bit-shift = <8>;
++      reg = <0x44df8a60 0x4>;
++};
++
++usb_otg_ss1_refclk960m: usb_otg_ss1_refclk960m@44df8a68 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_clkdcoldo>;
++      bit-shift = <8>;
++      reg = <0x44df8a68 0x4>;
++};
++
++usb_phy1_always_on_clk32k: usb_phy1_always_on_clk32k {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clocks = <&clk_32768_ck>;
++};
++
++usb_phy2_always_on_clk32k: usb_phy2_always_on_clk32k {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clocks = <&clk_32768_ck>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/dra7.dtsi
+@@ -0,0 +1,1278 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ * Based on "omap4.dtsi"
++ */
++
++#include <dt-bindings/interrupt-controller/arm-gic.h>
++
++#include "skeleton.dtsi"
++
++/ {
++      compatible = "ti,dra7xx";
++      interrupt-parent = <&gic>;
++
++      aliases {
++              i2c0 = &i2c1;
++              i2c1 = &i2c2;
++              i2c2 = &i2c3;
++              i2c3 = &i2c4;
++              i2c4 = &i2c5;
++              serial0 = &uart1;
++              serial1 = &uart2;
++              serial2 = &uart3;
++              serial3 = &uart4;
++              serial4 = &uart5;
++              serial5 = &uart6;
++              ethernet0 = &cpsw_emac0;
++              ethernet1 = &cpsw_emac1;
++      };
++
++      cpus {
++              #address-cells = <1>;
++              #size-cells = <0>;
++
++              cpu0: cpu@0 {
++                      device_type = "cpu";
++                      compatible = "arm,cortex-a15";
++                      reg = <0>;
++
++                      operating-points = <
++                              /* kHz    uV */
++                              1000000 1090000
++                              1176000 1210000
++                              >;
++
++                      clocks = <&dpll_mpu_ck>;
++                      clock-names = "cpu";
++
++                      clock-latency = <300000>; /* From omap-cpufreq driver */
++              };
++              cpu@1 {
++                      device_type = "cpu";
++                      compatible = "arm,cortex-a15";
++                      reg = <1>;
++              };
++      };
++
++      timer {
++              compatible = "arm,armv7-timer";
++              /* PPI secure/nonsecure IRQ */
++              interrupts = <GIC_PPI 13 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>,
++                           <GIC_PPI 14 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>,
++                           <GIC_PPI 11 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>,
++                           <GIC_PPI 10 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>;
++              clock-frequency = <6144000>;
++      };
++
++      gic: interrupt-controller@48211000 {
++              compatible = "arm,cortex-a15-gic";
++              interrupt-controller;
++              #interrupt-cells = <3>;
++              reg = <0x48211000 0x1000>,
++                    <0x48212000 0x1000>,
++                    <0x48214000 0x2000>,
++                    <0x48216000 0x2000>;
++      };
++
++      /*
++       * The soc node represents the soc top level view. It is uses for IPs
++       * that are not memory mapped in the MPU view or for the MPU itself.
++       */
++      soc {
++              compatible = "ti,omap-infra";
++              mpu {
++                      compatible = "ti,omap5-mpu";
++                      ti,hwmods = "mpu";
++              };
++      };
++
++      /*
++       * XXX: Use a flat representation of the SOC interconnect.
++       * The real OMAP interconnect network is quite complex.
++       * Since that will not bring real advantage to represent that in DT for
++       * the moment, just use a fake OCP bus entry to represent the whole bus
++       * hierarchy.
++       */
++      ocp {
++              compatible = "ti,omap4-l3-noc", "simple-bus";
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              ti,hwmods = "l3_main_1", "l3_main_2";
++
++              crossbar_mpu: mpuirq@4a002a48 {
++                      compatible = "crossbar";
++                      crossbar-name = "mpu-irq";
++                      reg = <0x4a002a48 0x0130>;
++                      reg-width = <16>;
++                      crossbar-lines = "mpu-irq", "rtc-ss-alarm", <0x9f 0xd9 0x12e>,
++                                       "mpu-irq", "mcasp3-arevt", <0x9e 0x96 0x12c>,
++                                       "mpu-irq", "mcasp3-axevt", <0x9d 0x97 0x12a>,
++                                       "mpu-irq", "mailbox5", <0x88 0xfb 0x100>,
++                                       "mpu-irq", "mailbox6", <0x8d 0xff 0x10a>,
++                                       "mpu-irq", "qspi", <0x7c 0x157 0x0ec>,
++                                       "mpu-irq", "vpe", <0x9c 0x162 0x128>,
++                                       "mpu-irq", "cpsw-rx-thresh", <0x32 0x14e 0x58>,
++                                       "mpu-irq", "cpsw-rx", <0x33 0x14f 0x5a>,
++                                       "mpu-irq", "cpsw-tx", <0x34 0x150 0x5c>,
++                                       "mpu-irq", "cpsw-misc", <0x35 0x151 0x5e>;
++              };
++
++              crossbar_dma: dmareq@4a002b78 {
++                      compatible = "crossbar";
++                      crossbar-name = "dma-req";
++                      reg = <0x4a002b78 0x0100>;
++                      reg-width = <16>;
++                      crossbar-lines = "dma-req", "mcasp3-rx", <0x7e 0x84 0xfc>,
++                                       "dma-req", "mcasp3-tx", <0x7d 0x85 0xfa>;
++              };
++
++              prcm: prcm@4ae06000 {
++                      compatible = "ti,dra7-prcm";
++                      reg = <0x4ae06000 0x1f00>;
++                      #reset-cells = <1>;
++              };
++
++              counter32k: counter@4ae04000 {
++                      compatible = "ti,omap-counter32k";
++                      reg = <0x4ae04000 0x40>;
++                      ti,hwmods = "counter_32k";
++                      clocks = <&wkupaon_iclk_mux>;
++                      clock-names = "fck";
++              };
++
++              avs_mpu: regulator-avs@0x4A003B18 {
++                      compatible = "ti,avsclass0";
++                      reg = <0x4A003B18 20>;
++                      efuse-settings = <1090000 8
++                      1210000 12
++                      1280000 16>;
++              };
++
++              avs_core: regulator-avs@0x4A0025EC {
++                      compatible = "ti,avsclass0";
++                      reg = <0x4A0025EC 20>;
++                      efuse-settings = <1030000 8>;
++              };
++
++              avs_gpu: regulator-avs@0x4A003B00 {
++                      compatible = "ti,avsclass0";
++                      reg = <0x4A003B00 20>;
++                      efuse-settings = <1090000 8
++                      1210000 12
++                      1280000 16>;
++              };
++
++              avs_dspeve: regulator-avs@0x4A0025D8 {
++                      compatible = "ti,avsclass0";
++                      reg = <0x4A0025D8 20>;
++                      efuse-settings = <1055000 8
++                      1150000 12
++                      1250000 16>;
++              };
++
++              avs_iva: regulator-avs@0x4A0025C4 {
++                      compatible = "ti,avsclass0";
++                      reg = <0x4A0025C4 20>;
++                      efuse-settings = <1055000 8
++                      1150000 12
++                      1250000 16>;
++              };
++
++              dra7_pmx_core: pinmux@4a003400 {
++                      compatible = "pinctrl-single";
++                      reg = <0x4a003400 0x0464>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      pinctrl-single,register-width = <32>;
++                      pinctrl-single,function-mask = <0x3fffffff>;
++              };
++
++              sdma: dma-controller@4a056000 {
++                      compatible = "ti,omap4430-sdma";
++                      reg = <0x4a056000 0x1000>;
++                      interrupts = <0 12 0x4>,
++                                   <0 13 0x4>,
++                                   <0 14 0x4>,
++                                   <0 15 0x4>;
++                      #dma-cells = <1>;
++                      #dma-channels = <32>;
++                      #dma-requests = <127>;
++                      clocks = <&l3_iclk_div>;
++                      clock-names = "fck";
++              };
++
++              gpio1: gpio@4ae10000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x4ae10000 0x200>;
++                      interrupts = <0 29 0x4>;
++                      ti,hwmods = "gpio1";
++                      clocks = <&wkupaon_iclk_mux>, <&gpio1_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio2: gpio@48055000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x48055000 0x200>;
++                      interrupts = <0 30 0x4>;
++                      ti,hwmods = "gpio2";
++                      clocks = <&l3_iclk_div>, <&gpio2_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio3: gpio@48057000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x48057000 0x200>;
++                      interrupts = <0 31 0x4>;
++                      ti,hwmods = "gpio3";
++                      clocks = <&l3_iclk_div>, <&gpio3_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio4: gpio@48059000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x48059000 0x200>;
++                      interrupts = <0 32 0x4>;
++                      ti,hwmods = "gpio4";
++                      clocks = <&l3_iclk_div>, <&gpio4_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio5: gpio@4805b000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x4805b000 0x200>;
++                      interrupts = <0 33 0x4>;
++                      ti,hwmods = "gpio5";
++                      clocks = <&l3_iclk_div>, <&gpio5_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio6: gpio@4805d000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x4805d000 0x200>;
++                      interrupts = <0 34 0x4>;
++                      ti,hwmods = "gpio6";
++                      clocks = <&l3_iclk_div>, <&gpio6_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio7: gpio@48051000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x48051000 0x200>;
++                      interrupts = <0 35 0x4>;
++                      ti,hwmods = "gpio7";
++                      clocks = <&l3_iclk_div>, <&gpio7_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              gpio8: gpio@48053000 {
++                      compatible = "ti,omap4-gpio";
++                      reg = <0x48053000 0x200>;
++                      interrupts = <0 121 0x4>;
++                      ti,hwmods = "gpio8";
++                      clocks = <&l3_iclk_div>, <&gpio8_dbclk>;
++                      clock-names = "fck", "dbclk";
++                      gpio-controller;
++                      #gpio-cells = <2>;
++                      interrupt-controller;
++                      #interrupt-cells = <1>;
++              };
++
++              uart1: serial@4806a000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x4806a000 0x100>;
++                      interrupts = <0 72 0x4>;
++                      ti,hwmods = "uart1";
++                      clocks = <&uart1_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart2: serial@4806c000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x4806c000 0x100>;
++                      interrupts = <0 73 0x4>;
++                      ti,hwmods = "uart2";
++                      clocks = <&uart2_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart3: serial@48020000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48020000 0x100>;
++                      interrupts = <0 74 0x4>;
++                      ti,hwmods = "uart3";
++                      clocks = <&uart3_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart4: serial@4806e000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x4806e000 0x100>;
++                      interrupts = <0 70 0x4>;
++                      ti,hwmods = "uart4";
++                      clocks = <&uart4_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                        status = "disabled";
++              };
++
++              uart5: serial@48066000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48066000 0x100>;
++                      interrupts = <0 105 0x4>;
++                      ti,hwmods = "uart5";
++                      clocks = <&uart5_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart6: serial@48068000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48068000 0x100>;
++                      interrupts = <0 106 0x4>;
++                      ti,hwmods = "uart6";
++                      clocks = <&uart6_gfclk_mux>;
++                      clock-names = "fck";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart7: serial@48420000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48420000 0x100>;
++                      ti,hwmods = "uart7";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart8: serial@48422000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48422000 0x100>;
++                      ti,hwmods = "uart8";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart9: serial@48424000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x48424000 0x100>;
++                      ti,hwmods = "uart9";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              uart10: serial@4ae2b000 {
++                      compatible = "ti,omap4-uart";
++                      reg = <0x4ae2b000 0x100>;
++                      ti,hwmods = "uart10";
++                      clock-frequency = <48000000>;
++                      status = "disabled";
++              };
++
++              mailbox1: mailbox@4a0f4000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4a0f4000 0x200>;
++                      interrupts = <0 26 0x4>;
++                      ti,hwmods = "mailbox1";
++                      ti,mbox-num-users = <3>;
++                      ti,mbox-num-fifos = <8>;
++                      #ti,mbox-data-cells = <4>;
++                      ti,mbox-names = "mbox1-1", "mbox1-2";
++                      ti,mbox-data = <0 1 0 0>, <3 2 0 0>;
++              };
++
++              mailbox2: mailbox@4883a000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4883a000 0x200>;
++                      ti,hwmods = "mailbox2";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox3: mailbox@4883c000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4883c000 0x200>;
++                      ti,hwmods = "mailbox3";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox4: mailbox@4883e000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4883e000 0x200>;
++                      ti,hwmods = "mailbox4";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox5: mailbox@48840000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48840000 0x200>;
++                      interrupts = <0 136 0x4>;
++                      ti,hwmods = "mailbox5";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      ti,mbox-names = "mbox-ipu1", "mbox-dsp1";
++                      ti,mbox-data = <6 4 0 2>, <5 1 0 2>;
++              };
++
++              mailbox6: mailbox@48842000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48842000 0x200>;
++                      interrupts = <0 141 0x4>;
++                      ti,hwmods = "mailbox6";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      ti,mbox-names = "mbox-ipu2", "mbox-dsp2";
++                      ti,mbox-data = <6 4 0 2>, <5 1 0 2>;
++              };
++
++              mailbox7: mailbox@48844000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48844000 0x200>;
++                      ti,hwmods = "mailbox7";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox8: mailbox@48846000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48846000 0x200>;
++                      ti,hwmods = "mailbox8";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox9: mailbox@4885e000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4885e000 0x200>;
++                      ti,hwmods = "mailbox9";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox10: mailbox@48860000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48860000 0x200>;
++                      ti,hwmods = "mailbox10";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox11: mailbox@48862000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48862000 0x200>;
++                      ti,hwmods = "mailbox11";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox12: mailbox@48864000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48864000 0x200>;
++                      ti,hwmods = "mailbox12";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              mailbox13: mailbox@48802000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x48802000 0x200>;
++                      ti,hwmods = "mailbox13";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <12>;
++                      #ti,mbox-data-cells = <4>;
++                      status = "disabled";
++              };
++
++              timer1: timer@4ae18000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x4ae18000 0x80>;
++                      interrupts = <0 37 0x4>;
++                      ti,hwmods = "timer1";
++                      clocks = <&timer1_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-alwon;
++              };
++
++              timer2: timer@48032000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48032000 0x80>;
++                      interrupts = <0 38 0x4>;
++                      ti,hwmods = "timer2";
++                      clocks = <&timer2_gfclk_mux>;
++                      clock-names = "fck";
++              };
++
++              timer3: timer@48034000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48034000 0x80>;
++                      interrupts = <0 39 0x4>;
++                      ti,hwmods = "timer3";
++                      clocks = <&timer3_gfclk_mux>;
++                      clock-names = "fck";
++              };
++
++              timer4: timer@48036000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48036000 0x80>;
++                      interrupts = <0 40 0x4>;
++                      ti,hwmods = "timer4";
++                      clocks = <&timer4_gfclk_mux>;
++                      clock-names = "fck";
++              };
++
++              timer5: timer@48820000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48820000 0x80>;
++                      interrupts = <0 41 0x4>;
++                      ti,hwmods = "timer5";
++                      clocks = <&timer5_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-dsp;
++              };
++
++              timer6: timer@48822000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48822000 0x80>;
++                      interrupts = <0 42 0x4>;
++                      ti,hwmods = "timer6";
++                      clocks = <&timer6_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-dsp;
++                      ti,timer-pwm;
++              };
++
++              timer7: timer@48824000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48824000 0x80>;
++                      interrupts = <0 43 0x4>;
++                      ti,hwmods = "timer7";
++                      clocks = <&timer7_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-dsp;
++              };
++
++              timer8: timer@48826000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48826000 0x80>;
++                      interrupts = <0 44 0x4>;
++                      ti,hwmods = "timer8";
++                      clocks = <&timer8_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-dsp;
++                      ti,timer-pwm;
++              };
++
++              timer9: timer@4803e000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x4803e000 0x80>;
++                      interrupts = <0 45 0x4>;
++                      ti,hwmods = "timer9";
++                      clocks = <&timer9_gfclk_mux>;
++                      clock-names = "fck";
++              };
++
++              timer10: timer@48086000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48086000 0x80>;
++                      interrupts = <0 46 0x4>;
++                      ti,hwmods = "timer10";
++                      clocks = <&timer10_gfclk_mux>;
++                      clock-names = "fck";
++              };
++
++              timer11: timer@48088000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48088000 0x80>;
++                      interrupts = <0 47 0x4>;
++                      ti,hwmods = "timer11";
++                      clocks = <&timer11_gfclk_mux>;
++                      clock-names = "fck";
++                      ti,timer-pwm;
++              };
++
++              timer13: timer@48828000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x48828000 0x80>;
++                      ti,hwmods = "timer13";
++                      status = "disabled";
++              };
++
++              timer14: timer@4882a000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x4882a000 0x80>;
++                      ti,hwmods = "timer14";
++                      status = "disabled";
++              };
++
++              timer15: timer@4882c000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x4882c000 0x80>;
++                      ti,hwmods = "timer15";
++                      status = "disabled";
++              };
++
++              timer16: timer@4882e000 {
++                      compatible = "ti,omap5430-timer";
++                      reg = <0x4882e000 0x80>;
++                      ti,hwmods = "timer16";
++                      status = "disabled";
++              };
++
++              wdt2: wdt@4ae14000 {
++                      compatible = "ti,omap4-wdt";
++                      reg = <0x4ae14000 0x80>;
++                      interrupts = <0 80 0x4>;
++                      ti,hwmods = "wd_timer2";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
++              };
++
++              i2c1: i2c@48070000 {
++                      compatible = "ti,omap4-i2c";
++                      reg = <0x48070000 0x100>;
++                      interrupts = <0 56 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "i2c1";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              i2c2: i2c@48072000 {
++                      compatible = "ti,omap4-i2c";
++                      reg = <0x48072000 0x100>;
++                      interrupts = <0 57 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "i2c2";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              i2c3: i2c@48060000 {
++                      compatible = "ti,omap4-i2c";
++                      reg = <0x48060000 0x100>;
++                      interrupts = <0 61 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "i2c3";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              i2c4: i2c@4807a000 {
++                      compatible = "ti,omap4-i2c";
++                      reg = <0x4807a000 0x100>;
++                      interrupts = <0 62 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "i2c4";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              i2c5: i2c@4807c000 {
++                      compatible = "ti,omap4-i2c";
++                      reg = <0x4807c000 0x100>;
++                      interrupts = <0 60 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "i2c5";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
++              };
++
++              mmc1: mmc@4809c000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x4809c000 0x400>;
++                      interrupts = <0 83 0x4>;
++                      ti,hwmods = "mmc1";
++                      clocks = <&mmc1_fclk_div>, <&mmc1_clk32k>;
++                      clock-names = "fck", "clk32k";
++                      ti,dual-volt;
++                      ti,needs-special-reset;
++                      dmas = <&sdma 61>, <&sdma 62>;
++                      dma-names = "tx", "rx";
++                      status = "disabled";
++              };
++
++              mmc2: mmc@480b4000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x480b4000 0x400>;
++                      interrupts = <0 86 0x4>;
++                      ti,hwmods = "mmc2";
++                      clocks = <&mmc2_fclk_div>, <&mmc2_clk32k>;
++                      clock-names = "fck", "clk32k";
++                      ti,needs-special-reset;
++                      dmas = <&sdma 47>, <&sdma 48>;
++                      dma-names = "tx", "rx";
++                      status = "disabled";
++              };
++
++              mmc3: mmc@480ad000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x480ad000 0x400>;
++                      interrupts = <0 94 0x4>;
++                      ti,hwmods = "mmc3";
++                      clocks = <&mmc3_gfclk_div>, <&mmc3_clk32k>;
++                      clock-names = "fck", "clk32k";
++                      ti,needs-special-reset;
++                      dmas = <&sdma 77>, <&sdma 78>;
++                      dma-names = "tx", "rx";
++                      status = "disabled";
++              };
++
++              mmc4: mmc@480d1000 {
++                      compatible = "ti,omap4-hsmmc";
++                      reg = <0x480d1000 0x400>;
++                      interrupts = <0 96 0x4>;
++                      ti,hwmods = "mmc4";
++                      clocks = <&mmc4_gfclk_div>, <&mmc4_clk32k>;
++                      clock-names = "fck", "clk32k";
++                      ti,needs-special-reset;
++                      dmas = <&sdma 57>, <&sdma 58>;
++                      dma-names = "tx", "rx";
++                      status = "disabled";
++              };
++
++              qspi: qspi@4b300000 {
++                      compatible = "ti,dra7xxx-qspi";
++                      reg = <0x4b300000 0x100>, <0x4a002558 0x4>,
++                              <0x5c000000 0x3ffffff>;
++                      reg-names = "qspi_base",
++                              "qspi_ctrlmod",
++                              "qspi_mmap";
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "qspi";
++                      ti,spi-num-cs = <4>;
++                      interrupts = <0 124 0x4>;
++                      mmap_read;
++              };
++
++              omap_control_sata: control-phy@4a002374 {
++                      compatible = "ti,control-phy-pipe3";
++                      reg = <0x4a002374 0x4>;
++                      reg-names = "power";
++                      clocks = <&sys_clkin1>;
++                      clock-names = "sysclk";
++              };
++
++              ocp2scp@4a090000 {
++                      compatible = "ti,omap-ocp2scp";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "ocp2scp3";
++                      reg = <0x4a090000 0x400>;       /* ocp2scp3 */
++                      sata_phy: sata-phy@4A096000 {
++                              compatible = "ti,phy-pipe3-sata";
++                              reg = <0x4A096000 0x80>, /* phy_rx */
++                                    <0x4A096400 0x64>, /* phy_tx */
++                                    <0x4A096800 0x40>; /* pll_ctrl */
++                              reg-names = "phy_rx", "phy_tx", "pll_ctrl";
++                              ctrl-module = <&omap_control_sata>;
++                              clocks = <&sata_ref_clk>;
++                              clock-names = "refclk";
++                              #phy-cells = <0>;
++                      };
++              };
++
++              sata@4a141100 {
++                      compatible = "ti,sata";
++                      ti,hwmods = "sata";
++                      reg = <0x4a141100 0x100>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      sata@4a140000 {
++                                compatible = "snps,dwc-ahci";
++                                reg = <0x4a140000 0x1100>;
++                                interrupts = <0 54 0x4>;
++                                phys = <&sata_phy>;
++                                phy-names = "sata-phy";
++                      };
++              };
++
++
++              mcspi1: spi@48098000 {
++                      compatible = "ti,omap4-mcspi";
++                      reg = <0x48098000 0x200>;
++                      interrupts = <0 65 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "mcspi1";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
++                      ti,spi-num-cs = <4>;
++                      dmas = <&sdma 35>,
++                             <&sdma 36>,
++                             <&sdma 37>,
++                             <&sdma 38>,
++                             <&sdma 39>,
++                             <&sdma 40>,
++                             <&sdma 41>,
++                             <&sdma 42>;
++                      dma-names = "tx0", "rx0", "tx1", "rx1",
++                                  "tx2", "rx2", "tx3", "rx3";
++                      status = "disabled";
++              };
++
++              mcspi2: spi@4809a000 {
++                      compatible = "ti,omap4-mcspi";
++                      reg = <0x4809a000 0x200>;
++                      interrupts = <0 66 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "mcspi2";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
++                      ti,spi-num-cs = <2>;
++                      dmas = <&sdma 43>,
++                             <&sdma 44>,
++                             <&sdma 45>,
++                             <&sdma 46>;
++                      dma-names = "tx0", "rx0", "tx1", "rx1";
++                      status = "disabled";
++              };
++
++              mcspi3: spi@480b8000 {
++                      compatible = "ti,omap4-mcspi";
++                      reg = <0x480b8000 0x200>;
++                      interrupts = <0 91 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "mcspi3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
++                      ti,spi-num-cs = <2>;
++                      dmas = <&sdma 15>, <&sdma 16>;
++                      dma-names = "tx0", "rx0";
++                      status = "disabled";
++              };
++
++              mcspi4: spi@480ba000 {
++                      compatible = "ti,omap4-mcspi";
++                      reg = <0x480ba000 0x200>;
++                      interrupts = <0 48 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++                      ti,hwmods = "mcspi4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
++                      ti,spi-num-cs = <1>;
++                      dmas = <&sdma 70>, <&sdma 71>;
++                      dma-names = "tx0", "rx0";
++                      status = "disabled";
++              };
++
++              rtcss@48838000 {
++                      compatible = "ti,da830-rtc";
++                      reg = <0x48838000 0x100>;
++                      interrupts = <0 159 0x4>,
++                                   <0 159 0x4>;
++                      ti,hwmods = "rtcss";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
++              };
++
++              omap_control_usb2phy1: control-phy@4a002300 {
++                      compatible = "ti,control-phy-usb2";
++                      reg = <0x4a002300 0x4>;
++                      reg-names = "power";
++              };
++
++              omap_control_usb3phy1: control-phy@4a002370 {
++                      compatible = "ti,control-phy-pipe3";
++                      reg = <0x4a002370 0x4>;
++                      reg-names = "power";
++              };
++
++              omap_control_usb2phy2: control-phy@0x4a002e74 {
++                      compatible = "ti,control-phy-dra7usb2";
++                      reg = <0x4a002e74 0x4>;
++                      reg-names = "power";
++              };
++
++              ocp2scp@4a080000 {
++                      compatible = "ti,omap-ocp2scp";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "ocp2scp1";
++                      reg = <0x4a080000 0x400>;       /* ocp2scp1 */
++
++                      usb2_phy1: usb2phy1@4a084000 {
++                              compatible = "ti,omap-usb2";
++                              reg = <0x4a084000 0x400>;
++                              ctrl-module = <&omap_control_usb2phy1>;
++                              clocks = <&usb_phy1_always_on_clk32k>,
++                                       <&usb_otg_ss1_refclk960m>;
++                              clock-names =   "wkupclk",
++                                              "refclk";
++                              #phy-cells = <0>;
++                      };
++
++                      usb2_phy2: usb2phy2@4a085000 {
++                              compatible = "ti,omap-usb2";
++                              reg = <0x4a085000 0x400>;
++                              ctrl-module = <&omap_control_usb2phy2>;
++                              clocks = <&usb_phy2_always_on_clk32k>,
++                                       <&usb_otg_ss2_refclk960m>;
++                              clock-names =   "wkupclk",
++                                              "refclk";
++                              #phy-cells = <0>;
++                      };
++
++                      usb3_phy1: usb3phy@4a084400 {
++                              compatible = "ti,phy-pipe3-usb3";
++                              reg = <0x4a084400 0x80>,
++                                    <0x4a084800 0x64>,
++                                    <0x4a084c00 0x40>;
++                              reg-names = "phy_rx", "phy_tx", "pll_ctrl";
++                              ctrl-module = <&omap_control_usb3phy1>;
++                              clocks = <&usb_phy1_always_on_clk32k>,
++                                       <&usb_otg_ss1_refclk960m>,
++                                       <&dpll_core_h13x2_ck>;
++                              clock-names =   "wkupclk",
++                                              "refclk",
++                                              "refclk2";
++                              #phy-cells = <0>;
++                      };
++              };
++
++              dwc3_1: omap_dwc3_1@48880000 {
++                      compatible = "ti,dwc3";
++                      ti,hwmods = "usb_otg_ss1";
++                      reg = <0x48880000 0x10000>;
++                      interrupts = <0 77 4>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <2>;
++                      ranges;
++                      usb1: usb@48890000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x48890000 0x17000>;
++                              interrupts = <0 76 4>;
++                              phys = <&usb2_phy1>, <&usb3_phy1>;
++                              phy-names = "usb2-phy", "usb3-phy";
++                              tx-fifo-resize;
++                              maximum-speed = "super-speed";
++                              dr_mode = "otg";
++                      };
++              };
++
++              dwc3_2: omap_dwc3_2@488c0000 {
++                      compatible = "ti,dwc3";
++                      ti,hwmods = "usb_otg_ss2";
++                      reg = <0x488c0000 0x10000>;
++                      interrupts = <0 92 4>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <2>;
++                      ranges;
++                      usb2: usb@488d0000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x488d0000 0x17000>;
++                              interrupts = <0 78 4>;
++                              phys = <&usb2_phy2>;
++                              phy-names = "usb2-phy";
++                              tx-fifo-resize;
++                              maximum-speed = "high-speed";
++                              dr_mode = "otg";
++                      };
++              };
++
++              /* IRQ for DWC3_3 and DWC3_4 need IRQ crossbar */
++              dwc3_3: omap_dwc3_3@48900000 {
++                      compatible = "ti,dwc3";
++                      ti,hwmods = "usb_otg_ss3";
++                      reg = <0x48900000 0x10000>;
++              /*      interrupts = <0 TBD 4>; */
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <2>;
++                      ranges;
++                      status = "disabled";
++                      usb3: usb@48910000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x48910000 0x17000>;
++              /*              interrupts = <0 93 4>; */
++                              tx-fifo-resize;
++                              maximum-speed = "high-speed";
++                              dr_mode = "otg";
++                      };
++              };
++
++              dwc3_4: omap_dwc3_4@48940000 {
++                      compatible = "ti,dwc3";
++                      ti,hwmods = "usb_otg_ss4";
++                      reg = <0x48940000 0x10000>;
++              /*      interrupts = <0 TBD 4>; */
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      utmi-mode = <2>;
++                      ranges;
++                      status = "disabled";
++                      usb4: usb@48950000 {
++                              compatible = "synopsys,dwc3";
++                              reg = <0x48950000 0x17000>;
++              /*              interrupts = <0 TBD 4>; */
++                              tx-fifo-resize;
++                              maximum-speed = "high-speed";
++                              dr_mode = "otg";
++                      };
++              };
++
++              dmm: dmm@4e000000 {
++                      compatible = "ti,omap5-dmm";
++                      reg = <0x4e000000 0x800>;
++                      interrupts = <0 113 0x4>;
++                      ti,hwmods = "dmm";
++              };
++
++              dss: dss@58000000 {
++                      compatible = "ti,omap4-dss", "simple-bus";
++                      reg = <0x58000000 0x80>,
++                            <0x58004000 0x340>,
++                            <0x58009000 0x340>;
++                      ti,hwmods = "dss_core";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++
++                      dispc@58001000 {
++                              compatible = "ti,omap4-dispc";
++                              reg = <0x58001000 0x1000>;
++                              interrupts = <0 25 0x4>;
++                              ti,hwmods = "dss_dispc";
++                      };
++
++                      dpi1: encoder@0 {
++                              compatible = "ti,dra7xx-dpi";
++                              id = <0>;
++                              channel = <0>;
++                      };
++
++                      dpi2: encoder@1 {
++                              compatible = "ti,dra7xx-dpi";
++                              id = <1>;
++                      };
++
++                      dpi3: encoder@2 {
++                              compatible = "ti,dra7xx-dpi";
++                              id = <2>;
++                      };
++
++                      hdmi: encoder@58040000 {
++                              compatible = "ti,omap5-hdmi";
++                              reg = <0x58040000 0x100>,
++                                    <0x58040200 0x40>,
++                                    <0x58040300 0x40>,
++                                    <0x58060000 0x19000>;
++                              reg-names = "hdmi_wp", "hdmi_pllctrl",
++                                          "hdmi_txphy", "hdmi_core";
++                              interrupts = <0 101 0x4>;
++                              ti,hwmods = "dss_hdmi";
++                      };
++              };
++
++              vpe {
++                      compatible = "ti,vpe";
++                      ti,hwmods = "vpe";
++                      reg = <0x489d0000 0x120>,
++                            <0x489d0300 0x20>,
++                            <0x489d0400 0x20>,
++                            <0x489d0500 0x20>,
++                            <0x489d0600 0x3c>,
++                            <0x489d0700 0x80>,
++                            <0x489d5700 0x18>,
++                            <0x489dd000 0x400>;
++                      reg-names = "vpe_top",
++                                  "vpe_chr_us0",
++                                  "vpe_chr_us1",
++                                  "vpe_chr_us2",
++                                  "vpe_dei",
++                                  "vpe_sc",
++                                  "vpe_csc",
++                                  "vpdma";
++                      interrupts = <0 0x9c 0x4>;
++                      #address-cells = <1>;
++                      #size-cells = <0>;
++              };
++
++              mac: ethernet@4a100000 {
++                      compatible = "ti,cpsw";
++                      ti,hwmods = "gmac";
++                      cpdma_channels = <8>;
++                      ale_entries = <1024>;
++                      bd_ram_size = <0x2000>;
++                      no_bd_ram = <0>;
++                      rx_descs = <64>;
++                      mac_control = <0x20>;
++                      slaves = <2>;
++                      active_slave = <0>;
++                      cpts_clock_mult = <0x80000000>;
++                      cpts_clock_shift = <29>;
++                      reg = <0x48484000 0x800
++                             0x48485200 0x100>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      /*
++                       * rx_thresh_pend
++                       * rx_pend
++                       * tx_pend
++                       * misc_pend
++                       */
++                      interrupts = <GIC_SPI 50 IRQ_TYPE_LEVEL_HIGH>,
++                                   <GIC_SPI 51 IRQ_TYPE_LEVEL_HIGH>,
++                                   <GIC_SPI 52 IRQ_TYPE_LEVEL_HIGH>,
++                                   <GIC_SPI 53 IRQ_TYPE_LEVEL_HIGH>;
++                      ranges;
++                      status = "disabled";
++
++                      davinci_mdio: mdio@4a101000 {
++                              compatible = "ti,davinci_mdio";
++                              #address-cells = <1>;
++                              #size-cells = <0>;
++                              ti,hwmods = "davinci_mdio";
++                              bus_freq = <1000000>;
++                              reg = <0x48485000 0x100>;
++                      };
++
++                      cpsw_emac0: slave@4a100200 {
++                              /* Filled in by U-Boot */
++                              mac-address = [ 00 00 00 00 00 00 ];
++                      };
++
++                      cpsw_emac1: slave@4a100300 {
++                              /* Filled in by U-Boot */
++                              mac-address = [ 00 00 00 00 00 00 ];
++                      };
++              };
++
++              elm: elm@48078000 {
++                      compatible = "ti,am3352-elm";
++                      /* compatible = "ti,elm"; */
++                      reg = <0x48078000 0x2000>;
++                      interrupts = <GIC_SPI 1 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "elm";
++                      status = "disabled";
++              };
++
++              gpmc: gpmc@50000000 {
++                      compatible = "ti,am3352-gpmc";
++              /*      compatible = "ti,gpmc"; */
++                      ti,hwmods = "gpmc";
++                      reg = <0x50000000 0x2000>;
++                      interrupts = <GIC_SPI 15 IRQ_TYPE_LEVEL_HIGH>;
++                      gpmc,num-cs = <8>;
++                      gpmc,num-waitpins = <2>;
++                      #address-cells = <2>;
++                      #size-cells = <1>;
++                      status = "disabled";
++              };
++
++              aes: aes@4b500000 {
++                      compatible = "ti,omap4-aes";
++                      ti,hwmods = "aes";
++                      reg = <0x4b500000 0xa0>;
++                      interrupts = <GIC_SPI 85 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&sdma 111>, <&sdma 110>;
++                      dma-names = "tx", "rx";
++                      clocks = <&l3_iclk_div>;
++                      clock-names = "fck";
++              };
++
++              des: des@480a5000 {
++                      compatible = "ti,omap4-des";
++                      ti,hwmods = "des";
++                      reg = <0x480a5000 0xa0>;
++                      interrupts = <GIC_SPI 82 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&sdma 117>, <&sdma 116>;
++                      dma-names = "tx", "rx";
++                      clocks = <&l3_iclk_div>;
++                      clock-names = "fck";
++              };
++      };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "dra7xx-clocks.dtsi"
++      };
++
++      clockdomains {
++              coreaon_clkdm: coreaon_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll_usb_ck>;
++              };
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/dra7-evm.dts
+@@ -0,0 +1,761 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ */
++/dts-v1/;
++
++#include "dra7.dtsi"
++#include <dt-bindings/pinctrl/dra7xx.h>
++
++/ {
++      model = "TI DRA7";
++      compatible = "ti,dra7-evm", "ti,dra752", "ti,dra7";
++
++      memory {
++              device_type = "memory";
++              reg = <0x80000000 0x60000000>; /* 1536 MB */
++      };
++
++      extcon1: gpio_usbvid_extcon1 {
++              compatible = "ti,gpio-usb-id";
++              gpios = <&gpio21 1 0>;
++      };
++
++      extcon2: gpio_usbvid_extcon2 {
++              compatible = "ti,gpio-usb-id";
++              gpios = <&gpio21 2 0>;
++      };
++
++      mmc2_3v3: fixedregulator-mmc2 {
++              compatible = "regulator-fixed";
++              regulator-name = "mmc2_3v3";
++              regulator-min-microvolt = <3300000>;
++              regulator-max-microvolt = <3300000>;
++      };
++};
++
++&dra7_pmx_core {
++      pinctrl-names = "default";
++      pinctrl-0 = <
++              &vout1_pins
++              &irq_pins
++      >;
++
++      i2c1_pins: pinmux_i2c1_pins {
++              pinctrl-single,pins = <
++                      0x400 0x60000   /* i2c1_sda */
++                      0x404 0x60000   /* i2c1_scl */
++              >;
++      };
++
++      i2c2_pins: pinmux_i2c2_pins {
++              pinctrl-single,pins = <
++                      0x408 0x60000   /* i2c2_sda */
++                      0x40c 0x60000   /* i2c2_scl */
++              >;
++      };
++
++      i2c3_pins: pinmux_i2c3_pins {
++              pinctrl-single,pins = <
++                      0x410 0x60000   /* i2c3_sda */
++                      0x414 0x60000   /* i2c3_scl */
++              >;
++      };
++
++      irq_pins: pinmux_irq_pins {
++              pinctrl-single,pins = <
++                      0x420   0x1     /* Wakeup2 INPUT | MODE1 */
++              >;
++      };
++
++      mmc1_pins: pinmux_mmc1_pins {
++              pinctrl-single,pins = <
++                      0x36c 0x4000e   /* mmc1sdcd.gpio INPUT | MODE15 */
++              >;
++      };
++
++      mcspi1_pins: pinmux_mcspi1_pins {
++              pinctrl-single,pins = <
++                      0x3a4 0x40000   /* spi2_clk */
++                      0x3a8 0x40000   /* spi2_d1 */
++                      0x3ac 0x40000   /* spi2_d0 */
++                      0x3b0 0xc0000   /* spi2_cs0 */
++                      0x3b4 0xc0000   /* spi2_cs1 */
++                      0x3b8 0xe0006   /* spi2_cs2 */
++                      0x3bc 0xe0006   /* spi2_cs3 */
++              >;
++      };
++
++      mcspi2_pins: pinmux_mcspi2_pins {
++              pinctrl-single,pins = <
++                      0x3c0 0x40000   /* spi2_sclk */
++                      0x3c4 0xc0000   /* spi2_d1 */
++                      0x3c8 0xc0000   /* spi2_d1 */
++                      0x3cc 0xe0000   /* spi2_cs0 */
++              >;
++      };
++
++      uart1_pins: pinmux_uart1_pins {
++              pinctrl-single,pins = <
++                      0x3e0 0xe0000   /* uart1_rxd */
++                      0x3e4 0xe0000   /* uart1_txd */
++                      0x3e8 0x60003   /* uart1_ctsn */
++                      0x3ec 0x60003   /* uart1_rtsn */
++              >;
++      };
++
++      uart2_pins: pinmux_uart2_pins {
++              pinctrl-single,pins = <
++                      0x3f0 0x60000 /* uart2_rxd */
++                      0x3f4 0x60000 /* uart2_txd */
++                      0x3f8 0x60000 /* uart2_ctsn */
++                      0x3fc 0x60000 /* uart2_rtsn */
++              >;
++      };
++
++      uart3_pins: pinmux_uart3_pins {
++              pinctrl-single,pins = <
++                      0x248 0xc0000 /* uart3_rxd */
++                      0x24c 0xc0000 /* uart3_txd */
++              >;
++      };
++
++      qspi1_pins: pinmux_qspi1_pins {
++              pinctrl-single,pins = <
++                      0x4c 0x40001  /* gpmc_a3.qspi1_cs2 */
++                      0x50 0x40001  /* gpmc_a4.qspi1_cs3 */
++                      0x74 0x40001  /* gpmc_a13.qspi1_rtclk */
++                      0x78 0x40001  /* gpmc_a14.qspi1_d3 */
++                      0x7c 0x40001  /* gpmc_a15.qspi1_d2 */
++                      0x80 0x40001  /* gpmc_a16.qspi1_d1 */
++                      0x84 0x40001  /* gpmc_a17.qspi1_d0 */
++                      0x88 0x40001  /* qpmc_a18.qspi1_sclk */
++                      0xb8 0x60001  /* gpmc_cs2.qspi1_cs0 */
++                      0xbc 0x60001  /* gpmc_cs3.qspi1_cs1 */
++              >;
++      };
++
++      usb1_pins: pinmux_usb1_pins {
++                pinctrl-single,pins = <
++                      0x280   0xc0000 /* usb1_drvvbus, SLOW_SLEW | PULLUPEN | MODE0 */
++                >;
++        };
++
++      usb2_pins: pinmux_usb2_pins {
++                pinctrl-single,pins = <
++                      0x284   0xc0000 /* usb2_drvvbus, SLOW_SLEW | PULLUPEN | MODE0 */
++                >;
++        };
++
++      vout1_pins: pinmux_vout1_pins {
++              pinctrl-single,pins = <
++                      0x1C8   0x0     /* vout1_clk OUTPUT | MODE0 */
++                      0x1CC   0x0     /* vout1_de OUTPUT | MODE0 */
++                      0x1D0   0x0     /* vout1_fld OUTPUT | MODE0 */
++                      0x1D4   0x0     /* vout1_hsync OUTPUT | MODE0 */
++                      0x1D8   0x0     /* vout1_vsync OUTPUT | MODE0 */
++                      0x1DC   0x0     /* vout1_d0 OUTPUT | MODE0 */
++                      0x1E0   0x0     /* vout1_d1 OUTPUT | MODE0 */
++                      0x1E4   0x0     /* vout1_d2 OUTPUT | MODE0 */
++                      0x1E8   0x0     /* vout1_d3 OUTPUT | MODE0 */
++                      0x1EC   0x0     /* vout1_d4 OUTPUT | MODE0 */
++                      0x1F0   0x0     /* vout1_d5 OUTPUT | MODE0 */
++                      0x1F4   0x0     /* vout1_d6 OUTPUT | MODE0 */
++                      0x1F8   0x0     /* vout1_d7 OUTPUT | MODE0 */
++                      0x1FC   0x0     /* vout1_d8 OUTPUT | MODE0 */
++                      0x200   0x0     /* vout1_d9 OUTPUT | MODE0 */
++                      0x204   0x0     /* vout1_d10 OUTPUT | MODE0 */
++                      0x208   0x0     /* vout1_d11 OUTPUT | MODE0 */
++                      0x20C   0x0     /* vout1_d12 OUTPUT | MODE0 */
++                      0x210   0x0     /* vout1_d13 OUTPUT | MODE0 */
++                      0x214   0x0     /* vout1_d14 OUTPUT | MODE0 */
++                      0x218   0x0     /* vout1_d15 OUTPUT | MODE0 */
++                      0x21C   0x0     /* vout1_d16 OUTPUT | MODE0 */
++                      0x220   0x0     /* vout1_d17 OUTPUT | MODE0 */
++                      0x224   0x0     /* vout1_d18 OUTPUT | MODE0 */
++                      0x228   0x0     /* vout1_d19 OUTPUT | MODE0 */
++                      0x22C   0x0     /* vout1_d20 OUTPUT | MODE0 */
++                      0x230   0x0     /* vout1_d21 OUTPUT | MODE0 */
++                      0x234   0x0     /* vout1_d22 OUTPUT | MODE0 */
++                      0x238   0x0     /* vout1_d23 OUTPUT | MODE0 */
++              >;
++      };
++
++      cpsw_default: cpsw_default {
++              pinctrl-single,pins = <
++                      /* Slave 1 */
++                      0x250 (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_tclk */
++                      0x254 (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_tctl */
++                      0x258 (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_td3 */
++                      0x25c (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_td2 */
++                      0x260 (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_td1 */
++                      0x264 (PIN_OUTPUT | MUX_MODE0)  /* rgmii1_td0 */
++                      0x268 (PIN_INPUT | MUX_MODE0)   /* rgmii1_rclk */
++                      0x26c (PIN_INPUT | MUX_MODE0)   /* rgmii1_rctl */
++                      0x270 (PIN_INPUT | MUX_MODE0)   /* rgmii1_rd3 */
++                      0x274 (PIN_INPUT | MUX_MODE0)   /* rgmii1_rd2 */
++                      0x278 (PIN_INPUT | MUX_MODE0)   /* rgmii1_rd1 */
++                      0x27c (PIN_INPUT | MUX_MODE0)   /* rgmii1_rd0 */
++
++                      /* Slave 2 */
++                      0x198 (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_tclk */
++                      0x19c (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_tctl */
++                      0x1a0 (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_td3 */
++                      0x1a4 (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_td2 */
++                      0x1a8 (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_td1 */
++                      0x1ac (PIN_OUTPUT | MUX_MODE3)  /* rgmii2_td0 */
++                      0x1b0 (PIN_INPUT | MUX_MODE3)   /* rgmii2_rclk */
++                      0x1b4 (PIN_INPUT | MUX_MODE3)   /* rgmii2_rctl */
++                      0x1b8 (PIN_INPUT | MUX_MODE3)   /* rgmii2_rd3 */
++                      0x1bc (PIN_INPUT | MUX_MODE3)   /* rgmii2_rd2 */
++                      0x1c0 (PIN_INPUT | MUX_MODE3)   /* rgmii2_rd1 */
++                      0x1c4 (PIN_INPUT | MUX_MODE3)   /* rgmii2_rd0 */
++              >;
++
++      };
++      cpsw_sleep: cpsw_sleep {
++              pinctrl-single,pins = <
++                      /* Slave 1 */
++                      0x250 (PIN_OFF_NONE)
++                      0x254 (PIN_OFF_NONE)
++                      0x258 (PIN_OFF_NONE)
++                      0x25c (PIN_OFF_NONE)
++                      0x260 (PIN_OFF_NONE)
++                      0x264 (PIN_OFF_NONE)
++                      0x268 (PIN_OFF_NONE)
++                      0x26c (PIN_OFF_NONE)
++                      0x270 (PIN_OFF_NONE)
++                      0x274 (PIN_OFF_NONE)
++                      0x278 (PIN_OFF_NONE)
++                      0x27c (PIN_OFF_NONE)
++
++                      /* Slave 1 */
++                      0x198 (PIN_OFF_NONE)
++                      0x19c (PIN_OFF_NONE)
++                      0x1a0 (PIN_OFF_NONE)
++                      0x1a4 (PIN_OFF_NONE)
++                      0x1a8 (PIN_OFF_NONE)
++                      0x1ac (PIN_OFF_NONE)
++                      0x1b0 (PIN_OFF_NONE)
++                      0x1b4 (PIN_OFF_NONE)
++                      0x1b8 (PIN_OFF_NONE)
++                      0x1bc (PIN_OFF_NONE)
++                      0x1c0 (PIN_OFF_NONE)
++                      0x1c4 (PIN_OFF_NONE)
++              >;
++      };
++
++      davinci_mdio_default: davinci_mdio_default {
++              pinctrl-single,pins = <
++                      /* MDIO */
++                      0x23c (PIN_OUTPUT_PULLUP | MUX_MODE0)   /* mdio_data */
++                      0x240 (PIN_INPUT_PULLUP | MUX_MODE0)    /* mdio_clk */
++              >;
++      };
++
++      davinci_mdio_sleep: davinci_mdio_sleep {
++              pinctrl-single,pins = <
++                      0x23c (PIN_OFF_NONE)
++                      0x240 (PIN_OFF_NONE)
++              >;
++      };
++
++      nand_flash_x16: nand_flash_x16 {
++              /* On DRA7 EVM, GPMC_WPN and NAND_BOOTn comes from DIP switch
++               * So NAND flash requires following switch settings:
++               * SW5.9 (GPMC_WPN) = LOW
++               * SW5.1 (NAND_BOOTn) = HIGH */
++              pinctrl-single,pins = <
++                      0x0     0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad0        */
++                      0x4     0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad1        */
++                      0x8     0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad2        */
++                      0xc     0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad3        */
++                      0x10    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad4        */
++                      0x14    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad5        */
++                      0x18    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad6        */
++                      0x1c    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad7        */
++                      0x20    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad8        */
++                      0x24    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad9        */
++                      0x28    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad10       */
++                      0x2c    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad11       */
++                      0x30    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad12       */
++                      0x34    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad13       */
++                      0x38    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad14       */
++                      0x3c    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_ad15       */
++                      0xD8    0x70000 /* (PIN_INPUT | MUX_MODE0)      gpmc_wait0      */
++                      0xCC    0x0     /* (PIN_OUTPUT     | MUX_MODE0) gpmc_wen        */
++                      0xB4    0x0     /* (PIN_OUTPUT | MUX_MODE0)     gpmc_csn0       */
++                      0xC4    0x0     /* (PIN_OUTPUT     | MUX_MODE0) gpmc_advn_ale */
++                      0xC8    0x0     /* (PIN_OUTPUT     | MUX_MODE0) gpmc_oen_ren     */
++                      0xD0    0x0     /* (PIN_OUTPUT     | MUX_MODE0) gpmc_be0n_cle */
++              >;
++      };
++};
++
++&i2c1 {
++      status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&i2c1_pins>;
++      clock-frequency = <400000>;
++
++      tps659038: tps659038@58 {
++              compatible = "ti,tps659038";
++              reg = <0x58>;
++
++              tps659038_pmic {
++                      compatible = "ti,tps659038-pmic";
++
++                      regulators {
++                              smps123_reg: smps123 {
++                                      /* VDD_MPU */
++                                              regulator-name = "smps123";
++                                              regulator-min-microvolt = < 850000>;
++                                              regulator-max-microvolt = <1250000>;
++                                              regulator-always-on;
++                                              regulator-boot-on;
++                                      };
++
++                              smps45_reg: smps45 {
++                                              /* VDD_DSPEVE */
++                                              regulator-name = "smps45";
++                                              regulator-min-microvolt = < 850000>;
++                                              regulator-max-microvolt = <1150000>;
++                                              regulator-boot-on;
++                                      };
++
++                              smps6_reg: smps6 {
++                                              /* VDD_GPU - over VDD_SMPS6 */
++                                              regulator-name = "smps6";
++                                              regulator-min-microvolt = <850000>;
++                                              regulator-max-microvolt = <12500000>;
++                                              regulator-boot-on;
++                                      };
++
++                              smps7_reg: smps7 {
++                                              /* CORE_VDD */
++                                              regulator-name = "smps7";
++                                              regulator-min-microvolt = <850000>;
++                                              regulator-max-microvolt = <1030000>;
++                                              regulator-always-on;
++                                              regulator-boot-on;
++                                      };
++
++                              smps8_reg: smps8 {
++                                              /* VDD_IVAHD */
++                                              regulator-name = "smps8";
++                                              regulator-min-microvolt = < 850000>;
++                                              regulator-max-microvolt = <1250000>;
++                                              regulator-boot-on;
++                                      };
++
++                              smps9_reg: smps9 {
++                                              /* VDDS1V8 */
++                                              regulator-name = "smps9";
++                                              regulator-min-microvolt = <1800000>;
++                                              regulator-max-microvolt = <1800000>;
++                                              regulator-always-on;
++                                              regulator-boot-on;
++                                      };
++
++                              ldo1_reg: ldo1 {
++                                              /* LDO1_OUT --> SDIO  */
++                                              regulator-name = "ldo1";
++                                              regulator-min-microvolt = <1800000>;
++                                              regulator-max-microvolt = <3300000>;
++                                              regulator-boot-on;
++                                      };
++
++                              ldo2_reg: ldo2 {
++                                              /* VDD_RTCIO */
++                                              /* LDO2 -> VDDSHV5, LDO2 also goes to CAN_PHY_3V3 */
++                                              regulator-name = "ldo2";
++                                              regulator-min-microvolt = <3300000>;
++                                              regulator-max-microvolt = <3300000>;
++                                              regulator-boot-on;
++                                      };
++
++                              ldo3_reg: ldo3 {
++                                              /* VDDA_1V8_PHY */
++                                              regulator-name = "ldo3";
++                                              regulator-min-microvolt = <1800000>;
++                                              regulator-max-microvolt = <1800000>;
++                                              regulator-boot-on;
++                                      };
++
++                              ldo9_reg: ldo9 {
++                                              /* VDD_RTC */
++                                              regulator-name = "ldo9";
++                                              regulator-min-microvolt = <1050000>;
++                                              regulator-max-microvolt = <1050000>;
++                                              regulator-boot-on;
++                                      };
++
++                              ldoln_reg: ldoln {
++                                              /* VDDA_1V8_PLL */
++                                              regulator-name = "ldoln";
++                                              regulator-min-microvolt = <1800000>;
++                                              regulator-max-microvolt = <1800000>;
++                                              regulator-always-on;
++                                              regulator-boot-on;
++                                      };
++
++                              ldousb_reg: ldousb {
++                                              /* VDDA_3V_USB: VDDA_USBHS33 */
++                                              regulator-name = "ldousb";
++                                              regulator-min-microvolt = <3300000>;
++                                              regulator-max-microvolt = <3300000>;
++                                              regulator-boot-on;
++                                      };
++
++                              };
++                      };
++              };
++
++      pcf_gpio_20: gpio@20 {
++              compatible = "ti,pcf8575";
++              reg = <0x20>;
++              lines-initial-states = <0x4000>;
++              gpio-controller;
++              #gpio-cells = <2>;
++              interrupt-parent = <&gpio6>;
++              interrupts = <11 2>;
++              interrupt-controller;
++              #interrupt-cells = <2>;
++      };
++
++      gpio21: gpio@21 {
++              compatible = "ti,pcf8575";
++              reg = <0x21>;
++              lines-initial-states = <0x1408>;
++              gpio-controller;
++              #gpio-cells = <2>;
++              interrupt-parent = <&pcf_gpio_20>;
++              interrupts = <14 2>;
++              interrupt-controller;
++              #interrupt-cells = <2>;
++      };
++
++      /* TLC chip for LCD panel power and backlight */
++      tlc59108: tlc59108@40 {
++              compatible = "ti,tlc59108";
++              reg = <0x40>;
++              gpios = <&pcf_gpio_20 13 0>; /* P15, CON_LCD_PWR_DN */
++              video-source = <&dpi1>;
++              data-lines = <24>;
++      };
++
++      mxt244: touchscreen@4a {
++              compatible = "atmel,mXT244";
++              status = "okay";
++              reg = <0x4a>;
++              interrupts = <0 119 0x4>;
++
++              atmel,config = <
++                      /* MXT244_GEN_COMMAND(6) */
++                      0x00 0x00 0x00 0x00 0x00 0x00
++                      /* MXT244_GEN_POWER(7) */
++                      0x20 0xff 0x32
++                      /* MXT244_GEN_ACQUIRE(8) */
++                      0x0a 0x00 0x05 0x00 0x00 0x00 0x09 0x23
++                      /* MXT244_TOUCH_MULTI(9) */
++                      0x00 0x00 0x00 0x13 0x0b 0x00 0x00 0x00 0x02 0x00
++                      0x00 0x01 0x01 0x0e 0x0a 0x0a 0x0a 0x0a 0x00 0x00
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00
++                      /* MXT244_TOUCH_KEYARRAY(15) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00
++                      /* MXT244_COMMSCONFIG_T18(2) */
++                      0x00 0x00
++                      /* MXT244_SPT_GPIOPWM(19) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00 0x00 0x00 0x00 0x00 0x00
++                      /* MXT244_PROCI_GRIPFACE(20) */
++                      0x07 0x00 0x00 0x00 0x00 0x00 0x00 0x50 0x28 0x04
++                      0x0f 0x0a
++                      /* MXT244_PROCG_NOISE(22) */
++                      0x05 0x00 0x00 0x00 0x00 0x00 0x00 0x03 0x23 0x00
++                      0x00 0x05 0x0f 0x19 0x23 0x2d 0x03
++                      /* MXT244_TOUCH_PROXIMITY(23) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00 0x00 0x00 0x00 0x00
++                      /* MXT244_PROCI_ONETOUCH(24) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      /* MXT244_SPT_SELFTEST(25) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      0x00 0x00 0x00 0x00
++                      /* MXT244_PROCI_TWOTOUCH(27) */
++                      0x00 0x00 0x00 0x00 0x00 0x00 0x00
++                      /* MXT244_SPT_CTECONFIG(28) */
++                      0x00 0x00 0x02 0x08 0x10 0x00
++              >;
++
++              atmel,x_line = <18>;
++              atmel,y_line = <12>;
++              atmel,x_size = <800>;
++              atmel,y_size = <480>;
++              atmel,blen = <0x01>;
++              atmel,threshold = <30>;
++              atmel,voltage = <2800000>;
++              atmel,orient = <0x4>;
++      };
++};
++
++&i2c2 {
++      status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&i2c2_pins>;
++      clock-frequency = <400000>;
++
++      pcf_hdmi: gpio@26 {
++              compatible = "nxp,pcf8575";
++              reg = <0x26>;
++              gpio-controller;
++              #gpio-cells = <2>;
++      };
++};
++
++&i2c3 {
++      status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&i2c3_pins>;
++      clock-frequency = <3400000>;
++};
++
++&mcspi1 {
++        status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&mcspi1_pins>;
++};
++
++&mcspi2 {
++        status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&mcspi2_pins>;
++};
++
++&uart1 {
++      status = "okay";
++        pinctrl-names = "default";
++        pinctrl-0 = <&uart1_pins>;
++};
++
++&uart2 {
++        status = "okay";
++        pinctrl-names = "default";
++        pinctrl-0 = <&uart2_pins>;
++};
++
++&uart3 {
++        status = "okay";
++        pinctrl-names = "default";
++        pinctrl-0 = <&uart3_pins>;
++};
++
++&qspi {
++      status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&qspi1_pins>;
++
++      spi-max-frequency = <48000000>;
++      m25p80@0 {
++              compatible = "s25fl256s1";
++              spi-max-frequency = <48000000>;
++              reg = <0>;
++              spi-tx-bus-width = <1>;
++              spi-rx-bus-width = <4>;
++              spi-cpol;
++              spi-cpha;
++      };
++};
++
++&usb1 {
++      dr_mode = "peripheral";
++      pinctrl-names = "default";
++      pinctrl-0 = <&usb1_pins>;
++};
++
++&usb2 {
++      dr_mode = "host";
++      pinctrl-names = "default";
++      pinctrl-0 = <&usb2_pins>;
++};
++
++&dwc3_1 {
++      extcon = <&extcon1>;
++};
++
++&dwc3_2 {
++      extcon = <&extcon2>;
++};
++
++&mmc1 {
++      status = "okay";
++      vmmc-supply = <&ldo1_reg>;
++      bus-width = <4>;
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
++      cd-gpios = <&gpio6 27 0>; /* gpio 187 */
++};
++
++&mmc2 {
++      status = "okay";
++      vmmc-supply = <&mmc2_3v3>;
++      bus-width = <8>;
++      ti,non-removable;
++};
++
++&dss {
++      vdda_video-supply = <&ldoln_reg>;
++};
++
++&hdmi {
++      vdda_hdmi_dac-supply = <&ldo3_reg>;
++};
++
++&avs_mpu {
++      avs-supply = <&smps123_reg>;
++};
++
++&avs_core {
++      avs-supply = <&smps7_reg>;
++};
++
++&avs_gpu {
++      avs-supply = <&smps6_reg>;
++};
++
++&avs_dspeve {
++      avs-supply = <&smps45_reg>;
++};
++
++&avs_iva {
++      avs-supply = <&smps8_reg>;
++};
++
++&cpu0 {
++      cpu0-supply = <&avs_mpu>;
++};
++
++/ {
++      aliases {
++              display0 = &tlc59108;
++              display1 = &hdmi0;
++      };
++
++      tpd12s015: encoder@0 {
++              compatible = "ti,draevm-tpd12s015";
++
++              video-source = <&hdmi>;
++
++              gpios = <&pcf_hdmi 4 0>,        /* P4, CT CP HPD */
++                      <&pcf_hdmi 5 0>,        /* P5, LS OE */
++                      <&gpio7 12 0>;          /* gpio7_12/sp1_cs2, HPD */
++      };
++
++      hdmi0: connector@0 {
++              compatible = "ti,hdmi_connector";
++
++              video-source = <&tpd12s015>;
++      };
++};
++
++&mac {
++      status = "okay";
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&cpsw_default>;
++      pinctrl-1 = <&cpsw_sleep>;
++};
++
++&cpsw_emac0 {
++      phy_id = <&davinci_mdio>, <2>;
++};
++
++&cpsw_emac1 {
++      phy_id = <&davinci_mdio>, <3>;
++};
++
++&davinci_mdio {
++      pinctrl-names = "default", "sleep";
++      pinctrl-0 = <&davinci_mdio_default>;
++      pinctrl-1 = <&davinci_mdio_sleep>;
++};
++
++&elm {
++      status = "okay";
++};
++
++&gpmc {
++      status = "okay";
++      pinctrl-names = "default";
++      pinctrl-0 = <&nand_flash_x16>;
++      ranges = <0 0 0x08000000 0x10000000>;
++      nand@0,0 {
++              reg = <0 0 0>;
++              nand-bus-width = <16>;
++              ti,nand-ecc-opt = "bch8";
++              gpmc,device-width = <2>;
++              gpmc,sync-clk-ps = <0>;
++              gpmc,cs-on-ns = <0>;
++              gpmc,cs-rd-off-ns = <55>;
++              gpmc,cs-wr-off-ns = <55>;
++              gpmc,adv-on-ns = <0>;
++              gpmc,adv-rd-off-ns = <55>;
++              gpmc,adv-wr-off-ns = <55>;
++              gpmc,we-on-ns = <5>;
++              gpmc,we-off-ns = <40>;
++              gpmc,oe-on-ns = <2>;
++              gpmc,oe-off-ns = <45>;
++              gpmc,access-ns = <40>;
++              gpmc,wr-access-ns = <37>;
++              gpmc,rd-cycle-ns = <55>;
++              gpmc,wr-cycle-ns = <55>;
++              gpmc,wait-on-read = "true";
++              gpmc,wait-on-write = "true";
++              gpmc,bus-turnaround-ns = <0>;
++              gpmc,cycle2cycle-delay-ns = <0>;
++              gpmc,clk-activation-ns = <0>;
++              gpmc,wait-monitoring-ns = <0>;
++              gpmc,wr-data-mux-bus-ns = <0>;
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ti,elm-id = <&elm>;
++              /* MTD partition table */
++              partition@0 {
++                      label = "SPL1";
++                      reg = <0x00000000 0x000020000>;
++              };
++              partition@1 {
++                      label = "SPL2";
++                      reg = <0x00020000 0x00020000>;
++              };
++              partition@2 {
++                      label = "SPL3";
++                      reg = <0x00040000 0x00020000>;
++              };
++              partition@3 {
++                      label = "SPL4";
++                      reg = <0x00060000 0x00020000>;
++              };
++              partition@4 {
++                      label = "U-boot";
++                      reg = <0x00080000 0x001e0000>;
++              };
++              partition@5 {
++                      label = "environment";
++                      reg = <0x00260000 0x00020000>;
++              };
++              partition@6 {
++                      label = "Kernel";
++                      reg = <0x00280000 0x00500000>;
++              };
++              partition@7 {
++                      label = "File-System";
++                      reg = <0x00780000 0x0F880000>;
++              };
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/dra7xx-clocks.dtsi
+@@ -0,0 +1,2103 @@
++/*
++ * Device Tree Source for DRA7xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++atl_clkin0_ck: atl_clkin0_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++atl_clkin1_ck: atl_clkin1_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++atl_clkin2_ck: atl_clkin2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++atlclkin3_ck: atlclkin3_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++hdmi_clkin_ck: hdmi_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++mlb_clkin_ck: mlb_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++mlbp_clkin_ck: mlbp_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++pciesref_acs_clk_ck: pciesref_acs_clk_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <100000000>;
++};
++
++ref_clkin0_ck: ref_clkin0_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++ref_clkin1_ck: ref_clkin1_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++ref_clkin2_ck: ref_clkin2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++ref_clkin3_ck: ref_clkin3_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++rmii_clk_ck: rmii_clk_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++sdvenc_clkin_ck: sdvenc_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++secure_32k_clk_src_ck: secure_32k_clk_src_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++sys_32k_ck: sys_32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++virt_12000000_ck: virt_12000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++virt_13000000_ck: virt_13000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <13000000>;
++};
++
++virt_16800000_ck: virt_16800000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <16800000>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_20000000_ck: virt_20000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <20000000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++virt_27000000_ck: virt_27000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <27000000>;
++};
++
++virt_38400000_ck: virt_38400000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <38400000>;
++};
++
++sys_clkin1: sys_clkin1@4ae06110 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_12000000_ck>, <&virt_20000000_ck>, <&virt_16800000_ck>, <&virt_19200000_ck>, <&virt_26000000_ck>, <&virt_27000000_ck>, <&virt_38400000_ck>;
++      reg = <0x4ae06110 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++sys_clkin2: sys_clkin2 {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <22579200>;
++};
++
++usb_otg_clkin_ck: usb_otg_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++video1_clkin_ck: video1_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++video1_m2_clkin_ck: video1_m2_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++video2_clkin_ck: video2_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++video2_m2_clkin_ck: video2_m2_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++abe_dpll_sys_clk_mux: abe_dpll_sys_clk_mux@4ae06118 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>;
++      reg = <0x4ae06118 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_dpll_bypass_clk_mux: abe_dpll_bypass_clk_mux@4ae06114 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_dpll_sys_clk_mux>, <&sys_32k_ck>;
++      reg = <0x4ae06114 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_dpll_clk_mux: abe_dpll_clk_mux@4ae0610c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_dpll_sys_clk_mux>, <&sys_32k_ck>;
++      reg = <0x4ae0610c 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_abe_ck: dpll_abe_ck@4a0051e0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-m4xen-clock";
++      clocks = <&abe_dpll_clk_mux>, <&abe_dpll_bypass_clk_mux>;
++      reg = <0x4a0051e0 0x4>, <0x4a0051e4 0x4>, <0x4a0051e8 0x4>, <0x4a0051ec 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_abe_x2_ck: dpll_abe_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_abe_ck>;
++};
++
++dpll_abe_m2x2_ck: dpll_abe_m2x2_ck@4a0051f0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0051f0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++abe_24m_fclk: abe_24m_fclk@4ae0611c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      reg = <0x4ae0611c 0x4>;
++      table = < 8 0 >, < 16 1 >;
++      bit-mask = <0x1>;
++};
++
++abe_clk: abe_clk@4a005108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      reg = <0x4a005108 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++aess_fclk: aess_fclk@4ae06178 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&abe_clk>;
++      reg = <0x4ae06178 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_giclk_div: abe_giclk_div@4ae06174 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&aess_fclk>;
++      reg = <0x4ae06174 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_lp_clk_div: abe_lp_clk_div@4ae061d8 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      reg = <0x4ae061d8 0x4>;
++      table = < 16 0 >, < 32 1 >;
++      bit-mask = <0x1>;
++};
++
++abe_sys_clk_div: abe_sys_clk_div@4ae06120 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin1>;
++      reg = <0x4ae06120 0x4>;
++      bit-mask = <0x1>;
++};
++
++adc_gfclk_mux: adc_gfclk_mux@4ae061dc {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>, <&sys_32k_ck>;
++      reg = <0x4ae061dc 0x4>;
++      bit-mask = <0x7>;
++};
++
++dpll_pcie_ref_ck: dpll_pcie_ref_ck@4a008200 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin1>;
++      reg = <0x4a008200 0x4>, <0x4a008204 0x4>, <0x4a008208 0x4>, <0x4a00820c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_pcie_ref_m2ldo_ck: dpll_pcie_ref_m2ldo_ck@4a008210 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_pcie_ref_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008210 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++apll_pcie_in_clk_mux: apll_pcie_in_clk_mux@4ae06118 {
++      compatible = "mux-clock";
++      clocks = <&dpll_pcie_ref_ck>, <&pciesref_acs_clk_ck>;
++      #clock-cells = <0>;
++      reg = <0x4a00821c 0x4>;
++      bit-mask = <0x80>;
++};
++
++apll_pcie_ck: apll_pcie_ck@4a008200 {
++      #clock-cells = <0>;
++      compatible = "ti,dra7-apll-clock";
++      clocks = <&apll_pcie_in_clk_mux>, <&dpll_pcie_ref_ck>;
++      reg = <0x4a00821c 0x4>, <0x4a008220 0x4>;
++      reg-names = "control", "idlest";
++};
++
++apll_pcie_clkvcoldo: apll_pcie_clkvcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&apll_pcie_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++apll_pcie_clkvcoldo_div: apll_pcie_clkvcoldo_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&apll_pcie_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++apll_pcie_m2_ck: apll_pcie_m2_ck@4a008224 {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&apll_pcie_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sys_clk1_dclk_div: sys_clk1_dclk_div@4ae061c8 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin1>;
++      reg = <0x4ae061c8 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++sys_clk2_dclk_div: sys_clk2_dclk_div@4ae061cc {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin2>;
++      reg = <0x4ae061cc 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++dpll_abe_m2_ck: dpll_abe_m2_ck@4a0051f0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0051f0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++per_abe_x1_dclk_div: per_abe_x1_dclk_div@4ae061bc {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2_ck>;
++      reg = <0x4ae061bc 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++dpll_abe_m3x2_ck: dpll_abe_m3x2_ck@4a0051f4 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0051f4 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_ck: dpll_core_ck@4a005120 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-core-clock";
++      clocks = <&sys_clkin1>, <&dpll_abe_m3x2_ck>;
++      reg = <0x4a005120 0x4>, <0x4a005124 0x4>, <0x4a005128 0x4>, <0x4a00512c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_core_x2_ck: dpll_core_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_core_ck>;
++};
++
++dpll_core_h12x2_ck: dpll_core_h12x2_ck@4a00513c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00513c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++mpu_dpll_hs_clk_div: mpu_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_mpu_ck: dpll_mpu_ck@4a005160 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&mpu_dpll_hs_clk_div>;
++      reg = <0x4a005160 0x4>, <0x4a005164 0x4>, <0x4a005168 0x4>, <0x4a00516c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_mpu_m2_ck: dpll_mpu_m2_ck@4a005170 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_mpu_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005170 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++mpu_dclk_div: mpu_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_mpu_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dsp_dpll_hs_clk_div: dsp_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_dsp_ck: dpll_dsp_ck@4a005234 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&dsp_dpll_hs_clk_div>;
++      reg = <0x4a005234 0x4>, <0x4a005238 0x4>, <0x4a00523c 0x4>, <0x4a005240 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_dsp_m2_ck: dpll_dsp_m2_ck@4a005244 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_dsp_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005244 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dsp_gclk_div: dsp_gclk_div@4ae0618c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_dsp_m2_ck>;
++      reg = <0x4ae0618c 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++iva_dpll_hs_clk_div: iva_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_iva_ck: dpll_iva_ck@4a0051a0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&iva_dpll_hs_clk_div>;
++      reg = <0x4a0051a0 0x4>, <0x4a0051a4 0x4>, <0x4a0051a8 0x4>, <0x4a0051ac 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_iva_m2_ck: dpll_iva_m2_ck@4a0051b0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_iva_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0051b0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++iva_dclk: iva_dclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_iva_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_gpu_ck: dpll_gpu_ck@4a0052d8 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&dpll_abe_m3x2_ck>;
++      reg = <0x4a0052d8 0x4>, <0x4a0052dc 0x4>, <0x4a0052e0 0x4>, <0x4a0052e4 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_gpu_m2_ck: dpll_gpu_m2_ck@4a0052e8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gpu_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052e8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++gpu_dclk: gpu_dclk@4ae061a0 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_gpu_m2_ck>;
++      reg = <0x4ae061a0 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++dpll_core_m2_ck: dpll_core_m2_ck@4a005130 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005130 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++core_dpll_out_dclk_div: core_dpll_out_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_ddr_ck: dpll_ddr_ck@4a005210 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&dpll_abe_m3x2_ck>;
++      reg = <0x4a005210 0x4>, <0x4a005214 0x4>, <0x4a005218 0x4>, <0x4a00521c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_ddr_m2_ck: dpll_ddr_m2_ck@4a005220 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_ddr_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005220 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++emif_phy_dclk_div: emif_phy_dclk_div@4ae06190 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_ddr_m2_ck>;
++      reg = <0x4ae06190 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++dpll_gmac_ck: dpll_gmac_ck@4a0052a8 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&dpll_abe_m3x2_ck>;
++      reg = <0x4a0052a8 0x4>, <0x4a0052ac 0x4>, <0x4a0052b0 0x4>, <0x4a0052b4 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_gmac_m2_ck: dpll_gmac_m2_ck@4a0052b8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gmac_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052b8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++gmac_250m_dclk_div: gmac_250m_dclk_div@4ae0619c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_gmac_m2_ck>;
++      reg = <0x4ae0619c 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++video2_dclk_div: video2_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video2_m2_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++video1_dclk_div: video1_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video1_m2_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++hdmi_dclk_div: hdmi_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&hdmi_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++per_dpll_hs_clk_div: per_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_per_ck: dpll_per_ck@4a008140 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&per_dpll_hs_clk_div>;
++      reg = <0x4a008140 0x4>, <0x4a008144 0x4>, <0x4a008148 0x4>, <0x4a00814c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_per_m2_ck: dpll_per_m2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++func_96m_aon_dclk_div: func_96m_aon_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++usb_dpll_hs_clk_div: usb_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <3>;
++};
++
++dpll_usb_ck: dpll_usb_ck@4a008180 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-j-type-clock";
++      clocks = <&sys_clkin1>, <&usb_dpll_hs_clk_div>;
++      reg = <0x4a008180 0x4>, <0x4a008184 0x4>, <0x4a008188 0x4>, <0x4a00818c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_usb_m2_ck: dpll_usb_m2_ck@4a008190 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_usb_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008190 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++l3init_480m_dclk_div: l3init_480m_dclk_div@4ae061ac {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      reg = <0x4ae061ac 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++usb_otg_dclk_div: usb_otg_dclk_div@4ae06184 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&usb_otg_clkin_ck>;
++      reg = <0x4ae06184 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++sata_dclk_div: sata_dclk_div@4ae061c0 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin1>;
++      reg = <0x4ae061c0 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++dpll_pcie_ref_m2_ck: dpll_pcie_ref_m2_ck@4a008210 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_pcie_ref_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008210 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++pcie2_dclk_div: pcie2_dclk_div@4ae061b8 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_pcie_ref_m2_ck>;
++      reg = <0x4ae061b8 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++pcie_dclk_div: pcie_dclk_div@4ae061b4 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&apll_pcie_m2_ck>;
++      reg = <0x4ae061b4 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++emu_dclk_div: emu_dclk_div@4ae06194 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin1>;
++      reg = <0x4ae06194 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++secure_32k_dclk_div: secure_32k_dclk_div@4ae061c4 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&secure_32k_clk_src_ck>;
++      reg = <0x4ae061c4 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++eve_dpll_hs_clk_div: eve_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_eve_ck: dpll_eve_ck@4a005284 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin1>, <&eve_dpll_hs_clk_div>;
++      reg = <0x4a005284 0x4>, <0x4a005288 0x4>, <0x4a00528c 0x4>, <0x4a005290 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_eve_m2_ck: dpll_eve_m2_ck@4a005294 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_eve_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005294 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++eve_dclk_div: eve_dclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_eve_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++clkoutmux0_clk_mux: clkoutmux0_clk_mux@4ae06158 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clk1_dclk_div>, <&sys_clk2_dclk_div>, <&per_abe_x1_dclk_div>, <&mpu_dclk_div>, <&dsp_gclk_div>, <&iva_dclk>, <&gpu_dclk>, <&core_dpll_out_dclk_div>, <&emif_phy_dclk_div>, <&gmac_250m_dclk_div>, <&video2_dclk_div>, <&video1_dclk_div>, <&hdmi_dclk_div>, <&func_96m_aon_dclk_div>, <&l3init_480m_dclk_div>, <&usb_otg_dclk_div>, <&sata_dclk_div>, <&pcie2_dclk_div>, <&pcie_dclk_div>, <&emu_dclk_div>, <&secure_32k_dclk_div>, <&eve_dclk_div>;
++      reg = <0x4ae06158 0x4>;
++      bit-mask = <0x1f>;
++};
++
++clkoutmux1_clk_mux: clkoutmux1_clk_mux@4ae0615c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clk1_dclk_div>, <&sys_clk2_dclk_div>, <&per_abe_x1_dclk_div>, <&mpu_dclk_div>, <&dsp_gclk_div>, <&iva_dclk>, <&gpu_dclk>, <&core_dpll_out_dclk_div>, <&emif_phy_dclk_div>, <&gmac_250m_dclk_div>, <&video2_dclk_div>, <&video1_dclk_div>, <&hdmi_dclk_div>, <&func_96m_aon_dclk_div>, <&l3init_480m_dclk_div>, <&usb_otg_dclk_div>, <&sata_dclk_div>, <&pcie2_dclk_div>, <&pcie_dclk_div>, <&emu_dclk_div>, <&secure_32k_dclk_div>, <&eve_dclk_div>;
++      reg = <0x4ae0615c 0x4>;
++      bit-mask = <0x1f>;
++};
++
++clkoutmux2_clk_mux: clkoutmux2_clk_mux@4ae06160 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clk1_dclk_div>, <&sys_clk2_dclk_div>, <&per_abe_x1_dclk_div>, <&mpu_dclk_div>, <&dsp_gclk_div>, <&iva_dclk>, <&gpu_dclk>, <&core_dpll_out_dclk_div>, <&emif_phy_dclk_div>, <&gmac_250m_dclk_div>, <&video2_dclk_div>, <&video1_dclk_div>, <&hdmi_dclk_div>, <&func_96m_aon_dclk_div>, <&l3init_480m_dclk_div>, <&usb_otg_dclk_div>, <&sata_dclk_div>, <&pcie2_dclk_div>, <&pcie_dclk_div>, <&emu_dclk_div>, <&secure_32k_dclk_div>, <&eve_dclk_div>;
++      reg = <0x4ae06160 0x4>;
++      bit-mask = <0x1f>;
++};
++
++custefuse_sys_gfclk_div: custefuse_sys_gfclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin1>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_core_h13x2_ck: dpll_core_h13x2_ck@4a005140 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005140 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h14x2_ck: dpll_core_h14x2_ck@4a005144 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005144 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h22x2_ck: dpll_core_h22x2_ck@4a005154 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005154 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h23x2_ck: dpll_core_h23x2_ck@4a005158 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005158 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h24x2_ck: dpll_core_h24x2_ck@4a00515c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00515c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_ddr_x2_ck: dpll_ddr_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_ddr_ck>;
++};
++
++dpll_ddr_h11x2_ck: dpll_ddr_h11x2_ck@4a005228 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_ddr_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005228 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_dsp_x2_ck: dpll_dsp_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_dsp_ck>;
++};
++
++dpll_dsp_m3x2_ck: dpll_dsp_m3x2_ck@4a005248 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_dsp_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a005248 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_gmac_x2_ck: dpll_gmac_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_gmac_ck>;
++};
++
++dpll_gmac_h11x2_ck: dpll_gmac_h11x2_ck@4a0052c0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gmac_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052c0 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_gmac_h12x2_ck: dpll_gmac_h12x2_ck@4a0052c4 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gmac_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052c4 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_gmac_h13x2_ck: dpll_gmac_h13x2_ck@4a0052c8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gmac_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052c8 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_gmac_m3x2_ck: dpll_gmac_m3x2_ck@4a0052bc {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_gmac_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0052bc 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_x2_ck: dpll_per_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_per_ck>;
++};
++
++dpll_per_h11x2_ck: dpll_per_h11x2_ck@4a008158 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008158 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_h12x2_ck: dpll_per_h12x2_ck@4a00815c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00815c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_h13x2_ck: dpll_per_h13x2_ck@4a008160 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008160 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_h14x2_ck: dpll_per_h14x2_ck@4a008164 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008164 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m2x2_ck: dpll_per_m2x2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_usb_clkdcoldo: dpll_usb_clkdcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_usb_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++eve_clk: eve_clk@4ae06180 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_eve_m2_ck>, <&dpll_dsp_m3x2_ck>;
++      reg = <0x4ae06180 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_128m_clk: func_128m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_h11x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++func_12m_fclk: func_12m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++func_24m_clk: func_24m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_48m_fclk: func_48m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_96m_fclk: func_96m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++gmii_m_clk_div: gmii_m_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_gmac_h11x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++hdmi_clk2_div: hdmi_clk2_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&hdmi_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++hdmi_div_clk: hdmi_div_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&hdmi_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++hdmi_dpll_clk_mux: hdmi_dpll_clk_mux@4ae061a4 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>;
++      reg = <0x4ae061a4 0x4>;
++      bit-mask = <0x7>;
++};
++
++l3_iclk_div: l3_iclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3init_60m_fclk: l3init_60m_fclk@4a008104 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      reg = <0x4a008104 0x4>;
++      table = < 1 0 >, < 8 1 >;
++      bit-mask = <0x1>;
++};
++
++l3init_960m_gfclk: l3init_960m_gfclk@4a0086c0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_clkdcoldo>;
++      bit-shift = <8>;
++      reg = <0x4a0086c0 0x4>;
++};
++
++l4_root_clk_div: l4_root_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l3_iclk_div>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mlb_clk: mlb_clk@4ae06134 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mlb_clkin_ck>;
++      reg = <0x4ae06134 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++mlbp_clk: mlbp_clk@4ae06130 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mlbp_clkin_ck>;
++      reg = <0x4ae06130 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++per_abe_x1_gfclk2_div: per_abe_x1_gfclk2_div@4ae06138 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2_ck>;
++      reg = <0x4ae06138 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++timer_sys_clk_div: timer_sys_clk_div@4ae06144 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin1>;
++      reg = <0x4ae06144 0x4>;
++      bit-mask = <0x1>;
++};
++
++video1_clk2_div: video1_clk2_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video1_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++video1_div_clk: video1_div_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video1_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++video1_dpll_clk_mux: video1_dpll_clk_mux@4ae061d0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>;
++      reg = <0x4ae061d0 0x4>;
++      bit-mask = <0x7>;
++};
++
++video2_clk2_div: video2_clk2_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video2_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++video2_div_clk: video2_div_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&video2_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++video2_dpll_clk_mux: video2_dpll_clk_mux@4ae061d4 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>;
++      reg = <0x4ae061d4 0x4>;
++      bit-mask = <0x7>;
++};
++
++wkupaon_iclk_mux: wkupaon_iclk_mux@4ae06108 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&abe_lp_clk_div>;
++      reg = <0x4ae06108 0x4>;
++      bit-mask = <0x1>;
++};
++
++dss_32khz_clk: dss_32khz_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <11>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_48mhz_clk: dss_48mhz_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48m_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_dss_clk: dss_dss_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_h12x2_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_hdmi_clk: dss_hdmi_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&hdmi_dpll_clk_mux>;
++      bit-shift = <10>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_video1_clk: dss_video1_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&video1_dpll_clk_mux>;
++      bit-shift = <12>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_video2_clk: dss_video2_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&video2_dpll_clk_mux>;
++      bit-shift = <13>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_deshdcp_clk: dss_deshdcp_clk@4a002558 {
++      compatible = "gate-clock";
++      clocks = <&l3_iclk_div>;
++      #clock-cells = <0>;
++      reg = <0x4a002558 0x1>;
++      bit-shift = <0>;
++};
++
++gpio1_dbclk: gpio1_dbclk@4ae07838 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae07838 0x4>;
++};
++
++gpio2_dbclk: gpio2_dbclk@4a009760 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009760 0x4>;
++};
++
++gpio3_dbclk: gpio3_dbclk@4a009768 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009768 0x4>;
++};
++
++gpio4_dbclk: gpio4_dbclk@4a009770 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009770 0x4>;
++};
++
++gpio5_dbclk: gpio5_dbclk@4a009778 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009778 0x4>;
++};
++
++gpio6_dbclk: gpio6_dbclk@4a009780 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009780 0x4>;
++};
++
++gpio7_dbclk: gpio7_dbclk@4a009810 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009810 0x4>;
++};
++
++gpio8_dbclk: gpio8_dbclk@4a009818 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009818 0x4>;
++};
++
++mmc1_clk32k: mmc1_clk32k@4a009328 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009328 0x4>;
++};
++
++mmc2_clk32k: mmc2_clk32k@4a009330 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009330 0x4>;
++};
++
++mmc3_clk32k: mmc3_clk32k@4a009820 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009820 0x4>;
++};
++
++mmc4_clk32k: mmc4_clk32k@4a009828 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009828 0x4>;
++};
++
++sata_ref_clk: sata_ref_clk@4a009388 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_clkin1>;
++      bit-shift = <8>;
++      reg = <0x4a009388 0x4>;
++};
++
++usb_otg_ss1_refclk960m: usb_otg_ss1_refclk960m@4a0093f0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_960m_gfclk>;
++      bit-shift = <8>;
++      reg = <0x4a0093f0 0x4>;
++};
++
++usb_otg_ss2_refclk960m: usb_otg_ss2_refclk960m@4a009340 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_960m_gfclk>;
++      bit-shift = <8>;
++      reg = <0x4a009340 0x4>;
++};
++
++usb_phy1_always_on_clk32k: usb_phy1_always_on_clk32k@4a008640 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008640 0x4>;
++};
++
++usb_phy2_always_on_clk32k: usb_phy2_always_on_clk32k@4a008688 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008688 0x4>;
++};
++
++usb_phy3_always_on_clk32k: usb_phy3_always_on_clk32k@4a008698 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008698 0x4>;
++};
++
++atl_dpll_clk_mux: atl_dpll_clk_mux@4a008c00 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_32k_ck>, <&video1_clkin_ck>, <&video2_clkin_ck>, <&hdmi_clkin_ck>;
++      bit-shift = <24>;
++      reg = <0x4a008c00 0x4>;
++      bit-mask = <0x3>;
++};
++
++atl_gfclk_mux: atl_gfclk_mux@4a008c00 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3_iclk_div>, <&dpll_abe_m2_ck>, <&atl_dpll_clk_mux>;
++      bit-shift = <26>;
++      reg = <0x4a008c00 0x4>;
++      bit-mask = <0x3>;
++};
++
++dcan1_sys_clk_mux: dcan1_sys_clk_mux@4ae07888 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin1>, <&sys_clkin2>;
++      bit-shift = <24>;
++      reg = <0x4ae07888 0x4>;
++      bit-mask = <0x1>;
++};
++
++gmac_gmii_ref_clk_div: gmac_gmii_ref_clk_div@4a0093d0 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_gmac_m2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a0093d0 0x4>;
++      table = < 2 0 >;
++      bit-mask = <0x1>;
++};
++
++gmac_rft_clk_mux: gmac_rft_clk_mux@4a0093d0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&video1_clkin_ck>, <&video2_clkin_ck>, <&dpll_abe_m2_ck>, <&hdmi_clkin_ck>, <&l3_iclk_div>;
++      bit-shift = <25>;
++      reg = <0x4a0093d0 0x4>;
++      bit-mask = <0x7>;
++};
++
++gpu_core_gclk_mux: gpu_core_gclk_mux@4a009220 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_h14x2_ck>, <&dpll_per_h14x2_ck>, <&dpll_gpu_m2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009220 0x4>;
++      bit-mask = <0x3>;
++};
++
++gpu_hyd_gclk_mux: gpu_hyd_gclk_mux@4a009220 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_h14x2_ck>, <&dpll_per_h14x2_ck>, <&dpll_gpu_m2_ck>;
++      bit-shift = <26>;
++      reg = <0x4a009220 0x4>;
++      bit-mask = <0x3>;
++};
++
++ipu1_gfclk_mux: ipu1_gfclk_mux@4a005520 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_abe_m2x2_ck>, <&dpll_core_h22x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a005520 0x4>;
++      bit-mask = <0x1>;
++};
++
++l3instr_ts_gclk_div: l3instr_ts_gclk_div@4a008e50 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&wkupaon_iclk_mux>;
++      bit-shift = <24>;
++      reg = <0x4a008e50 0x4>;
++      table = < 8 0 >, < 16 1 >, < 32 2 >;
++      bit-mask = <0x3>;
++};
++
++mcasp1_ahclkr_mux: mcasp1_ahclkr_mux@4a005550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <28>;
++      reg = <0x4a005550 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp1_ahclkx_mux: mcasp1_ahclkx_mux@4a005550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a005550 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp1_aux_gfclk_mux: mcasp1_aux_gfclk_mux@4a005550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a005550 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp2_ahclkr_mux: mcasp2_ahclkr_mux@4a009860 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <28>;
++      reg = <0x4a009860 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp2_ahclkx_mux: mcasp2_ahclkx_mux@4a009860 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <28>;
++      reg = <0x4a009860 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp2_aux_gfclk_mux: mcasp2_aux_gfclk_mux@4a009860 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009860 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp3_ahclkx_mux: mcasp3_ahclkx_mux@4a009868 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009868 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp3_aux_gfclk_mux: mcasp3_aux_gfclk_mux@4a009868 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009868 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp4_ahclkx_mux: mcasp4_ahclkx_mux@4a009898 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009898 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp4_aux_gfclk_mux: mcasp4_aux_gfclk_mux@4a009898 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009898 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp5_ahclkx_mux: mcasp5_ahclkx_mux@4a009878 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009878 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp5_aux_gfclk_mux: mcasp5_aux_gfclk_mux@4a009878 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009878 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp6_ahclkx_mux: mcasp6_ahclkx_mux@4a009904 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009904 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp6_aux_gfclk_mux: mcasp6_aux_gfclk_mux@4a009904 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009904 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp7_ahclkx_mux: mcasp7_ahclkx_mux@4a009908 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009908 0x4>;
++      bit-mask = <0xf>;
++};
++
++mcasp7_aux_gfclk_mux: mcasp7_aux_gfclk_mux@4a009908 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <22>;
++      reg = <0x4a009908 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp8_ahclk_mux: mcasp8_ahclk_mux@4a009890 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&abe_sys_clk_div>, <&func_24m_clk>, <&atlclkin3_ck>, <&atl_clkin2_ck>, <&atl_clkin1_ck>, <&atl_clkin0_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&mlb_clk>, <&mlbp_clk>;
++      bit-shift = <22>;
++      reg = <0x4a009890 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp8_aux_gfclk_mux: mcasp8_aux_gfclk_mux@4a009890 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_abe_x1_gfclk2_div>, <&video1_clk2_div>, <&video2_clk2_div>, <&hdmi_clk2_div>;
++      bit-shift = <24>;
++      reg = <0x4a009890 0x4>;
++      bit-mask = <0xf>;
++};
++
++mmc1_fclk_mux: mmc1_fclk_mux@4a009328 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_128m_clk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009328 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc1_fclk_div: mmc1_fclk_div@4a009328 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc1_fclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009328 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++mmc2_fclk_mux: mmc2_fclk_mux@4a009330 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_128m_clk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009330 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc2_fclk_div: mmc2_fclk_div@4a009330 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc2_fclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009330 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++mmc3_gfclk_mux: mmc3_gfclk_mux@4a009820 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009820 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc3_gfclk_div: mmc3_gfclk_div@4a009820 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc3_gfclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009820 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++mmc4_gfclk_mux: mmc4_gfclk_mux@4a009828 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009828 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc4_gfclk_div: mmc4_gfclk_div@4a009828 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc4_gfclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009828 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++qspi_gfclk_mux: qspi_gfclk_mux@4a009838 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_128m_clk>, <&dpll_per_h13x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009838 0x4>;
++      bit-mask = <0x1>;
++};
++
++qspi_gfclk_div: qspi_gfclk_div@4a009838 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&qspi_gfclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009838 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++timer10_gfclk_mux: timer10_gfclk_mux@4a009728 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009728 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer11_gfclk_mux: timer11_gfclk_mux@4a009730 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009730 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer13_gfclk_mux: timer13_gfclk_mux@4a0097c8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a0097c8 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer14_gfclk_mux: timer14_gfclk_mux@4a0097d0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a0097d0 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer15_gfclk_mux: timer15_gfclk_mux@4a0097d8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a0097d8 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer16_gfclk_mux: timer16_gfclk_mux@4a009830 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009830 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer1_gfclk_mux: timer1_gfclk_mux@4ae07840 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4ae07840 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer2_gfclk_mux: timer2_gfclk_mux@4a009738 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009738 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer3_gfclk_mux: timer3_gfclk_mux@4a009740 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009740 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer4_gfclk_mux: timer4_gfclk_mux@4a009748 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009748 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer5_gfclk_mux: timer5_gfclk_mux@4a005558 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>, <&clkoutmux0_clk_mux>;
++      bit-shift = <24>;
++      reg = <0x4a005558 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer6_gfclk_mux: timer6_gfclk_mux@4a005560 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>, <&clkoutmux0_clk_mux>;
++      bit-shift = <24>;
++      reg = <0x4a005560 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer7_gfclk_mux: timer7_gfclk_mux@4a005568 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>, <&clkoutmux0_clk_mux>;
++      bit-shift = <24>;
++      reg = <0x4a005568 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer8_gfclk_mux: timer8_gfclk_mux@4a005570 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>, <&clkoutmux0_clk_mux>;
++      bit-shift = <24>;
++      reg = <0x4a005570 0x4>;
++      bit-mask = <0xf>;
++};
++
++timer9_gfclk_mux: timer9_gfclk_mux@4a009750 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&timer_sys_clk_div>, <&sys_32k_ck>, <&sys_clkin2>, <&ref_clkin0_ck>, <&ref_clkin1_ck>, <&ref_clkin2_ck>, <&ref_clkin3_ck>, <&abe_giclk_div>, <&video1_div_clk>, <&video2_div_clk>, <&hdmi_div_clk>;
++      bit-shift = <24>;
++      reg = <0x4a009750 0x4>;
++      bit-mask = <0xf>;
++};
++
++uart10_gfclk_mux: uart10_gfclk_mux@4ae07880 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4ae07880 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart1_gfclk_mux: uart1_gfclk_mux@4a009840 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009840 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart2_gfclk_mux: uart2_gfclk_mux@4a009848 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009848 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart3_gfclk_mux: uart3_gfclk_mux@4a009850 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009850 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart4_gfclk_mux: uart4_gfclk_mux@4a009858 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009858 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart5_gfclk_mux: uart5_gfclk_mux@4a009870 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009870 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart6_gfclk_mux: uart6_gfclk_mux@4a005580 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a005580 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart7_gfclk_mux: uart7_gfclk_mux@4a0098d0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a0098d0 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart8_gfclk_mux: uart8_gfclk_mux@4a0098e0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a0098e0 0x4>;
++      bit-mask = <0x1>;
++};
++
++uart9_gfclk_mux: uart9_gfclk_mux@4a0098e8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_48m_fclk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a0098e8 0x4>;
++      bit-mask = <0x1>;
++};
++
++vip1_gclk_mux: vip1_gclk_mux@4a009020 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3_iclk_div>, <&dpll_core_h23x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009020 0x4>;
++      bit-mask = <0x1>;
++};
++
++vip2_gclk_mux: vip2_gclk_mux@4a009028 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3_iclk_div>, <&dpll_core_h23x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009028 0x4>;
++      bit-mask = <0x1>;
++};
++
++vip3_gclk_mux: vip3_gclk_mux@4a009030 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3_iclk_div>, <&dpll_core_h23x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009030 0x4>;
++      bit-mask = <0x1>;
++};
++
++optfclk_pciephy_div: optfclk_pciephy_div@4a00821c {
++      compatible = "divider-clock";
++      clocks = <&apll_pcie_ck>;
++      #clock-cells = <0>;
++      reg = <0x4a00821c 0x4>;
++      bit-mask = <0x100>;
++};
++
++optfclk_pciephy_clk: optfclk_pciephy_clk@4a0093b0 {
++      compatible = "gate-clock";
++      clocks = <&apll_pcie_ck>;
++      #clock-cells = <0>;
++      reg = <0x4a0093b0 0x4>;
++      bit-shift = <9>;
++};
++
++optfclk_pciephy_div_clk: optfclk_pciephy_div_clk@4a0093b0 {
++      compatible = "gate-clock";
++      clocks = <&optfclk_pciephy_div>;
++      #clock-cells = <0>;
++      reg = <0x4a0093b0 0x4>;
++      bit-shift = <10>;
++};
+--- a/arch/arm/boot/dts/Makefile
++++ b/arch/arm/boot/dts/Makefile
+@@ -186,9 +186,12 @@ dtb-$(CONFIG_ARCH_OMAP2PLUS) += omap2420
+       am335x-evmsk.dtb \
+       am335x-bone.dtb \
+       am335x-boneblack.dtb \
++      am335x-evm-profile2.dtb \
+       am3517-evm.dtb \
+       am3517_mt_ventoux.dtb \
+-      am43x-epos-evm.dtb
++      am43x-epos-evm.dtb \
++      am437x-gp-evm.dtb \
++      dra7-evm.dtb
+ dtb-$(CONFIG_ARCH_ORION5X) += orion5x-lacie-ethernet-disk-mini-v2.dtb
+ dtb-$(CONFIG_ARCH_PRIMA2) += prima2-evb.dtb
+ dtb-$(CONFIG_ARCH_U8500) += ste-snowball.dtb \
+--- a/arch/arm/boot/dts/omap2420.dtsi
++++ b/arch/arm/boot/dts/omap2420.dtsi
+@@ -114,6 +114,18 @@
+                       dma-names = "tx", "rx";
+               };
++              mailbox: mailbox@48094000 {
++                      compatible = "ti,omap2-mailbox";
++                      reg = <0x48094000 0x200>;
++                      interrupts = <26>, /* DSP Interrupt */
++                                   <34>; /* IVA Interrupt */
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <6>;
++                      ti,mbox-names = "dsp", "iva";
++                      ti,mbox-data = <0 1 0 0>, <2 3 1 3>;
++              };
++
+               timer1: timer@48028000 {
+                       compatible = "ti,omap2420-timer";
+                       reg = <0x48028000 0x400>;
+--- a/arch/arm/boot/dts/omap2430.dtsi
++++ b/arch/arm/boot/dts/omap2430.dtsi
+@@ -175,6 +175,17 @@
+                       dma-names = "tx", "rx";
+               };
++              mailbox: mailbox@48094000 {
++                      compatible = "ti,omap2-mailbox";
++                      reg = <0x48094000 0x200>;
++                      interrupts = <26>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <4>;
++                      ti,mbox-num-fifos = <6>;
++                      ti,mbox-names = "dsp";
++                      ti,mbox-data = <0 1 0 0>;
++              };
++
+               timer1: timer@49018000 {
+                       compatible = "ti,omap2420-timer";
+                       reg = <0x49018000 0x400>;
+--- /dev/null
++++ b/arch/arm/boot/dts/omap3430es1-clocks.dtsi
+@@ -0,0 +1,158 @@
++/*
++ * Device Tree Source for OMAP3430 ES1 clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++gfx_l3_ck: gfx_l3_ck@48004b10 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&l3_ick>;
++      reg = <0x48004b10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++gfx_l3_fck: gfx_l3_fck@48004b40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l3_ick>;
++      reg = <0x48004b40 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++gfx_l3_ick: gfx_l3_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&gfx_l3_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++gfx_cg1_ck: gfx_cg1_ck@48004b00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&gfx_l3_fck>;
++      reg = <0x48004b00 0x4>;
++      ti,enable-bit = <1>;
++};
++
++gfx_cg2_ck: gfx_cg2_ck@48004b00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&gfx_l3_fck>;
++      reg = <0x48004b00 0x4>;
++      ti,enable-bit = <2>;
++};
++
++d2d_26m_fck: d2d_26m_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <3>;
++};
++
++fshostusb_fck: fshostusb_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <5>;
++};
++
++ssi_ssr_div_fck_3430es1: ssi_ssr_div_fck_3430es1@48004a40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&corex2_fck>;
++      bit-shift = <8>;
++      reg = <0x48004a40 0x4>;
++      table = < 1 1 >, < 2 2 >, < 3 3 >, < 4 4 >, < 6 6 >, < 8 8 >;
++      bit-mask = <0xf>;
++};
++
++ssi_ssr_fck_3430es1: ssi_ssr_fck_3430es1@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&ssi_ssr_div_fck_3430es1>;
++      bit-shift = <0>;
++      reg = <0x48004a00 0x4>;
++};
++
++ssi_sst_fck_3430es1: ssi_sst_fck_3430es1 {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&ssi_ssr_fck_3430es1>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++hsotgusb_ick: hsotgusb_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-no-wait-interface-clock";
++      clocks = <&core_l3_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <4>;
++};
++
++fac_ick: fac_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <8>;
++};
++
++ssi_l4_ick: ssi_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++ssi_ick_3430es1: ssi_ick_3430es1@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-no-wait-interface-clock";
++      clocks = <&ssi_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++usb_l4_div_ick: usb_l4_div_ick@48004a40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l4_ick>;
++      bit-shift = <4>;
++      reg = <0x48004a40 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++usb_l4_ick: usb_l4_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&usb_l4_div_ick>;
++      bit-shift = <5>;
++      reg = <0x48004a10 0x4>;
++};
++
++dss1_alwon_fck_3430es1: dss1_alwon_fck_3430es1@48004e00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m4x2_ck>;
++      reg = <0x48004e00 0x4>;
++      bit-shift = <0>;
++};
++
++dss_ick_3430es1: dss_ick_3430es1@48004e10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-no-wait-interface-clock";
++      clocks = <&l4_ick>;
++      reg = <0x48004e10 0x4>;
++      ti,enable-bit = <0>;
++};
+--- a/arch/arm/boot/dts/omap34xx.dtsi
++++ b/arch/arm/boot/dts/omap34xx.dtsi
+@@ -25,4 +25,113 @@
+                       clock-latency = <300000>; /* From legacy driver */
+               };
+       };
+-};
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap34xx-omap36xx-clocks.dtsi"
++              /include/ "omap36xx-omap3430es2plus-clocks.dtsi"
++              /include/ "omap36xx-am35xx-omap3430es2plus-clocks.dtsi"
++      };
++
++      clockdomains {
++              usbhost_clkdm: usbhost_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&usbhost_48m_fck>, <&usbhost_ick>;
++              };
++
++              wkup_clkdm: wkup_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&wdt1_ick>, <&gpt12_ick>, <&gpio1_ick>,
++                               <&gpt1_ick>, <&omap_32ksync_ick>, <&wdt2_ick>,
++                               <&wdt2_fck>;
++              };
++
++              cam_clkdm: cam_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&cam_ick>;
++              };
++
++              dpll4_clkdm: dpll4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll4_ck>;
++              };
++
++              sgx_clkdm: sgx_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sgx_ick>;
++              };
++
++              dpll3_clkdm: dpll3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll3_ck>;
++              };
++
++              iva2_clkdm: iva2_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&iva2_ck>;
++              };
++
++              dpll1_clkdm: dpll1_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll1_ck>;
++              };
++
++              dpll2_clkdm: dpll2_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll2_ck>;
++              };
++
++              dpll5_clkdm: dpll5_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll5_ck>;
++              };
++
++              dss_clkdm: dss_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dss1_alwon_fck_3430es2>, <&dss_ick_3430es2>;
++              };
++
++              core_l4_clkdm: core_l4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&mmchs1_ick>, <&mmchs2_ick>, <&hdq_fck>,
++                               <&uart1_ick>, <&mcspi4_fck>, <&i2c3_fck>,
++                               <&mcspi2_ick>, <&uart2_ick>, <&mcspi3_ick>,
++                               <&i2c1_fck>, <&hdq_ick>, <&sha12_ick>,
++                               <&mcbsp5_ick>, <&mcspi3_fck>, <&aes2_ick>,
++                               <&mcspi1_ick>, <&uart2_fck>, <&mmchs2_fck>,
++                               <&mmchs1_fck>, <&i2c3_ick>, <&mcspi1_fck>,
++                               <&mcspi4_ick>, <&omapctrl_ick>, <&mcbsp1_ick>,
++                               <&mcspi2_fck>, <&gpt10_ick>, <&i2c2_fck>,
++                               <&i2c2_ick>, <&gpt11_ick>, <&i2c1_ick>,
++                               <&uart1_fck>;
++              };
++
++              core_l3_clkdm: core_l3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sdrc_ick>;
++              };
++
++              per_clkdm: per_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&gpt2_ick>, <&uart3_fck>, <&gpio3_ick>,
++                               <&mcbsp2_ick>, <&gpt6_ick>, <&mcbsp4_ick>,
++                               <&gpt4_ick>, <&mcbsp3_ick>, <&gpt8_ick>,
++                               <&uart3_ick>, <&gpt5_ick>, <&gpt7_ick>,
++                               <&gpio2_ick>, <&gpio6_ick>, <&gpt9_ick>,
++                               <&gpt3_ick>, <&gpio5_ick>, <&wdt3_ick>,
++                               <&gpio4_ick>, <&wdt3_fck>, <&uart4_ick>;
++              };
++
++              emu_clkdm: emu_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&emu_src_ck>;
++              };
++
++              d2d_clkdm: d2d_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&mad2d_ick>, <&sad2d_ick>, <&modem_fck>;
++              };
++      };
++};
+\ No newline at end of file
+--- /dev/null
++++ b/arch/arm/boot/dts/omap34xx-omap36xx-clocks.dtsi
+@@ -0,0 +1,222 @@
++/*
++ * Device Tree Source for OMAP34xx/OMAP36xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++security_l4_ick2: security_l4_ick2 {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++aes1_ick: aes1_ick@48004a14 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&security_l4_ick2>;
++      reg = <0x48004a14 0x4>;
++      ti,enable-bit = <3>;
++};
++
++rng_ick: rng_ick@48004a14 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&security_l4_ick2>;
++      reg = <0x48004a14 0x4>;
++      ti,enable-bit = <2>;
++};
++
++sha11_ick: sha11_ick@48004a14 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&security_l4_ick2>;
++      reg = <0x48004a14 0x4>;
++      ti,enable-bit = <1>;
++};
++
++des1_ick: des1_ick@48004a14 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&security_l4_ick2>;
++      reg = <0x48004a14 0x4>;
++      ti,enable-bit = <0>;
++};
++
++cam_mclk: cam_mclk@48004f00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m5x2_ck>;
++      bit-shift = <0>;
++      reg = <0x48004f00 0x4>;
++      set-rate-parent;
++};
++
++cam_ick: cam_ick@48004f10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-no-wait-interface-clock";
++      clocks = <&l4_ick>;
++      reg = <0x48004f10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++csi2_96m_fck: csi2_96m_fck@48004f00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004f00 0x4>;
++      bit-shift = <1>;
++};
++
++security_l3_ick: security_l3_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l3_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++pka_ick: pka_ick@48004a14 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&security_l3_ick>;
++      reg = <0x48004a14 0x4>;
++      ti,enable-bit = <4>;
++};
++
++icr_ick: icr_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <29>;
++};
++
++des2_ick: des2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <26>;
++};
++
++mspro_ick: mspro_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <23>;
++};
++
++mailboxes_ick: mailboxes_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <7>;
++};
++
++ssi_l4_ick: ssi_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sr1_fck: sr1_fck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004c00 0x4>;
++      ti,enable-bit = <6>;
++};
++
++sr2_fck: sr2_fck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004c00 0x4>;
++      ti,enable-bit = <7>;
++};
++
++sr_l4_ick: sr_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll2_fck: dpll2_fck@48004040 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&core_ck>;
++      bit-shift = <19>;
++      reg = <0x48004040 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++dpll2_ck: dpll2_ck@48004004 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-clock";
++      clocks = <&sys_ck>, <&dpll2_fck>;
++      ti,modes = <0xa2>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004004 0x4>, <0x48004024 0x4>, <0x48004034 0x4>, <0x48004040 0x4>;
++};
++
++dpll2_m2_ck: dpll2_m2_ck@48004044 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll2_ck>;
++      reg = <0x48004044 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++iva2_ck: iva2_ck@48004000 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&dpll2_m2_ck>;
++      reg = <0x48004000 0x4>;
++      ti,enable-bit = <0>;
++};
++
++modem_fck: modem_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <31>;
++};
++
++sad2d_ick: sad2d_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&l3_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <3>;
++};
++
++mad2d_ick: mad2d_ick@48004a18 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&l3_ick>;
++      reg = <0x48004a18 0x4>;
++      ti,enable-bit = <3>;
++};
++
++mspro_fck: mspro_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <23>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap36xx-am35xx-omap3430es2plus-clocks.dtsi
+@@ -0,0 +1,196 @@
++/*
++ * Device Tree Source for OMAP36xx/AM35xx/OMAP34xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++dpll5_ck: dpll5_ck@48004d04 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-clock";
++      clocks = <&sys_ck>, <&sys_ck>;
++      ti,modes = <0x82>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004d04 0x4>, <0x48004d24 0x4>, <0x48004d34 0x4>, <0x48004d4c 0x4>;
++};
++
++dpll5_m2_ck: dpll5_m2_ck@48004d50 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll5_ck>;
++      reg = <0x48004d50 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++core_d3_ck: core_d3_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&core_ck>;
++      clock-mult = <1>;
++      clock-div = <3>;
++};
++
++core_d4_ck: core_d4_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&core_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++core_d6_ck: core_d6_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&core_ck>;
++      clock-mult = <1>;
++      clock-div = <6>;
++};
++
++omap_192m_alwon_fck: omap_192m_alwon_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++core_d2_ck: core_d2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&core_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++corex2_d3_fck: corex2_d3_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&corex2_fck>;
++      clock-mult = <1>;
++      clock-div = <3>;
++};
++
++corex2_d5_fck: corex2_d5_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&corex2_fck>;
++      clock-mult = <1>;
++      clock-div = <5>;
++};
++
++sgx_mux_fck: sgx_mux_fck@48004b40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&core_d3_ck>, <&core_d4_ck>, <&core_d6_ck>, <&cm_96m_fck>, <&omap_192m_alwon_fck>, <&core_d2_ck>, <&corex2_d3_fck>, <&corex2_d5_fck>;
++      reg = <0x48004b40 0x4>;
++      table = <&core_d3_ck 0>, <&core_d4_ck 1>, <&core_d6_ck 2>, <&cm_96m_fck 3>, <&omap_192m_alwon_fck 4>, <&core_d2_ck 5>, <&corex2_d3_fck 6>, <&corex2_d5_fck 7>;
++      bit-mask = <0x7>;
++};
++
++sgx_fck: sgx_fck@48004b00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sgx_mux_fck>;
++      bit-shift = <1>;
++      reg = <0x48004b00 0x4>;
++};
++
++sgx_ick: sgx_ick@48004b10 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&l3_ick>;
++      reg = <0x48004b10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++cpefuse_fck: cpefuse_fck@48004a08 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004a08 0x4>;
++      bit-shift = <0>;
++};
++
++ts_fck: ts_fck@48004a08 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&omap_32k_fck>;
++      reg = <0x48004a08 0x4>;
++      bit-shift = <1>;
++};
++
++usbtll_fck: usbtll_fck@48004a08 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&dpll5_m2_ck>;
++      reg = <0x48004a08 0x4>;
++      ti,enable-bit = <2>;
++};
++
++usbtll_ick: usbtll_ick@48004a18 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a18 0x4>;
++      ti,enable-bit = <2>;
++};
++
++mmchs3_ick: mmchs3_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <30>;
++};
++
++mmchs3_fck: mmchs3_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <30>;
++};
++
++dss1_alwon_fck_3430es2: dss1_alwon_fck_3430es2@48004e00 {
++      #clock-cells = <0>;
++      compatible = "ti,dss-gate-clock";
++      clocks = <&dpll4_m4x2_ck>;
++      reg = <0x48004e00 0x4>;
++      ti,enable-bit = <0>;
++};
++
++dss_ick_3430es2: dss_ick_3430es2@48004e10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dss-interface-clock";
++      clocks = <&l4_ick>;
++      reg = <0x48004e10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++usbhost_120m_fck: usbhost_120m_fck@48005400 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll5_m2_ck>;
++      reg = <0x48005400 0x4>;
++      bit-shift = <1>;
++};
++
++usbhost_48m_fck: usbhost_48m_fck@48005400 {
++      #clock-cells = <0>;
++      compatible = "ti,dss-gate-clock";
++      clocks = <&omap_48m_fck>;
++      reg = <0x48005400 0x4>;
++      ti,enable-bit = <0>;
++};
++
++usbhost_ick: usbhost_ick@48005410 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dss-interface-clock";
++      clocks = <&l4_ick>;
++      reg = <0x48005410 0x4>;
++      ti,enable-bit = <0>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap36xx-clocks.dtsi
+@@ -0,0 +1,80 @@
++/*
++ * Device Tree Source for OMAP36xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++dpll4_ck: dpll4_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-per-j-type-clock";
++      clocks = <&sys_ck>, <&sys_ck>;
++      ti,modes = <0x82>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004d00 0x4>, <0x48004d20 0x4>, <0x48004d30 0x4>, <0x48004d44 0x4>;
++};
++
++dpll4_m2x2_ck: dpll4_m2x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,hsdiv-gate-clock";
++      clocks = <&dpll4_m2x2_mul_ck>;
++      reg = <0x48004d00 0x4>;
++      ti,enable-bit = <0x1b>;
++      ti,set-bit-to-disable;
++};
++
++dpll3_m3x2_ck: dpll3_m3x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,hsdiv-gate-clock";
++      clocks = <&dpll3_m3x2_mul_ck>;
++      reg = <0x48004d00 0x4>;
++      ti,enable-bit = <0xc>;
++      ti,set-bit-to-disable;
++};
++
++dpll4_m3x2_ck: dpll4_m3x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,hsdiv-gate-clock";
++      clocks = <&dpll4_m3x2_mul_ck>;
++      reg = <0x48004d00 0x4>;
++      ti,enable-bit = <0x1c>;
++      ti,set-bit-to-disable;
++};
++
++dpll4_m5x2_ck: dpll4_m5x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,hsdiv-gate-clock";
++      clocks = <&dpll4_m5x2_mul_ck>;
++      reg = <0x48004d00 0x4>;
++      ti,enable-bit = <0x1e>;
++      ti,set-rate-parent;
++      ti,set-bit-to-disable;
++};
++
++dpll4_m6x2_ck: dpll4_m6x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,hsdiv-gate-clock";
++      clocks = <&dpll4_m6x2_mul_ck>;
++      reg = <0x48004d00 0x4>;
++      ti,enable-bit = <0x1f>;
++      ti,set-bit-to-disable;
++};
++
++omap_192m_alwon_fck: omap_192m_alwon_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++uart4_fck: uart4_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&per_48m_fck>;
++      reg = <0x48005000 0x4>;
++      ti,enable-bit = <18>;
++};
+--- a/arch/arm/boot/dts/omap36xx.dtsi
++++ b/arch/arm/boot/dts/omap36xx.dtsi
+@@ -35,4 +35,114 @@
+                       clock-frequency = <48000000>;
+               };
+       };
+-};
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap36xx-clocks.dtsi"
++              /include/ "omap34xx-omap36xx-clocks.dtsi"
++              /include/ "omap36xx-omap3430es2plus-clocks.dtsi"
++              /include/ "omap36xx-am35xx-omap3430es2plus-clocks.dtsi"
++      };
++
++      clockdomains {
++              usbhost_clkdm: usbhost_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&usbhost_48m_fck>, <&usbhost_ick>;
++              };
++
++              wkup_clkdm: wkup_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&wdt1_ick>, <&gpt12_ick>, <&gpio1_ick>,
++                               <&gpt1_ick>, <&omap_32ksync_ick>, <&wdt2_ick>,
++                               <&wdt2_fck>;
++              };
++
++              cam_clkdm: cam_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&cam_ick>;
++              };
++
++              dpll4_clkdm: dpll4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll4_ck>;
++              };
++
++              sgx_clkdm: sgx_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sgx_ick>;
++              };
++
++              dpll3_clkdm: dpll3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll3_ck>;
++              };
++
++              iva2_clkdm: iva2_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&iva2_ck>;
++              };
++
++              dpll1_clkdm: dpll1_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll1_ck>;
++              };
++
++              dpll5_clkdm: dpll5_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll5_ck>;
++              };
++
++              dpll2_clkdm: dpll2_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll2_ck>;
++              };
++
++              dss_clkdm: dss_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dss1_alwon_fck_3430es2>, <&dss_ick_3430es2>;
++              };
++
++              core_l4_clkdm: core_l4_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&mmchs1_ick>, <&mmchs2_ick>, <&hdq_fck>,
++                               <&uart1_ick>, <&mcspi4_fck>, <&i2c3_fck>,
++                               <&mcspi2_ick>, <&uart2_ick>, <&mcspi3_ick>,
++                               <&i2c1_fck>, <&hdq_ick>, <&sha12_ick>,
++                               <&mcbsp5_ick>, <&mcspi3_fck>, <&aes2_ick>,
++                               <&mcspi1_ick>, <&uart2_fck>, <&mmchs2_fck>,
++                               <&mmchs1_fck>, <&i2c3_ick>, <&mcspi1_fck>,
++                               <&mcspi4_ick>, <&omapctrl_ick>, <&mcbsp1_ick>,
++                               <&mcspi2_fck>, <&gpt10_ick>, <&i2c2_fck>,
++                               <&i2c2_ick>, <&gpt11_ick>, <&i2c1_ick>,
++                               <&uart1_fck>;
++              };
++
++              core_l3_clkdm: core_l3_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&sdrc_ick>;
++              };
++
++              per_clkdm: per_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&gpt2_ick>, <&uart3_fck>, <&gpio3_ick>,
++                               <&mcbsp2_ick>, <&gpt6_ick>, <&mcbsp4_ick>,
++                               <&gpt4_ick>, <&mcbsp3_ick>, <&gpt8_ick>,
++                               <&uart3_ick>, <&gpt5_ick>, <&gpt7_ick>,
++                               <&gpio2_ick>, <&gpio6_ick>, <&gpt9_ick>,
++                               <&gpt3_ick>, <&gpio5_ick>, <&wdt3_ick>,
++                               <&gpio4_ick>, <&wdt3_fck>, <&uart4_ick>;
++              };
++
++              emu_clkdm: emu_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&emu_src_ck>;
++              };
++
++              d2d_clkdm: d2d_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&mad2d_ick>, <&sad2d_ick>, <&modem_fck>;
++              };
++      };
++};
+\ No newline at end of file
+--- /dev/null
++++ b/arch/arm/boot/dts/omap36xx-omap3430es2plus-clocks.dtsi
+@@ -0,0 +1,175 @@
++/*
++ * Device Tree Source for OMAP34xx/OMAP36xx clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++ssi_ssr_div_fck_3430es2: ssi_ssr_div_fck_3430es2@48004a40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&corex2_fck>;
++      bit-shift = <8>;
++      reg = <0x48004a40 0x4>;
++      table = < 1 1 >, < 2 2 >, < 3 3 >, < 4 4 >, < 6 6 >, < 8 8 >;
++      bit-mask = <0xf>;
++};
++
++ssi_ssr_fck_3430es2: ssi_ssr_fck_3430es2@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&ssi_ssr_div_fck_3430es2>;
++      bit-shift = <0>;
++      reg = <0x48004a00 0x4>;
++};
++
++ssi_sst_fck_3430es2: ssi_sst_fck_3430es2 {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&ssi_ssr_fck_3430es2>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++hsotgusb_ick: hsotgusb_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-hsotgusb-interface-clock";
++      clocks = <&core_l3_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <4>;
++};
++
++ssi_l4_ick: ssi_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++ssi_ick_3430es2: ssi_ick_3430es2@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-ssi-interface-clock";
++      clocks = <&ssi_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++dpll5_ck: dpll5_ck@48004d04 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-clock";
++      clocks = <&sys_ck>, <&sys_ck>;
++      ti,modes = <0x82>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004d04 0x4>, <0x48004d24 0x4>, <0x48004d34 0x4>, <0x48004d4c 0x4>;
++};
++
++dpll5_m2_ck: dpll5_m2_ck@48004d50 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll5_ck>;
++      reg = <0x48004d50 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll5_m2_d20_ck: dpll5_m2_d20_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll5_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <20>;
++};
++
++sys_d2_ck: sys_d2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++omap_96m_d2_fck: omap_96m_d2_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++omap_96m_d4_fck: omap_96m_d4_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++omap_96m_d8_fck: omap_96m_d8_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++omap_96m_d10_fck: omap_96m_d10_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <10>;
++};
++
++dpll5_m2_d4_ck: dpll5_m2_d4_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll5_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++dpll5_m2_d8_ck: dpll5_m2_d8_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll5_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++dpll5_m2_d16_ck: dpll5_m2_d16_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll5_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++usim_mux_fck: usim_mux_fck@48004c40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_ck>, <&dpll5_m2_d20_ck>, <&sys_d2_ck>, <&omap_96m_d2_fck>, <&omap_96m_d4_fck>, <&omap_96m_d8_fck>, <&omap_96m_d10_fck>, <&dpll5_m2_d4_ck>, <&dpll5_m2_d8_ck>, <&dpll5_m2_d16_ck>;
++      bit-shift = <3>;
++      reg = <0x48004c40 0x4>;
++      table = <&sys_ck 1>, <&dpll5_m2_d20_ck 10>, <&sys_d2_ck 2>, <&omap_96m_d2_fck 3>, <&omap_96m_d4_fck 4>, <&omap_96m_d8_fck 5>, <&omap_96m_d10_fck 6>, <&dpll5_m2_d4_ck 7>, <&dpll5_m2_d8_ck 8>, <&dpll5_m2_d16_ck 9>;
++      bit-mask = <0xf>;
++};
++
++usim_fck: usim_fck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&usim_mux_fck>;
++      bit-shift = <9>;
++      reg = <0x48004c00 0x4>;
++};
++
++usim_ick: usim_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <9>;
++};
+--- a/arch/arm/boot/dts/omap3-beagle.dts
++++ b/arch/arm/boot/dts/omap3-beagle.dts
+@@ -44,17 +44,6 @@
+               };
+       };
+-      /* HS USB Port 2 RESET */
+-      hsusb2_reset: hsusb2_reset_reg {
+-              compatible = "regulator-fixed";
+-              regulator-name = "hsusb2_reset";
+-              regulator-min-microvolt = <3300000>;
+-              regulator-max-microvolt = <3300000>;
+-              gpio = <&gpio5 19 0>;   /* gpio_147 */
+-              startup-delay-us = <70000>;
+-              enable-active-high;
+-      };
+-
+       /* HS USB Port 2 Power */
+       hsusb2_power: hsusb2_power_reg {
+               compatible = "regulator-fixed";
+@@ -68,7 +57,7 @@
+       /* HS USB Host PHY on PORT 2 */
+       hsusb2_phy: hsusb2_phy {
+               compatible = "usb-nop-xceiv";
+-              reset-supply = <&hsusb2_reset>;
++              reset-gpios = <&gpio5 19 GPIO_ACTIVE_LOW>;      /* gpio_147 */
+               vcc-supply = <&hsusb2_power>;
+       };
+@@ -101,18 +90,18 @@
+       hsusbb2_pins: pinmux_hsusbb2_pins {
+               pinctrl-single,pins = <
+-                      0x5c0 (PIN_OUTPUT | MUX_MODE3)          /* usbb2_ulpitll_clk.usbb1_ulpiphy_clk */
+-                      0x5c2 (PIN_OUTPUT | MUX_MODE3)          /* usbb2_ulpitll_clk.usbb1_ulpiphy_stp */
+-                      0x5c4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dir */
+-                      0x5c6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_nxt */
+-                      0x5c8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat0 */
+-                      0x5cA (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat1 */
+-                      0x1a4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat2 */
+-                      0x1a6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat3 */
+-                      0x1a8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat4 */
+-                      0x1aa (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat5 */
+-                      0x1ac (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat6 */
+-                      0x1ae (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* usbb2_ulpitll_clk.usbb1_ulpiphy_dat7 */
++                      0x5c0 (PIN_OUTPUT | MUX_MODE3)          /* etk_d10.hsusb2_clk */
++                      0x5c2 (PIN_OUTPUT | MUX_MODE3)          /* etk_d11.hsusb2_stp */
++                      0x5c4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d12.hsusb2_dir */
++                      0x5c6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d13.hsusb2_nxt */
++                      0x5c8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d14.hsusb2_data0 */
++                      0x5cA (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d15.hsusb2_data1 */
++                      0x1a4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi1_cs3.hsusb2_data2 */
++                      0x1a6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_clk.hsusb2_data7 */
++                      0x1a8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_simo.hsusb2_data4 */
++                      0x1aa (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_somi.hsusb2_data5 */
++                      0x1ac (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_cs0.hsusb2_data6 */
++                      0x1ae (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_cs1.hsusb2_data3 */
+               >;
+       };
+@@ -180,3 +169,39 @@
+       pinctrl-names = "default";
+       pinctrl-0 = <&gpio1_pins>;
+ };
++
++&usb_otg_hs {
++      interface-type = <0>;
++      usb-phy = <&usb2_phy>;
++      mode = <3>;
++      power = <50>;
++};
++
++&dpi {
++      vdds_dsi-supply = <&vpll2>;
++};
++
++/ {
++      aliases {
++              display0 = &dvi0;
++              display1 = &tv0;
++      };
++
++      tfp410: encoder@0 {
++              compatible = "ti,tfp410";
++              video-source = <&dpi>;
++              data-lines = <24>;
++              gpios = <&gpio5 10 0>;  /* 170, power-down */
++      };
++
++      dvi0: connector@0 {
++              compatible = "ti,dvi_connector";
++              video-source = <&tfp410>;
++              i2c-bus = <&i2c3>;
++      };
++
++      tv0: connector@1 {
++              compatible = "ti,svideo_connector";
++              video-source = <&venc>;
++      };
++};
+--- a/arch/arm/boot/dts/omap3-beagle-xm.dts
++++ b/arch/arm/boot/dts/omap3-beagle-xm.dts
+@@ -69,6 +69,23 @@
+               };
+       };
++
++      /* HS USB Port 2 Power */
++      hsusb2_power: hsusb2_power_reg {
++              compatible = "regulator-fixed";
++              regulator-name = "hsusb2_vbus";
++              regulator-min-microvolt = <3300000>;
++              regulator-max-microvolt = <3300000>;
++              gpio = <&twl_gpio 18 0>;        /* GPIO LEDA */
++              startup-delay-us = <70000>;
++      };
++
++      /* HS USB Host PHY on PORT 2 */
++      hsusb2_phy: hsusb2_phy {
++              compatible = "usb-nop-xceiv";
++              reset-gpios = <&gpio5 19 GPIO_ACTIVE_LOW>; /* gpio_147 */
++              vcc-supply = <&hsusb2_power>;
++      };
+ };
+ &omap3_pmx_wkup {
+@@ -79,6 +96,37 @@
+       };
+ };
++&omap3_pmx_core {
++      pinctrl-names = "default";
++      pinctrl-0 = <
++                      &hsusbb2_pins
++      >;
++
++      uart3_pins: pinmux_uart3_pins {
++              pinctrl-single,pins = <
++                      0x16e (PIN_INPUT | PIN_OFF_WAKEUPENABLE | MUX_MODE0) /* uart3_rx_irrx.uart3_rx_irrx */
++                      0x170 (PIN_OUTPUT | MUX_MODE0) /* uart3_tx_irtx.uart3_tx_irtx OUTPUT | MODE0 */
++              >;
++      };
++
++      hsusbb2_pins: pinmux_hsusbb2_pins {
++              pinctrl-single,pins = <
++                      0x5c0 (PIN_OUTPUT | MUX_MODE3)          /* etk_d10.hsusb2_clk */
++                      0x5c2 (PIN_OUTPUT | MUX_MODE3)          /* etk_d11.hsusb2_stp */
++                      0x5c4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d12.hsusb2_dir */
++                      0x5c6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d13.hsusb2_nxt */
++                      0x5c8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d14.hsusb2_data0 */
++                      0x5cA (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* etk_d15.hsusb2_data1 */
++                      0x1a4 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi1_cs3.hsusb2_data2 */
++                      0x1a6 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_clk.hsusb2_data7 */
++                      0x1a8 (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_simo.hsusb2_data4 */
++                      0x1aa (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_somi.hsusb2_data5 */
++                      0x1ac (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_cs0.hsusb2_data6 */
++                      0x1ae (PIN_INPUT_PULLDOWN | MUX_MODE3)  /* mcspi2_cs1.hsusb2_data3 */
++              >;
++      };
++};
++
+ &i2c1 {
+       clock-frequency = <2600000>;
+@@ -144,19 +192,12 @@
+ &usb_otg_hs {
+       interface-type = <0>;
+       usb-phy = <&usb2_phy>;
++      phys = <&usb2_phy>;
++      phy-names = "usb2-phy";
+       mode = <3>;
+       power = <50>;
+ };
+-&omap3_pmx_core {
+-      uart3_pins: pinmux_uart3_pins {
+-              pinctrl-single,pins = <
+-                      0x16e (PIN_INPUT | PIN_OFF_WAKEUPENABLE | MUX_MODE0) /* uart3_rx_irrx.uart3_rx_irrx */
+-                      0x170 (PIN_OUTPUT | MUX_MODE0) /* uart3_tx_irtx.uart3_tx_irtx OUTPUT | MODE0 */
+-              >;
+-      };
+-};
+-
+ &uart3 {
+       pinctrl-names = "default";
+       pinctrl-0 = <&uart3_pins>;
+@@ -166,3 +207,11 @@
+       pinctrl-names = "default";
+       pinctrl-0 = <&gpio1_pins>;
+ };
++
++&usbhshost {
++      port2-mode = "ehci-phy";
++};
++
++&usbhsehci {
++      phys = <0 &hsusb2_phy>;
++};
+--- a/arch/arm/boot/dts/omap3.dtsi
++++ b/arch/arm/boot/dts/omap3.dtsi
+@@ -19,6 +19,9 @@
+       interrupt-parent = <&intc>;
+       aliases {
++              i2c0 = &i2c1;
++              i2c1 = &i2c2;
++              i2c2 = &i2c3;
+               serial0 = &uart1;
+               serial1 = &uart2;
+               serial2 = &uart3;
+@@ -32,6 +35,11 @@
+                       compatible = "arm,cortex-a8";
+                       device_type = "cpu";
+                       reg = <0x0>;
++
++                      clocks = <&dpll1_ck>;
++                      clock-names = "cpu";
++
++                      clock-latency = <300000>; /* From omap-cpufreq driver */
+               };
+       };
+@@ -80,6 +88,8 @@
+                       compatible = "ti,omap-counter32k";
+                       reg = <0x48320000 0x20>;
+                       ti,hwmods = "counter_32k";
++                      clocks = <&wkup_32k_fck>;
++                      clock-names = "fck";
+               };
+               intc: interrupt-controller@48200000 {
+@@ -100,6 +110,8 @@
+                       #dma-cells = <1>;
+                       #dma-channels = <32>;
+                       #dma-requests = <96>;
++                      clocks = <&core_l3_ick>;
++                      clock-names = "fck";
+               };
+               omap3_pmx_core: pinmux@48002030 {
+@@ -125,6 +137,8 @@
+                       reg = <0x48310000 0x200>;
+                       interrupts = <29>;
+                       ti,hwmods = "gpio1";
++                      clocks = <&gpio1_ick>, <&gpio1_dbck>;
++                      clock-names = "fck", "dbclk";
+                       ti,gpio-always-on;
+                       gpio-controller;
+                       #gpio-cells = <2>;
+@@ -137,6 +151,8 @@
+                       reg = <0x49050000 0x200>;
+                       interrupts = <30>;
+                       ti,hwmods = "gpio2";
++                      clocks = <&gpio2_ick>, <&gpio2_dbck>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -148,6 +164,8 @@
+                       reg = <0x49052000 0x200>;
+                       interrupts = <31>;
+                       ti,hwmods = "gpio3";
++                      clocks = <&gpio3_ick>, <&gpio3_dbck>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -159,6 +177,8 @@
+                       reg = <0x49054000 0x200>;
+                       interrupts = <32>;
+                       ti,hwmods = "gpio4";
++                      clocks = <&gpio4_ick>, <&gpio4_dbck>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -170,6 +190,8 @@
+                       reg = <0x49056000 0x200>;
+                       interrupts = <33>;
+                       ti,hwmods = "gpio5";
++                      clocks = <&gpio5_ick>, <&gpio5_dbck>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -181,6 +203,8 @@
+                       reg = <0x49058000 0x200>;
+                       interrupts = <34>;
+                       ti,hwmods = "gpio6";
++                      clocks = <&gpio6_ick>, <&gpio6_dbck>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -190,18 +214,24 @@
+               uart1: serial@4806a000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart1";
++                      clocks = <&uart1_fck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+               uart2: serial@4806c000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart2";
++                      clocks = <&uart2_fck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+               uart3: serial@49020000 {
+                       compatible = "ti,omap3-uart";
+                       ti,hwmods = "uart3";
++                      clocks = <&uart3_fck>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+@@ -210,6 +240,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c1";
++                      clocks = <&i2c1_fck>;
++                      clock-names = "fck";
+               };
+               i2c2: i2c@48072000 {
+@@ -217,6 +249,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c2";
++                      clocks = <&i2c2_fck>;
++                      clock-names = "fck";
+               };
+               i2c3: i2c@48060000 {
+@@ -224,6 +258,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c3";
++                      clocks = <&i2c3_fck>;
++                      clock-names = "fck";
+               };
+               mcspi1: spi@48098000 {
+@@ -231,6 +267,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi1";
++                      clocks = <&mcspi1_fck>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <4>;
+                       dmas = <&sdma 35>,
+                              <&sdma 36>,
+@@ -249,6 +287,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi2";
++                      clocks = <&mcspi2_fck>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 43>,
+                              <&sdma 44>,
+@@ -262,6 +302,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi3";
++                      clocks = <&mcspi3_fck>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 15>,
+                              <&sdma 16>,
+@@ -275,6 +317,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi4";
++                      clocks = <&mcspi4_fck>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <1>;
+                       dmas = <&sdma 70>, <&sdma 71>;
+                       dma-names = "tx0", "rx0";
+@@ -283,6 +327,8 @@
+               mmc1: mmc@4809c000 {
+                       compatible = "ti,omap3-hsmmc";
+                       ti,hwmods = "mmc1";
++                      clocks = <&mmchs1_fck>, <&omap_32k_fck>;
++                      clock-names = "fck", "dbck";
+                       ti,dual-volt;
+                       dmas = <&sdma 61>, <&sdma 62>;
+                       dma-names = "tx", "rx";
+@@ -291,6 +337,8 @@
+               mmc2: mmc@480b4000 {
+                       compatible = "ti,omap3-hsmmc";
+                       ti,hwmods = "mmc2";
++                      clocks = <&mmchs2_fck>, <&omap_32k_fck>;
++                      clock-names = "fck", "dbck";
+                       dmas = <&sdma 47>, <&sdma 48>;
+                       dma-names = "tx", "rx";
+               };
+@@ -298,6 +346,8 @@
+               mmc3: mmc@480ad000 {
+                       compatible = "ti,omap3-hsmmc";
+                       ti,hwmods = "mmc3";
++                      clocks = <&mmchs3_fck>, <&omap_32k_fck>;
++                      clock-names = "fck", "dbck";
+                       dmas = <&sdma 77>, <&sdma 78>;
+                       dma-names = "tx", "rx";
+               };
+@@ -305,6 +355,8 @@
+               wdt2: wdt@48314000 {
+                       compatible = "ti,omap3-wdt";
+                       ti,hwmods = "wd_timer2";
++                      clocks = <&wdt2_fck>;
++                      clock-names = "fck";
+               };
+               mcbsp1: mcbsp@48074000 {
+@@ -317,6 +369,8 @@
+                       interrupt-names = "common", "tx", "rx";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp1";
++                      clocks = <&mcbsp1_fck>, <&mcbsp_clks>, <&core_96m_fck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 31>,
+                              <&sdma 32>;
+                       dma-names = "tx", "rx";
+@@ -366,6 +420,8 @@
+                       interrupt-names = "common", "tx", "rx";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp4";
++                      clocks = <&mcbsp4_fck>, <&mcbsp_clks>, <&per_96m_fck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 19>,
+                              <&sdma 20>;
+                       dma-names = "tx", "rx";
+@@ -381,16 +437,31 @@
+                       interrupt-names = "common", "tx", "rx";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp5";
++                      clocks = <&mcbsp5_fck>, <&mcbsp_clks>, <&core_96m_fck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 21>,
+                              <&sdma 22>;
+                       dma-names = "tx", "rx";
+               };
++              mailbox: mailbox@48094000 {
++                      compatible = "ti,omap2-mailbox";
++                      reg = <0x48094000 0x200>;
++                      interrupts = <26>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <2>;
++                      ti,mbox-num-fifos = <2>;
++                      ti,mbox-names = "dsp";
++                      ti,mbox-data = <0 1 0 0>;
++              };
++
+               timer1: timer@48318000 {
+                       compatible = "ti,omap3430-timer";
+                       reg = <0x48318000 0x400>;
+                       interrupts = <37>;
+                       ti,hwmods = "timer1";
++                      clocks = <&gpt1_fck>;
++                      clock-names = "fck";
+                       ti,timer-alwon;
+               };
+@@ -399,6 +470,8 @@
+                       reg = <0x49032000 0x400>;
+                       interrupts = <38>;
+                       ti,hwmods = "timer2";
++                      clocks = <&gpt2_fck>;
++                      clock-names = "fck";
+               };
+               timer3: timer@49034000 {
+@@ -406,6 +479,8 @@
+                       reg = <0x49034000 0x400>;
+                       interrupts = <39>;
+                       ti,hwmods = "timer3";
++                      clocks = <&gpt3_fck>;
++                      clock-names = "fck";
+               };
+               timer4: timer@49036000 {
+@@ -413,6 +488,8 @@
+                       reg = <0x49036000 0x400>;
+                       interrupts = <40>;
+                       ti,hwmods = "timer4";
++                      clocks = <&gpt4_fck>;
++                      clock-names = "fck";
+               };
+               timer5: timer@49038000 {
+@@ -420,6 +497,8 @@
+                       reg = <0x49038000 0x400>;
+                       interrupts = <41>;
+                       ti,hwmods = "timer5";
++                      clocks = <&gpt5_fck>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -428,6 +507,8 @@
+                       reg = <0x4903a000 0x400>;
+                       interrupts = <42>;
+                       ti,hwmods = "timer6";
++                      clocks = <&gpt6_fck>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -436,6 +517,8 @@
+                       reg = <0x4903c000 0x400>;
+                       interrupts = <43>;
+                       ti,hwmods = "timer7";
++                      clocks = <&gpt7_fck>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -444,6 +527,8 @@
+                       reg = <0x4903e000 0x400>;
+                       interrupts = <44>;
+                       ti,hwmods = "timer8";
++                      clocks = <&gpt8_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+                       ti,timer-dsp;
+               };
+@@ -453,6 +538,8 @@
+                       reg = <0x49040000 0x400>;
+                       interrupts = <45>;
+                       ti,hwmods = "timer9";
++                      clocks = <&gpt9_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -461,6 +548,8 @@
+                       reg = <0x48086000 0x400>;
+                       interrupts = <46>;
+                       ti,hwmods = "timer10";
++                      clocks = <&gpt10_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -469,6 +558,8 @@
+                       reg = <0x48088000 0x400>;
+                       interrupts = <47>;
+                       ti,hwmods = "timer11";
++                      clocks = <&gpt11_fck>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -477,6 +568,8 @@
+                       reg = <0x48304000 0x400>;
+                       interrupts = <95>;
+                       ti,hwmods = "timer12";
++                      clocks = <&gpt12_fck>;
++                      clock-names = "fck";
+                       ti,timer-alwon;
+                       ti,timer-secure;
+               };
+@@ -486,12 +579,16 @@
+                       reg = <0x48062000 0x1000>;
+                       interrupts = <78>;
+                       ti,hwmods = "usb_tll_hs";
++                      clocks = <&usbtll_fck>;
++                      clock-names = "fck";
+               };
+               usbhshost: usbhshost@48064000 {
+                       compatible = "ti,usbhs-host";
+                       reg = <0x48064000 0x400>;
+                       ti,hwmods = "usb_host_hs";
++                      clocks = <&usbhost_48m_fck>, <&usbhost_120m_fck>;
++                      clock-names = "fck", "ehci_logic_fck";
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       ranges;
+@@ -514,6 +611,8 @@
+               gpmc: gpmc@6e000000 {
+                       compatible = "ti,omap3430-gpmc";
+                       ti,hwmods = "gpmc";
++                      clocks = <&gpmc_fck>;
++                      clock-names = "fck";
+                       reg = <0x6e000000 0x02d0>;
+                       interrupts = <20>;
+                       gpmc,num-cs = <8>;
+@@ -528,9 +627,61 @@
+                       interrupts = <92>, <93>;
+                       interrupt-names = "mc", "dma";
+                       ti,hwmods = "usb_otg_hs";
++                      clocks = <&hsotgusb_ick>;
++                      clock-names = "fck";
+                       multipoint = <1>;
+                       num-eps = <16>;
+                       ram-bits = <12>;
+               };
++
++              dss@48050000 {
++                      compatible = "ti,omap3-dss", "simple-bus";
++                      reg = <0x48050000 0x200>;
++                      ti,hwmods = "dss_core";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++
++                      dispc@48050400 {
++                              compatible = "ti,omap3-dispc";
++                              reg = <0x48050400 0x400>;
++                              interrupts = <25>;
++                              ti,hwmods = "dss_dispc";
++                      };
++
++                      dpi: encoder@0 {
++                              compatible = "ti,omap3-dpi";
++                      };
++
++                      sdi: encoder@1 {
++                              compatible = "ti,omap3-sdi";
++                      };
++
++                      dsi: encoder@4804fc00 {
++                              compatible = "ti,omap3-dsi";
++                              reg = <0x4804fc00 0x400>;
++                              interrupts = <25>;
++                              ti,hwmods = "dss_dsi1";
++                      };
++
++                      rfbi: encoder@48050800 {
++                              compatible = "ti,omap3-rfbi";
++                              reg = <0x48050800 0x100>;
++                              ti,hwmods = "dss_rfbi";
++                      };
++
++                      venc: encoder@48050c00 {
++                              compatible = "ti,omap3-venc";
++                              reg = <0x48050c00 0x100>;
++                              ti,hwmods = "dss_venc";
++                      };
++              };
++      };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap3xxx-clocks.dtsi"
+       };
+ };
+--- a/arch/arm/boot/dts/omap3-evm.dts
++++ b/arch/arm/boot/dts/omap3-evm.dts
+@@ -70,6 +70,8 @@
+ &usb_otg_hs {
+       interface-type = <0>;
+       usb-phy = <&usb2_phy>;
++      phys = <&usb2_phy>;
++      phy-names = "usb2-phy";
+       mode = <3>;
+       power = <50>;
+ };
+--- a/arch/arm/boot/dts/omap3-overo.dtsi
++++ b/arch/arm/boot/dts/omap3-overo.dtsi
+@@ -76,6 +76,8 @@
+ &usb_otg_hs {
+       interface-type = <0>;
+       usb-phy = <&usb2_phy>;
++      phys = <&usb2_phy>;
++      phy-names = "usb2-phy";
+       mode = <3>;
+       power = <50>;
+ };
+--- a/arch/arm/boot/dts/omap3-tobi.dts
++++ b/arch/arm/boot/dts/omap3-tobi.dts
+@@ -81,3 +81,36 @@
+ &mmc3 {
+       status = "disabled";
+ };
++
++&dpi {
++      vdds_dsi-supply = <&vpll2>;
++};
++
++/ {
++      aliases {
++              display0 = &lcd0;
++      };
++
++      lcd0: display@0 {
++              compatible = "samsung,lte430wq-f0c", "panel-dpi";
++              video-source = <&dpi>;
++              data-lines = <24>;
++
++              panel-timing {
++                      clock-frequency = <9200000>;
++                      hactive = <480>;
++                      vactive = <272>;
++                      hfront-porch = <8>;
++                      hback-porch = <4>;
++                      hsync-len = <41>;
++                      vback-porch = <2>;
++                      vfront-porch = <4>;
++                      vsync-len = <10>;
++
++                      hsync-active = <0>;
++                      vsync-active = <0>;
++                      de-active = <1>;
++                      pixelclk-active = <1>;
++              };
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap3xxx-clocks.dtsi
+@@ -0,0 +1,1513 @@
++/*
++ * Device Tree Source for OMAP3 clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++dummy_apb_pclk: dummy_apb_pclk {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0x0>;
++};
++
++omap_32k_fck: omap_32k_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++virt_12m_ck: virt_12m_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++virt_13m_ck: virt_13m_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <13000000>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++virt_38_4m_ck: virt_38_4m_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <38400000>;
++};
++
++virt_16_8m_ck: virt_16_8m_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <16800000>;
++};
++
++osc_sys_ck: osc_sys_ck@48306d40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_12m_ck>, <&virt_13m_ck>, <&virt_19200000_ck>, <&virt_26000000_ck>, <&virt_38_4m_ck>, <&virt_16_8m_ck>;
++      reg = <0x48306d40 0x4>;
++      bit-mask = <0x7>;
++};
++
++sys_ck: sys_ck@48307270 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&osc_sys_ck>;
++      bit-shift = <6>;
++      reg = <0x48307270 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++dpll4_ck: dpll4_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-per-clock";
++      clocks = <&sys_ck>, <&sys_ck>;
++      ti,modes = <0x82>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004d00 0x4>, <0x48004d20 0x4>, <0x48004d30 0x4>, <0x48004d44 0x4>;
++};
++
++dpll4_m2_ck: dpll4_m2_ck@48004d48 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll4_ck>;
++      reg = <0x48004d48 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++};
++
++dpll4_m2x2_mul_ck: dpll4_m2x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m2_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_m2x2_ck: dpll4_m2x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m2x2_mul_ck>;
++      bit-shift = <0x1b>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++omap_96m_alwon_fck: omap_96m_alwon_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll3_ck: dpll3_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-core-clock";
++      clocks = <&sys_ck>, <&sys_ck>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004d00 0x4>, <0x48004d20 0x4>, <0x48004d30 0x4>, <0x48004d40 0x4>;
++};
++
++dpll3_m3_ck: dpll3_m3_ck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll3_ck>;
++      bit-shift = <16>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll3_m3x2_mul_ck: dpll3_m3x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_m3_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll3_m3x2_ck: dpll3_m3x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll3_m3x2_mul_ck>;
++      bit-shift = <0xc>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++emu_core_alwon_ck: emu_core_alwon_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sys_altclk: sys_altclk {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0x0>;
++};
++
++mcbsp_clks: mcbsp_clks {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0x0>;
++};
++
++sys_clkout1: sys_clkout1@48306d70 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&osc_sys_ck>;
++      reg = <0x48306d70 0x4>;
++      bit-shift = <7>;
++};
++
++dpll3_m2_ck: dpll3_m2_ck@48004d40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll3_ck>;
++      bit-shift = <27>;
++      reg = <0x48004d40 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++core_ck: core_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll1_fck: dpll1_fck@48004940 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&core_ck>;
++      bit-shift = <19>;
++      reg = <0x48004940 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++dpll1_ck: dpll1_ck@48004904 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-dpll-clock";
++      clocks = <&sys_ck>, <&dpll1_fck>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++      reg = <0x48004904 0x4>, <0x48004924 0x4>, <0x48004934 0x4>, <0x48004940 0x4>;
++};
++
++dpll1_x2_ck: dpll1_x2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll1_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll1_x2m2_ck: dpll1_x2m2_ck@48004944 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll1_x2_ck>;
++      reg = <0x48004944 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll3_x2_ck: dpll3_x2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll3_m2x2_ck: dpll3_m2x2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_m2_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_x2_ck: dpll4_x2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++cm_96m_fck: cm_96m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_alwon_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++omap_96m_fck: omap_96m_fck@48004d40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&cm_96m_fck>, <&sys_ck>;
++      bit-shift = <6>;
++      reg = <0x48004d40 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll4_m3_ck: dpll4_m3_ck@48004e40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll4_ck>;
++      bit-shift = <8>;
++      reg = <0x48004e40 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++};
++
++dpll4_m3x2_mul_ck: dpll4_m3x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m3_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_m3x2_ck: dpll4_m3x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m3x2_mul_ck>;
++      bit-shift = <0x1c>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++omap_54m_fck: omap_54m_fck@48004d40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll4_m3x2_ck>, <&sys_altclk>;
++      bit-shift = <5>;
++      reg = <0x48004d40 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm_96m_d2_fck: cm_96m_d2_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&cm_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++omap_48m_fck: omap_48m_fck@48004d40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&cm_96m_d2_fck>, <&sys_altclk>;
++      bit-shift = <3>;
++      reg = <0x48004d40 0x4>;
++      table = <&cm_96m_d2_fck 0>, <&sys_altclk 1>;
++      bit-mask = <0x1>;
++};
++
++omap_12m_fck: omap_12m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_48m_fck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++dpll4_m4_ck: dpll4_m4_ck@48004e40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll4_ck>;
++      reg = <0x48004e40 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++};
++
++dpll4_m4x2_mul_ck: dpll4_m4x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m4_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_m4x2_ck: dpll4_m4x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m4x2_mul_ck>;
++      bit-shift = <0x1d>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++dpll4_m5_ck: dpll4_m5_ck@48004f40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll4_ck>;
++      reg = <0x48004f40 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++};
++
++dpll4_m5x2_mul_ck: dpll4_m5x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m5_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_m5x2_ck: dpll4_m5x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m5x2_mul_ck>;
++      bit-shift = <0x1e>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++dpll4_m6_ck: dpll4_m6_ck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll4_ck>;
++      bit-shift = <24>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++};
++
++dpll4_m6x2_mul_ck: dpll4_m6x2_mul_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m6_ck>;
++      clock-mult = <2>;
++      clock-div = <1>;
++};
++
++dpll4_m6x2_ck: dpll4_m6x2_ck@48004d00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll4_m6x2_mul_ck>;
++      bit-shift = <0x1f>;
++      reg = <0x48004d00 0x4>;
++      set-bit-to-disable;
++};
++
++emu_per_alwon_ck: emu_per_alwon_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll4_m6x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++clkout2_src_mux_ck: clkout2_src_mux_ck@48004d70 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&core_ck>, <&sys_ck>, <&cm_96m_fck>, <&omap_54m_fck>;
++      reg = <0x48004d70 0x4>;
++      bit-mask = <0x3>;
++};
++
++clkout2_src_ck: clkout2_src_ck@48004d70 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&clkout2_src_mux_ck>;
++      bit-shift = <7>;
++      reg = <0x48004d70 0x4>;
++};
++
++sys_clkout2: sys_clkout2@48004d70 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&clkout2_src_ck>;
++      bit-shift = <3>;
++      reg = <0x48004d70 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++corex2_fck: corex2_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll3_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mpu_ck: mpu_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll1_x2m2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++arm_fck: arm_fck@48004924 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mpu_ck>;
++      reg = <0x48004924 0x4>;
++      bit-mask = <0x1>;
++};
++
++emu_mpu_alwon_ck: emu_mpu_alwon_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&mpu_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3_ick: l3_ick@48004a40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&core_ck>;
++      reg = <0x48004a40 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++l4_ick: l4_ick@48004a40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l3_ick>;
++      bit-shift = <2>;
++      reg = <0x48004a40 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++rm_ick: rm_ick@48004c40 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l4_ick>;
++      bit-shift = <1>;
++      reg = <0x48004c40 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++gpt10_mux_fck: gpt10_mux_fck@48004a40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <6>;
++      reg = <0x48004a40 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt10_fck: gpt10_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt10_mux_fck>;
++      bit-shift = <11>;
++      reg = <0x48004a00 0x4>;
++};
++
++gpt11_mux_fck: gpt11_mux_fck@48004a40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <7>;
++      reg = <0x48004a40 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt11_fck: gpt11_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt11_mux_fck>;
++      bit-shift = <12>;
++      reg = <0x48004a00 0x4>;
++};
++
++core_96m_fck: core_96m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mmchs2_fck: mmchs2_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <25>;
++};
++
++mmchs1_fck: mmchs1_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <24>;
++};
++
++i2c3_fck: i2c3_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <17>;
++};
++
++i2c2_fck: i2c2_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <16>;
++};
++
++i2c1_fck: i2c1_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_96m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <15>;
++};
++
++mcbsp5_mux_fck: mcbsp5_mux_fck@480022d8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&core_96m_fck>, <&mcbsp_clks>;
++      bit-shift = <4>;
++      reg = <0x480022d8 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcbsp5_fck: mcbsp5_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mcbsp5_mux_fck>;
++      bit-shift = <10>;
++      reg = <0x48004a00 0x4>;
++};
++
++mcbsp1_mux_fck: mcbsp1_mux_fck@48002274 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&core_96m_fck>, <&mcbsp_clks>;
++      bit-shift = <2>;
++      reg = <0x48002274 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcbsp1_fck: mcbsp1_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mcbsp1_mux_fck>;
++      bit-shift = <9>;
++      reg = <0x48004a00 0x4>;
++};
++
++core_48m_fck: core_48m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_48m_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mcspi4_fck: mcspi4_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <21>;
++};
++
++mcspi3_fck: mcspi3_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <20>;
++};
++
++mcspi2_fck: mcspi2_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <19>;
++};
++
++mcspi1_fck: mcspi1_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <18>;
++};
++
++uart2_fck: uart2_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <14>;
++};
++
++uart1_fck: uart1_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_48m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <13>;
++};
++
++core_12m_fck: core_12m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_12m_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++hdq_fck: hdq_fck@48004a00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_12m_fck>;
++      reg = <0x48004a00 0x4>;
++      ti,enable-bit = <22>;
++};
++
++core_l3_ick: core_l3_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l3_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++sdrc_ick: sdrc_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&core_l3_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <1>;
++};
++
++gpmc_fck: gpmc_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&core_l3_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++core_l4_ick: core_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++mmchs2_ick: mmchs2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <25>;
++};
++
++mmchs1_ick: mmchs1_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <24>;
++};
++
++hdq_ick: hdq_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <22>;
++};
++
++mcspi4_ick: mcspi4_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <21>;
++};
++
++mcspi3_ick: mcspi3_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <20>;
++};
++
++mcspi2_ick: mcspi2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <19>;
++};
++
++mcspi1_ick: mcspi1_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <18>;
++};
++
++i2c3_ick: i2c3_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <17>;
++};
++
++i2c2_ick: i2c2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <16>;
++};
++
++i2c1_ick: i2c1_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <15>;
++};
++
++uart2_ick: uart2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <14>;
++};
++
++uart1_ick: uart1_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <13>;
++};
++
++gpt11_ick: gpt11_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <12>;
++};
++
++gpt10_ick: gpt10_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <11>;
++};
++
++mcbsp5_ick: mcbsp5_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <10>;
++};
++
++mcbsp1_ick: mcbsp1_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <9>;
++};
++
++omapctrl_ick: omapctrl_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <6>;
++};
++
++dss_tv_fck: dss_tv_fck@48004e00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&omap_54m_fck>;
++      reg = <0x48004e00 0x4>;
++      bit-shift = <2>;
++};
++
++dss_96m_fck: dss_96m_fck@48004e00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&omap_96m_fck>;
++      reg = <0x48004e00 0x4>;
++      bit-shift = <2>;
++};
++
++dss2_alwon_fck: dss2_alwon_fck@48004e00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_ck>;
++      reg = <0x48004e00 0x4>;
++      bit-shift = <1>;
++};
++
++gpt1_mux_fck: gpt1_mux_fck@48004c40 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      reg = <0x48004c40 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt1_fck: gpt1_fck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt1_mux_fck>;
++      bit-shift = <0>;
++      reg = <0x48004c00 0x4>;
++};
++
++aes2_ick: aes2_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <28>;
++};
++
++wkup_32k_fck: wkup_32k_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_32k_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++gpio1_dbck: gpio1_dbck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&wkup_32k_fck>;
++      reg = <0x48004c00 0x4>;
++      bit-shift = <3>;
++};
++
++sha12_ick: sha12_ick@48004a10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&core_l4_ick>;
++      reg = <0x48004a10 0x4>;
++      ti,enable-bit = <27>;
++};
++
++wdt2_fck: wdt2_fck@48004c00 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&wkup_32k_fck>;
++      reg = <0x48004c00 0x4>;
++      ti,enable-bit = <5>;
++};
++
++wkup_l4_ick: wkup_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++wdt2_ick: wdt2_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <5>;
++};
++
++wdt1_ick: wdt1_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <4>;
++};
++
++gpio1_ick: gpio1_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <3>;
++};
++
++omap_32ksync_ick: omap_32ksync_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <2>;
++};
++
++gpt12_ick: gpt12_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <1>;
++};
++
++gpt1_ick: gpt1_ick@48004c10 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&wkup_l4_ick>;
++      reg = <0x48004c10 0x4>;
++      ti,enable-bit = <0>;
++};
++
++per_96m_fck: per_96m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_96m_alwon_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++per_48m_fck: per_48m_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_48m_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++uart3_fck: uart3_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&per_48m_fck>;
++      reg = <0x48005000 0x4>;
++      ti,enable-bit = <11>;
++};
++
++gpt2_mux_fck: gpt2_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt2_fck: gpt2_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt2_mux_fck>;
++      bit-shift = <3>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt3_mux_fck: gpt3_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <1>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt3_fck: gpt3_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt3_mux_fck>;
++      bit-shift = <4>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt4_mux_fck: gpt4_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <2>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt4_fck: gpt4_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt4_mux_fck>;
++      bit-shift = <5>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt5_mux_fck: gpt5_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <3>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt5_fck: gpt5_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt5_mux_fck>;
++      bit-shift = <6>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt6_mux_fck: gpt6_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <4>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt6_fck: gpt6_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt6_mux_fck>;
++      bit-shift = <7>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt7_mux_fck: gpt7_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <5>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt7_fck: gpt7_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt7_mux_fck>;
++      bit-shift = <8>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt8_mux_fck: gpt8_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <6>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt8_fck: gpt8_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt8_mux_fck>;
++      bit-shift = <9>;
++      reg = <0x48005000 0x4>;
++};
++
++gpt9_mux_fck: gpt9_mux_fck@48005040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&omap_32k_fck>, <&sys_ck>;
++      bit-shift = <7>;
++      reg = <0x48005040 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpt9_fck: gpt9_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&gpt9_mux_fck>;
++      bit-shift = <10>;
++      reg = <0x48005000 0x4>;
++};
++
++per_32k_alwon_fck: per_32k_alwon_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&omap_32k_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++gpio6_dbck: gpio6_dbck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      bit-shift = <17>;
++};
++
++gpio5_dbck: gpio5_dbck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      bit-shift = <16>;
++};
++
++gpio4_dbck: gpio4_dbck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      bit-shift = <15>;
++};
++
++gpio3_dbck: gpio3_dbck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      bit-shift = <14>;
++};
++
++gpio2_dbck: gpio2_dbck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      bit-shift = <13>;
++};
++
++wdt3_fck: wdt3_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "ti,gate-clock";
++      clocks = <&per_32k_alwon_fck>;
++      reg = <0x48005000 0x4>;
++      ti,enable-bit = <12>;
++};
++
++per_l4_ick: per_l4_ick {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l4_ick>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++gpio6_ick: gpio6_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <17>;
++};
++
++gpio5_ick: gpio5_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <16>;
++};
++
++gpio4_ick: gpio4_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <15>;
++};
++
++gpio3_ick: gpio3_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <14>;
++};
++
++gpio2_ick: gpio2_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <13>;
++};
++
++wdt3_ick: wdt3_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <12>;
++};
++
++uart3_ick: uart3_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <11>;
++};
++
++uart4_ick: uart4_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <18>;
++};
++
++gpt9_ick: gpt9_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <10>;
++};
++
++gpt8_ick: gpt8_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <9>;
++};
++
++gpt7_ick: gpt7_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <8>;
++};
++
++gpt6_ick: gpt6_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <7>;
++};
++
++gpt5_ick: gpt5_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <6>;
++};
++
++gpt4_ick: gpt4_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <5>;
++};
++
++gpt3_ick: gpt3_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <4>;
++};
++
++gpt2_ick: gpt2_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <3>;
++};
++
++mcbsp2_ick: mcbsp2_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <0>;
++};
++
++mcbsp3_ick: mcbsp3_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <1>;
++};
++
++mcbsp4_ick: mcbsp4_ick@48005010 {
++      #clock-cells = <0>;
++      compatible = "ti,omap3-interface-clock";
++      clocks = <&per_l4_ick>;
++      reg = <0x48005010 0x4>;
++      ti,enable-bit = <2>;
++};
++
++mcbsp2_mux_fck: mcbsp2_mux_fck@48002274 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_96m_fck>, <&mcbsp_clks>;
++      bit-shift = <6>;
++      reg = <0x48002274 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcbsp2_fck: mcbsp2_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mcbsp2_mux_fck>;
++      bit-shift = <0>;
++      reg = <0x48005000 0x4>;
++};
++
++mcbsp3_mux_fck: mcbsp3_mux_fck@480022d8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_96m_fck>, <&mcbsp_clks>;
++      reg = <0x480022d8 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcbsp3_fck: mcbsp3_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mcbsp3_mux_fck>;
++      bit-shift = <1>;
++      reg = <0x48005000 0x4>;
++};
++
++mcbsp4_mux_fck: mcbsp4_mux_fck@480022d8 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&per_96m_fck>, <&mcbsp_clks>;
++      bit-shift = <2>;
++      reg = <0x480022d8 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcbsp4_fck: mcbsp4_fck@48005000 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&mcbsp4_mux_fck>;
++      bit-shift = <2>;
++      reg = <0x48005000 0x4>;
++};
++
++emu_src_mux_ck: emu_src_mux_ck@48005140 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_ck>, <&emu_core_alwon_ck>, <&emu_per_alwon_ck>, <&emu_mpu_alwon_ck>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x3>;
++};
++
++emu_src_ck: emu_src_ck {
++      #clock-cells = <0>;
++      compatible = "ti,clkdm-gate-clock";
++      clocks = <&emu_src_mux_ck>;
++};
++
++pclk_fck: pclk_fck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&emu_src_ck>;
++      bit-shift = <8>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++pclkx2_fck: pclkx2_fck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&emu_src_ck>;
++      bit-shift = <6>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++atclk_fck: atclk_fck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&emu_src_ck>;
++      bit-shift = <4>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x3>;
++      index-starts-at-one;
++};
++
++traceclk_src_fck: traceclk_src_fck@48005140 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_ck>, <&emu_core_alwon_ck>, <&emu_per_alwon_ck>, <&emu_mpu_alwon_ck>;
++      bit-shift = <2>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x3>;
++};
++
++traceclk_fck: traceclk_fck@48005140 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&traceclk_src_fck>;
++      bit-shift = <11>;
++      reg = <0x48005140 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++secure_32k_fck: secure_32k_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++gpt12_fck: gpt12_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&secure_32k_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++wdt1_fck: wdt1_fck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&secure_32k_fck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap443x-clocks.dtsi
+@@ -0,0 +1,17 @@
++/*
++ * Device Tree Source for OMAP443x clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++bandgap_fclk: bandgap_fclk@4a307888 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a307888 0x4>;
++};
+--- a/arch/arm/boot/dts/omap443x.dtsi
++++ b/arch/arm/boot/dts/omap443x.dtsi
+@@ -30,4 +30,24 @@
+                      0x4a00232C 0x4>;
+               compatible = "ti,omap4430-bandgap";
+       };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap44xx-clocks.dtsi"
++              /include/ "omap443x-clocks.dtsi"
++      };
++
++      clockdomains {
++              l3_init_clkdm: l3_init_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll_usb_ck>;
++              };
++
++              emu_sys_clkdm: emu_sys_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&trace_clk_div_ck>;
++              };
++      };
+ };
+--- a/arch/arm/boot/dts/omap4460.dtsi
++++ b/arch/arm/boot/dts/omap4460.dtsi
+@@ -38,4 +38,24 @@
+               interrupts = <0 126 IRQ_TYPE_LEVEL_HIGH>; /* talert */
+               gpios = <&gpio3 22 0>; /* tshut */
+       };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap44xx-clocks.dtsi"
++              /include/ "omap446x-clocks.dtsi"
++      };
++
++      clockdomains {
++              l3_init_clkdm: l3_init_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll_usb_ck>;
++              };
++
++              emu_sys_clkdm: emu_sys_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&trace_clk_div_ck>;
++              };
++      };
+ };
+--- /dev/null
++++ b/arch/arm/boot/dts/omap446x-clocks.dtsi
+@@ -0,0 +1,27 @@
++/*
++ * Device Tree Source for OMAP446x clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++div_ts_ck: div_ts_ck@4a307888 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l4_wkup_clk_mux_ck>;
++      bit-shift = <24>;
++      reg = <0x4a307888 0x4>;
++      table = < 8 0 >, < 16 1 >, < 32 2 >;
++      bit-mask = <0x3>;
++};
++
++bandgap_ts_fclk: bandgap_ts_fclk@4a307888 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&div_ts_ck>;
++      bit-shift = <8>;
++      reg = <0x4a307888 0x4>;
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap44xx-clocks.dtsi
+@@ -0,0 +1,1639 @@
++/*
++ * Device Tree Source for OMAP4 clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++extalt_clkin_ck: extalt_clkin_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <59000000>;
++};
++
++pad_clks_src_ck: pad_clks_src_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++pad_clks_ck: pad_clks_ck@4a004108 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&pad_clks_src_ck>;
++      bit-shift = <8>;
++      reg = <0x4a004108 0x4>;
++};
++
++pad_slimbus_core_clks_ck: pad_slimbus_core_clks_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++secure_32k_clk_src_ck: secure_32k_clk_src_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++slimbus_src_clk: slimbus_src_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++slimbus_clk: slimbus_clk@4a004108 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&slimbus_src_clk>;
++      bit-shift = <10>;
++      reg = <0x4a004108 0x4>;
++};
++
++sys_32k_ck: sys_32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++virt_12000000_ck: virt_12000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++virt_13000000_ck: virt_13000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <13000000>;
++};
++
++virt_16800000_ck: virt_16800000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <16800000>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++virt_27000000_ck: virt_27000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <27000000>;
++};
++
++virt_38400000_ck: virt_38400000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <38400000>;
++};
++
++sys_clkin_ck: sys_clkin_ck@4a306110 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_12000000_ck>, <&virt_13000000_ck>, <&virt_16800000_ck>, <&virt_19200000_ck>, <&virt_26000000_ck>, <&virt_27000000_ck>, <&virt_38400000_ck>;
++      reg = <0x4a306110 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++tie_low_clock_ck: tie_low_clock_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <0>;
++};
++
++utmi_phy_clkout_ck: utmi_phy_clkout_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++xclk60mhsp1_ck: xclk60mhsp1_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++xclk60mhsp2_ck: xclk60mhsp2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++xclk60motg_ck: xclk60motg_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++abe_dpll_bypass_clk_mux_ck: abe_dpll_bypass_clk_mux_ck@4a306108 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a306108 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_dpll_refclk_mux_ck: abe_dpll_refclk_mux_ck@4a30610c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      reg = <0x4a30610c 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_abe_ck: dpll_abe_ck@4a0041e0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-m4xen-clock";
++      clocks = <&abe_dpll_refclk_mux_ck>, <&abe_dpll_bypass_clk_mux_ck>;
++      reg = <0x4a0041e0 0x4>, <0x4a0041e4 0x4>, <0x4a0041e8 0x4>, <0x4a0041ec 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_abe_x2_ck: dpll_abe_x2_ck@4a0041f0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_abe_ck>;
++      reg = <0x4a0041f0 0x4>;
++};
++
++dpll_abe_m2x2_ck: dpll_abe_m2x2_ck@4a0041f0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041f0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++abe_24m_fclk: abe_24m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++abe_clk: abe_clk@4a004108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      reg = <0x4a004108 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++aess_fclk: aess_fclk@4a004528 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&abe_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004528 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_abe_m3x2_ck: dpll_abe_m3x2_ck@4a0041f4 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041f4 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++core_hsd_byp_clk_mux_ck: core_hsd_byp_clk_mux_ck@4a00412c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_abe_m3x2_ck>;
++      bit-shift = <23>;
++      reg = <0x4a00412c 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_core_ck: dpll_core_ck@4a004120 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-core-clock";
++      clocks = <&sys_clkin_ck>, <&core_hsd_byp_clk_mux_ck>;
++      reg = <0x4a004120 0x4>, <0x4a004124 0x4>, <0x4a004128 0x4>, <0x4a00412c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_core_x2_ck: dpll_core_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_core_ck>;
++};
++
++dpll_core_m6x2_ck: dpll_core_m6x2_ck@4a004140 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004140 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dbgclk_mux_ck: dbgclk_mux_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_core_m2_ck: dpll_core_m2_ck@4a004130 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004130 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++ddrphy_ck: ddrphy_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_core_m5x2_ck: dpll_core_m5x2_ck@4a00413c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00413c 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++div_core_ck: div_core_ck@4a004100 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_m5x2_ck>;
++      reg = <0x4a004100 0x4>;
++      bit-mask = <0x1>;
++};
++
++div_iva_hs_clk: div_iva_hs_clk@4a0041dc {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_m5x2_ck>;
++      reg = <0x4a0041dc 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++div_mpu_hs_clk: div_mpu_hs_clk@4a00419c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_m5x2_ck>;
++      reg = <0x4a00419c 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++dpll_core_m4x2_ck: dpll_core_m4x2_ck@4a004138 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004138 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dll_clk_div_ck: dll_clk_div_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_m4x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_abe_m2_ck: dpll_abe_m2_ck@4a0041f0 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_ck>;
++      reg = <0x4a0041f0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_core_m3x2_div_ck: dpll_core_m3x2_div_ck@4a004134 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      reg = <0x4a004134 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_core_m3x2_ck: dpll_core_m3x2_ck@4a004134 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_core_m3x2_div_ck>;
++      bit-shift = <8>;
++      reg = <0x4a004134 0x4>;
++};
++
++dpll_core_m7x2_ck: dpll_core_m7x2_ck@4a004144 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004144 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++iva_hsd_byp_clk_mux_ck: iva_hsd_byp_clk_mux_ck@4a0041ac {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&div_iva_hs_clk>;
++      bit-shift = <23>;
++      reg = <0x4a0041ac 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_iva_ck: dpll_iva_ck@4a0041a0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&iva_hsd_byp_clk_mux_ck>;
++      reg = <0x4a0041a0 0x4>, <0x4a0041a4 0x4>, <0x4a0041a8 0x4>, <0x4a0041ac 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_iva_x2_ck: dpll_iva_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_iva_ck>;
++};
++
++dpll_iva_m4x2_ck: dpll_iva_m4x2_ck@4a0041b8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_iva_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041b8 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_iva_m5x2_ck: dpll_iva_m5x2_ck@4a0041bc {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_iva_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041bc 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_mpu_ck: dpll_mpu_ck@4a004160 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&div_mpu_hs_clk>;
++      reg = <0x4a004160 0x4>, <0x4a004164 0x4>, <0x4a004168 0x4>, <0x4a00416c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_mpu_m2_ck: dpll_mpu_m2_ck@4a004170 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_mpu_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004170 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++per_hs_clk_div_ck: per_hs_clk_div_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++per_hsd_byp_clk_mux_ck: per_hsd_byp_clk_mux_ck@4a00814c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&per_hs_clk_div_ck>;
++      bit-shift = <23>;
++      reg = <0x4a00814c 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_per_ck: dpll_per_ck@4a008140 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin_ck>, <&per_hsd_byp_clk_mux_ck>;
++      reg = <0x4a008140 0x4>, <0x4a008144 0x4>, <0x4a008148 0x4>, <0x4a00814c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_per_m2_ck: dpll_per_m2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_ck>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_per_x2_ck: dpll_per_x2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_per_ck>;
++      reg = <0x4a008150 0x4>;
++};
++
++dpll_per_m2x2_ck: dpll_per_m2x2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m3x2_div_ck: dpll_per_m3x2_div_ck@4a008154 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      reg = <0x4a008154 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++};
++
++dpll_per_m3x2_ck: dpll_per_m3x2_ck@4a008154 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_m3x2_div_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008154 0x4>;
++};
++
++dpll_per_m4x2_ck: dpll_per_m4x2_ck@4a008158 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008158 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m5x2_ck: dpll_per_m5x2_ck@4a00815c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00815c 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m6x2_ck: dpll_per_m6x2_ck@4a008160 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008160 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m7x2_ck: dpll_per_m7x2_ck@4a008164 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008164 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++usb_hs_clk_div_ck: usb_hs_clk_div_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <3>;
++};
++
++dpll_usb_ck: dpll_usb_ck@4a008180 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-j-type-clock";
++      clocks = <&sys_clkin_ck>, <&usb_hs_clk_div_ck>;
++      reg = <0x4a008180 0x4>, <0x4a008184 0x4>, <0x4a008188 0x4>, <0x4a00818c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_usb_clkdcoldo_ck: dpll_usb_clkdcoldo_ck@4a0081b4 {
++      #clock-cells = <0>;
++      compatible = "ti,fixed-factor-clock";
++      clocks = <&dpll_usb_ck>;
++      ti,autoidle-shift = <8>;
++      clock-div = <1>;
++      reg = <0x4a0081b4 0x4>;
++      clock-mult = <1>;
++      ti,autoidle-low;
++};
++
++dpll_usb_m2_ck: dpll_usb_m2_ck@4a008190 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_usb_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008190 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++ducati_clk_mux_ck: ducati_clk_mux_ck@4a008100 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&div_core_ck>, <&dpll_per_m6x2_ck>;
++      reg = <0x4a008100 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_12m_fclk: func_12m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++func_24m_clk: func_24m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_24mc_fclk: func_24mc_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++func_48m_fclk: func_48m_fclk@4a008108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      reg = <0x4a008108 0x4>;
++      table = < 4 0 >, < 8 1 >;
++      bit-mask = <0x1>;
++};
++
++func_48mc_fclk: func_48mc_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_64m_fclk: func_64m_fclk@4a008108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m4x2_ck>;
++      reg = <0x4a008108 0x4>;
++      table = < 2 0 >, < 4 1 >;
++      bit-mask = <0x1>;
++};
++
++func_96m_fclk: func_96m_fclk@4a008108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      reg = <0x4a008108 0x4>;
++      table = < 2 0 >, < 4 1 >;
++      bit-mask = <0x1>;
++};
++
++init_60m_fclk: init_60m_fclk@4a008104 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      reg = <0x4a008104 0x4>;
++      table = < 1 0 >, < 8 1 >;
++      bit-mask = <0x1>;
++};
++
++l3_div_ck: l3_div_ck@4a004100 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&div_core_ck>;
++      bit-shift = <4>;
++      reg = <0x4a004100 0x4>;
++      bit-mask = <0x1>;
++};
++
++l4_div_ck: l4_div_ck@4a004100 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <8>;
++      reg = <0x4a004100 0x4>;
++      bit-mask = <0x1>;
++};
++
++lp_clk_div_ck: lp_clk_div_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++l4_wkup_clk_mux_ck: l4_wkup_clk_mux_ck@4a306108 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&lp_clk_div_ck>;
++      reg = <0x4a306108 0x4>;
++      bit-mask = <0x1>;
++};
++
++mpu_periphclk: mpu_periphclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_mpu_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++ocp_abe_iclk: ocp_abe_iclk@4a004528 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&aess_fclk>;
++      bit-shift = <24>;
++      reg = <0x4a004528 0x4>;
++      table = < 2 0 >, < 1 1 >;
++      bit-mask = <0x1>;
++};
++
++per_abe_24m_fclk: per_abe_24m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++per_abe_nc_fclk: per_abe_nc_fclk@4a008108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2_ck>;
++      reg = <0x4a008108 0x4>;
++      bit-mask = <0x1>;
++};
++
++syc_clk_div_ck: syc_clk_div_ck@4a306100 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&sys_clkin_ck>;
++      reg = <0x4a306100 0x4>;
++      bit-mask = <0x1>;
++};
++
++aes1_fck: aes1_fck@4a0095a0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <1>;
++      reg = <0x4a0095a0 0x4>;
++};
++
++aes2_fck: aes2_fck@4a0095a8 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <1>;
++      reg = <0x4a0095a8 0x4>;
++};
++
++dmic_sync_mux_ck: dmic_sync_mux_ck@4a004538 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&syc_clk_div_ck>, <&func_24m_clk>;
++      bit-shift = <25>;
++      reg = <0x4a004538 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_dmic_abe_gfclk: func_dmic_abe_gfclk@4a004538 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dmic_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004538 0x4>;
++      bit-mask = <0x3>;
++};
++
++dss_sys_clk: dss_sys_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&syc_clk_div_ck>;
++      bit-shift = <10>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_tv_clk: dss_tv_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&extalt_clkin_ck>;
++      bit-shift = <11>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_dss_clk: dss_dss_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_m5x2_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_48mhz_clk: dss_48mhz_clk@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48mc_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009120 0x4>;
++};
++
++dss_fck: dss_fck@4a009120 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <1>;
++      reg = <0x4a009120 0x4>;
++};
++
++fdif_fck: fdif_fck@4a009028 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m4x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009028 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++gpio1_dbclk: gpio1_dbclk@4a307838 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a307838 0x4>;
++};
++
++gpio2_dbclk: gpio2_dbclk@4a009460 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009460 0x4>;
++};
++
++gpio3_dbclk: gpio3_dbclk@4a009468 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009468 0x4>;
++};
++
++gpio4_dbclk: gpio4_dbclk@4a009470 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009470 0x4>;
++};
++
++gpio5_dbclk: gpio5_dbclk@4a009478 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009478 0x4>;
++};
++
++gpio6_dbclk: gpio6_dbclk@4a009480 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009480 0x4>;
++};
++
++sgx_clk_mux: sgx_clk_mux@4a009220 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_m7x2_ck>, <&dpll_per_m7x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009220 0x4>;
++      bit-mask = <0x1>;
++};
++
++hsi_fck: hsi_fck@4a009338 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009338 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++iss_ctrlclk: iss_ctrlclk@4a009020 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_96m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a009020 0x4>;
++};
++
++mcasp_sync_mux_ck: mcasp_sync_mux_ck@4a004540 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&syc_clk_div_ck>, <&func_24m_clk>;
++      bit-shift = <25>;
++      reg = <0x4a004540 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_mcasp_abe_gfclk: func_mcasp_abe_gfclk@4a004540 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcasp_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004540 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp1_sync_mux_ck: mcbsp1_sync_mux_ck@4a004548 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&syc_clk_div_ck>, <&func_24m_clk>;
++      bit-shift = <25>;
++      reg = <0x4a004548 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_mcbsp1_gfclk: func_mcbsp1_gfclk@4a004548 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp1_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004548 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp2_sync_mux_ck: mcbsp2_sync_mux_ck@4a004550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&syc_clk_div_ck>, <&func_24m_clk>;
++      bit-shift = <25>;
++      reg = <0x4a004550 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_mcbsp2_gfclk: func_mcbsp2_gfclk@4a004550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp2_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004550 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp3_sync_mux_ck: mcbsp3_sync_mux_ck@4a004558 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&syc_clk_div_ck>, <&func_24m_clk>;
++      bit-shift = <25>;
++      reg = <0x4a004558 0x4>;
++      bit-mask = <0x1>;
++};
++
++func_mcbsp3_gfclk: func_mcbsp3_gfclk@4a004558 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp3_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004558 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp4_sync_mux_ck: mcbsp4_sync_mux_ck@4a0094e0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_96m_fclk>, <&per_abe_nc_fclk>;
++      bit-shift = <25>;
++      reg = <0x4a0094e0 0x4>;
++      bit-mask = <0x1>;
++};
++
++per_mcbsp4_gfclk: per_mcbsp4_gfclk@4a0094e0 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp4_sync_mux_ck>, <&pad_clks_ck>;
++      bit-shift = <24>;
++      reg = <0x4a0094e0 0x4>;
++      bit-mask = <0x1>;
++};
++
++hsmmc1_fclk: hsmmc1_fclk@4a009328 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_64m_fclk>, <&func_96m_fclk>;
++      bit-shift = <24>;
++      reg = <0x4a009328 0x4>;
++      bit-mask = <0x1>;
++};
++
++hsmmc2_fclk: hsmmc2_fclk@4a009330 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_64m_fclk>, <&func_96m_fclk>;
++      bit-shift = <24>;
++      reg = <0x4a009330 0x4>;
++      bit-mask = <0x1>;
++};
++
++ocp2scp_usb_phy_phy_48m: ocp2scp_usb_phy_phy_48m@4a0093e0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a0093e0 0x4>;
++};
++
++sha2md5_fck: sha2md5_fck@4a0095c8 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <1>;
++      reg = <0x4a0095c8 0x4>;
++};
++
++slimbus1_fclk_1: slimbus1_fclk_1@4a004560 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_24m_clk>;
++      bit-shift = <9>;
++      reg = <0x4a004560 0x4>;
++};
++
++slimbus1_fclk_0: slimbus1_fclk_0@4a004560 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&abe_24m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a004560 0x4>;
++};
++
++slimbus1_fclk_2: slimbus1_fclk_2@4a004560 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&pad_clks_ck>;
++      bit-shift = <10>;
++      reg = <0x4a004560 0x4>;
++};
++
++slimbus1_slimbus_clk: slimbus1_slimbus_clk@4a004560 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&slimbus_clk>;
++      bit-shift = <11>;
++      reg = <0x4a004560 0x4>;
++};
++
++slimbus2_fclk_1: slimbus2_fclk_1@4a009538 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&per_abe_24m_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009538 0x4>;
++};
++
++slimbus2_fclk_0: slimbus2_fclk_0@4a009538 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_24mc_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a009538 0x4>;
++};
++
++slimbus2_slimbus_clk: slimbus2_slimbus_clk@4a009538 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&pad_slimbus_core_clks_ck>;
++      bit-shift = <10>;
++      reg = <0x4a009538 0x4>;
++};
++
++smartreflex_core_fck: smartreflex_core_fck@4a008638 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l4_wkup_clk_mux_ck>;
++      bit-shift = <1>;
++      reg = <0x4a008638 0x4>;
++};
++
++smartreflex_iva_fck: smartreflex_iva_fck@4a008630 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l4_wkup_clk_mux_ck>;
++      bit-shift = <1>;
++      reg = <0x4a008630 0x4>;
++};
++
++smartreflex_mpu_fck: smartreflex_mpu_fck@4a008628 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l4_wkup_clk_mux_ck>;
++      bit-shift = <1>;
++      reg = <0x4a008628 0x4>;
++};
++
++dmt1_clk_mux: dmt1_clk_mux@4a307840 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a307840 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm10_mux: cm2_dm10_mux@4a009428 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009428 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm11_mux: cm2_dm11_mux@4a009430 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009430 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm2_mux: cm2_dm2_mux@4a009438 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009438 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm3_mux: cm2_dm3_mux@4a009440 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009440 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm4_mux: cm2_dm4_mux@4a009448 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009448 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer5_sync_mux: timer5_sync_mux@4a004568 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&syc_clk_div_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004568 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer6_sync_mux: timer6_sync_mux@4a004570 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&syc_clk_div_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004570 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer7_sync_mux: timer7_sync_mux@4a004578 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&syc_clk_div_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004578 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer8_sync_mux: timer8_sync_mux@4a004580 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&syc_clk_div_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004580 0x4>;
++      bit-mask = <0x1>;
++};
++
++cm2_dm9_mux: cm2_dm9_mux@4a009450 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009450 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_host_fs_fck: usb_host_fs_fck@4a0093d0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48mc_fclk>;
++      reg = <0x4a0093d0 0x4>;
++      bit-shift = <1>;
++};
++
++utmi_p1_gfclk: utmi_p1_gfclk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&init_60m_fclk>, <&xclk60mhsp1_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009358 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_host_hs_utmi_p1_clk: usb_host_hs_utmi_p1_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&utmi_p1_gfclk>;
++      bit-shift = <8>;
++      reg = <0x4a009358 0x4>;
++};
++
++utmi_p2_gfclk: utmi_p2_gfclk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&init_60m_fclk>, <&xclk60mhsp2_ck>;
++      bit-shift = <25>;
++      reg = <0x4a009358 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_host_hs_utmi_p2_clk: usb_host_hs_utmi_p2_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&utmi_p2_gfclk>;
++      bit-shift = <9>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_utmi_p3_clk: usb_host_hs_utmi_p3_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <10>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_hsic480m_p1_clk: usb_host_hs_hsic480m_p1_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      bit-shift = <13>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_hsic60m_p1_clk: usb_host_hs_hsic60m_p1_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <11>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_hsic60m_p2_clk: usb_host_hs_hsic60m_p2_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <12>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_hsic480m_p2_clk: usb_host_hs_hsic480m_p2_clk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      bit-shift = <14>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_func48mclk: usb_host_hs_func48mclk@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48mc_fclk>;
++      bit-shift = <15>;
++      reg = <0x4a009358 0x4>;
++};
++
++usb_host_hs_fck: usb_host_hs_fck@4a009358 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <1>;
++      reg = <0x4a009358 0x4>;
++};
++
++otg_60m_gfclk: otg_60m_gfclk@4a009360 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&utmi_phy_clkout_ck>, <&xclk60motg_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009360 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_otg_hs_xclk: usb_otg_hs_xclk@4a009360 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&otg_60m_gfclk>;
++      bit-shift = <8>;
++      reg = <0x4a009360 0x4>;
++};
++
++usb_otg_hs_ick: usb_otg_hs_ick@4a009360 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3_div_ck>;
++      bit-shift = <0>;
++      reg = <0x4a009360 0x4>;
++};
++
++usb_phy_cm_clk32k: usb_phy_cm_clk32k@4a008640 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008640 0x4>;
++};
++
++usb_tll_hs_usb_ch2_clk: usb_tll_hs_usb_ch2_clk@4a009368 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <10>;
++      reg = <0x4a009368 0x4>;
++};
++
++usb_tll_hs_usb_ch0_clk: usb_tll_hs_usb_ch0_clk@4a009368 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a009368 0x4>;
++};
++
++usb_tll_hs_usb_ch1_clk: usb_tll_hs_usb_ch1_clk@4a009368 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&init_60m_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009368 0x4>;
++};
++
++usb_tll_hs_ick: usb_tll_hs_ick@4a009368 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l4_div_ck>;
++      bit-shift = <0>;
++      reg = <0x4a009368 0x4>;
++};
++
++usim_ck: usim_ck@4a307858 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m4x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a307858 0x4>;
++      table = < 14 0 >, < 18 1 >;
++      bit-mask = <0x1>;
++};
++
++usim_fclk: usim_fclk@4a307858 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&usim_ck>;
++      bit-shift = <8>;
++      reg = <0x4a307858 0x4>;
++};
++
++pmd_stm_clock_mux_ck: pmd_stm_clock_mux_ck@4a307a20 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m6x2_ck>, <&tie_low_clock_ck>;
++      bit-shift = <20>;
++      reg = <0x4a307a20 0x4>;
++      bit-mask = <0x3>;
++};
++
++pmd_trace_clk_mux_ck: pmd_trace_clk_mux_ck@4a307a20 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m6x2_ck>, <&tie_low_clock_ck>;
++      bit-shift = <22>;
++      reg = <0x4a307a20 0x4>;
++      bit-mask = <0x3>;
++};
++
++stm_clk_div_ck: stm_clk_div_ck@4a307a20 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&pmd_stm_clock_mux_ck>;
++      bit-shift = <27>;
++      reg = <0x4a307a20 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++trace_clk_div_div_ck: trace_clk_div_div_ck@4a307a20 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      bit-shift = <24>;
++      reg = <0x4a307a20 0x4>;
++      bit-mask = <0x7>;
++      index-power-of-two;
++};
++
++trace_clk_div_ck: trace_clk_div_ck {
++      #clock-cells = <0>;
++      compatible = "ti,clkdm-gate-clock";
++      clocks = <&trace_clk_div_div_ck>;
++};
++
++auxclk0_src_mux_ck: auxclk0_src_mux_ck@4a30a310 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a310 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk0_src_ck: auxclk0_src_ck@4a30a310 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk0_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a310 0x4>;
++};
++
++auxclk0_ck: auxclk0_ck@4a30a310 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk0_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a310 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk1_src_mux_ck: auxclk1_src_mux_ck@4a30a314 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a314 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk1_src_ck: auxclk1_src_ck@4a30a314 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk1_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a314 0x4>;
++};
++
++auxclk1_ck: auxclk1_ck@4a30a314 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk1_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a314 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk2_src_mux_ck: auxclk2_src_mux_ck@4a30a318 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a318 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk2_src_ck: auxclk2_src_ck@4a30a318 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk2_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a318 0x4>;
++};
++
++auxclk2_ck: auxclk2_ck@4a30a318 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk2_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a318 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk3_src_mux_ck: auxclk3_src_mux_ck@4a30a31c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a31c 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk3_src_ck: auxclk3_src_ck@4a30a31c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk3_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a31c 0x4>;
++};
++
++auxclk3_ck: auxclk3_ck@4a30a31c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk3_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a31c 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk4_src_mux_ck: auxclk4_src_mux_ck@4a30a320 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a320 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk4_src_ck: auxclk4_src_ck@4a30a320 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk4_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a320 0x4>;
++};
++
++auxclk4_ck: auxclk4_ck@4a30a320 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk4_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a320 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk5_src_mux_ck: auxclk5_src_mux_ck@4a30a324 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin_ck>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4a30a324 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk5_src_ck: auxclk5_src_ck@4a30a324 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk5_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4a30a324 0x4>;
++};
++
++auxclk5_ck: auxclk5_ck@4a30a324 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk5_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4a30a324 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclkreq0_ck: auxclkreq0_ck@4a30a210 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a210 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq1_ck: auxclkreq1_ck@4a30a214 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a214 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq2_ck: auxclkreq2_ck@4a30a218 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a218 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq3_ck: auxclkreq3_ck@4a30a21c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a21c 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq4_ck: auxclkreq4_ck@4a30a220 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a220 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq5_ck: auxclkreq5_ck@4a30a224 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>, <&auxclk5_ck>;
++      bit-shift = <2>;
++      reg = <0x4a30a224 0x4>;
++      bit-mask = <0x7>;
++};
+--- a/arch/arm/boot/dts/omap4.dtsi
++++ b/arch/arm/boot/dts/omap4.dtsi
+@@ -17,6 +17,10 @@
+       interrupt-parent = <&gic>;
+       aliases {
++              i2c0 = &i2c1;
++              i2c1 = &i2c2;
++              i2c2 = &i2c3;
++              i2c3 = &i2c4;
+               serial0 = &uart1;
+               serial1 = &uart2;
+               serial2 = &uart3;
+@@ -32,6 +36,11 @@
+                       device_type = "cpu";
+                       next-level-cache = <&L2>;
+                       reg = <0x0>;
++
++                      clocks = <&dpll_mpu_ck>;
++                      clock-names = "cpu";
++
++                      clock-latency = <300000>; /* From omap-cpufreq driver */
+               };
+               cpu@1 {
+                       compatible = "arm,cortex-a9";
+@@ -107,6 +116,8 @@
+                       compatible = "ti,omap-counter32k";
+                       reg = <0x4a304000 0x20>;
+                       ti,hwmods = "counter_32k";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
+               };
+               omap4_pmx_core: pinmux@4a100040 {
+@@ -136,6 +147,8 @@
+                       #dma-cells = <1>;
+                       #dma-channels = <32>;
+                       #dma-requests = <127>;
++                      clocks = <&l3_div_ck>;
++                      clock-names = "fck";
+               };
+               gpio1: gpio@4a310000 {
+@@ -143,6 +156,8 @@
+                       reg = <0x4a310000 0x200>;
+                       interrupts = <GIC_SPI 29 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio1";
++                      clocks = <&l4_wkup_clk_mux_ck>, <&gpio1_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       ti,gpio-always-on;
+                       gpio-controller;
+                       #gpio-cells = <2>;
+@@ -155,6 +170,8 @@
+                       reg = <0x48055000 0x200>;
+                       interrupts = <GIC_SPI 30 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio2";
++                      clocks = <&l4_div_ck>, <&gpio2_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -166,6 +183,8 @@
+                       reg = <0x48057000 0x200>;
+                       interrupts = <GIC_SPI 31 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio3";
++                      clocks = <&l4_div_ck>, <&gpio3_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -177,6 +196,8 @@
+                       reg = <0x48059000 0x200>;
+                       interrupts = <GIC_SPI 32 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio4";
++                      clocks = <&l4_div_ck>, <&gpio4_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -188,6 +209,8 @@
+                       reg = <0x4805b000 0x200>;
+                       interrupts = <GIC_SPI 33 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio5";
++                      clocks = <&l4_div_ck>, <&gpio5_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -199,6 +222,8 @@
+                       reg = <0x4805d000 0x200>;
+                       interrupts = <GIC_SPI 34 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio6";
++                      clocks = <&l4_div_ck>, <&gpio6_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -214,6 +239,7 @@
+                       gpmc,num-cs = <8>;
+                       gpmc,num-waitpins = <4>;
+                       ti,hwmods = "gpmc";
++                      ti,no-idle;
+               };
+               uart1: serial@4806a000 {
+@@ -221,6 +247,8 @@
+                       reg = <0x4806a000 0x100>;
+                       interrupts = <GIC_SPI 72 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart1";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+@@ -229,6 +257,8 @@
+                       reg = <0x4806c000 0x100>;
+                       interrupts = <GIC_SPI 73 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart2";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+@@ -237,6 +267,8 @@
+                       reg = <0x48020000 0x100>;
+                       interrupts = <GIC_SPI 74 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+@@ -245,6 +277,8 @@
+                       reg = <0x4806e000 0x100>;
+                       interrupts = <GIC_SPI 70 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
+               };
+@@ -255,6 +289,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c1";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
+               };
+               i2c2: i2c@48072000 {
+@@ -264,6 +300,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c2";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
+               };
+               i2c3: i2c@48060000 {
+@@ -273,6 +311,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c3";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
+               };
+               i2c4: i2c@48350000 {
+@@ -282,6 +322,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c4";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
+               };
+               mcspi1: spi@48098000 {
+@@ -291,6 +333,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi1";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <4>;
+                       dmas = <&sdma 35>,
+                              <&sdma 36>,
+@@ -311,6 +355,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi2";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 43>,
+                              <&sdma 44>,
+@@ -326,6 +372,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 15>, <&sdma 16>;
+                       dma-names = "tx0", "rx0";
+@@ -338,6 +386,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <1>;
+                       dmas = <&sdma 70>, <&sdma 71>;
+                       dma-names = "tx0", "rx0";
+@@ -348,6 +398,8 @@
+                       reg = <0x4809c000 0x400>;
+                       interrupts = <GIC_SPI 83 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc1";
++                      clocks = <&hsmmc1_fclk>;
++                      clock-names = "fck";
+                       ti,dual-volt;
+                       ti,needs-special-reset;
+                       dmas = <&sdma 61>, <&sdma 62>;
+@@ -359,6 +411,8 @@
+                       reg = <0x480b4000 0x400>;
+                       interrupts = <GIC_SPI 86 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc2";
++                      clocks = <&hsmmc2_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 47>, <&sdma 48>;
+                       dma-names = "tx", "rx";
+@@ -369,6 +423,8 @@
+                       reg = <0x480ad000 0x400>;
+                       interrupts = <GIC_SPI 94 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 77>, <&sdma 78>;
+                       dma-names = "tx", "rx";
+@@ -379,6 +435,8 @@
+                       reg = <0x480d1000 0x400>;
+                       interrupts = <GIC_SPI 96 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 57>, <&sdma 58>;
+                       dma-names = "tx", "rx";
+@@ -389,16 +447,20 @@
+                       reg = <0x480d5000 0x400>;
+                       interrupts = <GIC_SPI 59 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc5";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 59>, <&sdma 60>;
+                       dma-names = "tx", "rx";
+               };
+               wdt2: wdt@4a314000 {
+-                      compatible = "ti,omap4-wdt", "ti,omap3-wdt";
++                      compatible = "ti,omap4-wdt";
+                       reg = <0x4a314000 0x80>;
+                       interrupts = <GIC_SPI 80 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "wd_timer2";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
+               };
+               mcpdm: mcpdm@40132000 {
+@@ -408,6 +470,8 @@
+                       reg-names = "mpu", "dma";
+                       interrupts = <GIC_SPI 112 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mcpdm";
++                      clocks = <&pad_clks_ck>;
++                      clock-names = "fck";
+                       dmas = <&sdma 65>,
+                              <&sdma 66>;
+                       dma-names = "up_link", "dn_link";
+@@ -420,6 +484,8 @@
+                       reg-names = "mpu", "dma";
+                       interrupts = <GIC_SPI 114 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "dmic";
++                      clocks = <&func_dmic_abe_gfclk>;
++                      clock-names = "fck";
+                       dmas = <&sdma 67>;
+                       dma-names = "up_link";
+               };
+@@ -433,6 +499,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp1";
++                      clocks = <&func_mcbsp1_gfclk>, <&pad_clks_ck>, <&mcbsp1_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 33>,
+                              <&sdma 34>;
+                       dma-names = "tx", "rx";
+@@ -447,6 +515,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp2";
++                      clocks = <&func_mcbsp2_gfclk>, <&pad_clks_ck>, <&mcbsp2_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 17>,
+                              <&sdma 18>;
+                       dma-names = "tx", "rx";
+@@ -461,6 +531,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp3";
++                      clocks = <&func_mcbsp3_gfclk>, <&pad_clks_ck>, <&mcbsp3_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 19>,
+                              <&sdma 20>;
+                       dma-names = "tx", "rx";
+@@ -474,6 +546,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp4";
++                      clocks = <&per_mcbsp4_gfclk>, <&pad_clks_ck>, <&mcbsp4_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 31>,
+                              <&sdma 32>;
+                       dma-names = "tx", "rx";
+@@ -485,6 +559,15 @@
+                       interrupts = <GIC_SPI 120 IRQ_TYPE_LEVEL_HIGH>;
+                       reg-names = "mpu";
+                       ti,hwmods = "kbd";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
++              };
++
++              dmm: dmm@4e000000 {
++                      compatible = "ti,omap4-dmm";
++                      reg = <0x4e000000 0x800>;
++                      interrupts = <0 113 0x4>;
++                      ti,hwmods = "dmm";
+               };
+               emif1: emif@4c000000 {
+@@ -492,6 +575,9 @@
+                       reg = <0x4c000000 0x100>;
+                       interrupts = <GIC_SPI 110 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "emif1";
++                      ti,no-idle;
++                      clocks = <&ddrphy_ck>;
++                      clock-names = "fck";
+                       phy-type = <1>;
+                       hw-caps-read-idle-ctrl;
+                       hw-caps-ll-interface;
+@@ -503,6 +589,9 @@
+                       reg = <0x4d000000 0x100>;
+                       interrupts = <GIC_SPI 111 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "emif2";
++                      ti,no-idle;
++                      clocks = <&ddrphy_ck>;
++                      clock-names = "fck";
+                       phy-type = <1>;
+                       hw-caps-read-idle-ctrl;
+                       hw-caps-ll-interface;
+@@ -516,18 +605,36 @@
+                       #size-cells = <1>;
+                       ranges;
+                       ti,hwmods = "ocp2scp_usb_phy";
++                      clocks = <&ocp2scp_usb_phy_phy_48m>;
++                      clock-names = "fck";
+                       usb2_phy: usb2phy@4a0ad080 {
+                               compatible = "ti,omap-usb2";
+                               reg = <0x4a0ad080 0x58>;
+-                              ctrl-module = <&omap_control_usb>;
++                              ctrl-module = <&omap_control_usb2phy>;
++                                clocks = <&usb_phy_cm_clk32k>, <&ocp2scp_usb_phy_phy_48m>;
++                                clock-names = "wkupclk", "refclk";
++                              #phy-cells = <0>;
+                       };
+               };
++              mailbox: mailbox@4a0f4000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4a0f4000 0x200>;
++                      interrupts = <GIC_SPI 26 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <3>;
++                      ti,mbox-num-fifos = <8>;
++                      ti,mbox-names = "mbox-ipu", "mbox-dsp";
++                      ti,mbox-data = <0 1 0 0>, <3 2 0 0>;
++              };
++
+               timer1: timer@4a318000 {
+                       compatible = "ti,omap3430-timer";
+                       reg = <0x4a318000 0x80>;
+                       interrupts = <GIC_SPI 37 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer1";
++                      clocks = <&dmt1_clk_mux>;
++                      clock-names = "fck";
+                       ti,timer-alwon;
+               };
+@@ -536,6 +643,8 @@
+                       reg = <0x48032000 0x80>;
+                       interrupts = <GIC_SPI 38 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer2";
++                      clocks = <&cm2_dm2_mux>;
++                      clock-names = "fck";
+               };
+               timer3: timer@48034000 {
+@@ -543,6 +652,8 @@
+                       reg = <0x48034000 0x80>;
+                       interrupts = <GIC_SPI 39 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer3";
++                      clocks = <&cm2_dm3_mux>;
++                      clock-names = "fck";
+               };
+               timer4: timer@48036000 {
+@@ -550,6 +661,8 @@
+                       reg = <0x48036000 0x80>;
+                       interrupts = <GIC_SPI 40 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer4";
++                      clocks = <&cm2_dm4_mux>;
++                      clock-names = "fck";
+               };
+               timer5: timer@40138000 {
+@@ -558,6 +671,8 @@
+                             <0x49038000 0x80>;
+                       interrupts = <GIC_SPI 41 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer5";
++                      clocks = <&timer5_sync_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -567,6 +682,8 @@
+                             <0x4903a000 0x80>;
+                       interrupts = <GIC_SPI 42 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer6";
++                      clocks = <&timer6_sync_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -576,6 +693,8 @@
+                             <0x4903c000 0x80>;
+                       interrupts = <GIC_SPI 43 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer7";
++                      clocks = <&timer7_sync_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -585,6 +704,8 @@
+                             <0x4903e000 0x80>;
+                       interrupts = <GIC_SPI 44 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer8";
++                      clocks = <&timer8_sync_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+                       ti,timer-dsp;
+               };
+@@ -594,6 +715,8 @@
+                       reg = <0x4803e000 0x80>;
+                       interrupts = <GIC_SPI 45 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer9";
++                      clocks = <&cm2_dm9_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -602,6 +725,8 @@
+                       reg = <0x48086000 0x80>;
+                       interrupts = <GIC_SPI 46 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer10";
++                      clocks = <&cm2_dm10_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -610,6 +735,8 @@
+                       reg = <0x48088000 0x80>;
+                       interrupts = <GIC_SPI 47 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer11";
++                      clocks = <&cm2_dm11_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -618,12 +745,16 @@
+                       reg = <0x4a062000 0x1000>;
+                       interrupts = <GIC_SPI 78 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "usb_tll_hs";
++                      clocks = <&usb_tll_hs_ick>;
++                      clock-names = "fck";
+               };
+               usbhshost: usbhshost@4a064000 {
+                       compatible = "ti,usbhs-host";
+                       reg = <0x4a064000 0x800>;
+                       ti,hwmods = "usb_host_hs";
++                      clocks = <&usb_host_hs_fck>;
++                      clock-names = "fck";
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       ranges;
+@@ -643,12 +774,16 @@
+                       };
+               };
+-              omap_control_usb: omap-control-usb@4a002300 {
+-                      compatible = "ti,omap-control-usb";
+-                      reg = <0x4a002300 0x4>,
+-                            <0x4a00233c 0x4>;
+-                      reg-names = "control_dev_conf", "otghs_control";
+-                      ti,type = <1>;
++              omap_control_usb2phy: control-phy@4a002300 {
++                      compatible = "ti,control-phy-usb2";
++                      reg = <0x4a002300 0x4>;
++                      reg-names = "power";
++              };
++
++              omap_control_usbotg: control-phy@4a00233c {
++                      compatible = "ti,control-phy-otghs";
++                      reg = <0x4a00233c 0x4>;
++                      reg-names = "otghs_control";
+               };
+               usb_otg_hs: usb_otg_hs@4a0ab000 {
+@@ -657,11 +792,98 @@
+                       interrupts = <GIC_SPI 92 IRQ_TYPE_LEVEL_HIGH>, <GIC_SPI 93 IRQ_TYPE_LEVEL_HIGH>;
+                       interrupt-names = "mc", "dma";
+                       ti,hwmods = "usb_otg_hs";
++                      clocks = <&usb_otg_hs_ick>, <&usb_otg_hs_xclk>;
++                      clock-names = "fck", "xclk";
+                       usb-phy = <&usb2_phy>;
++                      phys = <&usb2_phy>;
++                      phy-names = "usb2-phy";
+                       multipoint = <1>;
+                       num-eps = <16>;
+                       ram-bits = <12>;
+-                      ti,has-mailbox;
++                      ctrl-module = <&omap_control_usbotg>;
++                      dr_mode = "peripheral";
++              };
++
++              dss@58000000 {
++                      compatible = "ti,omap4-dss", "simple-bus";
++                      reg = <0x58000000 0x80>;
++                      ti,hwmods = "dss_core";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++
++                      dispc@58001000 {
++                              compatible = "ti,omap4-dispc";
++                              reg = <0x58001000 0x1000>;
++                              interrupts = <0 25 0x4>;
++                              ti,hwmods = "dss_dispc";
++                      };
++
++                      dpi: encoder@0 {
++                              compatible = "ti,omap4-dpi";
++                      };
++
++                      rfbi: encoder@58002000  {
++                              compatible = "ti,omap4-rfbi";
++                              reg = <0x58002000 0x1000>;
++                              ti,hwmods = "dss_rfbi";
++                      };
++
++                      /*
++                       * Accessing venc registers cause a crash on omap4, so
++                       * this is disabled for now.
++                       */
++                      /*
++                      venc: encoder@58003000 {
++                              compatible = "ti,omap4-venc";
++                              reg = <0x58003000 0x1000>;
++                              ti,hwmods = "dss_venc";
++                      };
++                      */
++
++                      dsi1: encoder@58004000 {
++                              compatible = "ti,omap4-dsi";
++                              reg = <0x58004000 0x200>;
++                              interrupts = <0 53 0x4>;
++                              ti,hwmods = "dss_dsi1";
++                      };
++
++                      dsi2: encoder@58005000 {
++                              compatible = "ti,omap4-dsi";
++                              reg = <0x58005000 0x200>;
++                              interrupts = <0 84 0x4>;
++                              ti,hwmods = "dss_dsi2";
++                      };
++
++                      hdmi: encoder@58006000 {
++                              compatible = "ti,omap4-hdmi";
++                              reg = <0x58006000 0x200>,
++                                    <0x58006200 0x100>,
++                                    <0x58006300 0x100>,
++                                    <0x58006400 0x1000>;
++                              reg-names = "hdmi_wp", "hdmi_pllctrl",
++                                          "hdmi_txphy", "hdmi_core";
++                              interrupts = <0 101 0x4>;
++                              ti,hwmods = "dss_hdmi";
++                      };
++              };
++
++              aes: aes@4b501000 {
++                      compatible = "ti,omap4-aes";
++                      ti,hwmods = "aes";
++                      reg = <0x4b501000 0xa0>;
++                      interrupts = <GIC_SPI 85 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&sdma 111>, <&sdma 110>;
++                      dma-names = "tx", "rx";
++              };
++
++              des: des@480a5000 {
++                      compatible = "ti,omap4-des";
++                      ti,hwmods = "des";
++                      reg = <0x480a5000 0xa0>;
++                      interrupts = <GIC_SPI 82 IRQ_TYPE_LEVEL_HIGH>;
++                      dmas = <&sdma 117>, <&sdma 116>;
++                      dma-names = "tx", "rx";
+               };
+       };
+ };
+--- a/arch/arm/boot/dts/omap4-panda-common.dtsi
++++ b/arch/arm/boot/dts/omap4-panda-common.dtsi
+@@ -60,22 +60,6 @@
+                       "AFMR", "Line In";
+       };
+-      /*
+-       * Temp hack: Need to be replaced with the proper gpio-controlled
+-       * reset driver as soon it will be merged.
+-       * http://thread.gmane.org/gmane.linux.drivers.devicetree/36830
+-       */
+-      /* HS USB Port 1 RESET */
+-      hsusb1_reset: hsusb1_reset_reg {
+-              compatible = "regulator-fixed";
+-              regulator-name = "hsusb1_reset";
+-              regulator-min-microvolt = <3300000>;
+-              regulator-max-microvolt = <3300000>;
+-              gpio = <&gpio2 30 0>;   /* gpio_62 */
+-              startup-delay-us = <70000>;
+-              enable-active-high;
+-      };
+-
+       /* HS USB Port 1 Power */
+       hsusb1_power: hsusb1_power_reg {
+               compatible = "regulator-fixed";
+@@ -97,14 +81,10 @@
+       /* HS USB Host PHY on PORT 1 */
+       hsusb1_phy: hsusb1_phy {
+               compatible = "usb-nop-xceiv";
+-              reset-supply = <&hsusb1_reset>;
++              reset-gpios = <&gpio2 30 GPIO_ACTIVE_LOW>;   /* gpio_62 */
+               vcc-supply = <&hsusb1_power>;
+-      /**
+-       * FIXME:
+-       * put the right clock phandle here when available
+-       *      clocks = <&auxclk3>;
+-       *      clock-names = "main_clk";
+-       */
++              clocks = <&auxclk3_ck>;
++              clock-names = "main_clk";
+               clock-frequency = <19200000>;
+       };
+@@ -401,3 +381,51 @@
+ &usbhsehci {
+       phys = <&hsusb1_phy>;
+ };
++
++&dsi1 {
++      vdds_dsi-supply = <&vcxio>;
++};
++
++&dsi2 {
++      vdds_dsi-supply = <&vcxio>;
++};
++
++&hdmi {
++      vdda_hdmi_dac-supply = <&vdac>;
++};
++
++/ {
++      aliases {
++              display0 = &dvi0;
++              display1 = &hdmi0;
++      };
++
++      tfp410: encoder@0 {
++              compatible = "ti,tfp410";
++              video-source = <&dpi>;
++              data-lines = <24>;
++              gpios = <&gpio1 0 0>;   /* 0, power-down */
++      };
++
++      dvi0: connector@0 {
++              compatible = "ti,dvi_connector";
++              video-source = <&tfp410>;
++              i2c-bus = <&i2c3>;
++      };
++
++      tpd12s015: encoder@1 {
++              compatible = "ti,tpd12s015";
++
++              video-source = <&hdmi>;
++
++              gpios = <&gpio2 28 0>,  /* 60, CT CP HPD */
++                      <&gpio2 9 0>,   /* 41, LS OE */
++                      <&gpio2 31 0>;  /* 63, HPD */
++      };
++
++      hdmi0: connector@1 {
++              compatible = "ti,hdmi_connector";
++
++              video-source = <&tpd12s015>;
++      };
++};
+--- a/arch/arm/boot/dts/omap4-sdp.dts
++++ b/arch/arm/boot/dts/omap4-sdp.dts
+@@ -569,3 +569,73 @@
+       mode = <3>;
+       power = <50>;
+ };
++
++&dsi1 {
++      vdds_dsi-supply = <&vcxio>;
++};
++
++&dsi2 {
++      vdds_dsi-supply = <&vcxio>;
++};
++
++&hdmi {
++      vdda_hdmi_dac-supply = <&vdac>;
++};
++
++/ {
++      aliases {
++              display0 = &lcd0;
++              display1 = &lcd1;
++              display2 = &hdmi0;
++      };
++
++      lcd0: display@0 {
++              compatible = "tpo,taal", "panel-dsi-cm";
++
++              video-source = <&dsi1>;
++
++              lanes = <
++                      0       /* clk + */
++                      1       /* clk - */
++                      2       /* data1 + */
++                      3       /* data1 - */
++                      4       /* data2 + */
++                      5       /* data2 - */
++              >;
++
++              gpios = <&gpio4 6 0>;   /* 102, reset */
++      };
++
++      lcd1: display@1 {
++              compatible = "tpo,taal", "panel-dsi-cm";
++
++              video-source = <&dsi2>;
++
++              lanes = <
++                      0       /* clk + */
++                      1       /* clk - */
++                      2       /* data1 + */
++                      3       /* data1 - */
++                      4       /* data2 + */
++                      5       /* data2 - */
++              >;
++
++              gpios = <&gpio4 8 0>;   /* 104, reset */
++      };
++
++      tpd12s015: encoder@0 {
++              compatible = "ti,tpd12s015";
++
++              video-source = <&hdmi>;
++
++              gpios = <&gpio2 28 0>,  /* 60, CT CP HPD */
++                      <&gpio2 9 0>,   /* 41, LS OE */
++                      <&gpio2 31 0>;  /* 63, HPD */
++      };
++
++      hdmi0: connector@0 {
++              compatible = "ti,hdmi_connector";
++
++              video-source = <&tpd12s015>;
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/omap54xx-clocks.dtsi
+@@ -0,0 +1,1400 @@
++/*
++ * Device Tree Source for OMAP5 clock data
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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.
++ */
++
++pad_clks_src_ck: pad_clks_src_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++pad_clks_ck: pad_clks_ck@4a004108 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&pad_clks_src_ck>;
++      bit-shift = <8>;
++      reg = <0x4a004108 0x4>;
++};
++
++secure_32k_clk_src_ck: secure_32k_clk_src_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++slimbus_src_clk: slimbus_src_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++slimbus_clk: slimbus_clk@4a004108 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&slimbus_src_clk>;
++      bit-shift = <10>;
++      reg = <0x4a004108 0x4>;
++};
++
++sys_32k_ck: sys_32k_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <32768>;
++};
++
++virt_12000000_ck: virt_12000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <12000000>;
++};
++
++virt_13000000_ck: virt_13000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <13000000>;
++};
++
++virt_16800000_ck: virt_16800000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <16800000>;
++};
++
++virt_19200000_ck: virt_19200000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <19200000>;
++};
++
++virt_26000000_ck: virt_26000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <26000000>;
++};
++
++virt_27000000_ck: virt_27000000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <27000000>;
++};
++
++virt_38400000_ck: virt_38400000_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <38400000>;
++};
++
++sys_clkin: sys_clkin@4ae06110 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&virt_12000000_ck>, <&virt_13000000_ck>, <&virt_16800000_ck>, <&virt_19200000_ck>, <&virt_26000000_ck>, <&virt_27000000_ck>, <&virt_38400000_ck>;
++      reg = <0x4ae06110 0x4>;
++      bit-mask = <0x7>;
++      index-starts-at-one;
++};
++
++xclk60mhsp1_ck: xclk60mhsp1_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++xclk60mhsp2_ck: xclk60mhsp2_ck {
++      #clock-cells = <0>;
++      compatible = "fixed-clock";
++      clock-frequency = <60000000>;
++};
++
++abe_dpll_bypass_clk_mux: abe_dpll_bypass_clk_mux@4ae06108 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      reg = <0x4ae06108 0x4>;
++      bit-mask = <0x1>;
++};
++
++abe_dpll_clk_mux: abe_dpll_clk_mux@4ae0610c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      reg = <0x4ae0610c 0x4>;
++      bit-mask = <0x1>;
++};
++
++dpll_abe_ck: dpll_abe_ck@4a0041e0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-m4xen-clock";
++      clocks = <&abe_dpll_clk_mux>, <&abe_dpll_bypass_clk_mux>;
++      reg = <0x4a0041e0 0x4>, <0x4a0041e4 0x4>, <0x4a0041e8 0x4>, <0x4a0041ec 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_abe_x2_ck: dpll_abe_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_abe_ck>;
++};
++
++dpll_abe_m2x2_ck: dpll_abe_m2x2_ck@4a0041f0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041f0 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++abe_24m_fclk: abe_24m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <8>;
++};
++
++abe_clk: abe_clk@4a004108 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      reg = <0x4a004108 0x4>;
++      bit-mask = <0x3>;
++      index-power-of-two;
++};
++
++abe_iclk: abe_iclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&abe_clk>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++abe_lp_clk_div: abe_lp_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++dpll_abe_m3x2_ck: dpll_abe_m3x2_ck@4a0041f4 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_abe_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041f4 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_ck: dpll_core_ck@4a004120 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-core-clock";
++      clocks = <&sys_clkin>, <&dpll_abe_m3x2_ck>;
++      reg = <0x4a004120 0x4>, <0x4a004124 0x4>, <0x4a004128 0x4>, <0x4a00412c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_core_x2_ck: dpll_core_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_core_ck>;
++};
++
++dpll_core_h21x2_ck: dpll_core_h21x2_ck@4a004150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004150 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++c2c_fclk: c2c_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h21x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++c2c_iclk: c2c_iclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&c2c_fclk>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++custefuse_sys_gfclk_div: custefuse_sys_gfclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_core_h11x2_ck: dpll_core_h11x2_ck@4a004138 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004138 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h12x2_ck: dpll_core_h12x2_ck@4a00413c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00413c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h13x2_ck: dpll_core_h13x2_ck@4a004140 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004140 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h14x2_ck: dpll_core_h14x2_ck@4a004144 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004144 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h22x2_ck: dpll_core_h22x2_ck@4a004154 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004154 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h23x2_ck: dpll_core_h23x2_ck@4a004158 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004158 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_h24x2_ck: dpll_core_h24x2_ck@4a00415c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00415c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_m2_ck: dpll_core_m2_ck@4a004130 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004130 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_core_m3x2_ck: dpll_core_m3x2_ck@4a004134 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_core_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004134 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++iva_dpll_hs_clk_div: iva_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_iva_ck: dpll_iva_ck@4a0041a0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin>, <&iva_dpll_hs_clk_div>;
++      reg = <0x4a0041a0 0x4>, <0x4a0041a4 0x4>, <0x4a0041a8 0x4>, <0x4a0041ac 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_iva_x2_ck: dpll_iva_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_iva_ck>;
++};
++
++dpll_iva_h11x2_ck: dpll_iva_h11x2_ck@4a0041b8 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_iva_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041b8 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_iva_h12x2_ck: dpll_iva_h12x2_ck@4a0041bc {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_iva_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0041bc 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++mpu_dpll_hs_clk_div: mpu_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_mpu_ck: dpll_mpu_ck@4a004160 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin>, <&mpu_dpll_hs_clk_div>;
++      reg = <0x4a004160 0x4>, <0x4a004164 0x4>, <0x4a004168 0x4>, <0x4a00416c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_mpu_m2_ck: dpll_mpu_m2_ck@4a004170 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_mpu_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a004170 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++per_dpll_hs_clk_div: per_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++dpll_per_ck: dpll_per_ck@4a008140 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin>, <&per_dpll_hs_clk_div>;
++      reg = <0x4a008140 0x4>, <0x4a008144 0x4>, <0x4a008148 0x4>, <0x4a00814c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_per_x2_ck: dpll_per_x2_ck {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-x2-clock";
++      clocks = <&dpll_per_ck>;
++};
++
++dpll_per_h11x2_ck: dpll_per_h11x2_ck@4a008158 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008158 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_h12x2_ck: dpll_per_h12x2_ck@4a00815c {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a00815c 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_h14x2_ck: dpll_per_h14x2_ck@4a008164 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008164 0x4>;
++      bit-mask = <0x3f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m2_ck: dpll_per_m2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m2x2_ck: dpll_per_m2x2_ck@4a008150 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008150 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_per_m3x2_ck: dpll_per_m3x2_ck@4a008154 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_per_x2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008154 0x4>;
++      bit-mask = <0x1f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_unipro1_ck: dpll_unipro1_ck@4a008200 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin>, <&sys_clkin>;
++      reg = <0x4a008200 0x4>, <0x4a008204 0x4>, <0x4a008208 0x4>, <0x4a00820c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_unipro1_clkdcoldo: dpll_unipro1_clkdcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_unipro1_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_unipro1_m2_ck: dpll_unipro1_m2_ck@4a008210 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_unipro1_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008210 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dpll_unipro2_ck: dpll_unipro2_ck@4a0081c0 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-clock";
++      clocks = <&sys_clkin>, <&sys_clkin>;
++      reg = <0x4a0081c0 0x4>, <0x4a0081c4 0x4>, <0x4a0081c8 0x4>, <0x4a0081cc 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_unipro2_clkdcoldo: dpll_unipro2_clkdcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_unipro2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_unipro2_m2_ck: dpll_unipro2_m2_ck@4a0081d0 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_unipro2_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a0081d0 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++usb_dpll_hs_clk_div: usb_dpll_hs_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_abe_m3x2_ck>;
++      clock-mult = <1>;
++      clock-div = <3>;
++};
++
++dpll_usb_ck: dpll_usb_ck@4a008180 {
++      #clock-cells = <0>;
++      compatible = "ti,omap4-dpll-j-type-clock";
++      clocks = <&sys_clkin>, <&usb_dpll_hs_clk_div>;
++      reg = <0x4a008180 0x4>, <0x4a008184 0x4>, <0x4a008188 0x4>, <0x4a00818c 0x4>;
++      reg-names = "control", "idlest", "autoidle", "mult-div1";
++};
++
++dpll_usb_clkdcoldo: dpll_usb_clkdcoldo {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_usb_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dpll_usb_m2_ck: dpll_usb_m2_ck@4a008190 {
++      #clock-cells = <0>;
++      compatible = "ti,divider-clock";
++      clocks = <&dpll_usb_ck>;
++      ti,autoidle-shift = <8>;
++      reg = <0x4a008190 0x4>;
++      bit-mask = <0x7f>;
++      index-starts-at-one;
++      ti,autoidle-low;
++};
++
++dss_syc_gfclk_div: dss_syc_gfclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&sys_clkin>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++func_128m_clk: func_128m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_h11x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++func_12m_fclk: func_12m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <16>;
++};
++
++func_24m_clk: func_24m_clk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_48m_fclk: func_48m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <4>;
++};
++
++func_96m_fclk: func_96m_fclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      clock-mult = <1>;
++      clock-div = <2>;
++};
++
++l3_iclk_div: l3_iclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&dpll_core_h12x2_ck>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++gpu_l3_iclk: gpu_l3_iclk {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l3_iclk_div>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l3init_60m_fclk: l3init_60m_fclk@4a008104 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      reg = <0x4a008104 0x4>;
++      table = < 1 0 >, < 8 1 >;
++      bit-mask = <0x1>;
++};
++
++wkupaon_iclk_mux: wkupaon_iclk_mux@4ae06108 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&abe_lp_clk_div>;
++      reg = <0x4ae06108 0x4>;
++      bit-mask = <0x1>;
++};
++
++l3instr_ts_gclk_div: l3instr_ts_gclk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&wkupaon_iclk_mux>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++l4_root_clk_div: l4_root_clk_div {
++      #clock-cells = <0>;
++      compatible = "fixed-factor-clock";
++      clocks = <&l3_iclk_div>;
++      clock-mult = <1>;
++      clock-div = <1>;
++};
++
++dss_32khz_clk: dss_32khz_clk@4a009420 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <11>;
++      reg = <0x4a009420 0x4>;
++};
++
++dss_48mhz_clk: dss_48mhz_clk@4a009420 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_48m_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009420 0x4>;
++};
++
++dss_dss_clk: dss_dss_clk@4a009420 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_per_h12x2_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009420 0x4>;
++};
++
++dss_sys_clk: dss_sys_clk@4a009420 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dss_syc_gfclk_div>;
++      bit-shift = <10>;
++      reg = <0x4a009420 0x4>;
++};
++
++gpio1_dbclk: gpio1_dbclk@4ae07938 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae07938 0x4>;
++};
++
++gpio2_dbclk: gpio2_dbclk@4a009060 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009060 0x4>;
++};
++
++gpio3_dbclk: gpio3_dbclk@4a009068 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009068 0x4>;
++};
++
++gpio4_dbclk: gpio4_dbclk@4a009070 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009070 0x4>;
++};
++
++gpio5_dbclk: gpio5_dbclk@4a009078 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009078 0x4>;
++};
++
++gpio6_dbclk: gpio6_dbclk@4a009080 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009080 0x4>;
++};
++
++gpio7_dbclk: gpio7_dbclk@4a009110 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009110 0x4>;
++};
++
++gpio8_dbclk: gpio8_dbclk@4a009118 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009118 0x4>;
++};
++
++iss_ctrlclk: iss_ctrlclk@4a009320 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&func_96m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a009320 0x4>;
++};
++
++lli_txphy_clk: lli_txphy_clk@4a008f20 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_unipro1_clkdcoldo>;
++      bit-shift = <8>;
++      reg = <0x4a008f20 0x4>;
++};
++
++lli_txphy_ls_clk: lli_txphy_ls_clk@4a008f20 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_unipro1_m2_ck>;
++      bit-shift = <9>;
++      reg = <0x4a008f20 0x4>;
++};
++
++mmc1_32khz_clk: mmc1_32khz_clk@4a009628 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a009628 0x4>;
++};
++
++sata_ref_clk: sata_ref_clk@4a009688 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_clkin>;
++      bit-shift = <8>;
++      reg = <0x4a009688 0x4>;
++};
++
++slimbus1_slimbus_clk: slimbus1_slimbus_clk@4a004560 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&slimbus_clk>;
++      bit-shift = <11>;
++      reg = <0x4a004560 0x4>;
++};
++
++usb_host_hs_hsic480m_p1_clk: usb_host_hs_hsic480m_p1_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      bit-shift = <13>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_hsic480m_p2_clk: usb_host_hs_hsic480m_p2_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      bit-shift = <14>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_hsic480m_p3_clk: usb_host_hs_hsic480m_p3_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_m2_ck>;
++      bit-shift = <7>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_hsic60m_p1_clk: usb_host_hs_hsic60m_p1_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <11>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_hsic60m_p2_clk: usb_host_hs_hsic60m_p2_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <12>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_hsic60m_p3_clk: usb_host_hs_hsic60m_p3_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <6>;
++      reg = <0x4a009658 0x4>;
++};
++
++utmi_p1_gfclk: utmi_p1_gfclk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3init_60m_fclk>, <&xclk60mhsp1_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009658 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_host_hs_utmi_p1_clk: usb_host_hs_utmi_p1_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&utmi_p1_gfclk>;
++      bit-shift = <8>;
++      reg = <0x4a009658 0x4>;
++};
++
++utmi_p2_gfclk: utmi_p2_gfclk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&l3init_60m_fclk>, <&xclk60mhsp2_ck>;
++      bit-shift = <25>;
++      reg = <0x4a009658 0x4>;
++      bit-mask = <0x1>;
++};
++
++usb_host_hs_utmi_p2_clk: usb_host_hs_utmi_p2_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&utmi_p2_gfclk>;
++      bit-shift = <9>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_host_hs_utmi_p3_clk: usb_host_hs_utmi_p3_clk@4a009658 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <10>;
++      reg = <0x4a009658 0x4>;
++};
++
++usb_otg_ss_refclk960m: usb_otg_ss_refclk960m@4a0096f0 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&dpll_usb_clkdcoldo>;
++      bit-shift = <8>;
++      reg = <0x4a0096f0 0x4>;
++};
++
++usb_phy_cm_clk32k: usb_phy_cm_clk32k@4a008640 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&sys_32k_ck>;
++      bit-shift = <8>;
++      reg = <0x4a008640 0x4>;
++};
++
++usb_tll_hs_usb_ch0_clk: usb_tll_hs_usb_ch0_clk@4a009668 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <8>;
++      reg = <0x4a009668 0x4>;
++};
++
++usb_tll_hs_usb_ch1_clk: usb_tll_hs_usb_ch1_clk@4a009668 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <9>;
++      reg = <0x4a009668 0x4>;
++};
++
++usb_tll_hs_usb_ch2_clk: usb_tll_hs_usb_ch2_clk@4a009668 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&l3init_60m_fclk>;
++      bit-shift = <10>;
++      reg = <0x4a009668 0x4>;
++};
++
++aess_fclk: aess_fclk@4a004528 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&abe_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004528 0x4>;
++      bit-mask = <0x1>;
++};
++
++dmic_sync_mux_ck: dmic_sync_mux_ck@4a004538 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&dss_syc_gfclk_div>, <&func_24m_clk>;
++      bit-shift = <26>;
++      reg = <0x4a004538 0x4>;
++      bit-mask = <0x3>;
++};
++
++dmic_gfclk: dmic_gfclk@4a004538 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dmic_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004538 0x4>;
++      bit-mask = <0x3>;
++};
++
++fdif_fclk: fdif_fclk@4a009328 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_h11x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009328 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpu_core_gclk_mux: gpu_core_gclk_mux@4a009520 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_h14x2_ck>, <&dpll_per_h14x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009520 0x4>;
++      bit-mask = <0x1>;
++};
++
++gpu_hyd_gclk_mux: gpu_hyd_gclk_mux@4a009520 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dpll_core_h14x2_ck>, <&dpll_per_h14x2_ck>;
++      bit-shift = <25>;
++      reg = <0x4a009520 0x4>;
++      bit-mask = <0x1>;
++};
++
++hsi_fclk: hsi_fclk@4a009638 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009638 0x4>;
++      bit-mask = <0x1>;
++};
++
++mcasp_sync_mux_ck: mcasp_sync_mux_ck@4a004540 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&dss_syc_gfclk_div>, <&func_24m_clk>;
++      bit-shift = <26>;
++      reg = <0x4a004540 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcasp_gfclk: mcasp_gfclk@4a004540 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcasp_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004540 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp1_sync_mux_ck: mcbsp1_sync_mux_ck@4a004548 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&dss_syc_gfclk_div>, <&func_24m_clk>;
++      bit-shift = <26>;
++      reg = <0x4a004548 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp1_gfclk: mcbsp1_gfclk@4a004548 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp1_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004548 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp2_sync_mux_ck: mcbsp2_sync_mux_ck@4a004550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&dss_syc_gfclk_div>, <&func_24m_clk>;
++      bit-shift = <26>;
++      reg = <0x4a004550 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp2_gfclk: mcbsp2_gfclk@4a004550 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp2_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004550 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp3_sync_mux_ck: mcbsp3_sync_mux_ck@4a004558 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&abe_24m_fclk>, <&dss_syc_gfclk_div>, <&func_24m_clk>;
++      bit-shift = <26>;
++      reg = <0x4a004558 0x4>;
++      bit-mask = <0x3>;
++};
++
++mcbsp3_gfclk: mcbsp3_gfclk@4a004558 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&mcbsp3_sync_mux_ck>, <&pad_clks_ck>, <&slimbus_clk>;
++      bit-shift = <24>;
++      reg = <0x4a004558 0x4>;
++      bit-mask = <0x3>;
++};
++
++mmc1_fclk_mux: mmc1_fclk_mux@4a009628 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_128m_clk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009628 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc1_fclk: mmc1_fclk@4a009628 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc1_fclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009628 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc2_fclk_mux: mmc2_fclk_mux@4a009630 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&func_128m_clk>, <&dpll_per_m2x2_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009630 0x4>;
++      bit-mask = <0x1>;
++};
++
++mmc2_fclk: mmc2_fclk@4a009630 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&mmc2_fclk_mux>;
++      bit-shift = <25>;
++      reg = <0x4a009630 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer10_gfclk_mux: timer10_gfclk_mux@4a009028 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009028 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer11_gfclk_mux: timer11_gfclk_mux@4a009030 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009030 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer1_gfclk_mux: timer1_gfclk_mux@4ae07940 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4ae07940 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer2_gfclk_mux: timer2_gfclk_mux@4a009038 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009038 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer3_gfclk_mux: timer3_gfclk_mux@4a009040 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009040 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer4_gfclk_mux: timer4_gfclk_mux@4a009048 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009048 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer5_gfclk_mux: timer5_gfclk_mux@4a004568 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dss_syc_gfclk_div>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004568 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer6_gfclk_mux: timer6_gfclk_mux@4a004570 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dss_syc_gfclk_div>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004570 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer7_gfclk_mux: timer7_gfclk_mux@4a004578 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dss_syc_gfclk_div>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004578 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer8_gfclk_mux: timer8_gfclk_mux@4a004580 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&dss_syc_gfclk_div>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a004580 0x4>;
++      bit-mask = <0x1>;
++};
++
++timer9_gfclk_mux: timer9_gfclk_mux@4a009050 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&sys_32k_ck>;
++      bit-shift = <24>;
++      reg = <0x4a009050 0x4>;
++      bit-mask = <0x1>;
++};
++
++auxclk0_src_mux_ck: auxclk0_src_mux_ck@4ae0a310 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4ae0a310 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk0_src_ck: auxclk0_src_ck@4ae0a310 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk0_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae0a310 0x4>;
++};
++
++auxclk0_ck: auxclk0_ck@4ae0a310 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk0_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4ae0a310 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk1_src_mux_ck: auxclk1_src_mux_ck@4ae0a314 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4ae0a314 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk1_src_ck: auxclk1_src_ck@4ae0a314 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk1_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae0a314 0x4>;
++};
++
++auxclk1_ck: auxclk1_ck@4ae0a314 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk1_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4ae0a314 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk2_src_mux_ck: auxclk2_src_mux_ck@4ae0a318 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4ae0a318 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk2_src_ck: auxclk2_src_ck@4ae0a318 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk2_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae0a318 0x4>;
++};
++
++auxclk2_ck: auxclk2_ck@4ae0a318 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk2_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4ae0a318 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk3_src_mux_ck: auxclk3_src_mux_ck@4ae0a31c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4ae0a31c 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk3_src_ck: auxclk3_src_ck@4ae0a31c {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk3_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae0a31c 0x4>;
++};
++
++auxclk3_ck: auxclk3_ck@4ae0a31c {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk3_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4ae0a31c 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclk4_src_mux_ck: auxclk4_src_mux_ck@4ae0a320 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&sys_clkin>, <&dpll_core_m3x2_ck>, <&dpll_per_m3x2_ck>;
++      bit-shift = <1>;
++      reg = <0x4ae0a320 0x4>;
++      bit-mask = <0x3>;
++};
++
++auxclk4_src_ck: auxclk4_src_ck@4ae0a320 {
++      #clock-cells = <0>;
++      compatible = "gate-clock";
++      clocks = <&auxclk4_src_mux_ck>;
++      bit-shift = <8>;
++      reg = <0x4ae0a320 0x4>;
++};
++
++auxclk4_ck: auxclk4_ck@4ae0a320 {
++      #clock-cells = <0>;
++      compatible = "divider-clock";
++      clocks = <&auxclk4_src_ck>;
++      bit-shift = <16>;
++      reg = <0x4ae0a320 0x4>;
++      bit-mask = <0xf>;
++};
++
++auxclkreq0_ck: auxclkreq0_ck@4ae0a210 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>;
++      bit-shift = <2>;
++      reg = <0x4ae0a210 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq1_ck: auxclkreq1_ck@4ae0a214 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>;
++      bit-shift = <2>;
++      reg = <0x4ae0a214 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq2_ck: auxclkreq2_ck@4ae0a218 {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>;
++      bit-shift = <2>;
++      reg = <0x4ae0a218 0x4>;
++      bit-mask = <0x7>;
++};
++
++auxclkreq3_ck: auxclkreq3_ck@4ae0a21c {
++      #clock-cells = <0>;
++      compatible = "mux-clock";
++      clocks = <&auxclk0_ck>, <&auxclk1_ck>, <&auxclk2_ck>, <&auxclk3_ck>, <&auxclk4_ck>;
++      bit-shift = <2>;
++      reg = <0x4ae0a21c 0x4>;
++      bit-mask = <0x7>;
++};
+--- a/arch/arm/boot/dts/omap5.dtsi
++++ b/arch/arm/boot/dts/omap5.dtsi
+@@ -21,6 +21,11 @@
+       interrupt-parent = <&gic>;
+       aliases {
++              i2c0 = &i2c1;
++              i2c1 = &i2c2;
++              i2c2 = &i2c3;
++              i2c3 = &i2c4;
++              i2c4 = &i2c5;
+               serial0 = &uart1;
+               serial1 = &uart2;
+               serial2 = &uart3;
+@@ -33,10 +38,23 @@
+               #address-cells = <1>;
+               #size-cells = <0>;
+-              cpu@0 {
++              cpu0: cpu@0 {
+                       device_type = "cpu";
+                       compatible = "arm,cortex-a15";
+                       reg = <0x0>;
++
++                      operating-points = <
++                              /* kHz    uV */
++                              500000  880000
++                              1000000 1060000
++                              1500000 1250000
++                      >;
++
++                      clocks = <&dpll_mpu_ck>;
++                      clock-names = "cpu";
++
++                      clock-latency = <300000>; /* From omap-cpufreq driver */
++
+               };
+               cpu@1 {
+                       device_type = "cpu";
+@@ -52,7 +70,6 @@
+                            <GIC_PPI 14 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>,
+                            <GIC_PPI 11 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>,
+                            <GIC_PPI 10 (GIC_CPU_MASK_RAW(3) | IRQ_TYPE_LEVEL_LOW)>;
+-              clock-frequency = <6144000>;
+       };
+       gic: interrupt-controller@48211000 {
+@@ -100,6 +117,8 @@
+                       compatible = "ti,omap-counter32k";
+                       reg = <0x4ae04000 0x40>;
+                       ti,hwmods = "counter_32k";
++                      clocks = <&wkupaon_iclk_mux>;
++                      clock-names = "fck";
+               };
+               omap5_pmx_core: pinmux@4a002840 {
+@@ -129,6 +148,8 @@
+                       #dma-cells = <1>;
+                       #dma-channels = <32>;
+                       #dma-requests = <127>;
++                      clocks = <&l3_iclk_div>;
++                      clock-names = "fck";
+               };
+               gpio1: gpio@4ae10000 {
+@@ -136,6 +157,8 @@
+                       reg = <0x4ae10000 0x200>;
+                       interrupts = <GIC_SPI 29 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio1";
++                      clocks = <&wkupaon_iclk_mux>, <&gpio1_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       ti,gpio-always-on;
+                       gpio-controller;
+                       #gpio-cells = <2>;
+@@ -148,6 +171,8 @@
+                       reg = <0x48055000 0x200>;
+                       interrupts = <GIC_SPI 30 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio2";
++                      clocks = <&l4_root_clk_div>, <&gpio2_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -159,6 +184,8 @@
+                       reg = <0x48057000 0x200>;
+                       interrupts = <GIC_SPI 31 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio3";
++                      clocks = <&l4_root_clk_div>, <&gpio3_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -170,6 +197,8 @@
+                       reg = <0x48059000 0x200>;
+                       interrupts = <GIC_SPI 32 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio4";
++                      clocks = <&l4_root_clk_div>, <&gpio4_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -181,6 +210,8 @@
+                       reg = <0x4805b000 0x200>;
+                       interrupts = <GIC_SPI 33 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio5";
++                      clocks = <&l4_root_clk_div>, <&gpio5_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -192,6 +223,8 @@
+                       reg = <0x4805d000 0x200>;
+                       interrupts = <GIC_SPI 34 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio6";
++                      clocks = <&l4_root_clk_div>, <&gpio6_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -203,6 +236,8 @@
+                       reg = <0x48051000 0x200>;
+                       interrupts = <GIC_SPI 35 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio7";
++                      clocks = <&l4_root_clk_div>, <&gpio7_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -214,6 +249,8 @@
+                       reg = <0x48053000 0x200>;
+                       interrupts = <GIC_SPI 121 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "gpio8";
++                      clocks = <&l4_root_clk_div>, <&gpio8_dbclk>;
++                      clock-names = "fck", "dbclk";
+                       gpio-controller;
+                       #gpio-cells = <2>;
+                       interrupt-controller;
+@@ -238,6 +275,9 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c1";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               i2c2: i2c@48072000 {
+@@ -247,6 +287,9 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c2";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               i2c3: i2c@48060000 {
+@@ -256,6 +299,9 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c3";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               i2c4: i2c@4807a000 {
+@@ -265,6 +311,9 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c4";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               i2c5: i2c@4807c000 {
+@@ -274,6 +323,9 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "i2c5";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
++                      status = "disabled";
+               };
+               mcspi1: spi@48098000 {
+@@ -283,6 +335,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi1";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <4>;
+                       dmas = <&sdma 35>,
+                              <&sdma 36>,
+@@ -294,6 +348,7 @@
+                              <&sdma 42>;
+                       dma-names = "tx0", "rx0", "tx1", "rx1",
+                                   "tx2", "rx2", "tx3", "rx3";
++                      status = "disabled";
+               };
+               mcspi2: spi@4809a000 {
+@@ -303,12 +358,15 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi2";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 43>,
+                              <&sdma 44>,
+                              <&sdma 45>,
+                              <&sdma 46>;
+                       dma-names = "tx0", "rx0", "tx1", "rx1";
++                      status = "disabled";
+               };
+               mcspi3: spi@480b8000 {
+@@ -318,9 +376,12 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <2>;
+                       dmas = <&sdma 15>, <&sdma 16>;
+                       dma-names = "tx0", "rx0";
++                      status = "disabled";
+               };
+               mcspi4: spi@480ba000 {
+@@ -330,9 +391,12 @@
+                       #address-cells = <1>;
+                       #size-cells = <0>;
+                       ti,hwmods = "mcspi4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,spi-num-cs = <1>;
+                       dmas = <&sdma 70>, <&sdma 71>;
+                       dma-names = "tx0", "rx0";
++                      status = "disabled";
+               };
+               uart1: serial@4806a000 {
+@@ -340,7 +404,10 @@
+                       reg = <0x4806a000 0x100>;
+                       interrupts = <GIC_SPI 72 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart1";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                      status = "disabled";
+               };
+               uart2: serial@4806c000 {
+@@ -348,7 +415,10 @@
+                       reg = <0x4806c000 0x100>;
+                       interrupts = <GIC_SPI 73 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart2";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                        status = "disabled";
+               };
+               uart3: serial@48020000 {
+@@ -356,7 +426,10 @@
+                       reg = <0x48020000 0x100>;
+                       interrupts = <GIC_SPI 74 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                        status = "disabled";
+               };
+               uart4: serial@4806e000 {
+@@ -364,7 +437,10 @@
+                       reg = <0x4806e000 0x100>;
+                       interrupts = <GIC_SPI 70 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                      status = "disabled";
+               };
+               uart5: serial@48066000 {
+@@ -372,7 +448,10 @@
+                       reg = <0x48066000 0x100>;
+                       interrupts = <GIC_SPI 105 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart5";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                      status = "disabled";
+               };
+               uart6: serial@48068000 {
+@@ -380,7 +459,10 @@
+                       reg = <0x48068000 0x100>;
+                       interrupts = <GIC_SPI 106 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "uart6";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       clock-frequency = <48000000>;
++                      status = "disabled";
+               };
+               mmc1: mmc@4809c000 {
+@@ -388,6 +470,8 @@
+                       reg = <0x4809c000 0x400>;
+                       interrupts = <GIC_SPI 83 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc1";
++                      clocks = <&mmc1_fclk>, <&mmc1_32khz_clk>;
++                      clock-names = "fck", "32khz_clk";
+                       ti,dual-volt;
+                       ti,needs-special-reset;
+                       dmas = <&sdma 61>, <&sdma 62>;
+@@ -399,6 +483,8 @@
+                       reg = <0x480b4000 0x400>;
+                       interrupts = <GIC_SPI 86 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc2";
++                      clocks = <&mmc2_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 47>, <&sdma 48>;
+                       dma-names = "tx", "rx";
+@@ -409,6 +495,8 @@
+                       reg = <0x480ad000 0x400>;
+                       interrupts = <GIC_SPI 94 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc3";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 77>, <&sdma 78>;
+                       dma-names = "tx", "rx";
+@@ -419,6 +507,8 @@
+                       reg = <0x480d1000 0x400>;
+                       interrupts = <GIC_SPI 96 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc4";
++                      clocks = <&func_48m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 57>, <&sdma 58>;
+                       dma-names = "tx", "rx";
+@@ -429,15 +519,63 @@
+                       reg = <0x480d5000 0x400>;
+                       interrupts = <GIC_SPI 59 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mmc5";
++                      clocks = <&func_96m_fclk>;
++                      clock-names = "fck";
+                       ti,needs-special-reset;
+                       dmas = <&sdma 59>, <&sdma 60>;
+                       dma-names = "tx", "rx";
+               };
++              omap_control_sata: control-phy@4a002374 {
++                      compatible = "ti,control-phy-pipe3";
++                      reg = <0x4a002374 0x4>;
++                      reg-names = "power";
++                      clocks = <&sys_clkin>;
++                      clock-names = "sysclk";
++              };
++
++              ocp2scp@4a090000 {
++                      compatible = "ti,omap-ocp2scp";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      ti,hwmods = "ocp2scp3";
++                      reg = <0x4a090000 0x1c>;        /* ocp2scp3 */
++                      sata_phy: sata-phy@4A096000 {
++                              compatible = "ti,phy-pipe3-sata";
++                              reg = <0x4A096000 0x80>, /* phy_rx */
++                                    <0x4A096400 0x64>, /* phy_tx */
++                                    <0x4A096800 0x40>; /* pll_ctrl */
++                              reg-names = "phy_rx", "phy_tx", "pll_ctrl";
++                              ctrl-module = <&omap_control_sata>;
++                              #phy-cells = <0>;
++                              clocks = <&sata_ref_clk>;
++                              clock-names = "refclk";
++                      };
++              };
++
++              sata@4a141100 {
++                      compatible = "ti,sata";
++                      ti,hwmods = "sata";
++                      reg = <0x4a141100 0x100>;
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++                      sata@4a140000 {
++                                compatible = "snps,dwc-ahci";
++                                reg = <0x4a140000 0x1100>;
++                                interrupts = <GIC_SPI 54 IRQ_TYPE_LEVEL_HIGH>;
++                                phys = <&sata_phy>;
++                                phy-names = "sata-phy";
++                      };
++              };
++
+               keypad: keypad@4ae1c000 {
+                       compatible = "ti,omap4-keypad";
+                       reg = <0x4ae1c000 0x400>;
+                       ti,hwmods = "kbd";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
+               };
+               mcpdm: mcpdm@40132000 {
+@@ -447,6 +585,8 @@
+                       reg-names = "mpu", "dma";
+                       interrupts = <GIC_SPI 112 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "mcpdm";
++                      clocks = <&pad_clks_ck>;
++                      clock-names = "fck";
+                       dmas = <&sdma 65>,
+                              <&sdma 66>;
+                       dma-names = "up_link", "dn_link";
+@@ -459,6 +599,8 @@
+                       reg-names = "mpu", "dma";
+                       interrupts = <GIC_SPI 114 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "dmic";
++                      clocks = <&dmic_gfclk>;
++                      clock-names = "fck";
+                       dmas = <&sdma 67>;
+                       dma-names = "up_link";
+               };
+@@ -472,6 +614,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp1";
++                      clocks = <&mcbsp1_gfclk>, <&pad_clks_ck>, <&mcbsp1_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 33>,
+                              <&sdma 34>;
+                       dma-names = "tx", "rx";
+@@ -486,6 +630,8 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp2";
++                      clocks = <&mcbsp2_gfclk>, <&pad_clks_ck>, <&mcbsp2_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 17>,
+                              <&sdma 18>;
+                       dma-names = "tx", "rx";
+@@ -500,16 +646,31 @@
+                       interrupt-names = "common";
+                       ti,buffer-size = <128>;
+                       ti,hwmods = "mcbsp3";
++                      clocks = <&mcbsp3_gfclk>, <&pad_clks_ck>, <&mcbsp3_sync_mux_ck>;
++                      clock-names = "fck", "pad_fck", "prcm_fck";
+                       dmas = <&sdma 19>,
+                              <&sdma 20>;
+                       dma-names = "tx", "rx";
+               };
++              mailbox: mailbox@4a0f4000 {
++                      compatible = "ti,omap4-mailbox";
++                      reg = <0x4a0f4000 0x200>;
++                      interrupts = <GIC_SPI 26 IRQ_TYPE_LEVEL_HIGH>;
++                      ti,hwmods = "mailbox";
++                      ti,mbox-num-users = <3>;
++                      ti,mbox-num-fifos = <8>;
++                      ti,mbox-names = "mbox-ipu", "mbox-dsp";
++                      ti,mbox-data = <0 1 0 0>, <3 2 0 0>;
++              };
++
+               timer1: timer@4ae18000 {
+                       compatible = "ti,omap5430-timer";
+                       reg = <0x4ae18000 0x80>;
+                       interrupts = <GIC_SPI 37 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer1";
++                      clocks = <&timer1_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-alwon;
+               };
+@@ -518,6 +679,8 @@
+                       reg = <0x48032000 0x80>;
+                       interrupts = <GIC_SPI 38 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer2";
++                      clocks = <&timer2_gfclk_mux>;
++                      clock-names = "fck";
+               };
+               timer3: timer@48034000 {
+@@ -525,6 +688,8 @@
+                       reg = <0x48034000 0x80>;
+                       interrupts = <GIC_SPI 39 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer3";
++                      clocks = <&timer3_gfclk_mux>;
++                      clock-names = "fck";
+               };
+               timer4: timer@48036000 {
+@@ -532,6 +697,8 @@
+                       reg = <0x48036000 0x80>;
+                       interrupts = <GIC_SPI 40 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer4";
++                      clocks = <&timer4_gfclk_mux>;
++                      clock-names = "fck";
+               };
+               timer5: timer@40138000 {
+@@ -540,6 +707,8 @@
+                             <0x49038000 0x80>;
+                       interrupts = <GIC_SPI 41 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer5";
++                      clocks = <&timer5_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+                       ti,timer-pwm;
+               };
+@@ -550,6 +719,8 @@
+                             <0x4903a000 0x80>;
+                       interrupts = <GIC_SPI 42 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer6";
++                      clocks = <&timer6_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+                       ti,timer-pwm;
+               };
+@@ -560,6 +731,8 @@
+                             <0x4903c000 0x80>;
+                       interrupts = <GIC_SPI 43 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer7";
++                      clocks = <&timer7_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+               };
+@@ -569,6 +742,8 @@
+                             <0x4903e000 0x80>;
+                       interrupts = <GIC_SPI 44 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer8";
++                      clocks = <&timer8_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-dsp;
+                       ti,timer-pwm;
+               };
+@@ -578,6 +753,8 @@
+                       reg = <0x4803e000 0x80>;
+                       interrupts = <GIC_SPI 45 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer9";
++                      clocks = <&timer9_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -586,6 +763,8 @@
+                       reg = <0x48086000 0x80>;
+                       interrupts = <GIC_SPI 46 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer10";
++                      clocks = <&timer10_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+@@ -594,19 +773,33 @@
+                       reg = <0x48088000 0x80>;
+                       interrupts = <GIC_SPI 47 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "timer11";
++                      clocks = <&timer11_gfclk_mux>;
++                      clock-names = "fck";
+                       ti,timer-pwm;
+               };
+               wdt2: wdt@4ae14000 {
+-                      compatible = "ti,omap5-wdt", "ti,omap3-wdt";
++                      compatible = "ti,omap5-wdt", "ti,omap4-wdt";
+                       reg = <0x4ae14000 0x80>;
+                       interrupts = <GIC_SPI 80 IRQ_TYPE_LEVEL_HIGH>;
+                       ti,hwmods = "wd_timer2";
++                      clocks = <&sys_32k_ck>;
++                      clock-names = "fck";
++              };
++
++              dmm: dmm@4e000000 {
++                      compatible = "ti,omap5-dmm";
++                      reg = <0x4e000000 0x800>;
++                      interrupts = <0 113 0x4>;
++                      ti,hwmods = "dmm";
+               };
+               emif1: emif@0x4c000000 {
+                       compatible      = "ti,emif-4d5";
+                       ti,hwmods       = "emif1";
++                      ti,no-idle;
++                      clocks = <&dpll_core_h11x2_ck>;
++                      clock-names = "fck";
+                       phy-type        = <2>; /* DDR PHY type: Intelli PHY */
+                       reg = <0x4c000000 0x400>;
+                       interrupts = <GIC_SPI 110 IRQ_TYPE_LEVEL_HIGH>;
+@@ -618,6 +811,9 @@
+               emif2: emif@0x4d000000 {
+                       compatible      = "ti,emif-4d5";
+                       ti,hwmods       = "emif2";
++                      ti,no-idle;
++                      clocks = <&dpll_core_h11x2_ck>;
++                      clock-names = "fck";
+                       phy-type        = <2>; /* DDR PHY type: Intelli PHY */
+                       reg = <0x4d000000 0x400>;
+                       interrupts = <GIC_SPI 111 IRQ_TYPE_LEVEL_HIGH>;
+@@ -626,18 +822,25 @@
+                       hw-caps-temp-alert;
+               };
+-              omap_control_usb: omap-control-usb@4a002300 {
+-                      compatible = "ti,omap-control-usb";
+-                      reg = <0x4a002300 0x4>,
+-                            <0x4a002370 0x4>;
+-                      reg-names = "control_dev_conf", "phy_power_usb";
+-                      ti,type = <2>;
++              omap_control_usb2phy: control-phy@4a002300 {
++                      compatible = "ti,control-phy-usb2";
++                      reg = <0x4a002300 0x4>;
++                      reg-names = "power";
++              };
++
++              omap_control_usb3phy: control-phy@4a002370 {
++                      compatible = "ti,control-phy-pipe3";
++                      reg = <0x4a002370 0x4>;
++                      reg-names = "power";
+               };
+-              omap_dwc3@4a020000 {
++              usb3: omap_dwc3@4a020000 {
+                       compatible = "ti,dwc3";
+                       ti,hwmods = "usb_otg_ss";
++                      clocks = <&dpll_core_h13x2_ck>, <&usb_otg_ss_refclk960m>;
++                      clock-names = "fck", "refclk960m";
+                       reg = <0x4a020000 0x10000>;
++
+                       interrupts = <GIC_SPI 93 IRQ_TYPE_LEVEL_HIGH>;
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+@@ -647,7 +850,10 @@
+                               compatible = "snps,dwc3";
+                               reg = <0x4a030000 0x10000>;
+                               interrupts = <GIC_SPI 92 IRQ_TYPE_LEVEL_HIGH>;
+-                              usb-phy = <&usb2_phy>, <&usb3_phy>;
++                              phys = <&usb2_phy>, <&usb3_phy>;
++                              phy-names = "usb2-phy", "usb3-phy";
++                              maximum-speed = "super-speed";
++                              dr_mode = "peripheral";
+                               tx-fifo-resize;
+                       };
+               };
+@@ -662,16 +868,26 @@
+                       usb2_phy: usb2phy@4a084000 {
+                               compatible = "ti,omap-usb2";
+                               reg = <0x4a084000 0x7c>;
+-                              ctrl-module = <&omap_control_usb>;
++                              ctrl-module = <&omap_control_usb2phy>;
++                              clocks = <&usb_phy_cm_clk32k>, <&usb_otg_ss_refclk960m>;
++                              clock-names = "wkupclk", "refclk";
++                              #phy-cells = <0>;
+                       };
+                       usb3_phy: usb3phy@4a084400 {
+-                              compatible = "ti,omap-usb3";
++                              compatible = "ti,phy-pipe3-usb3";
+                               reg = <0x4a084400 0x80>,
+                                     <0x4a084800 0x64>,
+                                     <0x4a084c00 0x40>;
+                               reg-names = "phy_rx", "phy_tx", "pll_ctrl";
+-                              ctrl-module = <&omap_control_usb>;
++                              ctrl-module = <&omap_control_usb3phy>;
++                              clocks = <&usb_phy_cm_clk32k>,
++                                       <&usb_otg_ss_refclk960m>,
++                                       <&dpll_core_h13x2_ck>;
++                              clock-names =   "wkupclk",
++                                              "refclk",
++                                              "refclk2";
++                              #phy-cells = <0>;
+                       };
+               };
+@@ -689,6 +905,8 @@
+                       #address-cells = <1>;
+                       #size-cells = <1>;
+                       ranges;
++                      clocks = <&l3init_60m_fclk>;
++                      clock-names = "init_60m_fclk";
+                       usbhsohci: ohci@4a064800 {
+                               compatible = "ti,ohci-omap3", "usb-ohci";
+@@ -713,5 +931,71 @@
+                       interrupts = <GIC_SPI 126 IRQ_TYPE_LEVEL_HIGH>;
+                       compatible = "ti,omap5430-bandgap";
+               };
++
++              dss@58000000 {
++                      compatible = "ti,omap4-dss", "simple-bus";
++                      reg = <0x58000000 0x80>;
++                      ti,hwmods = "dss_core";
++                      #address-cells = <1>;
++                      #size-cells = <1>;
++                      ranges;
++
++                      dispc@58001000 {
++                              compatible = "ti,omap4-dispc";
++                              reg = <0x58001000 0x1000>;
++                              interrupts = <0 25 0x4>;
++                              ti,hwmods = "dss_dispc";
++                      };
++
++                      dpi: encoder@0 {
++                              compatible = "ti,omap4-dpi";
++                      };
++
++                      rfbi: encoder@58002000  {
++                              compatible = "ti,omap4-rfbi";
++                              reg = <0x58002000 0x1000>;
++                              ti,hwmods = "dss_rfbi";
++                      };
++
++                      dsi1: encoder@58004000 {
++                              compatible = "ti,omap4-dsi";
++                              reg = <0x58004000 0x200>;
++                              interrupts = <0 53 0x4>;
++                              ti,hwmods = "dss_dsi1";
++                      };
++
++                      dsi2: encoder@58005000 {
++                              compatible = "ti,omap4-dsi";
++                              reg = <0x58005000 0x200>;
++                              interrupts = <0 84 0x4>;
++                              ti,hwmods = "dss_dsi2";
++                      };
++
++                      hdmi: encoder@58060000 {
++                              compatible = "ti,omap5-hdmi";
++                              reg = <0x58040000 0x200>,
++                                    <0x58040200 0x100>,
++                                    <0x58040300 0x100>,
++                                    <0x58060000 0x19000>;
++                              reg-names = "hdmi_wp", "hdmi_pllctrl",
++                                          "hdmi_txphy", "hdmi_core";
++                              interrupts = <0 101 0x4>;
++                              ti,hwmods = "dss_hdmi";
++                      };
++              };
++      };
++
++      clocks {
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              /include/ "omap54xx-clocks.dtsi"
++      };
++
++      clockdomains {
++              l3init_clkdm: l3init_clkdm {
++                      compatible = "ti,clockdomain";
++                      clocks = <&dpll_usb_ck>;
++              };
+       };
+ };
+--- a/arch/arm/boot/dts/omap5-uevm.dts
++++ b/arch/arm/boot/dts/omap5-uevm.dts
+@@ -27,45 +27,19 @@
+               regulator-max-microvolt = <3000000>;
+       };
+-      /* HS USB Port 2 RESET */
+-      hsusb2_reset: hsusb2_reset_reg {
+-              compatible = "regulator-fixed";
+-              regulator-name = "hsusb2_reset";
+-              regulator-min-microvolt = <3300000>;
+-              regulator-max-microvolt = <3300000>;
+-              gpio = <&gpio3 16 GPIO_ACTIVE_HIGH>; /* gpio3_80 HUB_NRESET */
+-              startup-delay-us = <70000>;
+-              enable-active-high;
+-      };
+-
+       /* HS USB Host PHY on PORT 2 */
+       hsusb2_phy: hsusb2_phy {
+               compatible = "usb-nop-xceiv";
+-              reset-supply = <&hsusb2_reset>;
+-      /**
+-        * FIXME
+-        * Put the right clock phandle here when available
+-        *     clocks = <&auxclk1>;
+-        *     clock-names = "main_clk";
+-        */
++              reset-gpios = <&gpio3 16 GPIO_ACTIVE_LOW>; /* gpio3_80 HUB_NRESET */
++              clocks = <&auxclk1_ck>;
++              clock-names = "main_clk";
+               clock-frequency = <19200000>;
+       };
+-      /* HS USB Port 3 RESET */
+-      hsusb3_reset: hsusb3_reset_reg {
+-              compatible = "regulator-fixed";
+-              regulator-name = "hsusb3_reset";
+-              regulator-min-microvolt = <3300000>;
+-              regulator-max-microvolt = <3300000>;
+-              gpio = <&gpio3 15 GPIO_ACTIVE_HIGH>; /* gpio3_79 ETH_NRESET */
+-              startup-delay-us = <70000>;
+-              enable-active-high;
+-      };
+-
+       /* HS USB Host PHY on PORT 3 */
+       hsusb3_phy: hsusb3_phy {
+               compatible = "usb-nop-xceiv";
+-              reset-supply = <&hsusb3_reset>;
++              reset-gpios = <&gpio3 15 GPIO_ACTIVE_LOW>; /* gpio3_79 ETH_NRESET */
+       };
+       leds {
+@@ -77,6 +51,28 @@
+                       default-state = "off";
+               };
+       };
++
++      sound: sound {
++              compatible = "ti,abe-twl6040";
++              ti,model = "omap5-uevm";
++
++              ti,mclk-freq = <19200000>;
++
++              ti,mcpdm = <&mcpdm>;
++
++              ti,twl6040 = <&twl6040>;
++
++              /* Audio routing */
++              ti,audio-routing =
++                      "Headset Stereophone", "HSOL",
++                      "Headset Stereophone", "HSOR",
++                      "Line Out", "AUXL",
++                      "Line Out", "AUXR",
++                      "HSMIC", "Headset Mic",
++                      "Headset Mic", "Headset Mic Bias",
++                      "AFML", "Line In",
++                      "AFMR", "Line In";
++      };
+ };
+ &omap5_pmx_core {
+@@ -84,16 +80,18 @@
+       pinctrl-0 = <
+                       &twl6040_pins
+                       &mcpdm_pins
+-                      &dmic_pins
+                       &mcbsp1_pins
+                       &mcbsp2_pins
+                       &usbhost_pins
+                       &led_gpio_pins
++                      &dss_hdmi_pins
++                      &tpd12s015_pins
++                      &palmas_pins
+       >;
+       twl6040_pins: pinmux_twl6040_pins {
+               pinctrl-single,pins = <
+-                      0x18a (PIN_OUTPUT | MUX_MODE6)  /* perslimbus2_clock.gpio5_145 */
++                      0x17e (PIN_OUTPUT | MUX_MODE6)  /* mcspi1_somi.gpio5_141 */
+               >;
+       };
+@@ -107,15 +105,6 @@
+               >;
+       };
+-      dmic_pins: pinmux_dmic_pins {
+-              pinctrl-single,pins = <
+-                      0x144 (PIN_INPUT | MUX_MODE0)           /* abedmic_din1.abedmic_din1 */
+-                      0x146 (PIN_INPUT | MUX_MODE0)           /* abedmic_din2.abedmic_din2 */
+-                      0x148 (PIN_INPUT | MUX_MODE0)           /* abedmic_din3.abedmic_din3 */
+-                      0x14a (PIN_OUTPUT | MUX_MODE0)          /* abedmic_clk1.abedmic_clk1 */
+-              >;
+-      };
+-
+       mcbsp1_pins: pinmux_mcbsp1_pins {
+               pinctrl-single,pins = <
+                       0x14c (PIN_INPUT | MUX_MODE1)           /* abedmic_clk2.abemcbsp1_fsx */
+@@ -143,8 +132,14 @@
+       i2c5_pins: pinmux_i2c5_pins {
+               pinctrl-single,pins = <
+-                      0x184 (PIN_INPUT | MUX_MODE0)           /* i2c5_scl */
+-                      0x186 (PIN_INPUT | MUX_MODE0)           /* i2c5_sda */
++                      0x186 (PIN_INPUT | MUX_MODE0)           /* i2c5_scl */
++                      0x188 (PIN_INPUT | MUX_MODE0)           /* i2c5_sda */
++              >;
++      };
++
++      mmc1_pins: pinmux_mmc1_pins {
++              pinctrl-single,pins = <
++                      0x194 (PIN_INPUT | MUX_MODE6)           /* gpio5_152  */
+               >;
+       };
+@@ -153,25 +148,25 @@
+                       0xbc (PIN_INPUT | MUX_MODE0)            /*  mcspi2_clk */
+                       0xbe (PIN_INPUT | MUX_MODE0)            /*  mcspi2_simo */
+                       0xc0 (PIN_INPUT_PULLUP | MUX_MODE0)     /*  mcspi2_somi */
+-                      0xc2 (PIN_OUTPUT | MUX_MODE0)           /*  mcspi2_cs */
++                      0xc2 (PIN_OUTPUT | MUX_MODE0)           /*  mcspi2_cs0 */
+               >;
+       };
+       mcspi3_pins: pinmux_mcspi3_pins {
+               pinctrl-single,pins = <
+-                      0x78 (PIN_INPUT | MUX_MODE1)            /*  mcspi2_somi */
+-                      0x7a (PIN_INPUT | MUX_MODE1)            /*  mcspi2_cs */
+-                      0x7c (PIN_INPUT | MUX_MODE1)            /*  mcspi2_simo */
+-                      0x7e (PIN_INPUT | MUX_MODE1)            /*  mcspi2_clk */
++                      0x78 (PIN_INPUT | MUX_MODE1)            /*  mcspi3_somi */
++                      0x7a (PIN_INPUT | MUX_MODE1)            /*  mcspi3_cs0 */
++                      0x7c (PIN_INPUT | MUX_MODE1)            /*  mcspi3_simo */
++                      0x7e (PIN_INPUT | MUX_MODE1)            /*  mcspi3_clk */
+               >;
+       };
+       mcspi4_pins: pinmux_mcspi4_pins {
+               pinctrl-single,pins = <
+-                      0x164 (PIN_INPUT | MUX_MODE1)           /*  mcspi2_clk */
+-                      0x168 (PIN_INPUT | MUX_MODE1)           /*  mcspi2_simo */
+-                      0x16a (PIN_INPUT | MUX_MODE1)           /*  mcspi2_somi */
+-                      0x16c (PIN_INPUT | MUX_MODE1)           /*  mcspi2_cs */
++                      0x164 (PIN_INPUT | MUX_MODE1)           /*  mcspi4_clk */
++                      0x168 (PIN_INPUT | MUX_MODE1)           /*  mcspi4_simo */
++                      0x16a (PIN_INPUT | MUX_MODE1)           /*  mcspi4_somi */
++                      0x16c (PIN_INPUT | MUX_MODE1)           /*  mcspi4_cs0 */
+               >;
+       };
+@@ -219,6 +214,25 @@
+               >;
+       };
++       dss_hdmi_pins: pinmux_dss_hdmi_pins {
++              pinctrl-single,pins = <
++                      0x0fc (PIN_INPUT_PULLUP | MUX_MODE0)    /* hdmi_cec.hdmi_cec */
++                      0x100 (PIN_INPUT | MUX_MODE0)   /* DDC-SCL */
++                      0x102 (PIN_INPUT | MUX_MODE0)   /* DDC-SDA */
++                >;
++        };
++
++      tpd12s015_pins: pinmux_tpd12s015_pins {
++              pinctrl-single,pins = <
++                      0x0fe (PIN_INPUT_PULLDOWN | MUX_MODE6)  /* hdmi_hpd.gpio7_193 */
++              >;
++      };
++
++      palmas_pins: pinmux_palmas_pins {
++              pinctrl-single,pins = <
++                      0x140 (PIN_INPUT_PULLUP | MUX_MODE1)    /* MSECURE */
++              >;
++      };
+ };
+ &omap5_pmx_wkup {
+@@ -235,8 +249,11 @@
+ };
+ &mmc1 {
++      pinctrl-names = "default";
++      pinctrl-0 = <&mmc1_pins>;
+       vmmc-supply = <&ldo9_reg>;
+       bus-width = <4>;
++      cd-gpios = <&gpio5 24 0>; /* gpio 152 */
+ };
+ &mmc2 {
+@@ -259,6 +276,7 @@
+ };
+ &i2c1 {
++      status = "okay";
+       pinctrl-names = "default";
+       pinctrl-0 = <&i2c1_pins>;
+@@ -272,6 +290,30 @@
+               interrupt-controller;
+               #interrupt-cells = <2>;
++              extcon_usb3: palmas_usb {
++                      compatible = "ti,palmas-usb-vid";
++                      ti,enable-vbus-detection;
++                      ti,enable-id-detection;
++                      ti,wakeup;
++              };
++
++              palmas_rtc: rtc {
++                      compatible = "ti,palmas-rtc";
++                      interrupt-parent = <&palmas>;
++                      interrupts = <8 IRQ_TYPE_NONE>;
++                      ti,backup-battery-chargeable;
++              };
++
++              clk32kg: palmas_clk32k@0 {
++                      compatible = "ti,palmas-clk32kg";
++                      #clock-cells = <0>;
++              };
++
++              clk32kgaudio: palmas_clk32k@1 {
++                      compatible = "ti,palmas-clk32kgaudio";
++                      #clock-cells = <0>;
++              };
++
+               palmas_pmic {
+                       compatible = "ti,palmas-pmic";
+                       interrupt-parent = <&palmas>;
+@@ -334,15 +376,22 @@
+                                       ti,smps-range = <0x80>;
+                               };
+-                              smps10_reg: smps10 {
++                              smps10_out2_reg: smps10_out2 {
+                                       /* VBUS_5V_OTG */
+-                                      regulator-name = "smps10";
++                                      regulator-name = "smps10_out2";
+                                       regulator-min-microvolt = <5000000>;
+                                       regulator-max-microvolt = <5000000>;
+                                       regulator-always-on;
+                                       regulator-boot-on;
+                               };
++                              smps10_out1_reg: smps10_out1 {
++                                      /* VBUS_5V_OTG */
++                                      regulator-name = "smps10_out1";
++                                      regulator-min-microvolt = <5000000>;
++                                      regulator-max-microvolt = <5000000>;
++                              };
++
+                               ldo1_reg: ldo1 {
+                                       /* VDDAPHY_CAM: vdda_csiport */
+                                       regulator-name = "ldo1";
+@@ -448,13 +497,37 @@
+                       };
+               };
+       };
++
++      twl6040: twl@4b {
++              compatible = "ti,twl6040";
++              reg = <0x4b>;
++
++              interrupts = <GIC_SPI 119 IRQ_TYPE_NONE>; /* IRQ_SYS_2N cascaded to gic */
++              interrupt-parent = <&gic>;
++              ti,audpwron-gpio = <&gpio5 13 0>;  /* gpio line 141 */
++
++              vio-supply = <&smps7_reg>;
++              v2v1-supply = <&smps9_reg>;
++              enable-active-high;
++
++              clocks = <&clk32kgaudio>;
++              clock-names = "clk32k";
++      };
+ };
+ &i2c5 {
++      status = "okay";
+       pinctrl-names = "default";
+       pinctrl-0 = <&i2c5_pins>;
+       clock-frequency = <400000>;
++
++      tca6424a: tca6424a@22 {
++              compatible = "ti,tca6424";
++              reg = <0x22>;
++              gpio-controller;
++              #gpio-cells = <2>;
++      };
+ };
+ &mcbsp3 {
+@@ -470,36 +543,91 @@
+       phys = <0 &hsusb2_phy &hsusb3_phy>;
+ };
+-&mcspi1 {
++&usb3 {
++      extcon = <&extcon_usb3>;
++      vbus-supply = <&smps10_out1_reg>;
++};
++&mcspi1 {
++      status = "okay";
+ };
+ &mcspi2 {
++      status = "okay";
+       pinctrl-names = "default";
+       pinctrl-0 = <&mcspi2_pins>;
+ };
+ &mcspi3 {
++      status = "okay";
+       pinctrl-names = "default";
+       pinctrl-0 = <&mcspi3_pins>;
+ };
+ &mcspi4 {
++      status = "okay";
+       pinctrl-names = "default";
+       pinctrl-0 = <&mcspi4_pins>;
+ };
+ &uart1 {
++      status = "okay";
+         pinctrl-names = "default";
+         pinctrl-0 = <&uart1_pins>;
+ };
+ &uart3 {
++      status = "okay";
+         pinctrl-names = "default";
+         pinctrl-0 = <&uart3_pins>;
+ };
+ &uart5 {
++      status = "okay";
+         pinctrl-names = "default";
+         pinctrl-0 = <&uart5_pins>;
+ };
++
++&hdmi {
++      vdda_hdmi_dac-supply = <&ldo4_reg>;
++};
++
++&dsi1 {
++      vdds_dsi-supply = <&ldo4_reg>;
++};
++
++&dsi2 {
++      vdds_dsi-supply = <&ldo4_reg>;
++};
++
++&cpu0 {
++      cpu0-supply = <&smps123_reg>;
++};
++
++/ {
++      aliases {
++              display0 = &hdmi0;
++              ethernet0 = &smsc0;
++      };
++
++      tpd12s015: encoder@0 {
++              compatible = "ti,tpd12s015";
++
++              video-source = <&hdmi>;
++
++              gpios = <&tca6424a 0 0>,        /* TCA6424A P01, CT CP HPD */
++                      <&tca6424a 1 0>,        /* TCA6424A P00, LS OE */
++                      <&gpio7 1 0>;           /* GPIO 193, HPD */
++      };
++
++      hdmi0: connector@0 {
++              compatible = "ti,hdmi_connector";
++
++              video-source = <&tpd12s015>;
++      };
++
++      smsc0: smsc95xx@0 {
++              /* Filled in by U-Boot */
++              mac-address = [ 00 00 00 00 00 00 ];
++      };
++};
+--- /dev/null
++++ b/arch/arm/boot/dts/tps65218.dtsi
+@@ -0,0 +1,41 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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.
++ */
++
++&tps {
++      compatible = "ti,tps65218";
++      interrupt-controller;
++      #interrupt-cells = <2>;
++
++      dcdc1: regulator-dcdc1 {
++              compatible = "ti,tps65218-dcdc1";
++      };
++
++      dcdc2: regulator-dcdc2 {
++              compatible = "ti,tps65218-dcdc2";
++      };
++
++      dcdc3: regulator-dcdc3 {
++              compatible = "ti,tps65218-dcdc3";
++      };
++
++      dcdc4: regulator-dcdc4 {
++              compatible = "ti,tps65218-dcdc4";
++      };
++
++      dcdc5: regulator-dcdc5 {
++              compatible = "ti,tps65218-dcdc5";
++      };
++
++      dcdc6: regulator-dcdc6 {
++              compatible = "ti,tps65218-dcdc6";
++      };
++
++      ldo1: regulator-ldo1 {
++              compatible = "ti,tps65218-ldo1";
++      };
++};
+--- a/arch/arm/boot/dts/twl4030.dtsi
++++ b/arch/arm/boot/dts/twl4030.dtsi
+@@ -86,6 +86,7 @@
+               usb1v8-supply = <&vusb1v8>;
+               usb3v1-supply = <&vusb3v1>;
+               usb_mode = <1>;
++              #phy-cells = <0>;
+       };
+       twl_pwm: pwm {
+--- a/arch/arm/boot/Makefile
++++ b/arch/arm/boot/Makefile
+@@ -55,6 +55,9 @@ $(obj)/zImage:       $(obj)/compressed/vmlinux
+       $(call if_changed,objcopy)
+       @$(kecho) '  Kernel: $@ is ready'
++$(obj)/zImage-dtb.%:  $(obj)/dts/%.dtb $(obj)/zImage
++      cat $(obj)/zImage $< > $@
++
+ endif
+ ifneq ($(LOADADDR),)
+@@ -80,6 +83,10 @@ $(obj)/uImage:      $(obj)/zImage FORCE
+       $(call if_changed,uimage)
+       @$(kecho) '  Image $@ is ready'
++$(obj)/uImage.%:      $(obj)/zImage-dtb.% FORCE
++      $(call if_changed,uimage)
++      @echo '  Image $@ is ready'
++
+ $(obj)/bootp/bootp: $(obj)/zImage initrd FORCE
+       $(Q)$(MAKE) $(build)=$(obj)/bootp $@
+       @:
+--- a/arch/arm/configs/omap2plus_defconfig
++++ b/arch/arm/configs/omap2plus_defconfig
+@@ -26,11 +26,13 @@ CONFIG_ARCH_OMAP2=y
+ CONFIG_ARCH_OMAP3=y
+ CONFIG_ARCH_OMAP4=y
+ CONFIG_SOC_AM33XX=y
++CONFIG_SOC_AM43XX=y
+ CONFIG_OMAP_RESET_CLOCKS=y
+ CONFIG_OMAP_MUX_DEBUG=y
+ CONFIG_ARCH_VEXPRESS_CA9X4=y
+ CONFIG_ARM_THUMBEE=y
+ CONFIG_ARM_ERRATA_411920=y
++CONFIG_OMAP4_ERRATA_I688=y
+ CONFIG_NO_HZ=y
+ CONFIG_HIGH_RES_TIMERS=y
+ CONFIG_SMP=y
+@@ -42,6 +44,14 @@ CONFIG_ARM_APPENDED_DTB=y
+ CONFIG_ARM_ATAG_DTB_COMPAT=y
+ CONFIG_CMDLINE="root=/dev/mmcblk0p2 rootwait console=ttyO2,115200"
+ CONFIG_KEXEC=y
++CONFIG_CPU_FREQ=y
++CONFIG_CPU_FREQ_STAT_DETAILS=y
++CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND=y
++CONFIG_CPU_FREQ_GOV_POWERSAVE=y
++CONFIG_CPU_FREQ_GOV_USERSPACE=y
++CONFIG_CPU_FREQ_GOV_CONSERVATIVE=y
++CONFIG_GENERIC_CPUFREQ_CPU0=y
++# CONFIG_ARM_OMAP2PLUS_CPUFREQ is not set
+ CONFIG_FPE_NWFPE=y
+ CONFIG_BINFMT_MISC=y
+ CONFIG_PM_DEBUG=y
+@@ -60,6 +70,7 @@ CONFIG_IP_PNP_RARP=y
+ # CONFIG_INET_LRO is not set
+ # CONFIG_IPV6 is not set
+ CONFIG_NETFILTER=y
++CONFIG_VLAN_8021Q=y
+ CONFIG_CAN=m
+ CONFIG_CAN_RAW=m
+ CONFIG_CAN_BCM=m
+@@ -82,6 +93,7 @@ CONFIG_DMA_CMA=y
+ CONFIG_CONNECTOR=y
+ CONFIG_DEVTMPFS=y
+ CONFIG_DEVTMPFS_MOUNT=y
++CONFIG_OMAP_OCP2SCP=y
+ CONFIG_MTD=y
+ CONFIG_MTD_CMDLINE_PARTS=y
+ CONFIG_MTD_CHAR=y
+@@ -89,8 +101,11 @@ CONFIG_MTD_BLOCK=y
+ CONFIG_MTD_OOPS=y
+ CONFIG_MTD_CFI=y
+ CONFIG_MTD_CFI_INTELEXT=y
++CONFIG_MTD_M25P80=y
++# CONFIG_M25PXX_USE_FAST_READ is not set
+ CONFIG_MTD_NAND=y
+ CONFIG_MTD_NAND_OMAP2=y
++CONFIG_MTD_NAND_OMAP_BCH=y
+ CONFIG_MTD_ONENAND=y
+ CONFIG_MTD_ONENAND_VERIFY_WRITE=y
+ CONFIG_MTD_ONENAND_OMAP2=y
+@@ -106,6 +121,9 @@ CONFIG_SCSI=y
+ CONFIG_BLK_DEV_SD=y
+ CONFIG_SCSI_MULTI_LUN=y
+ CONFIG_SCSI_SCAN_ASYNC=y
++CONFIG_ATA=y
++CONFIG_SATA_AHCI_PLATFORM=y
++CONFIG_SATA_TI=y
+ CONFIG_MD=y
+ CONFIG_NETDEVICES=y
+ CONFIG_SMSC_PHY=y
+@@ -131,6 +149,9 @@ CONFIG_KEYBOARD_MATRIX=m
+ CONFIG_KEYBOARD_TWL4030=y
+ CONFIG_INPUT_TOUCHSCREEN=y
+ CONFIG_TOUCHSCREEN_ADS7846=y
++CONFIG_TOUCHSCREEN_ATMEL_MXT=y
++CONFIG_TOUCHSCREEN_TI_AM335X_TSC=y
++CONFIG_TOUCHSCREEN_PIXCIR=m
+ CONFIG_INPUT_MISC=y
+ CONFIG_INPUT_TWL4030_PWRBUTTON=y
+ CONFIG_VT_HW_CONSOLE_BINDING=y
+@@ -151,10 +172,14 @@ CONFIG_HW_RANDOM=y
+ CONFIG_I2C_CHARDEV=y
+ CONFIG_SPI=y
+ CONFIG_SPI_OMAP24XX=y
++CONFIG_SPI_TI_QSPI=y
+ CONFIG_PINCTRL_SINGLE=y
+ CONFIG_DEBUG_GPIO=y
+ CONFIG_GPIO_SYSFS=y
+ CONFIG_GPIO_TWL4030=y
++CONFIG_GPIOLIB=y
++CONFIG_I2C=y
++CONFIG_GPIO_PCF857X=y
+ CONFIG_W1=y
+ CONFIG_POWER_SUPPLY=y
+ CONFIG_SENSORS_LM75=m
+@@ -168,31 +193,52 @@ CONFIG_THERMAL_GOV_USER_SPACE=y
+ CONFIG_CPU_THERMAL=y
+ CONFIG_OMAP_WATCHDOG=y
+ CONFIG_TWL4030_WATCHDOG=y
++CONFIG_MFD_TI_AM335X_TSCADC=y
++CONFIG_MFD_PALMAS=y
+ CONFIG_MFD_TPS65217=y
+ CONFIG_MFD_TPS65910=y
+ CONFIG_TWL6040_CORE=y
+ CONFIG_REGULATOR_TWL4030=y
++CONFIG_REGULATOR_TIAVSCLASS0=y
+ CONFIG_REGULATOR_TPS65023=y
+ CONFIG_REGULATOR_TPS6507X=y
+ CONFIG_REGULATOR_TPS65217=y
+ CONFIG_REGULATOR_TPS65910=y
++CONFIG_REGULATOR_PALMAS=y
++CONFIG_MEDIA_SUPPORT=m
++CONFIG_MEDIA_CAMERA_SUPPORT=y
++CONFIG_VIDEO_DEV=m
++CONFIG_VIDEO_V4L2=m
++CONFIG_VIDEOBUF2_CORE=m
++CONFIG_VIDEOBUF2_MEMOPS=m
++CONFIG_VIDEOBUF2_VMALLOC=m
++CONFIG_MEDIA_USB_SUPPORT=y
++CONFIG_USB_VIDEO_CLASS=m
++CONFIG_USB_VIDEO_CLASS_INPUT_EVDEV=y
++CONFIG_USB_GSPCA=m
+ CONFIG_FB=y
+ CONFIG_FIRMWARE_EDID=y
+ CONFIG_FB_MODE_HELPERS=y
+ CONFIG_FB_TILEBLITTING=y
+ CONFIG_FB_OMAP_LCD_VGA=y
+-CONFIG_OMAP2_DSS=m
++CONFIG_FB_DA8XX=y
++CONFIG_FB_DA8XX_TDA998X=y
++CONFIG_OMAP2_DSS=y
+ CONFIG_OMAP2_DSS_RFBI=y
+ CONFIG_OMAP2_DSS_SDI=y
+ CONFIG_OMAP2_DSS_DSI=y
+-CONFIG_FB_OMAP2=m
+-CONFIG_DISPLAY_ENCODER_TFP410=m
+-CONFIG_DISPLAY_ENCODER_TPD12S015=m
+-CONFIG_DISPLAY_CONNECTOR_DVI=m
+-CONFIG_DISPLAY_CONNECTOR_HDMI=m
+-CONFIG_DISPLAY_PANEL_DPI=m
++CONFIG_FB_OMAP2=y
++CONFIG_DISPLAY_ENCODER_TFP410=y
++CONFIG_DISPLAY_ENCODER_TPD12S015=y
++CONFIG_DISPLAY_DRA_EVM_ENCODER_TPD12S015=y
++CONFIG_DISPLAY_CONNECTOR_DVI=y
++CONFIG_DISPLAY_CONNECTOR_HDMI=y
++CONFIG_DISPLAY_PANEL_DPI=y
++CONFIG_DISPLAY_PANEL_TFCS9700=y
+ CONFIG_BACKLIGHT_LCD_SUPPORT=y
+ CONFIG_LCD_CLASS_DEVICE=y
++CONFIG_BACKLIGHT_CLASS_DEVICE=y
++CONFIG_BACKLIGHT_PWM=y
+ CONFIG_LCD_PLATFORM=y
+ CONFIG_DISPLAY_SUPPORT=y
+ CONFIG_FRAMEBUFFER_CONSOLE=y
+@@ -210,25 +256,57 @@ CONFIG_SND_DEBUG=y
+ CONFIG_SND_USB_AUDIO=m
+ CONFIG_SND_SOC=m
+ CONFIG_SND_OMAP_SOC=m
++CONFIG_SND_AM33XX_SOC_EVM=m
++CONFIG_SND_DAVINCI_SOC=m
+ CONFIG_SND_OMAP_SOC_OMAP_TWL4030=m
+ CONFIG_SND_OMAP_SOC_OMAP_ABE_TWL6040=m
+ CONFIG_SND_OMAP_SOC_OMAP3_PANDORA=m
+ CONFIG_USB=y
+-CONFIG_USB_DEBUG=y
+ CONFIG_USB_ANNOUNCE_NEW_DEVICES=y
+ CONFIG_USB_DEVICEFS=y
+ CONFIG_USB_MON=y
++CONFIG_USB_XHCI_HCD=y
++CONFIG_USB_XHCI_PLATFORM=y
++CONFIG_USB_EHCI_HCD=y
++CONFIG_USB_MUSB_HDRC=y
++CONFIG_USB_MUSB_OMAP2PLUS=m
++CONFIG_USB_MUSB_DSPS=m
+ CONFIG_USB_WDM=y
+ CONFIG_USB_STORAGE=y
+ CONFIG_USB_LIBUSUAL=y
+ CONFIG_USB_TEST=y
++CONFIG_AM335X_PHY_USB=y
++CONFIG_TWL6030_USB=y
+ CONFIG_USB_PHY=y
+ CONFIG_NOP_USB_XCEIV=y
++
++CONFIG_USB_DWC3=y
++CONFIG_USB_DWC3_OMAP=y
++
+ CONFIG_USB_GADGET=y
+ CONFIG_USB_GADGET_DEBUG=y
+ CONFIG_USB_GADGET_DEBUG_FILES=y
+ CONFIG_USB_GADGET_DEBUG_FS=y
+ CONFIG_USB_ZERO=m
++CONFIG_USB_AUDIO=m
++CONFIG_USB_ETH=m
++CONFIG_USB_G_NCM=m
++CONFIG_USB_GADGETFS=m
++CONFIG_USB_FUNCTIONFS=m
++CONFIG_USB_FUNCTIONFS_ETH=y
++CONFIG_USB_FUNCTIONFS_RNDIS=y
++CONFIG_USB_FUNCTIONFS_GENERIC=y
++CONFIG_USB_MASS_STORAGE=m
++CONFIG_USB_G_SERIAL=m
++CONFIG_USB_MIDI_GADGET=m
++CONFIG_USB_G_PRINTER=m
++CONFIG_USB_CDC_COMPOSITE=m
++CONFIG_USB_G_ACM_MS=m
++CONFIG_USB_G_MULTI=m
++CONFIG_USB_G_MULTI_CDC=y
++CONFIG_USB_G_HID=m
++CONFIG_USB_G_DBGP=m
++CONFIG_USB_G_WEBCAM=m
+ CONFIG_MMC=y
+ CONFIG_MMC_UNSAFE_RESUME=y
+ CONFIG_SDIO_UART=y
+@@ -249,14 +327,35 @@ CONFIG_RTC_CLASS=y
+ CONFIG_RTC_DRV_TWL92330=y
+ CONFIG_RTC_DRV_TWL4030=y
+ CONFIG_RTC_DRV_OMAP=y
++CONFIG_RTC_DRV_PALMAS=y
+ CONFIG_DMADEVICES=y
+ CONFIG_TI_EDMA=y
+ CONFIG_DMA_OMAP=y
++CONFIG_PWM=y
++CONFIG_COMMON_CLK_DEBUG=y
++CONFIG_PWM_TIECAP=m
++CONFIG_PWM_TIEHRPWM=m
+ CONFIG_TI_SOC_THERMAL=y
+ CONFIG_TI_THERMAL=y
+ CONFIG_OMAP4_THERMAL=y
+ CONFIG_OMAP5_THERMAL=y
+ CONFIG_DRA752_THERMAL=y
++
++CONFIG_EXTCON=y
++CONFIG_EXTCON_PALMAS=y
++CONFIG_EXTCON_GPIO_USBVID=y
++
++CONFIG_GENERIC_PHY=y
++CONFIG_OMAP_CONTROL_PHY=y
++CONFIG_IIO=m
++CONFIG_IIO_BUFFER=y
++CONFIG_IIO_BUFFER_CB=y
++CONFIG_IIO_KFIFO_BUF=m
++CONFIG_TI_AM335X_ADC=m
++CONFIG_OMAP_USB2=y
++CONFIG_OMAP_PIPE3=y
++CONFIG_TWL4030_USB=y
++
+ CONFIG_EXT2_FS=y
+ CONFIG_EXT3_FS=y
+ # CONFIG_EXT3_FS_XATTR is not set
+@@ -295,6 +394,10 @@ CONFIG_DEBUG_INFO=y
+ CONFIG_SECURITY=y
+ CONFIG_CRYPTO_MICHAEL_MIC=y
+ # CONFIG_CRYPTO_ANSI_CPRNG is not set
++CONFIG_CRYPTO_DEV_OMAP_SHAM=y
++CONFIG_CRYPTO_DEV_OMAP_AES=y
++CONFIG_CRYPTO_DEV_OMAP_DES=y
++CONFIG_CRYPTO_TEST=m
+ CONFIG_CRC_CCITT=y
+ CONFIG_CRC_T10DIF=y
+ CONFIG_CRC_ITU_T=y
+@@ -306,3 +409,4 @@ CONFIG_TI_DAVINCI_CPDMA=y
+ CONFIG_TI_CPSW=y
+ CONFIG_AT803X_PHY=y
+ CONFIG_SOC_DRA7XX=y
++CONFIG_GPIO_PCA953X=y
+--- a/arch/arm/Kconfig
++++ b/arch/arm/Kconfig
+@@ -873,10 +873,33 @@ config ARCH_OMAP1
+       help
+         Support for older TI OMAP1 (omap7xx, omap15xx or omap16xx)
++config ARCH_OMAP2PLUS
++      bool "TI OMAP2+"
++      depends on MMU
++      select ARCH_HAS_BANDGAP
++      select ARCH_HAS_CPUFREQ
++      select ARCH_HAS_HOLES_MEMORYMODEL
++      select ARCH_OMAP
++      select ARCH_REQUIRE_GPIOLIB
++      select CLKDEV_LOOKUP
++      select CLKSRC_MMIO
++      select GENERIC_CLOCKEVENTS
++      select GENERIC_IRQ_CHIP
++      select HAVE_CLK
++      select OMAP_DM_TIMER
++      select PINCTRL
++      select PROC_DEVICETREE if PROC_FS
++      select SOC_BUS
++      select SPARSE_IRQ
++      select TI_PRIV_EDMA
++      select USE_OF
++      select AUTO_ZRELADDR
++      help
++        SUpport for OMAP2, OMAP3, OMAP4 and OMAP5
++
+ endchoice
+ menu "Multiple platform selection"
+-      depends on ARCH_MULTIPLATFORM
+ comment "CPU Core family selection"
+@@ -1606,6 +1629,7 @@ config ARCH_NR_GPIO
+       default 352 if ARCH_VT8500
+       default 288 if ARCH_SUNXI
+       default 264 if MACH_H4700
++      default 192 if SOC_AM43XX
+       default 0
+       help
+         Maximum number of GPIOs in the system.
+--- a/arch/arm/Kconfig.debug
++++ b/arch/arm/Kconfig.debug
+@@ -1077,7 +1077,7 @@ config DEBUG_UNCOMPRESS
+ config UNCOMPRESS_INCLUDE
+       string
+-      default "debug/uncompress.h" if ARCH_MULTIPLATFORM || ARCH_MSM
++      default "debug/uncompress.h" if ARCH_MULTIPLATFORM || ARCH_MSM || ARCH_OMAP
+       default "mach/uncompress.h"
+ config EARLY_PRINTK
+--- a/arch/arm/kernel/head.S
++++ b/arch/arm/kernel/head.S
+@@ -534,7 +534,8 @@ smp_on_up:
+ __do_fixup_smp_on_up:
+       cmp     r4, r5
+       movhs   pc, lr
+-      ldmia   r4!, {r0, r6}
++      ldmia   r4!, {r0}
++      ldmia   r4!, {r6}
+  ARM( str     r6, [r0, r3]    )
+  THUMB(       add     r0, r0, r3      )
+ #ifdef __ARMEB__
+--- a/arch/arm/mach-omap2/am33xx-restart.c
++++ b/arch/arm/mach-omap2/am33xx-restart.c
+@@ -9,6 +9,7 @@
+ #include <linux/reboot.h>
+ #include "common.h"
++#include "prcm43xx.h"
+ #include "prm-regbits-33xx.h"
+ #include "prm33xx.h"
+@@ -33,3 +34,25 @@ void am33xx_restart(enum reboot_mode mod
+       (void)am33xx_prm_read_reg(AM33XX_PRM_DEVICE_MOD,
+                                 AM33XX_PRM_RSTCTRL_OFFSET);
+ }
++
++/**
++ * am43xx_restart - trigger a software restart of the SoC
++ * @mode: the "reboot mode", see arch/arm/kernel/{setup,process}.c
++ * @cmd: passed fr-om the userspace program rebooting the system (if provided)
++ *
++ * Resets the SoC.  For @cmd, see the 'reboot' syscall in
++ * kernel/sys.c.  No return value.
++ */
++void am43xx_restart(enum reboot_mode mode, const char *cmd)
++{
++      /* TODO: Handle mode and cmd if necessary */
++
++      am33xx_prm_rmw_reg_bits(AM33XX_RST_GLOBAL_WARM_SW_MASK,
++                              AM33XX_RST_GLOBAL_WARM_SW_MASK,
++                              AM43XX_PRM_DEVICE_INST,
++                              AM33XX_PRM_RSTCTRL_OFFSET);
++
++      /* OCP barrier */
++      (void)am33xx_prm_read_reg(AM43XX_PRM_DEVICE_INST,
++                                AM33XX_PRM_RSTCTRL_OFFSET);
++}
+--- a/arch/arm/mach-omap2/board-2430sdp.c
++++ b/arch/arm/mach-omap2/board-2430sdp.c
+@@ -246,7 +246,7 @@ static void __init omap_2430sdp_init(voi
+       omap_hsmmc_init(mmc);
+       omap_mux_init_signal("usb0hs_stp", OMAP_PULL_ENA | OMAP_PULL_UP);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       board_smc91x_init();
+--- a/arch/arm/mach-omap2/board-3430sdp.c
++++ b/arch/arm/mach-omap2/board-3430sdp.c
+@@ -607,7 +607,7 @@ static void __init omap_3430sdp_init(voi
+       omap_ads7846_init(1, gpio_pendown, 310, NULL);
+       omap_serial_init();
+       omap_sdrc_init(hyb18m512160af6_sdrc_params, NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       board_smc91x_init();
+       board_flash_init(sdp_flash_partitions, chip_sel_3430, 0);
+--- a/arch/arm/mach-omap2/board-cm-t35.c
++++ b/arch/arm/mach-omap2/board-cm-t35.c
+@@ -725,7 +725,7 @@ static void __init cm_t3x_common_init(vo
+       cm_t35_init_display();
+       omap_twl4030_audio_init("cm-t3x", NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       cm_t35_init_usbh();
+       cm_t35_init_camera();
+--- a/arch/arm/mach-omap2/board-devkit8000.c
++++ b/arch/arm/mach-omap2/board-devkit8000.c
+@@ -628,7 +628,7 @@ static void __init devkit8000_init(void)
+       omap_ads7846_init(2, OMAP3_DEVKIT_TS_GPIO, 0, NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       usbhs_init(&usbhs_bdata);
+       board_nand_init(devkit8000_nand_partitions,
+--- a/arch/arm/mach-omap2/board-flash.c
++++ b/arch/arm/mach-omap2/board-flash.c
+@@ -142,7 +142,7 @@ __init board_nand_init(struct mtd_partit
+       board_nand_data.nr_parts        = nr_parts;
+       board_nand_data.devsize         = nand_type;
+-      board_nand_data.ecc_opt = OMAP_ECC_HAMMING_CODE_DEFAULT;
++      board_nand_data.ecc_opt = OMAP_ECC_BCH8_CODE_HW;
+       gpmc_nand_init(&board_nand_data, gpmc_t);
+ }
+ #endif /* CONFIG_MTD_NAND_OMAP2 || CONFIG_MTD_NAND_OMAP2_MODULE */
+--- a/arch/arm/mach-omap2/board-generic.c
++++ b/arch/arm/mach-omap2/board-generic.c
+@@ -15,13 +15,11 @@
+ #include <linux/of_irq.h>
+ #include <linux/of_platform.h>
+ #include <linux/irqdomain.h>
+-#include <linux/clk.h>
+ #include <asm/mach/arch.h>
+ #include "common.h"
+ #include "common-board-devices.h"
+-#include "dss-common.h"
+ #if !(defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3))
+ #define intc_of_init  NULL
+@@ -36,40 +34,13 @@ static struct of_device_id omap_dt_match
+       { }
+ };
+-/*
+- * Create alias for USB host PHY clock.
+- * Remove this when clock phandle can be provided via DT
+- */
+-static void __init legacy_init_ehci_clk(char *clkname)
+-{
+-      int ret;
+-
+-      ret = clk_add_alias("main_clk", NULL, clkname, NULL);
+-      if (ret) {
+-              pr_err("%s:Failed to add main_clk alias to %s :%d\n",
+-                                              __func__, clkname, ret);
+-      }
+-}
+-
+ static void __init omap_generic_init(void)
+ {
+       omap_sdrc_init(NULL, NULL);
+       of_platform_populate(NULL, omap_dt_match_table, NULL, NULL);
+-      /*
+-       * HACK: call display setup code for selected boards to enable omapdss.
+-       * This will be removed when omapdss supports DT.
+-       */
+-      if (of_machine_is_compatible("ti,omap4-panda")) {
+-              omap4_panda_display_init_of();
+-              legacy_init_ehci_clk("auxclk3_ck");
+-
+-      }
+-      else if (of_machine_is_compatible("ti,omap4-sdp"))
+-              omap_4430sdp_display_init_of();
+-      else if (of_machine_is_compatible("ti,omap5-uevm"))
+-              legacy_init_ehci_clk("auxclk1_ck");
++      omapdss_init_of();
+ }
+ #ifdef CONFIG_SOC_OMAP2420
+@@ -165,6 +136,24 @@ DT_MACHINE_START(OMAP3_GP_DT, "Generic O
+       .dt_compat      = omap3_gp_boards_compat,
+       .restart        = omap3xxx_restart,
+ MACHINE_END
++
++static const char *omap3630_gp_boards_compat[] __initdata = {
++      "ti,omap3-beagle-xm",
++      NULL,
++};
++
++DT_MACHINE_START(OMAP3630_GP_DT, "Generic OMAP3630-GP (Flattened Device Tree)")
++      .reserve        = omap_reserve,
++      .map_io         = omap3_map_io,
++      .init_early     = omap3630_init_early,
++      .init_irq       = omap_intc_of_init,
++      .handle_irq     = omap3_intc_handle_irq,
++      .init_machine   = omap_generic_init,
++      .init_late      = omap3_init_late,
++      .init_time      = omap3_secure_sync32k_timer_init,
++      .dt_compat      = omap3630_gp_boards_compat,
++      .restart        = omap3xxx_restart,
++MACHINE_END
+ #endif
+ #ifdef CONFIG_SOC_AM33XX
+@@ -174,12 +163,14 @@ static const char *am33xx_boards_compat[
+ };
+ DT_MACHINE_START(AM33XX_DT, "Generic AM33XX (Flattened Device Tree)")
+-      .reserve        = omap_reserve,
++      .reserve        = am33xx_reserve,
+       .map_io         = am33xx_map_io,
+       .init_early     = am33xx_init_early,
++      .init_late      = am33xx_init_late,
+       .init_irq       = omap_intc_of_init,
+       .handle_irq     = omap3_intc_handle_irq,
+       .init_machine   = omap_generic_init,
++      .init_late      = am33xx_init_late,
+       .init_time      = omap3_gptimer_timer_init,
+       .dt_compat      = am33xx_boards_compat,
+       .restart        = am33xx_restart,
+@@ -219,6 +210,7 @@ DT_MACHINE_START(OMAP5_DT, "Generic OMAP
+       .init_early     = omap5_init_early,
+       .init_irq       = omap_gic_of_init,
+       .init_machine   = omap_generic_init,
++      .init_late      = omap5_init_late,
+       .init_time      = omap5_realtime_timer_init,
+       .dt_compat      = omap5_boards_compat,
+       .restart        = omap44xx_restart,
+@@ -232,12 +224,14 @@ static const char *am43_boards_compat[]
+ };
+ DT_MACHINE_START(AM43_DT, "Generic AM43 (Flattened Device Tree)")
++      .reserve        = am33xx_reserve,
+       .map_io         = am33xx_map_io,
+       .init_early     = am43xx_init_early,
+       .init_irq       = omap_gic_of_init,
+       .init_machine   = omap_generic_init,
+       .init_time      = omap3_sync32k_timer_init,
+       .dt_compat      = am43_boards_compat,
++      .restart        = am43xx_restart,
+ MACHINE_END
+ #endif
+@@ -254,6 +248,7 @@ DT_MACHINE_START(DRA7XX_DT, "Generic DRA
+       .init_early     = dra7xx_init_early,
+       .init_irq       = omap_gic_of_init,
+       .init_machine   = omap_generic_init,
++      .init_late      = dra7xx_init_late,
+       .init_time      = omap5_realtime_timer_init,
+       .dt_compat      = dra7xx_boards_compat,
+       .restart        = omap44xx_restart,
+--- a/arch/arm/mach-omap2/board-igep0020.c
++++ b/arch/arm/mach-omap2/board-igep0020.c
+@@ -667,7 +667,7 @@ static void __init igep_init(void)
+       omap_serial_init();
+       omap_sdrc_init(m65kxxxxam_sdrc_params,
+                                 m65kxxxxam_sdrc_params);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       igep_flash_init();
+--- a/arch/arm/mach-omap2/board-ldp.c
++++ b/arch/arm/mach-omap2/board-ldp.c
+@@ -403,7 +403,7 @@ static void __init omap_ldp_init(void)
+       omap_ads7846_init(1, 54, 310, NULL);
+       omap_serial_init();
+       omap_sdrc_init(NULL, NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       board_nand_init(ldp_nand_partitions, ARRAY_SIZE(ldp_nand_partitions),
+                       ZOOM_NAND_CS, 0, nand_default_timings);
+--- a/arch/arm/mach-omap2/board-omap3beagle.c
++++ b/arch/arm/mach-omap2/board-omap3beagle.c
+@@ -289,18 +289,12 @@ static struct regulator_consumer_supply
+ static struct gpio_led gpio_leds[];
+-/* PHY's VCC regulator might be added later, so flag that we need it */
+-static struct usb_phy_gen_xceiv_platform_data hsusb2_phy_data = {
+-      .needs_vcc = true,
+-};
+-
+ static struct usbhs_phy_data phy_data[] = {
+       {
+               .port = 2,
+               .reset_gpio = 147,
+               .vcc_gpio = -1,         /* updated in beagle_twl_gpio_setup */
+               .vcc_polarity = 1,      /* updated in beagle_twl_gpio_setup */
+-              .platform_data = &hsusb2_phy_data,
+       },
+ };
+@@ -567,7 +561,7 @@ static void __init omap3_beagle_init(voi
+       omap_sdrc_init(mt46h32m32lf6_sdrc_params,
+                                 mt46h32m32lf6_sdrc_params);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       usbhs_init(&usbhs_bdata);
+--- a/arch/arm/mach-omap2/board-omap3evm.c
++++ b/arch/arm/mach-omap2/board-omap3evm.c
+@@ -723,7 +723,7 @@ static void __init omap3_evm_init(void)
+               omap_mux_init_gpio(135, OMAP_PIN_OUTPUT);
+               phy_data[0].reset_gpio = 135;
+       }
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(&musb_board_data);
+       usbhs_init_phys(phy_data, ARRAY_SIZE(phy_data));
+--- a/arch/arm/mach-omap2/board-omap3logic.c
++++ b/arch/arm/mach-omap2/board-omap3logic.c
+@@ -216,7 +216,7 @@ static void __init omap3logic_init(void)
+       board_mmc_init();
+       board_smsc911x_init();
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       /* Ensure SDRC pins are mux'd for self-refresh */
+--- a/arch/arm/mach-omap2/board-omap3pandora.c
++++ b/arch/arm/mach-omap2/board-omap3pandora.c
+@@ -607,7 +607,7 @@ static void __init omap3pandora_init(voi
+       usbhs_init_phys(phy_data, ARRAY_SIZE(phy_data));
+       usbhs_init(&usbhs_bdata);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       gpmc_nand_init(&pandora_nand_data, NULL);
+--- a/arch/arm/mach-omap2/board-omap3stalker.c
++++ b/arch/arm/mach-omap2/board-omap3stalker.c
+@@ -407,7 +407,7 @@ static void __init omap3_stalker_init(vo
+       omap_serial_init();
+       omap_sdrc_init(mt46h32m32lf6_sdrc_params, NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       usbhs_init_phys(phy_data, ARRAY_SIZE(phy_data));
+--- a/arch/arm/mach-omap2/board-omap3touchbook.c
++++ b/arch/arm/mach-omap2/board-omap3touchbook.c
+@@ -367,7 +367,7 @@ static void __init omap3_touchbook_init(
+       /* Touchscreen and accelerometer */
+       omap_ads7846_init(4, OMAP3_TS_GPIO, 310, &ads7846_pdata);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       usbhs_init_phys(phy_data, ARRAY_SIZE(phy_data));
+--- a/arch/arm/mach-omap2/board-overo.c
++++ b/arch/arm/mach-omap2/board-overo.c
+@@ -511,7 +511,7 @@ static void __init overo_init(void)
+                                 mt46h32m32lf6_sdrc_params);
+       board_nand_init(overo_nand_partitions,
+                       ARRAY_SIZE(overo_nand_partitions), NAND_CS, 0, NULL);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       usbhs_init_phys(phy_data, ARRAY_SIZE(phy_data));
+--- a/arch/arm/mach-omap2/board-rm680.c
++++ b/arch/arm/mach-omap2/board-rm680.c
+@@ -135,7 +135,7 @@ static void __init rm680_init(void)
+       sdrc_params = nokia_get_sdram_timings();
+       omap_sdrc_init(sdrc_params, sdrc_params);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       rm680_peripherals_init();
+ }
+--- a/arch/arm/mach-omap2/board-rx51.c
++++ b/arch/arm/mach-omap2/board-rx51.c
+@@ -99,7 +99,7 @@ static void __init rx51_init(void)
+       sdrc_params = nokia_get_sdram_timings();
+       omap_sdrc_init(sdrc_params, sdrc_params);
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(&musb_board_data);
+       rx51_peripherals_init();
+--- a/arch/arm/mach-omap2/board-zoom-peripherals.c
++++ b/arch/arm/mach-omap2/board-zoom-peripherals.c
+@@ -353,7 +353,7 @@ void __init zoom_peripherals_init(void)
+       omap_i2c_init();
+       pwm_add_table(zoom_pwm_lookup, ARRAY_SIZE(zoom_pwm_lookup));
+       platform_add_devices(zoom_devices, ARRAY_SIZE(zoom_devices));
+-      usb_bind_phy("musb-hdrc.0.auto", 0, "twl4030_usb");
++      usb_bind_phy("musb-hdrc.0", 0, "twl4030_usb");
+       usb_musb_init(NULL);
+       enable_board_wakeup_source();
+       omap_serial_init();
+--- a/arch/arm/mach-omap2/cclock33xx_data.c
++++ /dev/null
+@@ -1,1064 +0,0 @@
+-/*
+- * AM33XX Clock data
+- *
+- * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com/
+- * Vaibhav Hiremath <hvaibhav@ti.com>
+- *
+- * 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 version 2.
+- *
+- * This program is distributed "as is" WITHOUT ANY WARRANTY of any
+- * kind, whether express or implied; without even the implied warranty
+- * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+- * GNU General Public License for more details.
+- */
+-
+-#include <linux/kernel.h>
+-#include <linux/list.h>
+-#include <linux/clk-private.h>
+-#include <linux/clkdev.h>
+-#include <linux/io.h>
+-
+-#include "am33xx.h"
+-#include "soc.h"
+-#include "iomap.h"
+-#include "clock.h"
+-#include "control.h"
+-#include "cm.h"
+-#include "cm33xx.h"
+-#include "cm-regbits-33xx.h"
+-#include "prm.h"
+-
+-/* Modulemode control */
+-#define AM33XX_MODULEMODE_HWCTRL_SHIFT                0
+-#define AM33XX_MODULEMODE_SWCTRL_SHIFT                1
+-
+-/*LIST_HEAD(clocks);*/
+-
+-/* Root clocks */
+-
+-/* RTC 32k */
+-DEFINE_CLK_FIXED_RATE(clk_32768_ck, CLK_IS_ROOT, 32768, 0x0);
+-
+-/* On-Chip 32KHz RC OSC */
+-DEFINE_CLK_FIXED_RATE(clk_rc32k_ck, CLK_IS_ROOT, 32000, 0x0);
+-
+-/* Crystal input clks */
+-DEFINE_CLK_FIXED_RATE(virt_19200000_ck, CLK_IS_ROOT, 19200000, 0x0);
+-
+-DEFINE_CLK_FIXED_RATE(virt_24000000_ck, CLK_IS_ROOT, 24000000, 0x0);
+-
+-DEFINE_CLK_FIXED_RATE(virt_25000000_ck, CLK_IS_ROOT, 25000000, 0x0);
+-
+-DEFINE_CLK_FIXED_RATE(virt_26000000_ck, CLK_IS_ROOT, 26000000, 0x0);
+-
+-/* Oscillator clock */
+-/* 19.2, 24, 25 or 26 MHz */
+-static const char *sys_clkin_ck_parents[] = {
+-      "virt_19200000_ck", "virt_24000000_ck", "virt_25000000_ck",
+-      "virt_26000000_ck",
+-};
+-
+-/*
+- * sys_clk in: input to the dpll and also used as funtional clock for,
+- *   adc_tsc, smartreflex0-1, timer1-7, mcasp0-1, dcan0-1, cefuse
+- *
+- */
+-DEFINE_CLK_MUX(sys_clkin_ck, sys_clkin_ck_parents, NULL, 0x0,
+-             AM33XX_CTRL_REGADDR(AM33XX_CONTROL_STATUS),
+-             AM33XX_CONTROL_STATUS_SYSBOOT1_SHIFT,
+-             AM33XX_CONTROL_STATUS_SYSBOOT1_WIDTH,
+-             0, NULL);
+-
+-/* External clock - 12 MHz */
+-DEFINE_CLK_FIXED_RATE(tclkin_ck, CLK_IS_ROOT, 12000000, 0x0);
+-
+-/* Module clocks and DPLL outputs */
+-
+-/* DPLL_CORE */
+-static struct dpll_data dpll_core_dd = {
+-      .mult_div1_reg  = AM33XX_CM_CLKSEL_DPLL_CORE,
+-      .clk_bypass     = &sys_clkin_ck,
+-      .clk_ref        = &sys_clkin_ck,
+-      .control_reg    = AM33XX_CM_CLKMODE_DPLL_CORE,
+-      .modes          = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
+-      .idlest_reg     = AM33XX_CM_IDLEST_DPLL_CORE,
+-      .mult_mask      = AM33XX_DPLL_MULT_MASK,
+-      .div1_mask      = AM33XX_DPLL_DIV_MASK,
+-      .enable_mask    = AM33XX_DPLL_EN_MASK,
+-      .idlest_mask    = AM33XX_ST_DPLL_CLK_MASK,
+-      .max_multiplier = 2047,
+-      .max_divider    = 128,
+-      .min_divider    = 1,
+-};
+-
+-/* CLKDCOLDO output */
+-static const char *dpll_core_ck_parents[] = {
+-      "sys_clkin_ck",
+-};
+-
+-static struct clk dpll_core_ck;
+-
+-static const struct clk_ops dpll_core_ck_ops = {
+-      .recalc_rate    = &omap3_dpll_recalc,
+-      .get_parent     = &omap2_init_dpll_parent,
+-};
+-
+-static struct clk_hw_omap dpll_core_ck_hw = {
+-      .hw     = {
+-              .clk    = &dpll_core_ck,
+-      },
+-      .dpll_data      = &dpll_core_dd,
+-      .ops            = &clkhwops_omap3_dpll,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_core_ck, dpll_core_ck_parents, dpll_core_ck_ops);
+-
+-static const char *dpll_core_x2_ck_parents[] = {
+-      "dpll_core_ck",
+-};
+-
+-static struct clk dpll_core_x2_ck;
+-
+-static const struct clk_ops dpll_x2_ck_ops = {
+-      .recalc_rate    = &omap3_clkoutx2_recalc,
+-};
+-
+-static struct clk_hw_omap dpll_core_x2_ck_hw = {
+-      .hw     = {
+-              .clk    = &dpll_core_x2_ck,
+-      },
+-      .flags          = CLOCK_CLKOUTX2,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_core_x2_ck, dpll_core_x2_ck_parents, dpll_x2_ck_ops);
+-
+-DEFINE_CLK_DIVIDER(dpll_core_m4_ck, "dpll_core_x2_ck", &dpll_core_x2_ck,
+-                 0x0, AM33XX_CM_DIV_M4_DPLL_CORE,
+-                 AM33XX_HSDIVIDER_CLKOUT1_DIV_SHIFT,
+-                 AM33XX_HSDIVIDER_CLKOUT1_DIV_WIDTH, CLK_DIVIDER_ONE_BASED,
+-                 NULL);
+-
+-DEFINE_CLK_DIVIDER(dpll_core_m5_ck, "dpll_core_x2_ck", &dpll_core_x2_ck,
+-                 0x0, AM33XX_CM_DIV_M5_DPLL_CORE,
+-                 AM33XX_HSDIVIDER_CLKOUT2_DIV_SHIFT,
+-                 AM33XX_HSDIVIDER_CLKOUT2_DIV_WIDTH,
+-                 CLK_DIVIDER_ONE_BASED, NULL);
+-
+-DEFINE_CLK_DIVIDER(dpll_core_m6_ck, "dpll_core_x2_ck", &dpll_core_x2_ck,
+-                 0x0, AM33XX_CM_DIV_M6_DPLL_CORE,
+-                 AM33XX_HSDIVIDER_CLKOUT3_DIV_SHIFT,
+-                 AM33XX_HSDIVIDER_CLKOUT3_DIV_WIDTH,
+-                 CLK_DIVIDER_ONE_BASED, NULL);
+-
+-
+-/* DPLL_MPU */
+-static struct dpll_data dpll_mpu_dd = {
+-      .mult_div1_reg  = AM33XX_CM_CLKSEL_DPLL_MPU,
+-      .clk_bypass     = &sys_clkin_ck,
+-      .clk_ref        = &sys_clkin_ck,
+-      .control_reg    = AM33XX_CM_CLKMODE_DPLL_MPU,
+-      .modes          = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
+-      .idlest_reg     = AM33XX_CM_IDLEST_DPLL_MPU,
+-      .mult_mask      = AM33XX_DPLL_MULT_MASK,
+-      .div1_mask      = AM33XX_DPLL_DIV_MASK,
+-      .enable_mask    = AM33XX_DPLL_EN_MASK,
+-      .idlest_mask    = AM33XX_ST_DPLL_CLK_MASK,
+-      .max_multiplier = 2047,
+-      .max_divider    = 128,
+-      .min_divider    = 1,
+-};
+-
+-/* CLKOUT: fdpll/M2 */
+-static struct clk dpll_mpu_ck;
+-
+-static const struct clk_ops dpll_mpu_ck_ops = {
+-      .enable         = &omap3_noncore_dpll_enable,
+-      .disable        = &omap3_noncore_dpll_disable,
+-      .recalc_rate    = &omap3_dpll_recalc,
+-      .round_rate     = &omap2_dpll_round_rate,
+-      .set_rate       = &omap3_noncore_dpll_set_rate,
+-      .get_parent     = &omap2_init_dpll_parent,
+-};
+-
+-static struct clk_hw_omap dpll_mpu_ck_hw = {
+-      .hw = {
+-              .clk    = &dpll_mpu_ck,
+-      },
+-      .dpll_data      = &dpll_mpu_dd,
+-      .ops            = &clkhwops_omap3_dpll,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_mpu_ck, dpll_core_ck_parents, dpll_mpu_ck_ops);
+-
+-/*
+- * TODO: Add clksel here (sys_clkin, CORE_CLKOUTM6, PER_CLKOUTM2
+- * and ALT_CLK1/2)
+- */
+-DEFINE_CLK_DIVIDER(dpll_mpu_m2_ck, "dpll_mpu_ck", &dpll_mpu_ck,
+-                 0x0, AM33XX_CM_DIV_M2_DPLL_MPU, AM33XX_DPLL_CLKOUT_DIV_SHIFT,
+-                 AM33XX_DPLL_CLKOUT_DIV_WIDTH, CLK_DIVIDER_ONE_BASED, NULL);
+-
+-/* DPLL_DDR */
+-static struct dpll_data dpll_ddr_dd = {
+-      .mult_div1_reg  = AM33XX_CM_CLKSEL_DPLL_DDR,
+-      .clk_bypass     = &sys_clkin_ck,
+-      .clk_ref        = &sys_clkin_ck,
+-      .control_reg    = AM33XX_CM_CLKMODE_DPLL_DDR,
+-      .modes          = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
+-      .idlest_reg     = AM33XX_CM_IDLEST_DPLL_DDR,
+-      .mult_mask      = AM33XX_DPLL_MULT_MASK,
+-      .div1_mask      = AM33XX_DPLL_DIV_MASK,
+-      .enable_mask    = AM33XX_DPLL_EN_MASK,
+-      .idlest_mask    = AM33XX_ST_DPLL_CLK_MASK,
+-      .max_multiplier = 2047,
+-      .max_divider    = 128,
+-      .min_divider    = 1,
+-};
+-
+-/* CLKOUT: fdpll/M2 */
+-static struct clk dpll_ddr_ck;
+-
+-static const struct clk_ops dpll_ddr_ck_ops = {
+-      .recalc_rate    = &omap3_dpll_recalc,
+-      .get_parent     = &omap2_init_dpll_parent,
+-      .round_rate     = &omap2_dpll_round_rate,
+-      .set_rate       = &omap3_noncore_dpll_set_rate,
+-};
+-
+-static struct clk_hw_omap dpll_ddr_ck_hw = {
+-      .hw = {
+-              .clk    = &dpll_ddr_ck,
+-      },
+-      .dpll_data      = &dpll_ddr_dd,
+-      .ops            = &clkhwops_omap3_dpll,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_ddr_ck, dpll_core_ck_parents, dpll_ddr_ck_ops);
+-
+-/*
+- * TODO: Add clksel here (sys_clkin, CORE_CLKOUTM6, PER_CLKOUTM2
+- * and ALT_CLK1/2)
+- */
+-DEFINE_CLK_DIVIDER(dpll_ddr_m2_ck, "dpll_ddr_ck", &dpll_ddr_ck,
+-                 0x0, AM33XX_CM_DIV_M2_DPLL_DDR,
+-                 AM33XX_DPLL_CLKOUT_DIV_SHIFT, AM33XX_DPLL_CLKOUT_DIV_WIDTH,
+-                 CLK_DIVIDER_ONE_BASED, NULL);
+-
+-/* emif_fck functional clock */
+-DEFINE_CLK_FIXED_FACTOR(dpll_ddr_m2_div2_ck, "dpll_ddr_m2_ck", &dpll_ddr_m2_ck,
+-                      0x0, 1, 2);
+-
+-/* DPLL_DISP */
+-static struct dpll_data dpll_disp_dd = {
+-      .mult_div1_reg  = AM33XX_CM_CLKSEL_DPLL_DISP,
+-      .clk_bypass     = &sys_clkin_ck,
+-      .clk_ref        = &sys_clkin_ck,
+-      .control_reg    = AM33XX_CM_CLKMODE_DPLL_DISP,
+-      .modes          = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
+-      .idlest_reg     = AM33XX_CM_IDLEST_DPLL_DISP,
+-      .mult_mask      = AM33XX_DPLL_MULT_MASK,
+-      .div1_mask      = AM33XX_DPLL_DIV_MASK,
+-      .enable_mask    = AM33XX_DPLL_EN_MASK,
+-      .idlest_mask    = AM33XX_ST_DPLL_CLK_MASK,
+-      .max_multiplier = 2047,
+-      .max_divider    = 128,
+-      .min_divider    = 1,
+-};
+-
+-/* CLKOUT: fdpll/M2 */
+-static struct clk dpll_disp_ck;
+-
+-static struct clk_hw_omap dpll_disp_ck_hw = {
+-      .hw = {
+-              .clk    = &dpll_disp_ck,
+-      },
+-      .dpll_data      = &dpll_disp_dd,
+-      .ops            = &clkhwops_omap3_dpll,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_disp_ck, dpll_core_ck_parents, dpll_ddr_ck_ops);
+-
+-/*
+- * TODO: Add clksel here (sys_clkin, CORE_CLKOUTM6, PER_CLKOUTM2
+- * and ALT_CLK1/2)
+- */
+-DEFINE_CLK_DIVIDER(dpll_disp_m2_ck, "dpll_disp_ck", &dpll_disp_ck,
+-                 CLK_SET_RATE_PARENT, AM33XX_CM_DIV_M2_DPLL_DISP,
+-                 AM33XX_DPLL_CLKOUT_DIV_SHIFT, AM33XX_DPLL_CLKOUT_DIV_WIDTH,
+-                 CLK_DIVIDER_ONE_BASED, NULL);
+-
+-/* DPLL_PER */
+-static struct dpll_data dpll_per_dd = {
+-      .mult_div1_reg  = AM33XX_CM_CLKSEL_DPLL_PERIPH,
+-      .clk_bypass     = &sys_clkin_ck,
+-      .clk_ref        = &sys_clkin_ck,
+-      .control_reg    = AM33XX_CM_CLKMODE_DPLL_PER,
+-      .modes          = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
+-      .idlest_reg     = AM33XX_CM_IDLEST_DPLL_PER,
+-      .mult_mask      = AM33XX_DPLL_MULT_PERIPH_MASK,
+-      .div1_mask      = AM33XX_DPLL_PER_DIV_MASK,
+-      .enable_mask    = AM33XX_DPLL_EN_MASK,
+-      .idlest_mask    = AM33XX_ST_DPLL_CLK_MASK,
+-      .max_multiplier = 2047,
+-      .max_divider    = 128,
+-      .min_divider    = 1,
+-      .flags          = DPLL_J_TYPE,
+-};
+-
+-/* CLKDCOLDO */
+-static struct clk dpll_per_ck;
+-
+-static struct clk_hw_omap dpll_per_ck_hw = {
+-      .hw     = {
+-              .clk    = &dpll_per_ck,
+-      },
+-      .dpll_data      = &dpll_per_dd,
+-      .ops            = &clkhwops_omap3_dpll,
+-};
+-
+-DEFINE_STRUCT_CLK(dpll_per_ck, dpll_core_ck_parents, dpll_ddr_ck_ops);
+-
+-/* CLKOUT: fdpll/M2 */
+-DEFINE_CLK_DIVIDER(dpll_per_m2_ck, "dpll_per_ck", &dpll_per_ck, 0x0,
+-                 AM33XX_CM_DIV_M2_DPLL_PER, AM33XX_DPLL_CLKOUT_DIV_SHIFT,
+-                 AM33XX_DPLL_CLKOUT_DIV_WIDTH, CLK_DIVIDER_ONE_BASED,
+-                 NULL);
+-
+-DEFINE_CLK_FIXED_FACTOR(dpll_per_m2_div4_wkupdm_ck, "dpll_per_m2_ck",
+-                      &dpll_per_m2_ck, 0x0, 1, 4);
+-
+-DEFINE_CLK_FIXED_FACTOR(dpll_per_m2_div4_ck, "dpll_per_m2_ck",
+-                      &dpll_per_m2_ck, 0x0, 1, 4);
+-
+-DEFINE_CLK_FIXED_FACTOR(dpll_core_m4_div2_ck, "dpll_core_m4_ck",
+-                      &dpll_core_m4_ck, 0x0, 1, 2);
+-
+-DEFINE_CLK_FIXED_FACTOR(l4_rtc_gclk, "dpll_core_m4_ck", &dpll_core_m4_ck, 0x0,
+-                      1, 2);
+-
+-DEFINE_CLK_FIXED_FACTOR(clk_24mhz, "dpll_per_m2_ck", &dpll_per_m2_ck, 0x0, 1,
+-                      8);
+-
+-/*
+- * Below clock nodes describes clockdomains derived out
+- * of core clock.
+- */
+-static const struct clk_ops clk_ops_null = {
+-};
+-
+-static const char *l3_gclk_parents[] = {
+-      "dpll_core_m4_ck"
+-};
+-
+-static struct clk l3_gclk;
+-DEFINE_STRUCT_CLK_HW_OMAP(l3_gclk, NULL);
+-DEFINE_STRUCT_CLK(l3_gclk, l3_gclk_parents, clk_ops_null);
+-
+-static struct clk l4hs_gclk;
+-DEFINE_STRUCT_CLK_HW_OMAP(l4hs_gclk, NULL);
+-DEFINE_STRUCT_CLK(l4hs_gclk, l3_gclk_parents, clk_ops_null);
+-
+-static const char *l3s_gclk_parents[] = {
+-      "dpll_core_m4_div2_ck"
+-};
+-
+-static struct clk l3s_gclk;
+-DEFINE_STRUCT_CLK_HW_OMAP(l3s_gclk, NULL);
+-DEFINE_STRUCT_CLK(l3s_gclk, l3s_gclk_parents, clk_ops_null);
+-
+-static struct clk l4fw_gclk;
+-DEFINE_STRUCT_CLK_HW_OMAP(l4fw_gclk, NULL);
+-DEFINE_STRUCT_CLK(l4fw_gclk, l3s_gclk_parents, clk_ops_null);
+-
+-static struct clk l4ls_gclk;
+-DEFINE_STRUCT_CLK_HW_OMAP(l4ls_gclk, NULL);
+-DEFINE_STRUCT_CLK(l4ls_gclk, l3s_gclk_parents, clk_ops_null);
+-
+-static struct clk sysclk_div_ck;
+-DEFINE_STRUCT_CLK_HW_OMAP(sysclk_div_ck, NULL);
+-DEFINE_STRUCT_CLK(sysclk_div_ck, l3_gclk_parents, clk_ops_null);
+-
+-/*
+- * In order to match the clock domain with hwmod clockdomain entry,
+- * separate clock nodes is required for the modules which are
+- * directly getting their funtioncal clock from sys_clkin.
+- */
+-static struct clk adc_tsc_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(adc_tsc_fck, NULL);
+-DEFINE_STRUCT_CLK(adc_tsc_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk dcan0_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(dcan0_fck, NULL);
+-DEFINE_STRUCT_CLK(dcan0_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk dcan1_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(dcan1_fck, NULL);
+-DEFINE_STRUCT_CLK(dcan1_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk mcasp0_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(mcasp0_fck, NULL);
+-DEFINE_STRUCT_CLK(mcasp0_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk mcasp1_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(mcasp1_fck, NULL);
+-DEFINE_STRUCT_CLK(mcasp1_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk smartreflex0_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(smartreflex0_fck, NULL);
+-DEFINE_STRUCT_CLK(smartreflex0_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk smartreflex1_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(smartreflex1_fck, NULL);
+-DEFINE_STRUCT_CLK(smartreflex1_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk sha0_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(sha0_fck, NULL);
+-DEFINE_STRUCT_CLK(sha0_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk aes0_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(aes0_fck, NULL);
+-DEFINE_STRUCT_CLK(aes0_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-static struct clk rng_fck;
+-DEFINE_STRUCT_CLK_HW_OMAP(rng_fck, NULL);
+-DEFINE_STRUCT_CLK(rng_fck, dpll_core_ck_parents, clk_ops_null);
+-
+-/*
+- * Modules clock nodes
+- *
+- * The following clock leaf nodes are added for the moment because:
+- *
+- *  - hwmod data is not present for these modules, either hwmod
+- *    control is not required or its not populated.
+- *  - Driver code is not yet migrated to use hwmod/runtime pm
+- *  - Modules outside kernel access (to disable them by default)
+- *
+- *     - mmu (gfx domain)
+- *     - cefuse
+- *     - usbotg_fck (its additional clock and not really a modulemode)
+- *     - ieee5000
+- */
+-
+-DEFINE_CLK_GATE(mmu_fck, "dpll_core_m4_ck", &dpll_core_m4_ck, 0x0,
+-              AM33XX_CM_GFX_MMUDATA_CLKCTRL, AM33XX_MODULEMODE_SWCTRL_SHIFT,
+-              0x0, NULL);
+-
+-DEFINE_CLK_GATE(cefuse_fck, "sys_clkin_ck", &sys_clkin_ck, 0x0,
+-              AM33XX_CM_CEFUSE_CEFUSE_CLKCTRL, AM33XX_MODULEMODE_SWCTRL_SHIFT,
+-              0x0, NULL);
+-
+-/*
+- * clkdiv32 is generated from fixed division of 732.4219
+- */
+-DEFINE_CLK_FIXED_FACTOR(clkdiv32k_ck, "clk_24mhz", &clk_24mhz, 0x0, 1, 732);
+-
+-static struct clk clkdiv32k_ick;
+-
+-static const char *clkdiv32k_ick_parent_names[] = {
+-      "clkdiv32k_ck",
+-};
+-
+-static const struct clk_ops clkdiv32k_ick_ops = {
+-      .enable         = &omap2_dflt_clk_enable,
+-      .disable        = &omap2_dflt_clk_disable,
+-      .is_enabled     = &omap2_dflt_clk_is_enabled,
+-      .init           = &omap2_init_clk_clkdm,
+-};
+-
+-static struct clk_hw_omap clkdiv32k_ick_hw = {
+-      .hw     = {
+-              .clk    = &clkdiv32k_ick,
+-      },
+-      .enable_reg     = AM33XX_CM_PER_CLKDIV32K_CLKCTRL,
+-      .enable_bit     = AM33XX_MODULEMODE_SWCTRL_SHIFT,
+-      .clkdm_name     = "clk_24mhz_clkdm",
+-};
+-
+-DEFINE_STRUCT_CLK(clkdiv32k_ick, clkdiv32k_ick_parent_names, clkdiv32k_ick_ops);
+-
+-/* "usbotg_fck" is an additional clock and not really a modulemode */
+-DEFINE_CLK_GATE(usbotg_fck, "dpll_per_ck", &dpll_per_ck, 0x0,
+-              AM33XX_CM_CLKDCOLDO_DPLL_PER, AM33XX_ST_DPLL_CLKDCOLDO_SHIFT,
+-              0x0, NULL);
+-
+-DEFINE_CLK_GATE(ieee5000_fck, "dpll_core_m4_div2_ck", &dpll_core_m4_div2_ck,
+-              0x0, AM33XX_CM_PER_IEEE5000_CLKCTRL,
+-              AM33XX_MODULEMODE_SWCTRL_SHIFT, 0x0, NULL);
+-
+-/* Timers */
+-static const struct clksel timer1_clkmux_sel[] = {
+-      { .parent = &sys_clkin_ck, .rates = div_1_0_rates },
+-      { .parent = &clkdiv32k_ick, .rates = div_1_1_rates },
+-      { .parent = &tclkin_ck, .rates = div_1_2_rates },
+-      { .parent = &clk_rc32k_ck, .rates = div_1_3_rates },
+-      { .parent = &clk_32768_ck, .rates = div_1_4_rates },
+-      { .parent = NULL },
+-};
+-
+-static const char *timer1_ck_parents[] = {
+-      "sys_clkin_ck", "clkdiv32k_ick", "tclkin_ck", "clk_rc32k_ck",
+-      "clk_32768_ck",
+-};
+-
+-static struct clk timer1_fck;
+-
+-static const struct clk_ops timer1_fck_ops = {
+-      .recalc_rate    = &omap2_clksel_recalc,
+-      .get_parent     = &omap2_clksel_find_parent_index,
+-      .set_parent     = &omap2_clksel_set_parent,
+-      .init           = &omap2_init_clk_clkdm,
+-};
+-
+-static struct clk_hw_omap timer1_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer1_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer1_clkmux_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER1MS_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_2_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer1_fck, timer1_ck_parents, timer1_fck_ops);
+-
+-static const struct clksel timer2_to_7_clk_sel[] = {
+-      { .parent = &tclkin_ck, .rates = div_1_0_rates },
+-      { .parent = &sys_clkin_ck, .rates = div_1_1_rates },
+-      { .parent = &clkdiv32k_ick, .rates = div_1_2_rates },
+-      { .parent = NULL },
+-};
+-
+-static const char *timer2_to_7_ck_parents[] = {
+-      "tclkin_ck", "sys_clkin_ck", "clkdiv32k_ick",
+-};
+-
+-static struct clk timer2_fck;
+-
+-static struct clk_hw_omap timer2_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer2_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER2_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer2_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-static struct clk timer3_fck;
+-
+-static struct clk_hw_omap timer3_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer3_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER3_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer3_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-static struct clk timer4_fck;
+-
+-static struct clk_hw_omap timer4_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer4_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER4_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer4_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-static struct clk timer5_fck;
+-
+-static struct clk_hw_omap timer5_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer5_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER5_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer5_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-static struct clk timer6_fck;
+-
+-static struct clk_hw_omap timer6_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer6_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER6_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer6_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-static struct clk timer7_fck;
+-
+-static struct clk_hw_omap timer7_fck_hw = {
+-      .hw     = {
+-              .clk    = &timer7_fck,
+-      },
+-      .clkdm_name     = "l4ls_clkdm",
+-      .clksel         = timer2_to_7_clk_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_TIMER7_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(timer7_fck, timer2_to_7_ck_parents, timer1_fck_ops);
+-
+-DEFINE_CLK_FIXED_FACTOR(cpsw_125mhz_gclk,
+-                      "dpll_core_m5_ck",
+-                      &dpll_core_m5_ck,
+-                      0x0,
+-                      1, 2);
+-
+-static const struct clk_ops cpsw_fck_ops = {
+-      .recalc_rate    = &omap2_clksel_recalc,
+-      .get_parent     = &omap2_clksel_find_parent_index,
+-      .set_parent     = &omap2_clksel_set_parent,
+-};
+-
+-static const struct clksel cpsw_cpts_rft_clkmux_sel[] = {
+-      { .parent = &dpll_core_m5_ck, .rates = div_1_0_rates },
+-      { .parent = &dpll_core_m4_ck, .rates = div_1_1_rates },
+-      { .parent = NULL },
+-};
+-
+-static const char *cpsw_cpts_rft_ck_parents[] = {
+-      "dpll_core_m5_ck", "dpll_core_m4_ck",
+-};
+-
+-static struct clk cpsw_cpts_rft_clk;
+-
+-static struct clk_hw_omap cpsw_cpts_rft_clk_hw = {
+-      .hw     = {
+-              .clk    = &cpsw_cpts_rft_clk,
+-      },
+-      .clkdm_name     = "cpsw_125mhz_clkdm",
+-      .clksel         = cpsw_cpts_rft_clkmux_sel,
+-      .clksel_reg     = AM33XX_CM_CPTS_RFT_CLKSEL,
+-      .clksel_mask    = AM33XX_CLKSEL_0_0_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(cpsw_cpts_rft_clk, cpsw_cpts_rft_ck_parents, cpsw_fck_ops);
+-
+-
+-/* gpio */
+-static const char *gpio0_ck_parents[] = {
+-      "clk_rc32k_ck", "clk_32768_ck", "clkdiv32k_ick",
+-};
+-
+-static const struct clksel gpio0_dbclk_mux_sel[] = {
+-      { .parent = &clk_rc32k_ck, .rates = div_1_0_rates },
+-      { .parent = &clk_32768_ck, .rates = div_1_1_rates },
+-      { .parent = &clkdiv32k_ick, .rates = div_1_2_rates },
+-      { .parent = NULL },
+-};
+-
+-static const struct clk_ops gpio_fck_ops = {
+-      .recalc_rate    = &omap2_clksel_recalc,
+-      .get_parent     = &omap2_clksel_find_parent_index,
+-      .set_parent     = &omap2_clksel_set_parent,
+-      .init           = &omap2_init_clk_clkdm,
+-};
+-
+-static struct clk gpio0_dbclk_mux_ck;
+-
+-static struct clk_hw_omap gpio0_dbclk_mux_ck_hw = {
+-      .hw     = {
+-              .clk    = &gpio0_dbclk_mux_ck,
+-      },
+-      .clkdm_name     = "l4_wkup_clkdm",
+-      .clksel         = gpio0_dbclk_mux_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_GPIO0_DBCLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(gpio0_dbclk_mux_ck, gpio0_ck_parents, gpio_fck_ops);
+-
+-DEFINE_CLK_GATE(gpio0_dbclk, "gpio0_dbclk_mux_ck", &gpio0_dbclk_mux_ck, 0x0,
+-              AM33XX_CM_WKUP_GPIO0_CLKCTRL,
+-              AM33XX_OPTFCLKEN_GPIO0_GDBCLK_SHIFT, 0x0, NULL);
+-
+-DEFINE_CLK_GATE(gpio1_dbclk, "clkdiv32k_ick", &clkdiv32k_ick, 0x0,
+-              AM33XX_CM_PER_GPIO1_CLKCTRL,
+-              AM33XX_OPTFCLKEN_GPIO_1_GDBCLK_SHIFT, 0x0, NULL);
+-
+-DEFINE_CLK_GATE(gpio2_dbclk, "clkdiv32k_ick", &clkdiv32k_ick, 0x0,
+-              AM33XX_CM_PER_GPIO2_CLKCTRL,
+-              AM33XX_OPTFCLKEN_GPIO_2_GDBCLK_SHIFT, 0x0, NULL);
+-
+-DEFINE_CLK_GATE(gpio3_dbclk, "clkdiv32k_ick", &clkdiv32k_ick, 0x0,
+-              AM33XX_CM_PER_GPIO3_CLKCTRL,
+-              AM33XX_OPTFCLKEN_GPIO_3_GDBCLK_SHIFT, 0x0, NULL);
+-
+-
+-static const char *pruss_ck_parents[] = {
+-      "l3_gclk", "dpll_disp_m2_ck",
+-};
+-
+-static const struct clksel pruss_ocp_clk_mux_sel[] = {
+-      { .parent = &l3_gclk, .rates = div_1_0_rates },
+-      { .parent = &dpll_disp_m2_ck, .rates = div_1_1_rates },
+-      { .parent = NULL },
+-};
+-
+-static struct clk pruss_ocp_gclk;
+-
+-static struct clk_hw_omap pruss_ocp_gclk_hw = {
+-      .hw     = {
+-              .clk    = &pruss_ocp_gclk,
+-      },
+-      .clkdm_name     = "pruss_ocp_clkdm",
+-      .clksel         = pruss_ocp_clk_mux_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_PRUSS_OCP_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_0_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(pruss_ocp_gclk, pruss_ck_parents, gpio_fck_ops);
+-
+-static const char *lcd_ck_parents[] = {
+-      "dpll_disp_m2_ck", "dpll_core_m5_ck", "dpll_per_m2_ck",
+-};
+-
+-static const struct clksel lcd_clk_mux_sel[] = {
+-      { .parent = &dpll_disp_m2_ck, .rates = div_1_0_rates },
+-      { .parent = &dpll_core_m5_ck, .rates = div_1_1_rates },
+-      { .parent = &dpll_per_m2_ck, .rates = div_1_2_rates },
+-      { .parent = NULL },
+-};
+-
+-static struct clk lcd_gclk;
+-
+-static struct clk_hw_omap lcd_gclk_hw = {
+-      .hw     = {
+-              .clk    = &lcd_gclk,
+-      },
+-      .clkdm_name     = "lcdc_clkdm",
+-      .clksel         = lcd_clk_mux_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_LCDC_PIXEL_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK_FLAGS(lcd_gclk, lcd_ck_parents,
+-                      gpio_fck_ops, CLK_SET_RATE_PARENT);
+-
+-DEFINE_CLK_FIXED_FACTOR(mmc_clk, "dpll_per_m2_ck", &dpll_per_m2_ck, 0x0, 1, 2);
+-
+-static const char *gfx_ck_parents[] = {
+-      "dpll_core_m4_ck", "dpll_per_m2_ck",
+-};
+-
+-static const struct clksel gfx_clksel_sel[] = {
+-      { .parent = &dpll_core_m4_ck, .rates = div_1_0_rates },
+-      { .parent = &dpll_per_m2_ck, .rates = div_1_1_rates },
+-      { .parent = NULL },
+-};
+-
+-static struct clk gfx_fclk_clksel_ck;
+-
+-static struct clk_hw_omap gfx_fclk_clksel_ck_hw = {
+-      .hw     = {
+-              .clk    = &gfx_fclk_clksel_ck,
+-      },
+-      .clksel         = gfx_clksel_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_GFX_FCLK,
+-      .clksel_mask    = AM33XX_CLKSEL_GFX_FCLK_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(gfx_fclk_clksel_ck, gfx_ck_parents, gpio_fck_ops);
+-
+-static const struct clk_div_table div_1_0_2_1_rates[] = {
+-      { .div = 1, .val = 0, },
+-      { .div = 2, .val = 1, },
+-      { .div = 0 },
+-};
+-
+-DEFINE_CLK_DIVIDER_TABLE(gfx_fck_div_ck, "gfx_fclk_clksel_ck",
+-                       &gfx_fclk_clksel_ck, 0x0, AM33XX_CLKSEL_GFX_FCLK,
+-                       AM33XX_CLKSEL_0_0_SHIFT, AM33XX_CLKSEL_0_0_WIDTH,
+-                       0x0, div_1_0_2_1_rates, NULL);
+-
+-static const char *sysclkout_ck_parents[] = {
+-      "clk_32768_ck", "l3_gclk", "dpll_ddr_m2_ck", "dpll_per_m2_ck",
+-      "lcd_gclk",
+-};
+-
+-static const struct clksel sysclkout_pre_sel[] = {
+-      { .parent = &clk_32768_ck, .rates = div_1_0_rates },
+-      { .parent = &l3_gclk, .rates = div_1_1_rates },
+-      { .parent = &dpll_ddr_m2_ck, .rates = div_1_2_rates },
+-      { .parent = &dpll_per_m2_ck, .rates = div_1_3_rates },
+-      { .parent = &lcd_gclk, .rates = div_1_4_rates },
+-      { .parent = NULL },
+-};
+-
+-static struct clk sysclkout_pre_ck;
+-
+-static struct clk_hw_omap sysclkout_pre_ck_hw = {
+-      .hw     = {
+-              .clk    = &sysclkout_pre_ck,
+-      },
+-      .clksel         = sysclkout_pre_sel,
+-      .clksel_reg     = AM33XX_CM_CLKOUT_CTRL,
+-      .clksel_mask    = AM33XX_CLKOUT2SOURCE_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(sysclkout_pre_ck, sysclkout_ck_parents, gpio_fck_ops);
+-
+-/* Divide by 8 clock rates with default clock is 1/1*/
+-static const struct clk_div_table div8_rates[] = {
+-      { .div = 1, .val = 0, },
+-      { .div = 2, .val = 1, },
+-      { .div = 3, .val = 2, },
+-      { .div = 4, .val = 3, },
+-      { .div = 5, .val = 4, },
+-      { .div = 6, .val = 5, },
+-      { .div = 7, .val = 6, },
+-      { .div = 8, .val = 7, },
+-      { .div = 0 },
+-};
+-
+-DEFINE_CLK_DIVIDER_TABLE(clkout2_div_ck, "sysclkout_pre_ck", &sysclkout_pre_ck,
+-                       0x0, AM33XX_CM_CLKOUT_CTRL, AM33XX_CLKOUT2DIV_SHIFT,
+-                       AM33XX_CLKOUT2DIV_WIDTH, 0x0, div8_rates, NULL);
+-
+-DEFINE_CLK_GATE(clkout2_ck, "clkout2_div_ck", &clkout2_div_ck, 0x0,
+-              AM33XX_CM_CLKOUT_CTRL, AM33XX_CLKOUT2EN_SHIFT, 0x0, NULL);
+-
+-static const char *wdt_ck_parents[] = {
+-      "clk_rc32k_ck", "clkdiv32k_ick",
+-};
+-
+-static const struct clksel wdt_clkmux_sel[] = {
+-      { .parent = &clk_rc32k_ck, .rates = div_1_0_rates },
+-      { .parent = &clkdiv32k_ick, .rates = div_1_1_rates },
+-      { .parent = NULL },
+-};
+-
+-static struct clk wdt1_fck;
+-
+-static struct clk_hw_omap wdt1_fck_hw = {
+-      .hw     = {
+-              .clk    = &wdt1_fck,
+-      },
+-      .clkdm_name     = "l4_wkup_clkdm",
+-      .clksel         = wdt_clkmux_sel,
+-      .clksel_reg     = AM33XX_CLKSEL_WDT1_CLK,
+-      .clksel_mask    = AM33XX_CLKSEL_0_1_MASK,
+-};
+-
+-DEFINE_STRUCT_CLK(wdt1_fck, wdt_ck_parents, gpio_fck_ops);
+-
+-static const char *pwmss_clk_parents[] = {
+-      "dpll_per_m2_ck",
+-};
+-
+-static const struct clk_ops ehrpwm_tbclk_ops = {
+-      .enable         = &omap2_dflt_clk_enable,
+-      .disable        = &omap2_dflt_clk_disable,
+-};
+-
+-DEFINE_CLK_OMAP_MUX_GATE(ehrpwm0_tbclk, "l4ls_clkdm",
+-                       NULL, NULL, 0,
+-                       AM33XX_CTRL_REGADDR(AM33XX_PWMSS_TBCLK_CLKCTRL),
+-                       AM33XX_PWMSS0_TBCLKEN_SHIFT,
+-                       NULL, pwmss_clk_parents, ehrpwm_tbclk_ops);
+-
+-DEFINE_CLK_OMAP_MUX_GATE(ehrpwm1_tbclk, "l4ls_clkdm",
+-                       NULL, NULL, 0,
+-                       AM33XX_CTRL_REGADDR(AM33XX_PWMSS_TBCLK_CLKCTRL),
+-                       AM33XX_PWMSS1_TBCLKEN_SHIFT,
+-                       NULL, pwmss_clk_parents, ehrpwm_tbclk_ops);
+-
+-DEFINE_CLK_OMAP_MUX_GATE(ehrpwm2_tbclk, "l4ls_clkdm",
+-                       NULL, NULL, 0,
+-                       AM33XX_CTRL_REGADDR(AM33XX_PWMSS_TBCLK_CLKCTRL),
+-                       AM33XX_PWMSS2_TBCLKEN_SHIFT,
+-                       NULL, pwmss_clk_parents, ehrpwm_tbclk_ops);
+-
+-/*
+- * debugss optional clocks
+- */
+-DEFINE_CLK_GATE(dbg_sysclk_ck, "sys_clkin_ck", &sys_clkin_ck,
+-              0x0, AM33XX_CM_WKUP_DEBUGSS_CLKCTRL,
+-              AM33XX_OPTFCLKEN_DBGSYSCLK_SHIFT, 0x0, NULL);
+-
+-DEFINE_CLK_GATE(dbg_clka_ck, "dpll_core_m4_ck", &dpll_core_m4_ck,
+-              0x0, AM33XX_CM_WKUP_DEBUGSS_CLKCTRL,
+-              AM33XX_OPTCLK_DEBUG_CLKA_SHIFT, 0x0, NULL);
+-
+-static const char *stm_pmd_clock_mux_ck_parents[] = {
+-      "dbg_sysclk_ck", "dbg_clka_ck",
+-};
+-
+-DEFINE_CLK_MUX(stm_pmd_clock_mux_ck, stm_pmd_clock_mux_ck_parents, NULL, 0x0,
+-             AM33XX_CM_WKUP_DEBUGSS_CLKCTRL, AM33XX_STM_PMD_CLKSEL_SHIFT,
+-             AM33XX_STM_PMD_CLKSEL_WIDTH, 0x0, NULL);
+-
+-DEFINE_CLK_MUX(trace_pmd_clk_mux_ck, stm_pmd_clock_mux_ck_parents, NULL, 0x0,
+-             AM33XX_CM_WKUP_DEBUGSS_CLKCTRL,
+-             AM33XX_TRC_PMD_CLKSEL_SHIFT,
+-             AM33XX_TRC_PMD_CLKSEL_WIDTH, 0x0, NULL);
+-
+-DEFINE_CLK_DIVIDER(stm_clk_div_ck, "stm_pmd_clock_mux_ck",
+-                 &stm_pmd_clock_mux_ck, 0x0, AM33XX_CM_WKUP_DEBUGSS_CLKCTRL,
+-                 AM33XX_STM_PMD_CLKDIVSEL_SHIFT,
+-                 AM33XX_STM_PMD_CLKDIVSEL_WIDTH, CLK_DIVIDER_POWER_OF_TWO,
+-                 NULL);
+-
+-DEFINE_CLK_DIVIDER(trace_clk_div_ck, "trace_pmd_clk_mux_ck",
+-                 &trace_pmd_clk_mux_ck, 0x0, AM33XX_CM_WKUP_DEBUGSS_CLKCTRL,
+-                 AM33XX_TRC_PMD_CLKDIVSEL_SHIFT,
+-                 AM33XX_TRC_PMD_CLKDIVSEL_WIDTH, CLK_DIVIDER_POWER_OF_TWO,
+-                 NULL);
+-
+-/*
+- * clkdev
+- */
+-static struct omap_clk am33xx_clks[] = {
+-      CLK(NULL,       "clk_32768_ck",         &clk_32768_ck),
+-      CLK(NULL,       "clk_rc32k_ck",         &clk_rc32k_ck),
+-      CLK(NULL,       "virt_19200000_ck",     &virt_19200000_ck),
+-      CLK(NULL,       "virt_24000000_ck",     &virt_24000000_ck),
+-      CLK(NULL,       "virt_25000000_ck",     &virt_25000000_ck),
+-      CLK(NULL,       "virt_26000000_ck",     &virt_26000000_ck),
+-      CLK(NULL,       "sys_clkin_ck",         &sys_clkin_ck),
+-      CLK(NULL,       "tclkin_ck",            &tclkin_ck),
+-      CLK(NULL,       "dpll_core_ck",         &dpll_core_ck),
+-      CLK(NULL,       "dpll_core_x2_ck",      &dpll_core_x2_ck),
+-      CLK(NULL,       "dpll_core_m4_ck",      &dpll_core_m4_ck),
+-      CLK(NULL,       "dpll_core_m5_ck",      &dpll_core_m5_ck),
+-      CLK(NULL,       "dpll_core_m6_ck",      &dpll_core_m6_ck),
+-      CLK(NULL,       "dpll_mpu_ck",          &dpll_mpu_ck),
+-      CLK("cpu0",     NULL,                   &dpll_mpu_ck),
+-      CLK(NULL,       "dpll_mpu_m2_ck",       &dpll_mpu_m2_ck),
+-      CLK(NULL,       "dpll_ddr_ck",          &dpll_ddr_ck),
+-      CLK(NULL,       "dpll_ddr_m2_ck",       &dpll_ddr_m2_ck),
+-      CLK(NULL,       "dpll_ddr_m2_div2_ck",  &dpll_ddr_m2_div2_ck),
+-      CLK(NULL,       "dpll_disp_ck",         &dpll_disp_ck),
+-      CLK(NULL,       "dpll_disp_m2_ck",      &dpll_disp_m2_ck),
+-      CLK(NULL,       "dpll_per_ck",          &dpll_per_ck),
+-      CLK(NULL,       "dpll_per_m2_ck",       &dpll_per_m2_ck),
+-      CLK(NULL,       "dpll_per_m2_div4_wkupdm_ck",   &dpll_per_m2_div4_wkupdm_ck),
+-      CLK(NULL,       "dpll_per_m2_div4_ck",  &dpll_per_m2_div4_ck),
+-      CLK(NULL,       "adc_tsc_fck",          &adc_tsc_fck),
+-      CLK(NULL,       "cefuse_fck",           &cefuse_fck),
+-      CLK(NULL,       "clkdiv32k_ck",         &clkdiv32k_ck),
+-      CLK(NULL,       "clkdiv32k_ick",        &clkdiv32k_ick),
+-      CLK(NULL,       "dcan0_fck",            &dcan0_fck),
+-      CLK("481cc000.d_can",   NULL,           &dcan0_fck),
+-      CLK(NULL,       "dcan1_fck",            &dcan1_fck),
+-      CLK("481d0000.d_can",   NULL,           &dcan1_fck),
+-      CLK(NULL,       "pruss_ocp_gclk",       &pruss_ocp_gclk),
+-      CLK(NULL,       "mcasp0_fck",           &mcasp0_fck),
+-      CLK(NULL,       "mcasp1_fck",           &mcasp1_fck),
+-      CLK(NULL,       "mmu_fck",              &mmu_fck),
+-      CLK(NULL,       "smartreflex0_fck",     &smartreflex0_fck),
+-      CLK(NULL,       "smartreflex1_fck",     &smartreflex1_fck),
+-      CLK(NULL,       "sha0_fck",             &sha0_fck),
+-      CLK(NULL,       "aes0_fck",             &aes0_fck),
+-      CLK(NULL,       "rng_fck",              &rng_fck),
+-      CLK(NULL,       "timer1_fck",           &timer1_fck),
+-      CLK(NULL,       "timer2_fck",           &timer2_fck),
+-      CLK(NULL,       "timer3_fck",           &timer3_fck),
+-      CLK(NULL,       "timer4_fck",           &timer4_fck),
+-      CLK(NULL,       "timer5_fck",           &timer5_fck),
+-      CLK(NULL,       "timer6_fck",           &timer6_fck),
+-      CLK(NULL,       "timer7_fck",           &timer7_fck),
+-      CLK(NULL,       "usbotg_fck",           &usbotg_fck),
+-      CLK(NULL,       "ieee5000_fck",         &ieee5000_fck),
+-      CLK(NULL,       "wdt1_fck",             &wdt1_fck),
+-      CLK(NULL,       "l4_rtc_gclk",          &l4_rtc_gclk),
+-      CLK(NULL,       "l3_gclk",              &l3_gclk),
+-      CLK(NULL,       "dpll_core_m4_div2_ck", &dpll_core_m4_div2_ck),
+-      CLK(NULL,       "l4hs_gclk",            &l4hs_gclk),
+-      CLK(NULL,       "l3s_gclk",             &l3s_gclk),
+-      CLK(NULL,       "l4fw_gclk",            &l4fw_gclk),
+-      CLK(NULL,       "l4ls_gclk",            &l4ls_gclk),
+-      CLK(NULL,       "clk_24mhz",            &clk_24mhz),
+-      CLK(NULL,       "sysclk_div_ck",        &sysclk_div_ck),
+-      CLK(NULL,       "cpsw_125mhz_gclk",     &cpsw_125mhz_gclk),
+-      CLK(NULL,       "cpsw_cpts_rft_clk",    &cpsw_cpts_rft_clk),
+-      CLK(NULL,       "gpio0_dbclk_mux_ck",   &gpio0_dbclk_mux_ck),
+-      CLK(NULL,       "gpio0_dbclk",          &gpio0_dbclk),
+-      CLK(NULL,       "gpio1_dbclk",          &gpio1_dbclk),
+-      CLK(NULL,       "gpio2_dbclk",          &gpio2_dbclk),
+-      CLK(NULL,       "gpio3_dbclk",          &gpio3_dbclk),
+-      CLK(NULL,       "lcd_gclk",             &lcd_gclk),
+-      CLK(NULL,       "mmc_clk",              &mmc_clk),
+-      CLK(NULL,       "gfx_fclk_clksel_ck",   &gfx_fclk_clksel_ck),
+-      CLK(NULL,       "gfx_fck_div_ck",       &gfx_fck_div_ck),
+-      CLK(NULL,       "sysclkout_pre_ck",     &sysclkout_pre_ck),
+-      CLK(NULL,       "clkout2_div_ck",       &clkout2_div_ck),
+-      CLK(NULL,       "timer_32k_ck",         &clkdiv32k_ick),
+-      CLK(NULL,       "timer_sys_ck",         &sys_clkin_ck),
+-      CLK(NULL,       "dbg_sysclk_ck",        &dbg_sysclk_ck),
+-      CLK(NULL,       "dbg_clka_ck",          &dbg_clka_ck),
+-      CLK(NULL,       "stm_pmd_clock_mux_ck", &stm_pmd_clock_mux_ck),
+-      CLK(NULL,       "trace_pmd_clk_mux_ck", &trace_pmd_clk_mux_ck),
+-      CLK(NULL,       "stm_clk_div_ck",       &stm_clk_div_ck),
+-      CLK(NULL,       "trace_clk_div_ck",     &trace_clk_div_ck),
+-      CLK(NULL,       "clkout2_ck",           &clkout2_ck),
+-      CLK("48300200.ehrpwm",  "tbclk",        &ehrpwm0_tbclk),
+-      CLK("48302200.ehrpwm",  "tbclk",        &ehrpwm1_tbclk),
+-      CLK("48304200.ehrpwm",  "tbclk",        &ehrpwm2_tbclk),
+-};
+-
+-
+-static const char *enable_init_clks[] = {
+-      "dpll_ddr_m2_ck",
+-      "dpll_mpu_m2_ck",
+-      "l3_gclk",
+-      "l4hs_gclk",
+-      "l4fw_gclk",
+-      "l4ls_gclk",
+-      "clkout2_ck",   /* Required for external peripherals like, Audio codecs */
+-};
+-
+-int __init am33xx_clk_init(void)
+-{
+-      if (soc_is_am33xx())
+-              cpu_mask = RATE_IN_AM33XX;
+-
+-      omap_clocks_register(am33xx_clks, ARRAY_SIZE(am33xx_clks));
+-
+-      omap2_clk_disable_autoidle_all();
+-
+-      omap2_clk_enable_init_clocks(enable_init_clks,
+-                                   ARRAY_SIZE(enable_init_clks));
+-
+-      /* TRM ERRATA: Timer 3 & 6 default parent (TCLKIN) may not be always
+-       *    physically present, in such a case HWMOD enabling of
+-       *    clock would be failure with default parent. And timer
+-       *    probe thinks clock is already enabled, this leads to
+-       *    crash upon accessing timer 3 & 6 registers in probe.
+-       *    Fix by setting parent of both these timers to master
+-       *    oscillator clock.
+-       */
+-
+-      clk_set_parent(&timer3_fck, &sys_clkin_ck);
+-      clk_set_parent(&timer6_fck, &sys_clkin_ck);
+-      /*
+-       * The On-Chip 32K RC Osc clock is not an accurate clock-source as per
+-       * the design/spec, so as a result, for example, timer which supposed
+-       * to get expired @60Sec, but will expire somewhere ~@40Sec, which is
+-       * not expected by any use-case, so change WDT1 clock source to PRCM
+-       * 32KHz clock.
+-       */
+-      clk_set_parent(&wdt1_fck, &clkdiv32k_ick);
+-
+-      return 0;
+-}
+--- a/arch/arm/mach-omap2/clkt_dpll.c
++++ b/arch/arm/mach-omap2/clkt_dpll.c
+@@ -209,7 +209,7 @@ u8 omap2_init_dpll_parent(struct clk_hw
+               if (v == OMAP3XXX_EN_DPLL_LPBYPASS ||
+                   v == OMAP3XXX_EN_DPLL_FRBYPASS)
+                       return 1;
+-      } else if (soc_is_am33xx() || cpu_is_omap44xx()) {
++      } else if (soc_is_am33xx() || cpu_is_omap44xx() || soc_is_am43xx()) {
+               if (v == OMAP4XXX_EN_DPLL_LPBYPASS ||
+                   v == OMAP4XXX_EN_DPLL_FRBYPASS ||
+                   v == OMAP4XXX_EN_DPLL_MNBYPASS)
+@@ -255,7 +255,7 @@ unsigned long omap2_get_dpll_rate(struct
+               if (v == OMAP3XXX_EN_DPLL_LPBYPASS ||
+                   v == OMAP3XXX_EN_DPLL_FRBYPASS)
+                       return __clk_get_rate(dd->clk_bypass);
+-      } else if (soc_is_am33xx() || cpu_is_omap44xx()) {
++      } else if (soc_is_am33xx() || cpu_is_omap44xx() || soc_is_am43xx()) {
+               if (v == OMAP4XXX_EN_DPLL_LPBYPASS ||
+                   v == OMAP4XXX_EN_DPLL_FRBYPASS ||
+                   v == OMAP4XXX_EN_DPLL_MNBYPASS)
+--- a/arch/arm/mach-omap2/clock3xxx.h
++++ b/arch/arm/mach-omap2/clock3xxx.h
+@@ -9,11 +9,12 @@
+ #define __ARCH_ARM_MACH_OMAP2_CLOCK3XXX_H
+ int omap3xxx_clk_init(void);
+-int omap3_dpll4_set_rate(struct clk_hw *clk, unsigned long rate,
+-                                      unsigned long parent_rate);
++int omap3430_clk_init(void);
++int omap3630_clk_init(void);
++int ti81xx_clk_init(void);
++int am35xx_clk_init(void);
+ int omap3_core_dpll_m2_set_rate(struct clk_hw *clk, unsigned long rate,
+                                       unsigned long parent_rate);
+-void omap3_clk_lock_dpll5(void);
+ extern struct clk *sdrc_ick_p;
+ extern struct clk *arm_fck_p;
+--- a/arch/arm/mach-omap2/clock.c
++++ b/arch/arm/mach-omap2/clock.c
+@@ -520,6 +520,9 @@ int omap2_clk_enable_autoidle_all(void)
+       list_for_each_entry(c, &clk_hw_omap_clocks, node)
+               if (c->ops && c->ops->allow_idle)
+                       c->ops->allow_idle(c);
++
++      of_omap_clk_allow_autoidle_all();
++
+       return 0;
+ }
+@@ -539,6 +542,9 @@ int omap2_clk_disable_autoidle_all(void)
+       list_for_each_entry(c, &clk_hw_omap_clocks, node)
+               if (c->ops && c->ops->deny_idle)
+                       c->ops->deny_idle(c);
++
++      of_omap_clk_deny_autoidle_all();
++
+       return 0;
+ }
+--- a/arch/arm/mach-omap2/clockdomain.h
++++ b/arch/arm/mach-omap2/clockdomain.h
+@@ -132,7 +132,7 @@ struct clockdomain {
+       u8 _flags;
+       const u8 dep_bit;
+       const u8 prcm_partition;
+-      const s16 cm_inst;
++      const u16 cm_inst;
+       const u16 clkdm_offs;
+       struct clkdm_dep *wkdep_srcs;
+       struct clkdm_dep *sleepdep_srcs;
+@@ -215,6 +215,7 @@ extern void __init omap242x_clockdomains
+ extern void __init omap243x_clockdomains_init(void);
+ extern void __init omap3xxx_clockdomains_init(void);
+ extern void __init am33xx_clockdomains_init(void);
++extern void am43xx_clockdomains_init(void);
+ extern void __init omap44xx_clockdomains_init(void);
+ extern void __init omap54xx_clockdomains_init(void);
+ extern void __init dra7xx_clockdomains_init(void);
+@@ -226,6 +227,7 @@ extern struct clkdm_ops omap2_clkdm_oper
+ extern struct clkdm_ops omap3_clkdm_operations;
+ extern struct clkdm_ops omap4_clkdm_operations;
+ extern struct clkdm_ops am33xx_clkdm_operations;
++extern struct clkdm_ops am43xx_clkdm_operations;
+ extern struct clkdm_dep gfx_24xx_wkdeps[];
+ extern struct clkdm_dep dsp_24xx_wkdeps[];
+--- /dev/null
++++ b/arch/arm/mach-omap2/clockdomains43xx_data.c
+@@ -0,0 +1,199 @@
++/*
++ * AM43xx Clock domains framework
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * This file is made by modifying the file generated automatically
++ * from the OMAP hardware databases.
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/io.h>
++
++#include "clockdomain.h"
++#include "prcm44xx.h"
++#include "prcm43xx.h"
++
++static struct clockdomain l4_cefuse_43xx_clkdm = {
++      .name             = "l4_cefuse_clkdm",
++      .pwrdm            = { .name = "cefuse_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_CEFUSE_INST,
++      .clkdm_offs       = AM43XX_CM_CEFUSE_CEFUSE_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain mpu_43xx_clkdm = {
++      .name             = "mpu_clkdm",
++      .pwrdm            = { .name = "mpu_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_MPU_INST,
++      .clkdm_offs       = AM43XX_CM_MPU_MPU_CDOFFS,
++      .flags            = CLKDM_CAN_HWSUP_SWSUP,
++};
++
++static struct clockdomain l4ls_43xx_clkdm = {
++      .name             = "l4ls_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_L4LS_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain tamper_43xx_clkdm = {
++      .name             = "tamper_clkdm",
++      .pwrdm            = { .name = "tamper_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_TAMPER_INST,
++      .clkdm_offs       = AM43XX_CM_TAMPER_TAMPER_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l4_rtc_43xx_clkdm = {
++      .name             = "l4_rtc_clkdm",
++      .pwrdm            = { .name = "rtc_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_RTC_INST,
++      .clkdm_offs       = AM43XX_CM_RTC_RTC_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain pruss_ocp_43xx_clkdm = {
++      .name             = "pruss_ocp_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_ICSS_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain ocpwp_l3_43xx_clkdm = {
++      .name             = "ocpwp_l3_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_OCPWP_L3_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l3s_tsc_43xx_clkdm = {
++      .name             = "l3s_tsc_clkdm",
++      .pwrdm            = { .name = "wkup_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_WKUP_INST,
++      .clkdm_offs       = AM43XX_CM_WKUP_L3S_TSC_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain dss_43xx_clkdm = {
++      .name             = "dss_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_DSS_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l3_aon_43xx_clkdm = {
++      .name             = "l3_aon_clkdm",
++      .pwrdm            = { .name = "wkup_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_WKUP_INST,
++      .clkdm_offs       = AM43XX_CM_WKUP_L3_AON_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain emif_43xx_clkdm = {
++      .name             = "emif_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_EMIF_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l4_wkup_aon_43xx_clkdm = {
++      .name             = "l4_wkup_aon_clkdm",
++      .pwrdm            = { .name = "wkup_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_WKUP_INST,
++      .clkdm_offs       = AM43XX_CM_WKUP_L4_WKUP_AON_CDOFFS,
++};
++
++static struct clockdomain l3_43xx_clkdm = {
++      .name             = "l3_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_L3_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l4_wkup_43xx_clkdm = {
++      .name             = "l4_wkup_clkdm",
++      .pwrdm            = { .name = "wkup_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_WKUP_INST,
++      .clkdm_offs       = AM43XX_CM_WKUP_WKUP_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain cpsw_125mhz_43xx_clkdm = {
++      .name             = "cpsw_125mhz_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_CPSW_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain gfx_l3_43xx_clkdm = {
++      .name             = "gfx_l3_clkdm",
++      .pwrdm            = { .name = "gfx_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_GFX_INST,
++      .clkdm_offs       = AM43XX_CM_GFX_GFX_L3_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain l3s_43xx_clkdm = {
++      .name             = "l3s_clkdm",
++      .pwrdm            = { .name = "per_pwrdm" },
++      .prcm_partition   = AM43XX_CM_PARTITION,
++      .cm_inst          = AM43XX_CM_PER_INST,
++      .clkdm_offs       = AM43XX_CM_PER_L3S_CDOFFS,
++      .flags            = CLKDM_CAN_SWSUP,
++};
++
++static struct clockdomain *clockdomains_am43xx[] __initdata = {
++      &l4_cefuse_43xx_clkdm,
++      &mpu_43xx_clkdm,
++      &l4ls_43xx_clkdm,
++      &tamper_43xx_clkdm,
++      &l4_rtc_43xx_clkdm,
++      &pruss_ocp_43xx_clkdm,
++      &ocpwp_l3_43xx_clkdm,
++      &l3s_tsc_43xx_clkdm,
++      &dss_43xx_clkdm,
++      &l3_aon_43xx_clkdm,
++      &emif_43xx_clkdm,
++      &l4_wkup_aon_43xx_clkdm,
++      &l3_43xx_clkdm,
++      &l4_wkup_43xx_clkdm,
++      &cpsw_125mhz_43xx_clkdm,
++      &gfx_l3_43xx_clkdm,
++      &l3s_43xx_clkdm,
++      NULL
++};
++
++void __init am43xx_clockdomains_init(void)
++{
++      clkdm_register_platform_funcs(&am43xx_clkdm_operations);
++      clkdm_register_clkdms(clockdomains_am43xx);
++      clkdm_complete_init();
++}
+--- a/arch/arm/mach-omap2/clockdomains7xx_data.c
++++ b/arch/arm/mach-omap2/clockdomains7xx_data.c
+@@ -409,7 +409,7 @@ static struct clockdomain l4sec_7xx_clkd
+       .dep_bit          = DRA7XX_L4SEC_STATDEP_SHIFT,
+       .wkdep_srcs       = l4sec_wkup_sleep_deps,
+       .sleepdep_srcs    = l4sec_wkup_sleep_deps,
+-      .flags            = CLKDM_CAN_HWSUP_SWSUP,
++      .flags            = CLKDM_CAN_SWSUP,
+ };
+ static struct clockdomain l3main1_7xx_clkdm = {
+@@ -554,7 +554,7 @@ static struct clockdomain dss_7xx_clkdm
+       .dep_bit          = DRA7XX_DSS_STATDEP_SHIFT,
+       .wkdep_srcs       = dss_wkup_sleep_deps,
+       .sleepdep_srcs    = dss_wkup_sleep_deps,
+-      .flags            = CLKDM_CAN_HWSUP_SWSUP,
++      .flags            = CLKDM_CAN_SWSUP,
+ };
+ static struct clockdomain emif_7xx_clkdm = {
+--- a/arch/arm/mach-omap2/clock.h
++++ b/arch/arm/mach-omap2/clock.h
+@@ -21,6 +21,7 @@
+ #include <linux/clkdev.h>
+ #include <linux/clk-provider.h>
++#include <linux/clk/ti.h>
+ struct omap_clk {
+       u16                             cpu;
+@@ -37,7 +38,6 @@ struct omap_clk {
+       }
+ struct clockdomain;
+-#define to_clk_hw_omap(_hw) container_of(_hw, struct clk_hw_omap, hw)
+ #define DEFINE_STRUCT_CLK(_name, _parent_array_name, _clkops_name)    \
+       static struct clk _name = {                             \
+@@ -178,141 +178,6 @@ struct clksel {
+       const struct clksel_rate *rates;
+ };
+-/**
+- * struct dpll_data - DPLL registers and integration data
+- * @mult_div1_reg: register containing the DPLL M and N bitfields
+- * @mult_mask: mask of the DPLL M bitfield in @mult_div1_reg
+- * @div1_mask: mask of the DPLL N bitfield in @mult_div1_reg
+- * @clk_bypass: struct clk pointer to the clock's bypass clock input
+- * @clk_ref: struct clk pointer to the clock's reference clock input
+- * @control_reg: register containing the DPLL mode bitfield
+- * @enable_mask: mask of the DPLL mode bitfield in @control_reg
+- * @last_rounded_rate: cache of the last rate result of omap2_dpll_round_rate()
+- * @last_rounded_m: cache of the last M result of omap2_dpll_round_rate()
+- * @last_rounded_m4xen: cache of the last M4X result of
+- *                    omap4_dpll_regm4xen_round_rate()
+- * @last_rounded_lpmode: cache of the last lpmode result of
+- *                     omap4_dpll_lpmode_recalc()
+- * @max_multiplier: maximum valid non-bypass multiplier value (actual)
+- * @last_rounded_n: cache of the last N result of omap2_dpll_round_rate()
+- * @min_divider: minimum valid non-bypass divider value (actual)
+- * @max_divider: maximum valid non-bypass divider value (actual)
+- * @modes: possible values of @enable_mask
+- * @autoidle_reg: register containing the DPLL autoidle mode bitfield
+- * @idlest_reg: register containing the DPLL idle status bitfield
+- * @autoidle_mask: mask of the DPLL autoidle mode bitfield in @autoidle_reg
+- * @freqsel_mask: mask of the DPLL jitter correction bitfield in @control_reg
+- * @idlest_mask: mask of the DPLL idle status bitfield in @idlest_reg
+- * @lpmode_mask: mask of the DPLL low-power mode bitfield in @control_reg
+- * @m4xen_mask: mask of the DPLL M4X multiplier bitfield in @control_reg
+- * @auto_recal_bit: bitshift of the driftguard enable bit in @control_reg
+- * @recal_en_bit: bitshift of the PRM_IRQENABLE_* bit for recalibration IRQs
+- * @recal_st_bit: bitshift of the PRM_IRQSTATUS_* bit for recalibration IRQs
+- * @flags: DPLL type/features (see below)
+- *
+- * Possible values for @flags:
+- * DPLL_J_TYPE: "J-type DPLL" (only some 36xx, 4xxx DPLLs)
+- *
+- * @freqsel_mask is only used on the OMAP34xx family and AM35xx.
+- *
+- * XXX Some DPLLs have multiple bypass inputs, so it's not technically
+- * correct to only have one @clk_bypass pointer.
+- *
+- * XXX The runtime-variable fields (@last_rounded_rate, @last_rounded_m,
+- * @last_rounded_n) should be separated from the runtime-fixed fields
+- * and placed into a different structure, so that the runtime-fixed data
+- * can be placed into read-only space.
+- */
+-struct dpll_data {
+-      void __iomem            *mult_div1_reg;
+-      u32                     mult_mask;
+-      u32                     div1_mask;
+-      struct clk              *clk_bypass;
+-      struct clk              *clk_ref;
+-      void __iomem            *control_reg;
+-      u32                     enable_mask;
+-      unsigned long           last_rounded_rate;
+-      u16                     last_rounded_m;
+-      u8                      last_rounded_m4xen;
+-      u8                      last_rounded_lpmode;
+-      u16                     max_multiplier;
+-      u8                      last_rounded_n;
+-      u8                      min_divider;
+-      u16                     max_divider;
+-      u8                      modes;
+-      void __iomem            *autoidle_reg;
+-      void __iomem            *idlest_reg;
+-      u32                     autoidle_mask;
+-      u32                     freqsel_mask;
+-      u32                     idlest_mask;
+-      u32                     dco_mask;
+-      u32                     sddiv_mask;
+-      u32                     lpmode_mask;
+-      u32                     m4xen_mask;
+-      u8                      auto_recal_bit;
+-      u8                      recal_en_bit;
+-      u8                      recal_st_bit;
+-      u8                      flags;
+-};
+-
+-/*
+- * struct clk.flags possibilities
+- *
+- * XXX document the rest of the clock flags here
+- *
+- * CLOCK_CLKOUTX2: (OMAP4 only) DPLL CLKOUT and CLKOUTX2 GATE_CTRL
+- *     bits share the same register.  This flag allows the
+- *     omap4_dpllmx*() code to determine which GATE_CTRL bit field
+- *     should be used.  This is a temporary solution - a better approach
+- *     would be to associate clock type-specific data with the clock,
+- *     similar to the struct dpll_data approach.
+- */
+-#define ENABLE_REG_32BIT      (1 << 0)        /* Use 32-bit access */
+-#define CLOCK_IDLE_CONTROL    (1 << 1)
+-#define CLOCK_NO_IDLE_PARENT  (1 << 2)
+-#define ENABLE_ON_INIT                (1 << 3)        /* Enable upon framework init */
+-#define INVERT_ENABLE         (1 << 4)        /* 0 enables, 1 disables */
+-#define CLOCK_CLKOUTX2                (1 << 5)
+-
+-/**
+- * struct clk_hw_omap - OMAP struct clk
+- * @node: list_head connecting this clock into the full clock list
+- * @enable_reg: register to write to enable the clock (see @enable_bit)
+- * @enable_bit: bitshift to write to enable/disable the clock (see @enable_reg)
+- * @flags: see "struct clk.flags possibilities" above
+- * @clksel_reg: for clksel clks, register va containing src/divisor select
+- * @clksel_mask: bitmask in @clksel_reg for the src/divisor selector
+- * @clksel: for clksel clks, pointer to struct clksel for this clock
+- * @dpll_data: for DPLLs, pointer to struct dpll_data for this clock
+- * @clkdm_name: clockdomain name that this clock is contained in
+- * @clkdm: pointer to struct clockdomain, resolved from @clkdm_name at runtime
+- * @rate_offset: bitshift for rate selection bitfield (OMAP1 only)
+- * @src_offset: bitshift for source selection bitfield (OMAP1 only)
+- *
+- * XXX @rate_offset, @src_offset should probably be removed and OMAP1
+- * clock code converted to use clksel.
+- *
+- */
+-
+-struct clk_hw_omap_ops;
+-
+-struct clk_hw_omap {
+-      struct clk_hw           hw;
+-      struct list_head        node;
+-      unsigned long           fixed_rate;
+-      u8                      fixed_div;
+-      void __iomem            *enable_reg;
+-      u8                      enable_bit;
+-      u8                      flags;
+-      void __iomem            *clksel_reg;
+-      u32                     clksel_mask;
+-      const struct clksel     *clksel;
+-      struct dpll_data        *dpll_data;
+-      const char              *clkdm_name;
+-      struct clockdomain      *clkdm;
+-      const struct clk_hw_omap_ops    *ops;
+-};
+-
+ struct clk_hw_omap_ops {
+       void                    (*find_idlest)(struct clk_hw_omap *oclk,
+                                       void __iomem **idlest_reg,
+@@ -348,36 +213,13 @@ unsigned long omap_fixed_divisor_recalc(
+ #define OMAP4XXX_EN_DPLL_FRBYPASS             0x6
+ #define OMAP4XXX_EN_DPLL_LOCKED                       0x7
+-/* CM_CLKEN_PLL*.EN* bit values - not all are available for every DPLL */
+-#define DPLL_LOW_POWER_STOP   0x1
+-#define DPLL_LOW_POWER_BYPASS 0x5
+-#define DPLL_LOCKED           0x7
+-
+-/* DPLL Type and DCO Selection Flags */
+-#define DPLL_J_TYPE           0x1
+-
+-long omap2_dpll_round_rate(struct clk_hw *hw, unsigned long target_rate,
+-                      unsigned long *parent_rate);
+-unsigned long omap3_dpll_recalc(struct clk_hw *hw, unsigned long parent_rate);
+-int omap3_noncore_dpll_enable(struct clk_hw *hw);
+-void omap3_noncore_dpll_disable(struct clk_hw *hw);
+-int omap3_noncore_dpll_set_rate(struct clk_hw *hw, unsigned long rate,
+-                              unsigned long parent_rate);
+ u32 omap3_dpll_autoidle_read(struct clk_hw_omap *clk);
+ void omap3_dpll_allow_idle(struct clk_hw_omap *clk);
+ void omap3_dpll_deny_idle(struct clk_hw_omap *clk);
+-unsigned long omap3_clkoutx2_recalc(struct clk_hw *hw,
+-                                  unsigned long parent_rate);
+ int omap4_dpllmx_gatectrl_read(struct clk_hw_omap *clk);
+ void omap4_dpllmx_allow_gatectrl(struct clk_hw_omap *clk);
+ void omap4_dpllmx_deny_gatectrl(struct clk_hw_omap *clk);
+-unsigned long omap4_dpll_regm4xen_recalc(struct clk_hw *hw,
+-                              unsigned long parent_rate);
+-long omap4_dpll_regm4xen_round_rate(struct clk_hw *hw,
+-                                  unsigned long target_rate,
+-                                  unsigned long *parent_rate);
+-void omap2_init_clk_clkdm(struct clk_hw *clk);
+ void __init omap2_clk_disable_clkdm_control(void);
+ /* clkt_clksel.c public functions */
+@@ -396,22 +238,15 @@ int omap2_clksel_set_parent(struct clk_h
+ extern void omap2_clkt_iclk_allow_idle(struct clk_hw_omap *clk);
+ extern void omap2_clkt_iclk_deny_idle(struct clk_hw_omap *clk);
+-u8 omap2_init_dpll_parent(struct clk_hw *hw);
+ unsigned long omap2_get_dpll_rate(struct clk_hw_omap *clk);
+-int omap2_dflt_clk_enable(struct clk_hw *hw);
+-void omap2_dflt_clk_disable(struct clk_hw *hw);
+-int omap2_dflt_clk_is_enabled(struct clk_hw *hw);
+ void omap2_clk_dflt_find_companion(struct clk_hw_omap *clk,
+                                  void __iomem **other_reg,
+                                  u8 *other_bit);
+ void omap2_clk_dflt_find_idlest(struct clk_hw_omap *clk,
+                               void __iomem **idlest_reg,
+                               u8 *idlest_bit, u8 *idlest_val);
+-void omap2_init_clk_hw_omap_clocks(struct clk *clk);
+ int omap2_clk_enable_autoidle_all(void);
+-int omap2_clk_disable_autoidle_all(void);
+-void omap2_clk_enable_init_clocks(const char **clk_names, u8 num_clocks);
+ int omap2_clk_switch_mpurate_at_boot(const char *mpurate_ck_name);
+ void omap2_clk_print_new_rates(const char *hfclkin_ck_name,
+                              const char *core_ck_name,
+@@ -431,19 +266,8 @@ extern const struct clksel_rate gfx_l3_r
+ extern const struct clksel_rate dsp_ick_rates[];
+ extern struct clk dummy_ck;
+-extern const struct clk_hw_omap_ops clkhwops_omap3_dpll;
+-extern const struct clk_hw_omap_ops clkhwops_iclk_wait;
+-extern const struct clk_hw_omap_ops clkhwops_wait;
+-extern const struct clk_hw_omap_ops clkhwops_omap4_dpllmx;
+-extern const struct clk_hw_omap_ops clkhwops_iclk;
+ extern const struct clk_hw_omap_ops clkhwops_omap3430es2_ssi_wait;
+-extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_ssi_wait;
+-extern const struct clk_hw_omap_ops clkhwops_omap3430es2_dss_usbhost_wait;
+-extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_dss_usbhost_wait;
+-extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_hsotgusb_wait;
+ extern const struct clk_hw_omap_ops clkhwops_omap3430es2_hsotgusb_wait;
+-extern const struct clk_hw_omap_ops clkhwops_am35xx_ipss_module_wait;
+-extern const struct clk_hw_omap_ops clkhwops_am35xx_ipss_wait;
+ extern const struct clk_hw_omap_ops clkhwops_apll54;
+ extern const struct clk_hw_omap_ops clkhwops_apll96;
+ extern const struct clk_hw_omap_ops clkhwops_omap2xxx_dpll;
+@@ -460,8 +284,5 @@ extern const struct clksel_rate div31_1t
+ extern int am33xx_clk_init(void);
+-extern int omap2_clkops_enable_clkdm(struct clk_hw *hw);
+-extern void omap2_clkops_disable_clkdm(struct clk_hw *hw);
+-
+ extern void omap_clocks_register(struct omap_clk *oclks, int cnt);
+ #endif
+--- a/arch/arm/mach-omap2/cm33xx.c
++++ b/arch/arm/mach-omap2/cm33xx.c
+@@ -48,13 +48,13 @@
+ /* Private functions */
+ /* Read a register in a CM instance */
+-static inline u32 am33xx_cm_read_reg(s16 inst, u16 idx)
++static inline u32 am33xx_cm_read_reg(u16 inst, u16 idx)
+ {
+       return __raw_readl(cm_base + inst + idx);
+ }
+ /* Write into a register in a CM */
+-static inline void am33xx_cm_write_reg(u32 val, s16 inst, u16 idx)
++static inline void am33xx_cm_write_reg(u32 val, u16 inst, u16 idx)
+ {
+       __raw_writel(val, cm_base + inst + idx);
+ }
+@@ -82,7 +82,7 @@ static inline u32 am33xx_cm_clear_reg_bi
+       return am33xx_cm_rmw_reg_bits(bits, 0x0, inst, idx);
+ }
+-static inline u32 am33xx_cm_read_reg_bits(u16 inst, s16 idx, u32 mask)
++static inline u32 am33xx_cm_read_reg_bits(u16 inst, u16 idx, u32 mask)
+ {
+       u32 v;
+@@ -102,7 +102,7 @@ static inline u32 am33xx_cm_read_reg_bit
+  * Return the IDLEST bitfield of a CM_*_CLKCTRL register, shifted down to
+  * bit 0.
+  */
+-static u32 _clkctrl_idlest(u16 inst, s16 cdoffs, u16 clkctrl_offs)
++static u32 _clkctrl_idlest(u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v = am33xx_cm_read_reg(inst, clkctrl_offs);
+       v &= AM33XX_IDLEST_MASK;
+@@ -119,7 +119,7 @@ static u32 _clkctrl_idlest(u16 inst, s16
+  * Returns true if the module's CM_*_CLKCTRL.IDLEST bitfield is either
+  * *FUNCTIONAL or *INTERFACE_IDLE; false otherwise.
+  */
+-static bool _is_module_ready(u16 inst, s16 cdoffs, u16 clkctrl_offs)
++static bool _is_module_ready(u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v;
+@@ -138,7 +138,7 @@ static bool _is_module_ready(u16 inst, s
+  * @c must be the unshifted value for CLKTRCTRL - i.e., this function
+  * will handle the shift itself.
+  */
+-static void _clktrctrl_write(u8 c, s16 inst, u16 cdoffs)
++static void _clktrctrl_write(u8 c, u16 inst, u16 cdoffs)
+ {
+       u32 v;
+@@ -158,7 +158,7 @@ static void _clktrctrl_write(u8 c, s16 i
+  * Returns true if the clockdomain referred to by (@inst, @cdoffs)
+  * is in hardware-supervised idle mode, or 0 otherwise.
+  */
+-bool am33xx_cm_is_clkdm_in_hwsup(s16 inst, u16 cdoffs)
++bool am33xx_cm_is_clkdm_in_hwsup(u16 inst, u16 cdoffs)
+ {
+       u32 v;
+@@ -177,7 +177,7 @@ bool am33xx_cm_is_clkdm_in_hwsup(s16 ins
+  * Put a clockdomain referred to by (@inst, @cdoffs) into
+  * hardware-supervised idle mode.  No return value.
+  */
+-void am33xx_cm_clkdm_enable_hwsup(s16 inst, u16 cdoffs)
++void am33xx_cm_clkdm_enable_hwsup(u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_ENABLE_AUTO, inst, cdoffs);
+ }
+@@ -191,7 +191,7 @@ void am33xx_cm_clkdm_enable_hwsup(s16 in
+  * software-supervised idle mode, i.e., controlled manually by the
+  * Linux OMAP clockdomain code.  No return value.
+  */
+-void am33xx_cm_clkdm_disable_hwsup(s16 inst, u16 cdoffs)
++void am33xx_cm_clkdm_disable_hwsup(u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_DISABLE_AUTO, inst, cdoffs);
+ }
+@@ -204,7 +204,7 @@ void am33xx_cm_clkdm_disable_hwsup(s16 i
+  * Put a clockdomain referred to by (@inst, @cdoffs) into idle
+  * No return value.
+  */
+-void am33xx_cm_clkdm_force_sleep(s16 inst, u16 cdoffs)
++void am33xx_cm_clkdm_force_sleep(u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_FORCE_SLEEP, inst, cdoffs);
+ }
+@@ -217,7 +217,7 @@ void am33xx_cm_clkdm_force_sleep(s16 ins
+  * Take a clockdomain referred to by (@inst, @cdoffs) out of idle,
+  * waking it up.  No return value.
+  */
+-void am33xx_cm_clkdm_force_wakeup(s16 inst, u16 cdoffs)
++void am33xx_cm_clkdm_force_wakeup(u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_FORCE_WAKEUP, inst, cdoffs);
+ }
+@@ -237,7 +237,7 @@ void am33xx_cm_clkdm_force_wakeup(s16 in
+  * sysconfig cannot be accessed and will probably lead to an "imprecise
+  * external abort"
+  */
+-int am33xx_cm_wait_module_ready(u16 inst, s16 cdoffs, u16 clkctrl_offs)
++int am33xx_cm_wait_module_ready(u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       int i = 0;
+@@ -258,7 +258,7 @@ int am33xx_cm_wait_module_ready(u16 inst
+  * like reset assertion or parent clock de-activation must wait the
+  * module to be fully disabled.
+  */
+-int am33xx_cm_wait_module_idle(u16 inst, s16 cdoffs, u16 clkctrl_offs)
++int am33xx_cm_wait_module_idle(u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       int i = 0;
+@@ -281,7 +281,7 @@ int am33xx_cm_wait_module_idle(u16 inst,
+  *
+  * No return value.
+  */
+-void am33xx_cm_module_enable(u8 mode, u16 inst, s16 cdoffs, u16 clkctrl_offs)
++void am33xx_cm_module_enable(u8 mode, u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v;
+@@ -299,7 +299,7 @@ void am33xx_cm_module_enable(u8 mode, u1
+  *
+  * No return value.
+  */
+-void am33xx_cm_module_disable(u16 inst, s16 cdoffs, u16 clkctrl_offs)
++void am33xx_cm_module_disable(u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v;
+--- a/arch/arm/mach-omap2/cm33xx.h
++++ b/arch/arm/mach-omap2/cm33xx.h
+@@ -377,36 +377,36 @@
+ #ifndef __ASSEMBLER__
+-extern bool am33xx_cm_is_clkdm_in_hwsup(s16 inst, u16 cdoffs);
+-extern void am33xx_cm_clkdm_enable_hwsup(s16 inst, u16 cdoffs);
+-extern void am33xx_cm_clkdm_disable_hwsup(s16 inst, u16 cdoffs);
+-extern void am33xx_cm_clkdm_force_sleep(s16 inst, u16 cdoffs);
+-extern void am33xx_cm_clkdm_force_wakeup(s16 inst, u16 cdoffs);
++extern bool am33xx_cm_is_clkdm_in_hwsup(u16 inst, u16 cdoffs);
++extern void am33xx_cm_clkdm_enable_hwsup(u16 inst, u16 cdoffs);
++extern void am33xx_cm_clkdm_disable_hwsup(u16 inst, u16 cdoffs);
++extern void am33xx_cm_clkdm_force_sleep(u16 inst, u16 cdoffs);
++extern void am33xx_cm_clkdm_force_wakeup(u16 inst, u16 cdoffs);
+-#if defined(CONFIG_SOC_AM33XX) || defined(CONFIG_SOC_AM43XX)
+-extern int am33xx_cm_wait_module_idle(u16 inst, s16 cdoffs,
++#ifdef CONFIG_SOC_AM33XX
++extern int am33xx_cm_wait_module_idle(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs);
+-extern void am33xx_cm_module_enable(u8 mode, u16 inst, s16 cdoffs,
++extern void am33xx_cm_module_enable(u8 mode, u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs);
+-extern void am33xx_cm_module_disable(u16 inst, s16 cdoffs,
++extern void am33xx_cm_module_disable(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs);
+-extern int am33xx_cm_wait_module_ready(u16 inst, s16 cdoffs,
++extern int am33xx_cm_wait_module_ready(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs);
+ #else
+-static inline int am33xx_cm_wait_module_idle(u16 inst, s16 cdoffs,
++static inline int am33xx_cm_wait_module_idle(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs)
+ {
+       return 0;
+ }
+-static inline void am33xx_cm_module_enable(u8 mode, u16 inst, s16 cdoffs,
++static inline void am33xx_cm_module_enable(u8 mode, u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs)
+ {
+ }
+-static inline void am33xx_cm_module_disable(u16 inst, s16 cdoffs,
++static inline void am33xx_cm_module_disable(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs)
+ {
+ }
+-static inline int am33xx_cm_wait_module_ready(u16 inst, s16 cdoffs,
++static inline int am33xx_cm_wait_module_ready(u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs)
+ {
+       return 0;
+--- a/arch/arm/mach-omap2/cminst44xx.c
++++ b/arch/arm/mach-omap2/cminst44xx.c
+@@ -80,7 +80,7 @@ void omap_cm_base_init(void)
+  * Return the IDLEST bitfield of a CM_*_CLKCTRL register, shifted down to
+  * bit 0.
+  */
+-static u32 _clkctrl_idlest(u8 part, u16 inst, s16 cdoffs, u16 clkctrl_offs)
++static u32 _clkctrl_idlest(u8 part, u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v = omap4_cminst_read_inst_reg(part, inst, clkctrl_offs);
+       v &= OMAP4430_IDLEST_MASK;
+@@ -98,7 +98,7 @@ static u32 _clkctrl_idlest(u8 part, u16
+  * Returns true if the module's CM_*_CLKCTRL.IDLEST bitfield is either
+  * *FUNCTIONAL or *INTERFACE_IDLE; false otherwise.
+  */
+-static bool _is_module_ready(u8 part, u16 inst, s16 cdoffs, u16 clkctrl_offs)
++static bool _is_module_ready(u8 part, u16 inst, u16 cdoffs, u16 clkctrl_offs)
+ {
+       u32 v;
+@@ -111,7 +111,7 @@ static bool _is_module_ready(u8 part, u1
+ /* Public functions */
+ /* Read a register in a CM instance */
+-u32 omap4_cminst_read_inst_reg(u8 part, s16 inst, u16 idx)
++u32 omap4_cminst_read_inst_reg(u8 part, u16 inst, u16 idx)
+ {
+       BUG_ON(part >= OMAP4_MAX_PRCM_PARTITIONS ||
+              part == OMAP4430_INVALID_PRCM_PARTITION ||
+@@ -120,7 +120,7 @@ u32 omap4_cminst_read_inst_reg(u8 part,
+ }
+ /* Write into a register in a CM instance */
+-void omap4_cminst_write_inst_reg(u32 val, u8 part, s16 inst, u16 idx)
++void omap4_cminst_write_inst_reg(u32 val, u8 part, u16 inst, u16 idx)
+ {
+       BUG_ON(part >= OMAP4_MAX_PRCM_PARTITIONS ||
+              part == OMAP4430_INVALID_PRCM_PARTITION ||
+@@ -152,7 +152,7 @@ u32 omap4_cminst_clear_inst_reg_bits(u32
+       return omap4_cminst_rmw_inst_reg_bits(bits, 0x0, part, inst, idx);
+ }
+-u32 omap4_cminst_read_inst_reg_bits(u8 part, u16 inst, s16 idx, u32 mask)
++u32 omap4_cminst_read_inst_reg_bits(u8 part, u16 inst, u16 idx, u32 mask)
+ {
+       u32 v;
+@@ -177,7 +177,7 @@ u32 omap4_cminst_read_inst_reg_bits(u8 p
+  * @c must be the unshifted value for CLKTRCTRL - i.e., this function
+  * will handle the shift itself.
+  */
+-static void _clktrctrl_write(u8 c, u8 part, s16 inst, u16 cdoffs)
++static void _clktrctrl_write(u8 c, u8 part, u16 inst, u16 cdoffs)
+ {
+       u32 v;
+@@ -196,7 +196,7 @@ static void _clktrctrl_write(u8 c, u8 pa
+  * Returns true if the clockdomain referred to by (@part, @inst, @cdoffs)
+  * is in hardware-supervised idle mode, or 0 otherwise.
+  */
+-bool omap4_cminst_is_clkdm_in_hwsup(u8 part, s16 inst, u16 cdoffs)
++bool omap4_cminst_is_clkdm_in_hwsup(u8 part, u16 inst, u16 cdoffs)
+ {
+       u32 v;
+@@ -216,7 +216,7 @@ bool omap4_cminst_is_clkdm_in_hwsup(u8 p
+  * Put a clockdomain referred to by (@part, @inst, @cdoffs) into
+  * hardware-supervised idle mode.  No return value.
+  */
+-void omap4_cminst_clkdm_enable_hwsup(u8 part, s16 inst, u16 cdoffs)
++void omap4_cminst_clkdm_enable_hwsup(u8 part, u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_ENABLE_AUTO, part, inst, cdoffs);
+ }
+@@ -231,7 +231,7 @@ void omap4_cminst_clkdm_enable_hwsup(u8
+  * software-supervised idle mode, i.e., controlled manually by the
+  * Linux OMAP clockdomain code.  No return value.
+  */
+-void omap4_cminst_clkdm_disable_hwsup(u8 part, s16 inst, u16 cdoffs)
++void omap4_cminst_clkdm_disable_hwsup(u8 part, u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_DISABLE_AUTO, part, inst, cdoffs);
+ }
+@@ -245,7 +245,7 @@ void omap4_cminst_clkdm_disable_hwsup(u8
+  * Take a clockdomain referred to by (@part, @inst, @cdoffs) out of idle,
+  * waking it up.  No return value.
+  */
+-void omap4_cminst_clkdm_force_wakeup(u8 part, s16 inst, u16 cdoffs)
++void omap4_cminst_clkdm_force_wakeup(u8 part, u16 inst, u16 cdoffs)
+ {
+       _clktrctrl_write(OMAP34XX_CLKSTCTRL_FORCE_WAKEUP, part, inst, cdoffs);
+ }
+@@ -266,7 +266,7 @@ void omap4_cminst_clkdm_force_wakeup(u8
+  * sysconfig cannot be accessed and will probably lead to an "imprecise
+  * external abort"
+  */
+-int omap4_cminst_wait_module_ready(u8 part, u16 inst, s16 cdoffs,
++int omap4_cminst_wait_module_ready(u8 part, u16 inst, u16 cdoffs,
+                                  u16 clkctrl_offs)
+ {
+       int i = 0;
+@@ -292,7 +292,8 @@ int omap4_cminst_wait_module_ready(u8 pa
+  * like reset assertion or parent clock de-activation must wait the
+  * module to be fully disabled.
+  */
+-int omap4_cminst_wait_module_idle(u8 part, u16 inst, s16 cdoffs, u16 clkctrl_offs)
++int omap4_cminst_wait_module_idle(u8 part, u16 inst,
++                                u16 cdoffs, u16 clkctrl_offs)
+ {
+       int i = 0;
+@@ -316,7 +317,7 @@ int omap4_cminst_wait_module_idle(u8 par
+  *
+  * No return value.
+  */
+-void omap4_cminst_module_enable(u8 mode, u8 part, u16 inst, s16 cdoffs,
++void omap4_cminst_module_enable(u8 mode, u8 part, u16 inst, u16 cdoffs,
+                           u16 clkctrl_offs)
+ {
+       u32 v;
+@@ -336,7 +337,7 @@ void omap4_cminst_module_enable(u8 mode,
+  *
+  * No return value.
+  */
+-void omap4_cminst_module_disable(u8 part, u16 inst, s16 cdoffs,
++void omap4_cminst_module_disable(u8 part, u16 inst, u16 cdoffs,
+                            u16 clkctrl_offs)
+ {
+       u32 v;
+@@ -479,6 +480,15 @@ struct clkdm_ops omap4_clkdm_operations
+       .clkdm_sleep            = omap4_clkdm_sleep,
+       .clkdm_wakeup           = omap4_clkdm_wakeup,
+       .clkdm_allow_idle       = omap4_clkdm_allow_idle,
++      .clkdm_deny_idle        = omap4_clkdm_deny_idle,
++      .clkdm_clk_enable       = omap4_clkdm_clk_enable,
++      .clkdm_clk_disable      = omap4_clkdm_clk_disable,
++};
++
++struct clkdm_ops am43xx_clkdm_operations = {
++      .clkdm_sleep            = omap4_clkdm_sleep,
++      .clkdm_wakeup           = omap4_clkdm_wakeup,
++      .clkdm_allow_idle       = omap4_clkdm_allow_idle,
+       .clkdm_deny_idle        = omap4_clkdm_deny_idle,
+       .clkdm_clk_enable       = omap4_clkdm_clk_enable,
+       .clkdm_clk_disable      = omap4_clkdm_clk_disable,
+--- a/arch/arm/mach-omap2/cminst44xx.h
++++ b/arch/arm/mach-omap2/cminst44xx.h
+@@ -11,31 +11,32 @@
+ #ifndef __ARCH_ASM_MACH_OMAP2_CMINST44XX_H
+ #define __ARCH_ASM_MACH_OMAP2_CMINST44XX_H
+-extern bool omap4_cminst_is_clkdm_in_hwsup(u8 part, s16 inst, u16 cdoffs);
+-extern void omap4_cminst_clkdm_enable_hwsup(u8 part, s16 inst, u16 cdoffs);
+-extern void omap4_cminst_clkdm_disable_hwsup(u8 part, s16 inst, u16 cdoffs);
+-extern void omap4_cminst_clkdm_force_sleep(u8 part, s16 inst, u16 cdoffs);
+-extern void omap4_cminst_clkdm_force_wakeup(u8 part, s16 inst, u16 cdoffs);
+-extern int omap4_cminst_wait_module_ready(u8 part, u16 inst, s16 cdoffs, u16 clkctrl_offs);
+-extern int omap4_cminst_wait_module_idle(u8 part, u16 inst, s16 cdoffs,
++extern bool omap4_cminst_is_clkdm_in_hwsup(u8 part, u16 inst, u16 cdoffs);
++extern void omap4_cminst_clkdm_enable_hwsup(u8 part, u16 inst, u16 cdoffs);
++extern void omap4_cminst_clkdm_disable_hwsup(u8 part, u16 inst, u16 cdoffs);
++extern void omap4_cminst_clkdm_force_sleep(u8 part, u16 inst, u16 cdoffs);
++extern void omap4_cminst_clkdm_force_wakeup(u8 part, u16 inst, u16 cdoffs);
++extern int omap4_cminst_wait_module_ready(u8 part, u16 inst,
++                                        u16 cdoffs, u16 clkctrl_offs);
++extern int omap4_cminst_wait_module_idle(u8 part, u16 inst, u16 cdoffs,
+                                        u16 clkctrl_offs);
+-extern void omap4_cminst_module_enable(u8 mode, u8 part, u16 inst, s16 cdoffs,
++extern void omap4_cminst_module_enable(u8 mode, u8 part, u16 inst, u16 cdoffs,
+                                      u16 clkctrl_offs);
+-extern void omap4_cminst_module_disable(u8 part, u16 inst, s16 cdoffs,
++extern void omap4_cminst_module_disable(u8 part, u16 inst, u16 cdoffs,
+                                       u16 clkctrl_offs);
+ /*
+  * In an ideal world, we would not export these low-level functions,
+  * but this will probably take some time to fix properly
+  */
+-extern u32 omap4_cminst_read_inst_reg(u8 part, s16 inst, u16 idx);
+-extern void omap4_cminst_write_inst_reg(u32 val, u8 part, s16 inst, u16 idx);
++extern u32 omap4_cminst_read_inst_reg(u8 part, u16 inst, u16 idx);
++extern void omap4_cminst_write_inst_reg(u32 val, u8 part, u16 inst, u16 idx);
+ extern u32 omap4_cminst_rmw_inst_reg_bits(u32 mask, u32 bits, u8 part,
+                                          s16 inst, s16 idx);
+ extern u32 omap4_cminst_set_inst_reg_bits(u32 bits, u8 part, s16 inst,
+                                          s16 idx);
+ extern u32 omap4_cminst_clear_inst_reg_bits(u32 bits, u8 part, s16 inst,
+                                          s16 idx);
+-extern u32 omap4_cminst_read_inst_reg_bits(u8 part, u16 inst, s16 idx,
++extern u32 omap4_cminst_read_inst_reg_bits(u8 part, u16 inst, u16 idx,
+                                          u32 mask);
+ extern void omap_cm_base_init(void);
+--- a/arch/arm/mach-omap2/common.c
++++ b/arch/arm/mach-omap2/common.c
+@@ -15,10 +15,14 @@
+ #include <linux/kernel.h>
+ #include <linux/init.h>
+ #include <linux/platform_data/dsp-omap.h>
++#include <asm/memblock.h>
++#include <asm/mach/map.h>
+ #include "common.h"
+ #include "omap-secure.h"
++#define AM33XX_DRAM_SYNC_VA 0xfe600000
++
+ /*
+  * Stub function for OMAP2 so that common files
+  * continue to build when custom builds are used
+@@ -34,3 +38,31 @@ void __init omap_reserve(void)
+       omap_secure_ram_reserve_memblock();
+       omap_barrier_reserve_memblock();
+ }
++
++static phys_addr_t am33xx_paddr;
++static u32 am33xx_size;
++
++/* Steal one page physical memory for uncached read DeepSleep */
++void __init am33xx_reserve(void)
++{
++      am33xx_size = ALIGN(PAGE_SIZE, SZ_1M);
++      am33xx_paddr = arm_memblock_steal(am33xx_size, SZ_1M);
++
++      omap_reserve();
++}
++
++void __iomem *am33xx_dram_sync;
++
++void __init am33xx_dram_sync_init(void)
++{
++      struct map_desc dram_io_desc[1];
++
++      dram_io_desc[0].virtual = AM33XX_DRAM_SYNC_VA;
++      dram_io_desc[0].pfn = __phys_to_pfn(am33xx_paddr);
++      dram_io_desc[0].length = am33xx_size;
++      dram_io_desc[0].type = MT_MEMORY_SO;
++
++      iotable_init(dram_io_desc, ARRAY_SIZE(dram_io_desc));
++
++      am33xx_dram_sync = (void __iomem *) dram_io_desc[0].virtual;
++}
+--- a/arch/arm/mach-omap2/common.h
++++ b/arch/arm/mach-omap2/common.h
+@@ -60,7 +60,7 @@ static inline int omap3_pm_init(void)
+ }
+ #endif
+-#if defined(CONFIG_PM) && defined(CONFIG_ARCH_OMAP4)
++#if defined(CONFIG_PM) && (defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5) || defined(CONFIG_SOC_DRA7XX))
+ int omap4_pm_init(void);
+ #else
+ static inline int omap4_pm_init(void)
+@@ -69,6 +69,15 @@ static inline int omap4_pm_init(void)
+ }
+ #endif
++#if defined(CONFIG_PM) && defined(CONFIG_SOC_AM33XX)
++int am33xx_pm_init(void);
++#else
++static inline int am33xx_pm_init(void)
++{
++      return 0;
++}
++#endif
++
+ #ifdef CONFIG_OMAP_MUX
+ int omap_mux_late_init(void);
+ #else
+@@ -107,10 +116,14 @@ void omap2430_init_late(void);
+ void omap3430_init_late(void);
+ void omap35xx_init_late(void);
+ void omap3630_init_late(void);
++void am33xx_init_late(void);
+ void am35xx_init_late(void);
+ void ti81xx_init_late(void);
++void am33xx_init_late(void);
++void omap5_init_late(void);
+ int omap2_common_pm_late_init(void);
+ void dra7xx_init_early(void);
++void dra7xx_init_late(void);
+ #ifdef CONFIG_SOC_BUS
+ void omap_soc_device_init(void);
+@@ -136,6 +149,14 @@ static inline void am33xx_restart(enum r
+ }
+ #endif
++#ifdef CONFIG_SOC_AM43XX
++void am43xx_restart(enum reboot_mode mode, const char *cmd);
++#else
++static inline void am43xx_restart(enum reboot_mode mode, const char *cmd)
++{
++}
++#endif
++
+ #ifdef CONFIG_ARCH_OMAP3
+ void omap3xxx_restart(enum reboot_mode mode, const char *cmd);
+ #else
+@@ -152,6 +173,14 @@ static inline void omap44xx_restart(enum
+ }
+ #endif
++#if defined(CONFIG_SUSPEND)
++void omap2_common_suspend_init(void);
++#else
++inline void omap2_common_suspend_init(void);
++{
++}
++#endif
++
+ /* This gets called from mach-omap2/io.c, do not call this */
+ void __init omap2_set_globals_tap(u32 class, void __iomem *tap);
+@@ -165,7 +194,6 @@ void __init ti81xx_map_io(void);
+ /* omap_barriers_init() is OMAP4 only */
+ void omap_barriers_init(void);
+-
+ /**
+  * omap_test_timeout - busy-loop, testing a condition
+  * @cond: condition to test until it evaluates to true
+@@ -259,6 +287,8 @@ extern int omap4_enter_lowpower(unsigned
+ extern int omap4_finish_suspend(unsigned long cpu_state);
+ extern void omap4_cpu_resume(void);
+ extern int omap4_hotplug_cpu(unsigned int cpu, unsigned int power_state);
++extern int omap5_finish_suspend(unsigned long cpu_state);
++extern void omap5_cpu_resume(void);
+ #else
+ static inline int omap4_enter_lowpower(unsigned int cpu,
+                                       unsigned int power_state)
+@@ -286,6 +316,14 @@ static inline int omap4_finish_suspend(u
+ static inline void omap4_cpu_resume(void)
+ {}
++static inline int omap5_finish_suspend(unsigned long cpu_state)
++{
++      return 0;
++}
++
++static inline void omap5_cpu_resume(void)
++{}
++
+ #endif
+ struct omap_sdrc_params;
+@@ -295,11 +333,17 @@ struct omap2_hsmmc_info;
+ extern int omap4_twl6030_hsmmc_init(struct omap2_hsmmc_info *controllers);
+ extern void omap_reserve(void);
++extern void am33xx_reserve(void);
++extern void am33xx_dram_sync_init(void);
++extern void __iomem *am33xx_dram_sync;
++
+ struct omap_hwmod;
+ extern int omap_dss_reset(struct omap_hwmod *);
+ /* SoC specific clock initializer */
+ extern int (*omap_clk_init)(void);
++int __init omapdss_init_of(void);
++
+ #endif /* __ASSEMBLER__ */
+ #endif /* __ARCH_ARM_MACH_OMAP2PLUS_COMMON_H */
+--- a/arch/arm/mach-omap2/devices.c
++++ b/arch/arm/mach-omap2/devices.c
+@@ -37,6 +37,7 @@
+ #include "mux.h"
+ #include "control.h"
+ #include "devices.h"
++#include "display.h"
+ #define L3_MODULES_MAX_LEN 12
+ #define L3_MODULES 3
+@@ -466,13 +467,13 @@ static struct platform_device omap_vout_
+       .resource       = &omap_vout_resource[0],
+       .id             = -1,
+ };
+-static void omap_init_vout(void)
++
++int __init omap_init_vout(void)
+ {
+-      if (platform_device_register(&omap_vout_device) < 0)
+-              printk(KERN_ERR "Unable to register OMAP-VOUT device\n");
++      return platform_device_register(&omap_vout_device);
+ }
+ #else
+-static inline void omap_init_vout(void) {}
++int __init omap_init_vout(void) { return 0; }
+ #endif
+ #if IS_ENABLED(CONFIG_WL12XX)
+@@ -524,9 +525,9 @@ static int __init omap2_init_devices(voi
+       omap_init_audio();
+       omap_init_camera();
+       omap_init_hdmi_audio();
+-      omap_init_mbox();
+       /* If dtb is there, the devices will be created dynamically */
+       if (!of_have_populated_dt()) {
++              omap_init_mbox();
+               omap_init_mcspi();
+               omap_init_sham();
+               omap_init_aes();
+@@ -536,7 +537,6 @@ static int __init omap2_init_devices(voi
+               omap_init_wl12xx_of();
+       }
+       omap_init_sti();
+-      omap_init_vout();
+       return 0;
+ }
+--- a/arch/arm/mach-omap2/display.c
++++ b/arch/arm/mach-omap2/display.c
+@@ -23,6 +23,8 @@
+ #include <linux/clk.h>
+ #include <linux/err.h>
+ #include <linux/delay.h>
++#include <linux/of.h>
++#include <linux/of_platform.h>
+ #include <video/omapdss.h>
+ #include "omap_hwmod.h"
+@@ -316,6 +318,10 @@ static enum omapdss_version __init omap_
+               return OMAPDSS_VER_OMAP4;
+       else if (soc_is_omap54xx())
+               return OMAPDSS_VER_OMAP5;
++      else if (soc_is_dra7xx())
++              return OMAPDSS_VER_DRA7xx;
++      else if (soc_is_am43xx())
++              return OMAPDSS_VER_AM43xx;
+       else
+               return OMAPDSS_VER_UNKNOWN;
+ }
+@@ -416,6 +422,34 @@ int __init omap_display_init(struct omap
+               }
+       }
++      /* create DRM device */
++      r = omap_init_drm();
++      if (r < 0) {
++              pr_err("Unable to register omapdrm device\n");
++              return r;
++      }
++
++      /* create vrfb device */
++      r = omap_init_vrfb();
++      if (r < 0) {
++              pr_err("Unable to register omapvrfb device\n");
++              return r;
++      }
++
++      /* create FB device */
++      r = omap_init_fb();
++      if (r < 0) {
++              pr_err("Unable to register omapfb device\n");
++              return r;
++      }
++
++      /* create V4L2 display device */
++      r = omap_init_vout();
++      if (r < 0) {
++              pr_err("Unable to register omap_vout device\n");
++              return r;
++      }
++
+       return 0;
+ }
+@@ -564,3 +598,63 @@ int omap_dss_reset(struct omap_hwmod *oh
+       return r;
+ }
++
++int __init omapdss_init_of(void)
++{
++      int r;
++      enum omapdss_version ver;
++
++      static struct omap_dss_board_info board_data = {
++              .dsi_enable_pads = omap_dsi_enable_pads,
++              .dsi_disable_pads = omap_dsi_disable_pads,
++              .get_context_loss_count = omap_pm_get_dev_context_loss_count,
++              .set_min_bus_tput = omap_dss_set_min_bus_tput,
++      };
++
++      ver = omap_display_get_version();
++
++      if (ver == OMAPDSS_VER_UNKNOWN) {
++              pr_err("DSS not supported on this SoC\n");
++              return -ENODEV;
++      }
++
++      board_data.version = ver;
++
++      omap_display_device.dev.platform_data = &board_data;
++
++      r = platform_device_register(&omap_display_device);
++      if (r < 0) {
++              pr_err("Unable to register omapdss device\n");
++              return r;
++      }
++
++      /* create DRM device */
++      r = omap_init_drm();
++      if (r < 0) {
++              pr_err("Unable to register omapdrm device\n");
++              return r;
++      }
++
++      /* create vrfb device */
++      r = omap_init_vrfb();
++      if (r < 0) {
++              pr_err("Unable to register omapvrfb device\n");
++              return r;
++      }
++
++      /* create FB device */
++      r = omap_init_fb();
++      if (r < 0) {
++              pr_err("Unable to register omapfb device\n");
++              return r;
++      }
++
++      /* create V4L2 display device */
++      r = omap_init_vout();
++      if (r < 0) {
++              pr_err("Unable to register omap_vout device\n");
++              return r;
++      }
++
++      return 0;
++}
+--- a/arch/arm/mach-omap2/display.h
++++ b/arch/arm/mach-omap2/display.h
+@@ -26,4 +26,8 @@ struct omap_dss_dispc_dev_attr {
+       bool    has_framedonetv_irq;
+ };
++int omap_init_drm(void);
++int omap_init_vrfb(void);
++int omap_init_fb(void);
++int omap_init_vout(void);
+ #endif
+--- a/arch/arm/mach-omap2/drm.c
++++ b/arch/arm/mach-omap2/drm.c
+@@ -26,10 +26,9 @@
+ #include <linux/platform_data/omap_drm.h>
+ #include "soc.h"
+-#include "omap_device.h"
+-#include "omap_hwmod.h"
++#include "display.h"
+-#if defined(CONFIG_DRM_OMAP) || (CONFIG_DRM_OMAP_MODULE)
++#if defined(CONFIG_DRM_OMAP) || defined(CONFIG_DRM_OMAP_MODULE)
+ static struct omap_drm_platform_data platform_data;
+@@ -42,26 +41,13 @@ static struct platform_device omap_drm_d
+       .id = 0,
+ };
+-static int __init omap_init_drm(void)
++int __init omap_init_drm(void)
+ {
+-      struct omap_hwmod *oh = NULL;
+-      struct platform_device *pdev;
+-
+-      /* lookup and populate the DMM information, if present - OMAP4+ */
+-      oh = omap_hwmod_lookup("dmm");
+-
+-      if (oh) {
+-              pdev = omap_device_build(oh->name, -1, oh, NULL, 0);
+-              WARN(IS_ERR(pdev), "Could not build omap_device for %s\n",
+-                      oh->name);
+-      }
+-
+       platform_data.omaprev = GET_OMAP_TYPE;
+       return platform_device_register(&omap_drm_device);
+ }
+-
+-omap_arch_initcall(omap_init_drm);
+-
++#else
++int __init omap_init_drm(void) { return 0; }
+ #endif
+--- a/arch/arm/mach-omap2/dss-common.c
++++ /dev/null
+@@ -1,215 +0,0 @@
+-/*
+- * Copyright (C) 2012 Texas Instruments, Inc..
+- * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
+- *
+- * 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, write to the Free Software
+- * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
+- * 02110-1301 USA
+- *
+- */
+-
+-/*
+- * NOTE: this is a transitional file to help with DT adaptation.
+- * This file will be removed when DSS supports DT.
+- */
+-
+-#include <linux/kernel.h>
+-#include <linux/gpio.h>
+-#include <linux/platform_device.h>
+-
+-#include <video/omapdss.h>
+-#include <video/omap-panel-data.h>
+-
+-#include "soc.h"
+-#include "dss-common.h"
+-#include "mux.h"
+-
+-#define HDMI_GPIO_CT_CP_HPD 60 /* HPD mode enable/disable */
+-#define HDMI_GPIO_LS_OE 41 /* Level shifter for HDMI */
+-#define HDMI_GPIO_HPD  63 /* Hotplug detect */
+-
+-#define PANDA_DVI_TFP410_POWER_DOWN_GPIO      0
+-
+-/* DVI Connector */
+-static struct connector_dvi_platform_data omap4_panda_dvi_connector_pdata = {
+-      .name                   = "dvi",
+-      .source                 = "tfp410.0",
+-      .i2c_bus_num            = 2,
+-};
+-
+-static struct platform_device omap4_panda_dvi_connector_device = {
+-      .name                   = "connector-dvi",
+-      .id                     = 0,
+-      .dev.platform_data      = &omap4_panda_dvi_connector_pdata,
+-};
+-
+-/* TFP410 DPI-to-DVI chip */
+-static struct encoder_tfp410_platform_data omap4_panda_tfp410_pdata = {
+-      .name                   = "tfp410.0",
+-      .source                 = "dpi.0",
+-      .data_lines             = 24,
+-      .power_down_gpio        = PANDA_DVI_TFP410_POWER_DOWN_GPIO,
+-};
+-
+-static struct platform_device omap4_panda_tfp410_device = {
+-      .name                   = "tfp410",
+-      .id                     = 0,
+-      .dev.platform_data      = &omap4_panda_tfp410_pdata,
+-};
+-
+-/* HDMI Connector */
+-static struct connector_hdmi_platform_data omap4_panda_hdmi_connector_pdata = {
+-      .name                   = "hdmi",
+-      .source                 = "tpd12s015.0",
+-};
+-
+-static struct platform_device omap4_panda_hdmi_connector_device = {
+-      .name                   = "connector-hdmi",
+-      .id                     = 0,
+-      .dev.platform_data      = &omap4_panda_hdmi_connector_pdata,
+-};
+-
+-/* TPD12S015 HDMI ESD protection & level shifter chip */
+-static struct encoder_tpd12s015_platform_data omap4_panda_tpd_pdata = {
+-      .name                   = "tpd12s015.0",
+-      .source                 = "hdmi.0",
+-
+-      .ct_cp_hpd_gpio = HDMI_GPIO_CT_CP_HPD,
+-      .ls_oe_gpio = HDMI_GPIO_LS_OE,
+-      .hpd_gpio = HDMI_GPIO_HPD,
+-};
+-
+-static struct platform_device omap4_panda_tpd_device = {
+-      .name                   = "tpd12s015",
+-      .id                     = 0,
+-      .dev.platform_data      = &omap4_panda_tpd_pdata,
+-};
+-
+-static struct omap_dss_board_info omap4_panda_dss_data = {
+-      .default_display_name = "dvi",
+-};
+-
+-void __init omap4_panda_display_init_of(void)
+-{
+-      omap_display_init(&omap4_panda_dss_data);
+-
+-      platform_device_register(&omap4_panda_tfp410_device);
+-      platform_device_register(&omap4_panda_dvi_connector_device);
+-
+-      platform_device_register(&omap4_panda_tpd_device);
+-      platform_device_register(&omap4_panda_hdmi_connector_device);
+-}
+-
+-
+-/* OMAP4 Blaze display data */
+-
+-#define DISPLAY_SEL_GPIO      59      /* LCD2/PicoDLP switch */
+-#define DLP_POWER_ON_GPIO     40
+-
+-static struct panel_dsicm_platform_data dsi1_panel = {
+-      .name           = "lcd",
+-      .source         = "dsi.0",
+-      .reset_gpio     = 102,
+-      .use_ext_te     = false,
+-      .ext_te_gpio    = 101,
+-      .pin_config = {
+-              .num_pins       = 6,
+-              .pins           = { 0, 1, 2, 3, 4, 5 },
+-      },
+-};
+-
+-static struct platform_device sdp4430_lcd_device = {
+-      .name                   = "panel-dsi-cm",
+-      .id                     = 0,
+-      .dev.platform_data      = &dsi1_panel,
+-};
+-
+-static struct panel_dsicm_platform_data dsi2_panel = {
+-      .name           = "lcd2",
+-      .source         = "dsi.1",
+-      .reset_gpio     = 104,
+-      .use_ext_te     = false,
+-      .ext_te_gpio    = 103,
+-      .pin_config = {
+-              .num_pins       = 6,
+-              .pins           = { 0, 1, 2, 3, 4, 5 },
+-      },
+-};
+-
+-static struct platform_device sdp4430_lcd2_device = {
+-      .name                   = "panel-dsi-cm",
+-      .id                     = 1,
+-      .dev.platform_data      = &dsi2_panel,
+-};
+-
+-/* HDMI Connector */
+-static struct connector_hdmi_platform_data sdp4430_hdmi_connector_pdata = {
+-      .name                   = "hdmi",
+-      .source                 = "tpd12s015.0",
+-};
+-
+-static struct platform_device sdp4430_hdmi_connector_device = {
+-      .name                   = "connector-hdmi",
+-      .id                     = 0,
+-      .dev.platform_data      = &sdp4430_hdmi_connector_pdata,
+-};
+-
+-/* TPD12S015 HDMI ESD protection & level shifter chip */
+-static struct encoder_tpd12s015_platform_data sdp4430_tpd_pdata = {
+-      .name                   = "tpd12s015.0",
+-      .source                 = "hdmi.0",
+-
+-      .ct_cp_hpd_gpio = HDMI_GPIO_CT_CP_HPD,
+-      .ls_oe_gpio = HDMI_GPIO_LS_OE,
+-      .hpd_gpio = HDMI_GPIO_HPD,
+-};
+-
+-static struct platform_device sdp4430_tpd_device = {
+-      .name                   = "tpd12s015",
+-      .id                     = 0,
+-      .dev.platform_data      = &sdp4430_tpd_pdata,
+-};
+-
+-
+-static struct omap_dss_board_info sdp4430_dss_data = {
+-      .default_display_name = "lcd",
+-};
+-
+-/*
+- * we select LCD2 by default (instead of Pico DLP) by setting DISPLAY_SEL_GPIO.
+- * Setting DLP_POWER_ON gpio enables the VDLP_2V5 VDLP_1V8 and VDLP_1V0 rails
+- * used by picodlp on the 4430sdp platform. Keep this gpio disabled as LCD2 is
+- * selected by default
+- */
+-void __init omap_4430sdp_display_init_of(void)
+-{
+-      int r;
+-
+-      r = gpio_request_one(DISPLAY_SEL_GPIO, GPIOF_OUT_INIT_HIGH,
+-                      "display_sel");
+-      if (r)
+-              pr_err("%s: Could not get display_sel GPIO\n", __func__);
+-
+-      r = gpio_request_one(DLP_POWER_ON_GPIO, GPIOF_OUT_INIT_LOW,
+-              "DLP POWER ON");
+-      if (r)
+-              pr_err("%s: Could not get DLP POWER ON GPIO\n", __func__);
+-
+-      omap_display_init(&sdp4430_dss_data);
+-
+-      platform_device_register(&sdp4430_lcd_device);
+-      platform_device_register(&sdp4430_lcd2_device);
+-
+-      platform_device_register(&sdp4430_tpd_device);
+-      platform_device_register(&sdp4430_hdmi_connector_device);
+-}
+--- a/arch/arm/mach-omap2/dss-common.h
++++ /dev/null
+@@ -1,12 +0,0 @@
+-#ifndef __OMAP_DSS_COMMON__
+-#define __OMAP_DSS_COMMON__
+-
+-/*
+- * NOTE: this is a transitional file to help with DT adaptation.
+- * This file will be removed when DSS supports DT.
+- */
+-
+-void __init omap4_panda_display_init_of(void);
+-void __init omap_4430sdp_display_init_of(void);
+-
+-#endif
+--- a/arch/arm/mach-omap2/fb.c
++++ b/arch/arm/mach-omap2/fb.c
+@@ -32,6 +32,7 @@
+ #include <asm/mach/map.h>
+ #include "soc.h"
++#include "display.h"
+ #ifdef CONFIG_OMAP2_VRFB
+@@ -64,7 +65,7 @@ static const struct resource omap3_vrfb_
+       DEFINE_RES_MEM_NAMED(0xfc000000u, 0x4000000, "vrfb-area-11"),
+ };
+-static int __init omap_init_vrfb(void)
++int __init omap_init_vrfb(void)
+ {
+       struct platform_device *pdev;
+       const struct resource *res;
+@@ -85,8 +86,8 @@ static int __init omap_init_vrfb(void)
+       return PTR_RET(pdev);
+ }
+-
+-omap_arch_initcall(omap_init_vrfb);
++#else
++int __init omap_init_vrfb(void) { return 0; }
+ #endif
+ #if defined(CONFIG_FB_OMAP2) || defined(CONFIG_FB_OMAP2_MODULE)
+@@ -105,11 +106,10 @@ static struct platform_device omap_fb_de
+       .num_resources = 0,
+ };
+-static int __init omap_init_fb(void)
++int __init omap_init_fb(void)
+ {
+       return platform_device_register(&omap_fb_device);
+ }
+-
+-omap_arch_initcall(omap_init_fb);
+-
++#else
++int __init omap_init_fb(void) { return 0; }
+ #endif
+--- a/arch/arm/mach-omap2/gpmc.c
++++ b/arch/arm/mach-omap2/gpmc.c
+@@ -68,6 +68,9 @@
+ #define       GPMC_ECC_BCH_RESULT_1   0x244   /* not available on OMAP2 */
+ #define       GPMC_ECC_BCH_RESULT_2   0x248   /* not available on OMAP2 */
+ #define       GPMC_ECC_BCH_RESULT_3   0x24c   /* not available on OMAP2 */
++#define       GPMC_ECC_BCH_RESULT_4   0x300   /* not available on OMAP2 */
++#define       GPMC_ECC_BCH_RESULT_5   0x304   /* not available on OMAP2 */
++#define       GPMC_ECC_BCH_RESULT_6   0x308   /* not available on OMAP2 */
+ /* GPMC ECC control settings */
+ #define GPMC_ECC_CTRL_ECCCLEAR                0x100
+@@ -659,13 +662,19 @@ void gpmc_update_nand_reg(struct gpmc_na
+       for (i = 0; i < GPMC_BCH_NUM_REMAINDER; i++) {
+               reg->gpmc_bch_result0[i] = gpmc_base + GPMC_ECC_BCH_RESULT_0 +
+-                                         GPMC_BCH_SIZE * i;
++                                         (GPMC_BCH_SIZE * i);
+               reg->gpmc_bch_result1[i] = gpmc_base + GPMC_ECC_BCH_RESULT_1 +
+-                                         GPMC_BCH_SIZE * i;
++                                         (GPMC_BCH_SIZE * i);
+               reg->gpmc_bch_result2[i] = gpmc_base + GPMC_ECC_BCH_RESULT_2 +
+-                                         GPMC_BCH_SIZE * i;
++                                         (GPMC_BCH_SIZE * i);
+               reg->gpmc_bch_result3[i] = gpmc_base + GPMC_ECC_BCH_RESULT_3 +
+-                                         GPMC_BCH_SIZE * i;
++                                         (GPMC_BCH_SIZE * i);
++              reg->gpmc_bch_result4[i] = gpmc_base + GPMC_ECC_BCH_RESULT_4 +
++                                         (GPMC_BCH_SIZE * i);
++              reg->gpmc_bch_result5[i] = gpmc_base + GPMC_ECC_BCH_RESULT_5 +
++                                         (GPMC_BCH_SIZE * i);
++              reg->gpmc_bch_result6[i] = gpmc_base + GPMC_ECC_BCH_RESULT_6 +
++                                         (GPMC_BCH_SIZE * i);
+       }
+ }
+@@ -1340,15 +1349,6 @@ static void __maybe_unused gpmc_read_tim
+ }
+ #ifdef CONFIG_MTD_NAND
+-
+-static const char * const nand_ecc_opts[] = {
+-      [OMAP_ECC_HAMMING_CODE_DEFAULT]         = "sw",
+-      [OMAP_ECC_HAMMING_CODE_HW]              = "hw",
+-      [OMAP_ECC_HAMMING_CODE_HW_ROMCODE]      = "hw-romcode",
+-      [OMAP_ECC_BCH4_CODE_HW]                 = "bch4",
+-      [OMAP_ECC_BCH8_CODE_HW]                 = "bch8",
+-};
+-
+ static const char * const nand_xfer_types[] = {
+       [NAND_OMAP_PREFETCH_POLLED]             = "prefetch-polled",
+       [NAND_OMAP_POLLED]                      = "polled",
+@@ -1377,17 +1377,42 @@ static int gpmc_probe_nand_child(struct
+       gpmc_nand_data->cs = val;
+       gpmc_nand_data->of_node = child;
+-
+-      if (!of_property_read_string(child, "ti,nand-ecc-opt", &s))
+-              for (val = 0; val < ARRAY_SIZE(nand_ecc_opts); val++)
+-                      if (!strcasecmp(s, nand_ecc_opts[val])) {
+-                              gpmc_nand_data->ecc_opt = val;
+-                              break;
+-                      }
++      /* Detect availability of ELM module */
++      gpmc_nand_data->elm_of_node = of_parse_phandle(child, "ti,elm-id", 0);
++      if (gpmc_nand_data->elm_of_node == NULL)
++              gpmc_nand_data->elm_of_node =
++                                      of_parse_phandle(child, "elm_id", 0);
++      if (gpmc_nand_data->elm_of_node == NULL)
++              pr_warn("%s: ti,elm-id property not found\n", __func__);
++
++      /* select NAND ecc-scheme */
++      if (of_property_read_string(child, "ti,nand-ecc-opt", &s)) {
++              pr_err("%s: valid ti,nand-ecc-opt not found\n", __func__);
++              return -ENODEV;
++      }
++      if (!strcmp(s, "ham1") || !strcmp(s, "sw") || !strcmp(s, "hw") ||
++              !strcmp(s, "hw-romcode"))
++              gpmc_nand_data->ecc_opt = OMAP_ECC_HAMMING_CODE_HW;
++      else if (!strcmp(s, "bch4"))
++              if (gpmc_nand_data->elm_of_node)
++                      gpmc_nand_data->ecc_opt = OMAP_ECC_BCH4_CODE_HW;
++              else
++                      gpmc_nand_data->ecc_opt =
++                              OMAP_ECC_BCH4_CODE_HW_DETECTION_SW;
++      else if (!strcmp(s, "bch8"))
++              if (gpmc_nand_data->elm_of_node)
++                      gpmc_nand_data->ecc_opt = OMAP_ECC_BCH8_CODE_HW;
++              else
++                      gpmc_nand_data->ecc_opt =
++                              OMAP_ECC_BCH8_CODE_HW_DETECTION_SW;
++      else if (!strcmp(s, "bch16"))
++                      gpmc_nand_data->ecc_opt = OMAP_ECC_BCH16_CODE_HW;
++      else
++              pr_err("%s: ti,nand-ecc-opt: invalid property val\n", __func__);
+       if (!of_property_read_string(child, "ti,nand-xfer-type", &s))
+               for (val = 0; val < ARRAY_SIZE(nand_xfer_types); val++)
+-                      if (!strcasecmp(s, nand_xfer_types[val])) {
++                      if (!strcmp(s, nand_xfer_types[val])) {
+                               gpmc_nand_data->xfer_type = val;
+                               break;
+                       }
+--- a/arch/arm/mach-omap2/gpmc-nand.c
++++ b/arch/arm/mach-omap2/gpmc-nand.c
+@@ -43,28 +43,6 @@ static struct platform_device gpmc_nand_
+       .resource       = gpmc_nand_resource,
+ };
+-static bool gpmc_hwecc_bch_capable(enum omap_ecc ecc_opt)
+-{
+-      /* support only OMAP3 class */
+-      if (!cpu_is_omap34xx() && !soc_is_am33xx()) {
+-              pr_err("BCH ecc is not supported on this CPU\n");
+-              return 0;
+-      }
+-
+-      /*
+-       * For now, assume 4-bit mode is only supported on OMAP3630 ES1.x, x>=1
+-       * and AM33xx derivates. Other chips may be added if confirmed to work.
+-       */
+-      if ((ecc_opt == OMAP_ECC_BCH4_CODE_HW) &&
+-          (!cpu_is_omap3630() || (GET_OMAP_REVISION() == 0)) &&
+-          (!soc_is_am33xx())) {
+-              pr_err("BCH 4-bit mode is not supported on this CPU\n");
+-              return 0;
+-      }
+-
+-      return 1;
+-}
+-
+ int gpmc_nand_init(struct omap_nand_platform_data *gpmc_nand_data,
+                  struct gpmc_timings *gpmc_t)
+ {
+@@ -127,9 +105,6 @@ int gpmc_nand_init(struct omap_nand_plat
+       gpmc_update_nand_reg(&gpmc_nand_data->reg, gpmc_nand_data->cs);
+-      if (!gpmc_hwecc_bch_capable(gpmc_nand_data->ecc_opt))
+-              return -EINVAL;
+-
+       err = platform_device_register(&gpmc_nand_device);
+       if (err < 0) {
+               dev_err(dev, "Unable to register NAND device\n");
+--- a/arch/arm/mach-omap2/io.c
++++ b/arch/arm/mach-omap2/io.c
+@@ -322,6 +322,7 @@ void __init ti81xx_map_io(void)
+ void __init am33xx_map_io(void)
+ {
+       iotable_init(omapam33xx_io_desc, ARRAY_SIZE(omapam33xx_io_desc));
++      am33xx_dram_sync_init();
+ }
+ #endif
+@@ -398,6 +399,7 @@ static void __init __maybe_unused omap_c
+ {
+       omap_mux_late_init();
+       omap2_common_pm_late_init();
++      omap2_common_suspend_init();
+       omap_soc_device_init();
+ }
+@@ -488,21 +490,29 @@ void __init omap3_init_early(void)
+ void __init omap3430_init_early(void)
+ {
+       omap3_init_early();
++      if (of_have_populated_dt())
++              omap_clk_init = omap3430_clk_init;
+ }
+ void __init omap35xx_init_early(void)
+ {
+       omap3_init_early();
++      if (of_have_populated_dt())
++              omap_clk_init = omap3430_clk_init;
+ }
+ void __init omap3630_init_early(void)
+ {
+       omap3_init_early();
++      if (of_have_populated_dt())
++              omap_clk_init = omap3630_clk_init;
+ }
+ void __init am35xx_init_early(void)
+ {
+       omap3_init_early();
++      if (of_have_populated_dt())
++              omap_clk_init = am35xx_clk_init;
+ }
+ void __init ti81xx_init_early(void)
+@@ -520,7 +530,10 @@ void __init ti81xx_init_early(void)
+       omap3xxx_clockdomains_init();
+       omap3xxx_hwmod_init();
+       omap_hwmod_init_postsetup();
+-      omap_clk_init = omap3xxx_clk_init;
++      if (of_have_populated_dt())
++              omap_clk_init = ti81xx_clk_init;
++      else
++              omap_clk_init = omap3xxx_clk_init;
+ }
+ void __init omap3_init_late(void)
+@@ -583,6 +596,13 @@ void __init am33xx_init_early(void)
+       omap_hwmod_init_postsetup();
+       omap_clk_init = am33xx_clk_init;
+ }
++
++void __init am33xx_init_late(void)
++{
++      omap_hwmod_force_mstandby_repeated();
++      omap2_common_pm_late_init();
++      am33xx_pm_init();
++}
+ #endif
+ #ifdef CONFIG_SOC_AM43XX
+@@ -594,7 +614,15 @@ void __init am43xx_init_early(void)
+                                 NULL);
+       omap2_set_globals_prm(AM33XX_L4_WK_IO_ADDRESS(AM43XX_PRCM_BASE));
+       omap2_set_globals_cm(AM33XX_L4_WK_IO_ADDRESS(AM43XX_PRCM_BASE), NULL);
++      omap_prm_base_init();
++      omap_cm_base_init();
+       omap3xxx_check_revision();
++      am33xx_check_features();
++      am43xx_powerdomains_init();
++      am43xx_clockdomains_init();
++      am33xx_hwmod_init();
++      omap_hwmod_init_postsetup();
++      omap_clk_init = am43xx_clk_init;
+ }
+ #endif
+@@ -650,6 +678,16 @@ void __init omap5_init_early(void)
+       omap54xx_clockdomains_init();
+       omap54xx_hwmod_init();
+       omap_hwmod_init_postsetup();
++      omap_clk_init = omap5xxx_clk_init;
++}
++
++void __init omap5_init_late(void)
++{
++      omap_mux_late_init();
++      omap2_common_pm_late_init();
++      omap2_common_suspend_init();
++      omap4_pm_init();
++      omap2_clk_enable_autoidle_all();
+ }
+ #endif
+@@ -670,9 +708,17 @@ void __init dra7xx_init_early(void)
+       dra7xx_clockdomains_init();
+       dra7xx_hwmod_init();
+       omap_hwmod_init_postsetup();
++      omap_clk_init = dra7xx_clk_init;
+ }
+-#endif
++void __init dra7xx_init_late(void)
++{
++      omap2_common_pm_late_init();
++      omap2_common_suspend_init();
++      omap4_pm_init();
++      omap2_clk_enable_autoidle_all();
++}
++#endif
+ void __init omap_sdrc_init(struct omap_sdrc_params *sdrc_cs0,
+                                     struct omap_sdrc_params *sdrc_cs1)
+--- a/arch/arm/mach-omap2/Kconfig
++++ b/arch/arm/mach-omap2/Kconfig
+@@ -66,11 +66,16 @@ config SOC_OMAP5
+ config SOC_AM33XX
+       bool "TI AM33XX"
+       depends on ARCH_MULTI_V7
+-      select ARCH_OMAP2PLUS
++      default y
+       select ARM_CPU_SUSPEND if PM
++      select COMMON_CLK
+       select CPU_V7
++      select MAILBOX if PM
+       select MULTI_IRQ_HANDLER
+-      select COMMON_CLK
++      select ARCH_HAS_RESET_CONTROLLER
++      select OMAP_MBOX_FWK if PM
++      select OMAP2PLUS_MBOX if PM
++      select RESET_TI
+ config SOC_AM43XX
+       bool "TI AM43x"
+@@ -81,29 +86,9 @@ config SOC_AM43XX
+       select ARM_GIC
+       select COMMON_CLK
+       select MACH_OMAP_GENERIC
+-
+-config ARCH_OMAP2PLUS
+-      bool
+-      select ARCH_HAS_BANDGAP
+-      select ARCH_HAS_CPUFREQ
+-      select ARCH_HAS_HOLES_MEMORYMODEL
+-      select ARCH_OMAP
+-      select ARCH_REQUIRE_GPIOLIB
+-      select CLKDEV_LOOKUP
+-      select CLKSRC_MMIO
+-      select GENERIC_CLOCKEVENTS
+-      select GENERIC_IRQ_CHIP
+-      select HAVE_CLK
+-      select OMAP_DM_TIMER
+-      select PINCTRL
+-      select PROC_DEVICETREE if PROC_FS
+-      select SOC_BUS
+-      select SPARSE_IRQ
+-      select TI_PRIV_EDMA
+-      select USE_OF
+-      help
+-        Systems based on OMAP2, OMAP3, OMAP4 or OMAP5
+-
++      select MIGHT_HAVE_CACHE_L2X0
++      select ARCH_HAS_RESET_CONTROLLER
++      select RESET_TI
+ if ARCH_OMAP2PLUS
+@@ -141,6 +126,9 @@ config SOC_DRA7XX
+       select ARM_GIC
+       select HAVE_SMP
+       select COMMON_CLK
++      select CROSSBAR
++      select ARCH_HAS_RESET_CONTROLLER
++      select RESET_TI
+ comment "OMAP Core Type"
+       depends on ARCH_OMAP2
+--- a/arch/arm/mach-omap2/Makefile
++++ b/arch/arm/mach-omap2/Makefile
+@@ -8,7 +8,7 @@ ccflags-$(CONFIG_ARCH_MULTIPLATFORM) :=
+ # Common support
+ obj-y := id.o io.o control.o mux.o devices.o fb.o serial.o gpmc.o timer.o pm.o \
+        common.o gpio.o dma.o wd_timer.o display.o i2c.o hdq1w.o omap_hwmod.o \
+-       omap_device.o sram.o
++       omap_device.o sram.o drm.o
+ omap-2-3-common                               = irq.o
+ hwmod-common                          = omap_hwmod.o omap_hwmod_reset.o \
+@@ -60,6 +60,7 @@ AFLAGS_sram34xx.o                    :=-Wa,-march=armv7-a
+ obj-$(CONFIG_SOC_OMAP2420)            += omap2-restart.o
+ obj-$(CONFIG_SOC_OMAP2430)            += omap2-restart.o
+ obj-$(CONFIG_SOC_AM33XX)              += am33xx-restart.o
++obj-$(CONFIG_SOC_AM43XX)              += am33xx-restart.o
+ obj-$(CONFIG_ARCH_OMAP3)              += omap3-restart.o
+ obj-$(CONFIG_ARCH_OMAP4)              += omap4-restart.o
+ obj-$(CONFIG_SOC_OMAP5)                       += omap4-restart.o
+@@ -91,6 +92,7 @@ obj-$(CONFIG_ARCH_OMAP3)             += pm34xx.o sl
+ obj-$(CONFIG_ARCH_OMAP4)              += pm44xx.o omap-mpuss-lowpower.o
+ obj-$(CONFIG_SOC_OMAP5)                       += omap-mpuss-lowpower.o
+ obj-$(CONFIG_SOC_DRA7XX)              += omap-mpuss-lowpower.o
++obj-$(CONFIG_SOC_AM33XX)              += pm33xx.o sleep33xx.o wkup_m3.o
+ obj-$(CONFIG_PM_DEBUG)                        += pm-debug.o
+ obj-$(CONFIG_POWER_AVS_OMAP)          += sr_device.o
+@@ -98,6 +100,7 @@ obj-$(CONFIG_POWER_AVS_OMAP_CLASS3)    +
+ AFLAGS_sleep24xx.o                    :=-Wa,-march=armv6
+ AFLAGS_sleep34xx.o                    :=-Wa,-march=armv7-a$(plus_sec)
++AFLAGS_sleep33xx.o                    :=-Wa,-march=armv7-a$(plus_sec)
+ endif
+@@ -112,13 +115,13 @@ obj-$(CONFIG_ARCH_OMAP2)         += prm2xxx_3xx
+ obj-$(CONFIG_ARCH_OMAP3)              += prm2xxx_3xxx.o prm3xxx.o cm3xxx.o
+ obj-$(CONFIG_ARCH_OMAP3)              += vc3xxx_data.o vp3xxx_data.o
+ obj-$(CONFIG_SOC_AM33XX)              += prm33xx.o cm33xx.o
+-obj-$(CONFIG_SOC_AM43XX)              += prm33xx.o cm33xx.o
+ omap-prcm-4-5-common                  =  cminst44xx.o cm44xx.o prm44xx.o \
+                                          prcm_mpu44xx.o prminst44xx.o \
+                                          vc44xx_data.o vp44xx_data.o
+ obj-$(CONFIG_ARCH_OMAP4)              += $(omap-prcm-4-5-common)
+ obj-$(CONFIG_SOC_OMAP5)                       += $(omap-prcm-4-5-common)
+ obj-$(CONFIG_SOC_DRA7XX)              += $(omap-prcm-4-5-common)
++obj-$(CONFIG_SOC_AM43XX)              += $(omap-prcm-4-5-common)
+ # OMAP voltage domains
+ voltagedomain-common                  := voltage.o vc.o vp.o
+@@ -146,6 +149,7 @@ obj-$(CONFIG_ARCH_OMAP4)           += powerdomain
+ obj-$(CONFIG_SOC_AM33XX)              += $(powerdomain-common)
+ obj-$(CONFIG_SOC_AM33XX)              += powerdomains33xx_data.o
+ obj-$(CONFIG_SOC_AM43XX)              += $(powerdomain-common)
++obj-$(CONFIG_SOC_AM43XX)              += powerdomains43xx_data.o
+ obj-$(CONFIG_SOC_OMAP5)                       += $(powerdomain-common)
+ obj-$(CONFIG_SOC_OMAP5)                       += powerdomains54xx_data.o
+ obj-$(CONFIG_SOC_DRA7XX)              += $(powerdomain-common)
+@@ -165,6 +169,7 @@ obj-$(CONFIG_ARCH_OMAP4)           += clockdomain
+ obj-$(CONFIG_SOC_AM33XX)              += $(clockdomain-common)
+ obj-$(CONFIG_SOC_AM33XX)              += clockdomains33xx_data.o
+ obj-$(CONFIG_SOC_AM43XX)              += $(clockdomain-common)
++obj-$(CONFIG_SOC_AM43XX)              += clockdomains43xx_data.o
+ obj-$(CONFIG_SOC_OMAP5)                       += $(clockdomain-common)
+ obj-$(CONFIG_SOC_OMAP5)                       += clockdomains54xx_data.o
+ obj-$(CONFIG_SOC_DRA7XX)              += $(clockdomain-common)
+@@ -184,10 +189,9 @@ obj-$(CONFIG_ARCH_OMAP3)          += clock34xx.o
+ obj-$(CONFIG_ARCH_OMAP3)              += clock3517.o clock36xx.o
+ obj-$(CONFIG_ARCH_OMAP3)              += dpll3xxx.o cclock3xxx_data.o
+ obj-$(CONFIG_ARCH_OMAP3)              += clkt_iclk.o
+-obj-$(CONFIG_ARCH_OMAP4)              += $(clock-common) cclock44xx_data.o
++obj-$(CONFIG_ARCH_OMAP4)              += $(clock-common)
+ obj-$(CONFIG_ARCH_OMAP4)              += dpll3xxx.o dpll44xx.o
+ obj-$(CONFIG_SOC_AM33XX)              += $(clock-common) dpll3xxx.o
+-obj-$(CONFIG_SOC_AM33XX)              += cclock33xx_data.o
+ obj-$(CONFIG_SOC_OMAP5)                       += $(clock-common)
+ obj-$(CONFIG_SOC_OMAP5)                       += dpll3xxx.o dpll44xx.o
+@@ -210,6 +214,7 @@ obj-$(CONFIG_ARCH_OMAP3)           += omap_hwmod_
+ obj-$(CONFIG_ARCH_OMAP3)              += omap_hwmod_2xxx_3xxx_interconnect_data.o
+ obj-$(CONFIG_ARCH_OMAP3)              += omap_hwmod_3xxx_data.o
+ obj-$(CONFIG_SOC_AM33XX)              += omap_hwmod_33xx_data.o
++obj-$(CONFIG_SOC_AM43XX)              += omap_hwmod_33xx_data.o
+ obj-$(CONFIG_ARCH_OMAP4)              += omap_hwmod_44xx_data.o
+ obj-$(CONFIG_SOC_OMAP5)                       += omap_hwmod_54xx_data.o
+ obj-$(CONFIG_SOC_DRA7XX)              += omap_hwmod_7xx_data.o
+@@ -228,10 +233,6 @@ endif
+ # OMAP2420 MSDI controller integration support ("MMC")
+ obj-$(CONFIG_SOC_OMAP2420)            += msdi.o
+-ifneq ($(CONFIG_DRM_OMAP),)
+-obj-y                                 += drm.o
+-endif
+-
+ # Specific board support
+ obj-$(CONFIG_MACH_OMAP_GENERIC)               += board-generic.o
+ obj-$(CONFIG_MACH_OMAP_H4)            += board-h4.o
+@@ -305,4 +306,4 @@ endif
+ emac-$(CONFIG_TI_DAVINCI_EMAC)                := am35xx-emac.o
+ obj-y                                 += $(emac-m) $(emac-y)
+-obj-y                                 += common-board-devices.o twl-common.o dss-common.o
++obj-y                                 += common-board-devices.o twl-common.o
+--- a/arch/arm/mach-omap2/omap4-common.c
++++ b/arch/arm/mach-omap2/omap4-common.c
+@@ -181,7 +181,7 @@ static int __init omap_l2_cache_init(voi
+        * To avoid code running on other OMAPs in
+        * multi-omap builds
+        */
+-      if (!cpu_is_omap44xx())
++      if (!cpu_is_omap44xx() && !soc_is_am43xx())
+               return -ENODEV;
+       /* Static mapping, never released */
+@@ -193,26 +193,32 @@ static int __init omap_l2_cache_init(voi
+        * 16-way associativity, parity disabled
+        * Way size - 32KB (es1.0)
+        * Way size - 64KB (es2.0 +)
++       * Way size - 16KB (am43xx)
+        */
+       aux_ctrl = ((1 << L2X0_AUX_CTRL_ASSOCIATIVITY_SHIFT) |
+                       (0x1 << 25) |
+                       (0x1 << L2X0_AUX_CTRL_NS_LOCKDOWN_SHIFT) |
+                       (0x1 << L2X0_AUX_CTRL_NS_INT_CTRL_SHIFT));
+-      if (omap_rev() == OMAP4430_REV_ES1_0) {
++      if (soc_is_am43xx())
++              aux_ctrl |= ((0x1 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT) |
++                      (1 << L2X0_AUX_CTRL_DATA_PREFETCH_SHIFT) |
++                      (1 << L2X0_AUX_CTRL_INSTR_PREFETCH_SHIFT) |
++                      (1 << L2X0_AUX_CTRL_EARLY_BRESP_SHIFT));
++      else if (omap_rev() == OMAP4430_REV_ES1_0)
+               aux_ctrl |= 0x2 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT;
+-      } else {
++      else
+               aux_ctrl |= ((0x3 << L2X0_AUX_CTRL_WAY_SIZE_SHIFT) |
+                       (1 << L2X0_AUX_CTRL_SHARE_OVERRIDE_SHIFT) |
+                       (1 << L2X0_AUX_CTRL_DATA_PREFETCH_SHIFT) |
+                       (1 << L2X0_AUX_CTRL_INSTR_PREFETCH_SHIFT) |
+                       (1 << L2X0_AUX_CTRL_EARLY_BRESP_SHIFT));
+-      }
+-      if (omap_rev() != OMAP4430_REV_ES1_0)
++
++      if (soc_is_am43xx() || (omap_rev() != OMAP4430_REV_ES1_0))
+               omap_smc1(0x109, aux_ctrl);
+       /* Enable PL310 L2 Cache controller */
+-      omap_smc1(0x102, 0x1);
++      omap_smc1(0x102, L2X0_CTRL_EN);
+       if (of_have_populated_dt())
+               l2x0_of_init(aux_ctrl, L2X0_AUX_CTRL_MASK);
+@@ -233,7 +239,10 @@ omap_early_initcall(omap_l2_cache_init);
+ void __iomem *omap4_get_sar_ram_base(void)
+ {
+-      return sar_ram_base;
++      if (sar_ram_base)
++              return sar_ram_base;
++      else
++              return NULL;
+ }
+ /*
+--- a/arch/arm/mach-omap2/omap4-sar-layout.h
++++ b/arch/arm/mach-omap2/omap4-sar-layout.h
+@@ -31,6 +31,8 @@
+ /* CPUx Wakeup Non-Secure Physical Address offsets in SAR_BANK3 */
+ #define CPU0_WAKEUP_NS_PA_ADDR_OFFSET         0xa04
+ #define CPU1_WAKEUP_NS_PA_ADDR_OFFSET         0xa08
++#define OMAP5_CPU0_WAKEUP_NS_PA_ADDR_OFFSET   0xe00
++#define OMAP5_CPU1_WAKEUP_NS_PA_ADDR_OFFSET   0xe04
+ #define SAR_BACKUP_STATUS_OFFSET              (SAR_BANK3_OFFSET + 0x500)
+ #define SAR_SECURE_RAM_SIZE_OFFSET            (SAR_BANK3_OFFSET + 0x504)
+--- a/arch/arm/mach-omap2/omap_device.c
++++ b/arch/arm/mach-omap2/omap_device.c
+@@ -35,6 +35,7 @@
+ #include <linux/pm_runtime.h>
+ #include <linux/of.h>
+ #include <linux/notifier.h>
++#include <linux/suspend.h>
+ #include "soc.h"
+ #include "omap_device.h"
+@@ -45,37 +46,32 @@
+ static void _add_clkdev(struct omap_device *od, const char *clk_alias,
+                      const char *clk_name)
+ {
++      int ret;
+       struct clk *r;
+-      struct clk_lookup *l;
++      struct device *dev = &od->pdev->dev;
++      struct device_node *node = dev->of_node;
+       if (!clk_alias || !clk_name)
+               return;
+-      dev_dbg(&od->pdev->dev, "Creating %s -> %s\n", clk_alias, clk_name);
++      dev_dbg(dev, "Creating %s -> %s\n", clk_alias, clk_name);
+-      r = clk_get_sys(dev_name(&od->pdev->dev), clk_alias);
++      r = clk_get(dev, clk_alias);
+       if (!IS_ERR(r)) {
+-              dev_warn(&od->pdev->dev,
+-                       "alias %s already exists\n", clk_alias);
++              if (!node)
++                      dev_warn(dev, "alias '%s' already exists\n", clk_alias);
+               clk_put(r);
+               return;
+       }
+-      r = clk_get(NULL, clk_name);
+-      if (IS_ERR(r)) {
+-              dev_err(&od->pdev->dev,
+-                      "clk_get for %s failed\n", clk_name);
+-              return;
+-      }
++      if (node)
++              dev_err(dev, "FIXME: clock-name '%s' DOES NOT exist in dt!\n",
++                      clk_alias);
+-      l = clkdev_alloc(r, clk_alias, dev_name(&od->pdev->dev));
+-      if (!l) {
+-              dev_err(&od->pdev->dev,
+-                      "clkdev_alloc for %s failed\n", clk_alias);
+-              return;
+-      }
+-
+-      clkdev_add(l);
++      ret = clk_add_alias(clk_alias, dev_name(dev), (char *)clk_name, dev);
++      if (ret)
++              dev_err(dev, "Failed to alias %s to %s: %d\n", clk_alias,
++                      clk_name, ret);
+ }
+ /**
+@@ -621,6 +617,13 @@ static int _od_suspend_noirq(struct devi
+       if (!ret && !pm_runtime_status_suspended(dev)) {
+               if (pm_generic_runtime_suspend(dev) == 0) {
++                      if (!pm_runtime_suspended(dev)) {
++                              /* NOTE: *might* indicate driver race */
++                              dev_dbg(dev, "%s: Force suspending\n",
++                                      __func__);
++                              pm_runtime_set_suspended(dev);
++                              od->flags |= OMAP_DEVICE_SUSPEND_FORCED;
++                      }
+                       omap_device_idle(pdev);
+                       od->flags |= OMAP_DEVICE_SUSPENDED;
+               }
+@@ -634,10 +637,15 @@ static int _od_resume_noirq(struct devic
+       struct platform_device *pdev = to_platform_device(dev);
+       struct omap_device *od = to_omap_device(pdev);
+-      if ((od->flags & OMAP_DEVICE_SUSPENDED) &&
+-          !pm_runtime_status_suspended(dev)) {
++      if (od->flags & OMAP_DEVICE_SUSPENDED) {
+               od->flags &= ~OMAP_DEVICE_SUSPENDED;
+               omap_device_enable(pdev);
++
++              if (od->flags & OMAP_DEVICE_SUSPEND_FORCED) {
++                      pm_runtime_set_active(dev);
++                      od->flags &= ~OMAP_DEVICE_SUSPEND_FORCED;
++              }
++
+               pm_generic_runtime_resume(dev);
+       }
+@@ -850,6 +858,7 @@ static int __init omap_device_late_idle(
+ {
+       struct platform_device *pdev = to_platform_device(dev);
+       struct omap_device *od = to_omap_device(pdev);
++      struct omap_hwmod *oh = NULL;
+       int i;
+       if (!od)
+@@ -874,6 +883,19 @@ static int __init omap_device_late_idle(
+                                __func__);
+                       omap_device_idle(pdev);
+               }
++      } else {
++      /*
++       * There are some IPs that do not have MSTANDBY asserted by default
++       * which is necessary for PER domain transition. If the drivers
++       * are not compiled into the kernel HWMOD code will not change the
++       * state of the IPs if the IP was never enabled, so we keep track of
++       * them here to idle them with a pm_notifier.
++       */
++              for (i = 0; i < od->hwmods_cnt; i++) {
++                      oh = od->hwmods[i];
++                      if (oh->flags & HWMOD_FORCE_MSTANDBY_REPEATED)
++                              omap_hwmod_disable_force_mstandby_repeated(oh);
++              }
+       }
+       return 0;
+--- a/arch/arm/mach-omap2/omap_device.h
++++ b/arch/arm/mach-omap2/omap_device.h
+@@ -38,6 +38,7 @@ extern struct dev_pm_domain omap_device_
+ /* omap_device.flags values */
+ #define OMAP_DEVICE_SUSPENDED         BIT(0)
++#define OMAP_DEVICE_SUSPEND_FORCED    BIT(1)
+ /**
+  * struct omap_device - omap_device wrapper for platform_devices
+--- a/arch/arm/mach-omap2/omap-hotplug.c
++++ b/arch/arm/mach-omap2/omap-hotplug.c
+@@ -22,6 +22,7 @@
+ #include "omap-wakeupgen.h"
+ #include "common.h"
+ #include "powerdomain.h"
++#include "soc.h"
+ /*
+  * platform-specific code to shutdown a CPU
+@@ -47,7 +48,10 @@ void __ref omap4_cpu_die(unsigned int cp
+               /*
+                * Enter into low power state
+                */
+-              omap4_hotplug_cpu(cpu, PWRDM_POWER_OFF);
++              if (soc_is_dra7xx())
++                      omap4_hotplug_cpu(cpu, PWRDM_POWER_RET);
++              else
++                      omap4_hotplug_cpu(cpu, PWRDM_POWER_OFF);
+               if (omap_secure_apis_support())
+                       boot_cpu = omap_read_auxcoreboot0();
+--- a/arch/arm/mach-omap2/omap_hwmod_33xx_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_33xx_data.c
+@@ -26,9 +26,11 @@
+ #include "cm33xx.h"
+ #include "prm33xx.h"
+ #include "prm-regbits-33xx.h"
++#include "prcm43xx.h"
+ #include "i2c.h"
+ #include "mmc.h"
+ #include "wd_timer.h"
++#include "soc.h"
+ /*
+  * IP blocks
+@@ -52,7 +54,7 @@ static struct omap_hwmod am33xx_emif_hwm
+       .name           = "emif",
+       .class          = &am33xx_emif_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "dpll_ddr_m2_div2_ck",
+       .prcm           = {
+               .omap4  = {
+@@ -74,11 +76,9 @@ static struct omap_hwmod am33xx_l3_main_
+       .name           = "l3_main",
+       .class          = &am33xx_l3_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
+-      .main_clk       = "l3_gclk",
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_L3_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -96,11 +96,10 @@ static struct omap_hwmod am33xx_l3_instr
+       .name           = "l3_instr",
+       .class          = &am33xx_l3_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_L3_INSTR_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -119,11 +118,10 @@ static struct omap_hwmod am33xx_l4_ls_hw
+       .name           = "l4_ls",
+       .class          = &am33xx_l4_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_L4LS_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -133,12 +131,10 @@ static struct omap_hwmod am33xx_l4_ls_hw
+ static struct omap_hwmod am33xx_l4_hs_hwmod = {
+       .name           = "l4_hs",
+       .class          = &am33xx_l4_hwmod_class,
+-      .clkdm_name     = "l4hs_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "l4hs_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_L4HS_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -150,10 +146,9 @@ static struct omap_hwmod am33xx_l4_wkup_
+       .name           = "l4_wkup",
+       .class          = &am33xx_l4_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_L4WKUP_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -170,11 +165,10 @@ static struct omap_hwmod am33xx_mpu_hwmo
+       .name           = "mpu",
+       .class          = &am33xx_mpu_hwmod_class,
+       .clkdm_name     = "mpu_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "dpll_mpu_m2_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_MPU_MPU_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -198,13 +192,9 @@ static struct omap_hwmod am33xx_wkup_m3_
+       .class          = &am33xx_wkup_m3_hwmod_class,
+       .clkdm_name     = "l4_wkup_aon_clkdm",
+       /* Keep hardreset asserted */
+-      .flags          = HWMOD_INIT_NO_RESET | HWMOD_NO_IDLEST,
+-      .main_clk       = "dpll_core_m4_div2_ck",
++      .flags          = HWMOD_NO_IDLEST,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_WKUP_M3_CLKCTRL_OFFSET,
+-                      .rstctrl_offs   = AM33XX_RM_WKUP_RSTCTRL_OFFSET,
+-                      .rstst_offs     = AM33XX_RM_WKUP_RSTST_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -233,8 +223,6 @@ static struct omap_hwmod am33xx_pruss_hw
+       .main_clk       = "pruss_ocp_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_PRUSS_CLKCTRL_OFFSET,
+-                      .rstctrl_offs   = AM33XX_RM_PER_RSTCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -259,9 +247,6 @@ static struct omap_hwmod am33xx_gfx_hwmo
+       .main_clk       = "gfx_fck_div_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_GFX_GFX_CLKCTRL_OFFSET,
+-                      .rstctrl_offs   = AM33XX_RM_GFX_RSTCTRL_OFFSET,
+-                      .rstst_offs     = AM33XX_RM_GFX_RSTST_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -305,11 +290,8 @@ static struct omap_hwmod_class am33xx_ad
+ static struct omap_hwmod am33xx_adc_tsc_hwmod = {
+       .name           = "adc_tsc",
+       .class          = &am33xx_adc_tsc_hwmod_class,
+-      .clkdm_name     = "l4_wkup_clkdm",
+-      .main_clk       = "adc_tsc_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_ADC_TSC_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -395,6 +377,7 @@ static struct omap_hwmod_class_sysconfig
+       .sysc_offs      = 0x84,
+       .syss_offs      = 0x88,
+       .sysc_flags     = SYSS_HAS_RESET_STATUS,
++      .sysc_fields    = &omap_hwmod_sysc_type4,
+ };
+ static struct omap_hwmod_class am33xx_aes0_hwmod_class = {
+@@ -406,10 +389,8 @@ static struct omap_hwmod am33xx_aes0_hwm
+       .name           = "aes",
+       .class          = &am33xx_aes0_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .main_clk       = "aes0_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_AES0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -432,10 +413,8 @@ static struct omap_hwmod am33xx_sha0_hwm
+       .name           = "sham",
+       .class          = &am33xx_sha0_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_SHA0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -450,11 +429,9 @@ static struct omap_hwmod am33xx_ocmcram_
+       .name           = "ocmcram",
+       .class          = &am33xx_ocmcram_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
+-      .main_clk       = "l3_gclk",
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_OCMCRAM_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -501,7 +478,6 @@ static struct omap_hwmod am33xx_smartref
+       .main_clk       = "smartreflex0_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_SMARTREFLEX0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -515,7 +491,6 @@ static struct omap_hwmod am33xx_smartref
+       .main_clk       = "smartreflex1_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_SMARTREFLEX1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -532,11 +507,9 @@ static struct omap_hwmod am33xx_control_
+       .name           = "control",
+       .class          = &am33xx_control_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
+-      .main_clk       = "dpll_core_m4_div2_ck",
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_CONTROL_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -566,12 +539,11 @@ static struct omap_hwmod am33xx_cpgmac0_
+       .name           = "cpgmac0",
+       .class          = &am33xx_cpgmac0_hwmod_class,
+       .clkdm_name     = "cpsw_125mhz_clkdm",
+-      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY),
+-      .main_clk       = "cpsw_125mhz_gclk",
++      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                         HWMOD_FORCE_MSTANDBY_REPEATED),
+       .mpu_rt_idx     = 1,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_CPGMAC0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -588,7 +560,6 @@ static struct omap_hwmod am33xx_mdio_hwm
+       .name           = "davinci_mdio",
+       .class          = &am33xx_mdio_hwmod_class,
+       .clkdm_name     = "cpsw_125mhz_clkdm",
+-      .main_clk       = "cpsw_125mhz_gclk",
+ };
+ /*
+@@ -603,10 +574,8 @@ static struct omap_hwmod am33xx_dcan0_hw
+       .name           = "d_can0",
+       .class          = &am33xx_dcan_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "dcan0_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_DCAN0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -617,10 +586,8 @@ static struct omap_hwmod am33xx_dcan1_hw
+       .name           = "d_can1",
+       .class          = &am33xx_dcan_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "dcan1_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_DCAN1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -647,10 +614,8 @@ static struct omap_hwmod am33xx_elm_hwmo
+       .name           = "elm",
+       .class          = &am33xx_elm_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_ELM_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -689,10 +654,8 @@ static struct omap_hwmod am33xx_epwmss0_
+       .name           = "epwmss0",
+       .class          = &am33xx_epwmss_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_EPWMSS0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -703,7 +666,6 @@ static struct omap_hwmod am33xx_ecap0_hw
+       .name           = "ecap0",
+       .class          = &am33xx_ecap_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /* eqep0 */
+@@ -719,7 +681,6 @@ static struct omap_hwmod am33xx_ehrpwm0_
+       .name           = "ehrpwm0",
+       .class          = &am33xx_ehrpwm_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /* epwmss1 */
+@@ -727,10 +688,8 @@ static struct omap_hwmod am33xx_epwmss1_
+       .name           = "epwmss1",
+       .class          = &am33xx_epwmss_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_EPWMSS1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -741,7 +700,6 @@ static struct omap_hwmod am33xx_ecap1_hw
+       .name           = "ecap1",
+       .class          = &am33xx_ecap_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /* eqep1 */
+@@ -757,7 +715,6 @@ static struct omap_hwmod am33xx_ehrpwm1_
+       .name           = "ehrpwm1",
+       .class          = &am33xx_ehrpwm_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /* epwmss2 */
+@@ -765,10 +722,8 @@ static struct omap_hwmod am33xx_epwmss2_
+       .name           = "epwmss2",
+       .class          = &am33xx_epwmss_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_EPWMSS2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -779,7 +734,6 @@ static struct omap_hwmod am33xx_ecap2_hw
+       .name           = "ecap2",
+       .class          = &am33xx_ecap_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /* eqep2 */
+@@ -795,7 +749,6 @@ static struct omap_hwmod am33xx_ehrpwm2_
+       .name           = "ehrpwm2",
+       .class          = &am33xx_ehrpwm_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+ };
+ /*
+@@ -825,90 +778,62 @@ static struct omap_gpio_dev_attr gpio_de
+ };
+ /* gpio0 */
+-static struct omap_hwmod_opt_clk gpio0_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio0_dbclk" },
+-};
+ static struct omap_hwmod am33xx_gpio0_hwmod = {
+       .name           = "gpio1",
+       .class          = &am33xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "dpll_core_m4_div2_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_GPIO0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = gpio0_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio0_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio1 */
+-static struct omap_hwmod_opt_clk gpio1_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio1_dbclk" },
+-};
+ static struct omap_hwmod am33xx_gpio1_hwmod = {
+       .name           = "gpio2",
+       .class          = &am33xx_gpio_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_GPIO1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = gpio1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio1_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio2 */
+-static struct omap_hwmod_opt_clk gpio2_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio2_dbclk" },
+-};
+ static struct omap_hwmod am33xx_gpio2_hwmod = {
+       .name           = "gpio3",
+       .class          = &am33xx_gpio_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_GPIO2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = gpio2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio2_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio3 */
+-static struct omap_hwmod_opt_clk gpio3_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio3_dbclk" },
+-};
+ static struct omap_hwmod am33xx_gpio3_hwmod = {
+       .name           = "gpio4",
+       .class          = &am33xx_gpio_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_GPIO3_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = gpio3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio3_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+@@ -932,11 +857,9 @@ static struct omap_hwmod am33xx_gpmc_hwm
+       .name           = "gpmc",
+       .class          = &am33xx_gpmc_hwmod_class,
+       .clkdm_name     = "l3s_clkdm",
+-      .flags          = (HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET),
+-      .main_clk       = "l3s_gclk",
++      .flags          = HWMOD_INIT_NO_RESET,
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_GPMC_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -971,10 +894,8 @@ static struct omap_hwmod am33xx_i2c1_hwm
+       .class          = &i2c_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "dpll_per_m2_div4_wkupdm_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_I2C0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -987,10 +908,8 @@ static struct omap_hwmod am33xx_i2c2_hwm
+       .class          = &i2c_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4 = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_I2C1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1003,10 +922,8 @@ static struct omap_hwmod am33xx_i2c3_hwm
+       .class          = &i2c_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_I2C2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1065,10 +982,8 @@ static struct omap_hwmod am33xx_mailbox_
+       .name           = "mailbox",
+       .class          = &am33xx_mailbox_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "l4ls_gclk",
+       .prcm = {
+               .omap4 = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MAILBOX0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1098,7 +1013,6 @@ static struct omap_hwmod am33xx_mcasp0_h
+       .main_clk       = "mcasp0_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MCASP0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1112,7 +1026,6 @@ static struct omap_hwmod am33xx_mcasp1_h
+       .main_clk       = "mcasp1_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MCASP1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1147,7 +1060,6 @@ static struct omap_hwmod am33xx_mmc0_hwm
+       .main_clk       = "mmc_clk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MMC0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1166,7 +1078,6 @@ static struct omap_hwmod am33xx_mmc1_hwm
+       .main_clk       = "mmc_clk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MMC1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1184,7 +1095,6 @@ static struct omap_hwmod am33xx_mmc2_hwm
+       .main_clk       = "mmc_clk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_MMC2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1213,10 +1123,8 @@ static struct omap_hwmod am33xx_rtc_hwmo
+       .name           = "rtc",
+       .class          = &am33xx_rtc_hwmod_class,
+       .clkdm_name     = "l4_rtc_clkdm",
+-      .main_clk       = "clk_32768_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_RTC_RTC_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1248,10 +1156,8 @@ static struct omap_hwmod am33xx_spi0_hwm
+       .name           = "spi0",
+       .class          = &am33xx_spi_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_SPI0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1263,10 +1169,8 @@ static struct omap_hwmod am33xx_spi1_hwm
+       .name           = "spi1",
+       .class          = &am33xx_spi_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_SPI1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1289,12 +1193,119 @@ static struct omap_hwmod am33xx_spinlock
+       .main_clk       = "l4ls_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_SPINLOCK_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+ };
++static struct omap_hwmod_class_sysconfig am43xx_qspi_sysc = {
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = SYSC_HAS_SIDLEMODE,
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                              SIDLE_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class am43xx_qspi_hwmod_class = {
++      .name   = "qspi",
++      .sysc   = &am43xx_qspi_sysc,
++};
++
++static struct omap_hwmod am43xx_qspi_hwmod = {
++      .name           = "qspi",
++      .class          = &am43xx_qspi_hwmod_class,
++      .clkdm_name     = "l3s_clkdm",
++      .main_clk       = "l3s_gclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_QSPI_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* 'ocp2scp' class
++ *
++ */
++
++
++static struct omap_hwmod_class am43xx_ocp2scp_hwmod_class = {
++      .name   = "ocp2scp",
++};
++
++/* ocp2scp0 */
++static struct omap_hwmod am43xx_ocp2scp0_hwmod = {
++      .name           = "ocp2scp0",
++      .class          = &am43xx_ocp2scp_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .main_clk       = "l4ls_gclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_USBPHYOCP2SCP0_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* ocp2scp1 */
++static struct omap_hwmod am43xx_ocp2scp1_hwmod = {
++      .name           = "ocp2scp1",
++      .class          = &am43xx_ocp2scp_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .main_clk       = "l4ls_gclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_USBPHYOCP2SCP1_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* 'usb_otg_ss' class */
++static struct omap_hwmod_class_sysconfig am43xx_usb_otg_ss_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_DMADISABLE | SYSC_HAS_MIDLEMODE |
++                         SYSC_HAS_SIDLEMODE),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class am43xx_usb_otg_ss_hwmod_class = {
++      .name   = "usb_otg_ss",
++      .sysc   = &am43xx_usb_otg_ss_sysc,
++};
++
++/* usb_otg_ss0 */
++static struct omap_hwmod am43xx_usb_otg_ss0_hwmod = {
++      .name           = "usb_otg_ss0",
++      .class          = &am43xx_usb_otg_ss_hwmod_class,
++      .clkdm_name     = "l3s_clkdm",
++      .main_clk       = "l3s_gclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_USB_OTG_SS0_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* usb_otg_ss1 */
++static struct omap_hwmod am43xx_usb_otg_ss1_hwmod = {
++      .name           = "usb_otg_ss1",
++      .class          = &am43xx_usb_otg_ss_hwmod_class,
++      .clkdm_name     = "l3s_clkdm",
++      .main_clk       = "l3s_gclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_USB_OTG_SS1_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
+ /* 'timer 2-7' class */
+ static struct omap_hwmod_class_sysconfig am33xx_timer_sysc = {
+       .rev_offs       = 0x0000,
+@@ -1332,10 +1343,8 @@ static struct omap_hwmod am33xx_timer1_h
+       .name           = "timer1",
+       .class          = &am33xx_timer1ms_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .main_clk       = "timer1_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_TIMER1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1345,10 +1354,8 @@ static struct omap_hwmod am33xx_timer2_h
+       .name           = "timer2",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer2_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1358,10 +1365,8 @@ static struct omap_hwmod am33xx_timer3_h
+       .name           = "timer3",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer3_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER3_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1371,10 +1376,8 @@ static struct omap_hwmod am33xx_timer4_h
+       .name           = "timer4",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer4_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER4_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1384,10 +1387,8 @@ static struct omap_hwmod am33xx_timer5_h
+       .name           = "timer5",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer5_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER5_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1397,10 +1398,8 @@ static struct omap_hwmod am33xx_timer6_h
+       .name           = "timer6",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer6_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER6_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1410,10 +1409,8 @@ static struct omap_hwmod am33xx_timer7_h
+       .name           = "timer7",
+       .class          = &am33xx_timer_hwmod_class,
+       .clkdm_name     = "l4ls_clkdm",
+-      .main_clk       = "timer7_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TIMER7_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1431,7 +1428,6 @@ static struct omap_hwmod am33xx_tpcc_hwm
+       .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TPCC_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1457,11 +1453,11 @@ static struct omap_hwmod am33xx_tptc0_hw
+       .name           = "tptc0",
+       .class          = &am33xx_tptc_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY,
++      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                                HWMOD_FORCE_MSTANDBY_REPEATED,
+       .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TPTC0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1472,11 +1468,11 @@ static struct omap_hwmod am33xx_tptc1_hw
+       .name           = "tptc1",
+       .class          = &am33xx_tptc_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY),
++      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                                 HWMOD_FORCE_MSTANDBY_REPEATED),
+       .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TPTC1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1487,11 +1483,11 @@ static struct omap_hwmod am33xx_tptc2_hw
+       .name           = "tptc2",
+       .class          = &am33xx_tptc_hwmod_class,
+       .clkdm_name     = "l3_clkdm",
+-      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY),
++      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                                 HWMOD_FORCE_MSTANDBY_REPEATED),
+       .main_clk       = "l3_gclk",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_TPTC2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1520,10 +1516,8 @@ static struct omap_hwmod am33xx_uart1_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = DEBUG_AM33XXUART1_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_wkupdm_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_UART0_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1534,10 +1528,8 @@ static struct omap_hwmod am33xx_uart2_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_UART1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1549,10 +1541,8 @@ static struct omap_hwmod am33xx_uart3_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_UART2_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1563,10 +1553,8 @@ static struct omap_hwmod am33xx_uart4_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_UART3_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1577,10 +1565,8 @@ static struct omap_hwmod am33xx_uart5_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_UART4_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1591,10 +1577,8 @@ static struct omap_hwmod am33xx_uart6_hw
+       .class          = &uart_class,
+       .clkdm_name     = "l4ls_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "dpll_per_m2_div4_ck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_PER_UART5_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1627,10 +1611,8 @@ static struct omap_hwmod am33xx_wd_timer
+       .class          = &am33xx_wd_timer_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "wdt1_fck",
+       .prcm           = {
+               .omap4  = {
+-                      .clkctrl_offs   = AM33XX_CM_WKUP_WDT1_CLKCTRL_OFFSET,
+                       .modulemode     = MODULEMODE_SWCTRL,
+               },
+       },
+@@ -1658,8 +1640,8 @@ static struct omap_hwmod am33xx_usbss_hw
+       .name           = "usb_otg_hs",
+       .class          = &am33xx_usbotg_class,
+       .clkdm_name     = "l3s_clkdm",
+-      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY,
+-      .main_clk       = "usbotg_fck",
++      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                                HWMOD_FORCE_MSTANDBY_REPEATED,
+       .prcm           = {
+               .omap4  = {
+                       .clkctrl_offs   = AM33XX_CM_PER_USB0_CLKCTRL_OFFSET,
+@@ -1668,6 +1650,272 @@ static struct omap_hwmod am33xx_usbss_hw
+       },
+ };
++static struct omap_hwmod_class_sysconfig am43xx_synctimer_sysc = {
++      .rev_offs       = 0x0,
++      .sysc_offs      = 0x4,
++      .sysc_flags     = SYSC_HAS_SIDLEMODE,
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class am43xx_synctimer_hwmod_class = {
++      .name   = "synctimer",
++      .sysc   = &am43xx_synctimer_sysc,
++};
++
++static struct omap_hwmod am43xx_synctimer_hwmod = {
++      .name           = "counter_32k",
++      .class          = &am43xx_synctimer_hwmod_class,
++      .clkdm_name     = "l4_wkup_aon_clkdm",
++      .flags          = HWMOD_SWSUP_SIDLE,
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_WKUP_SYNCTIMER_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_timer8_hwmod = {
++      .name           = "timer8",
++      .class          = &am33xx_timer_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = AM43XX_CM_PER_TIMER8_CLKCTRL_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_timer9_hwmod = {
++      .name           = "timer9",
++      .class          = &am33xx_timer_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = AM43XX_CM_PER_TIMER9_CLKCTRL_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_timer10_hwmod = {
++      .name           = "timer10",
++      .class          = &am33xx_timer_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = AM43XX_CM_PER_TIMER10_CLKCTRL_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_timer11_hwmod = {
++      .name           = "timer11",
++      .class          = &am33xx_timer_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = AM43XX_CM_PER_TIMER11_CLKCTRL_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_epwmss3_hwmod = {
++      .name           = "epwmss3",
++      .class          = &am33xx_epwmss_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_EPWMSS3_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_ehrpwm3_hwmod = {
++      .name           = "ehrpwm3",
++      .class          = &am33xx_ehrpwm_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++};
++
++static struct omap_hwmod am43xx_epwmss4_hwmod = {
++      .name           = "epwmss4",
++      .class          = &am33xx_epwmss_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_EPWMSS4_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_ehrpwm4_hwmod = {
++      .name           = "ehrpwm4",
++      .class          = &am33xx_ehrpwm_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++};
++
++static struct omap_hwmod am43xx_epwmss5_hwmod = {
++      .name           = "epwmss5",
++      .class          = &am33xx_epwmss_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_EPWMSS5_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod am43xx_ehrpwm5_hwmod = {
++      .name           = "ehrpwm5",
++      .class          = &am33xx_ehrpwm_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++};
++
++static struct omap_hwmod am43xx_spi2_hwmod = {
++      .name           = "spi2",
++      .class          = &am33xx_spi_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_SPI2_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .dev_attr       = &mcspi_attrib,
++};
++
++static struct omap_hwmod am43xx_spi3_hwmod = {
++      .name           = "spi3",
++      .class          = &am33xx_spi_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_SPI3_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .dev_attr       = &mcspi_attrib,
++};
++
++static struct omap_hwmod am43xx_spi4_hwmod = {
++      .name           = "spi4",
++      .class          = &am33xx_spi_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_SPI4_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .dev_attr       = &mcspi_attrib,
++};
++
++static struct omap_hwmod am43xx_gpio4_hwmod = {
++      .name           = "gpio5",
++      .class          = &am33xx_gpio_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_GPIO4_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .dev_attr       = &gpio_dev_attr,
++};
++
++static struct omap_hwmod am43xx_gpio5_hwmod = {
++      .name           = "gpio6",
++      .class          = &am33xx_gpio_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = AM43XX_CM_PER_GPIO5_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .dev_attr       = &gpio_dev_attr,
++};
++
++/* Display sub system - DSS */
++
++static struct omap_hwmod_dma_info am43xx_dss_sdma_chs[] = {
++      { .name = "dispc", .dma_req = 5 },
++      { .dma_req = -1 },
++};
++
++struct omap_dss_dispc_dev_attr am43xx_dss_dispc_dev_attr = {
++      .manager_count          = 1,
++      .has_framedonetv_irq    = 0
++};
++
++
++static struct omap_hwmod_class_sysconfig am43xx_dispc_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_SIDLEMODE | SYSC_HAS_MIDLEMODE),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class am43xx_dispc_hwmod_class = {
++      .name   = "dispc",
++      .sysc   = &am43xx_dispc_sysc,
++};
++
++
++
++static struct omap_hwmod am43xx_dss_core_hwmod = {
++      .name           = "dss_core",
++      .class          = &omap2_dss_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "disp_clk",
++      .sdma_reqs      = am43xx_dss_sdma_chs,
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_DSS_CLKCTRL_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* display controller -dispc*/
++
++static struct omap_hwmod am43xx_dss_dispc_hwmod = {
++      .name           = "dss_dispc",
++      .class          = &am43xx_dispc_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "disp_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_DSS_CLKCTRL_OFFSET,
++              },
++      },
++      .dev_attr       = &am43xx_dss_dispc_dev_attr,
++};
++
++/*RFBI*/
++
++static struct omap_hwmod am43xx_dss_rfbi_hwmod = {
++      .name           = "dss_rfbi",
++      .class          = &omap2_rfbi_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "disp_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = AM43XX_CM_PER_DSS_CLKCTRL_OFFSET,
++              },
++      },
++};
+ /*
+  * Interfaces
+@@ -1766,7 +2014,6 @@ static struct omap_hwmod_ocp_if am33xx_p
+ static struct omap_hwmod_ocp_if am33xx_wkup_m3__l4_wkup = {
+       .master         = &am33xx_wkup_m3_hwmod,
+       .slave          = &am33xx_l4_wkup_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
+@@ -1782,7 +2029,6 @@ static struct omap_hwmod_ocp_if am33xx_g
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__wkup_m3 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_wkup_m3_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
+@@ -1824,7 +2070,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__smartreflex0 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_smartreflex0_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -1832,7 +2077,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__smartreflex1 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_smartreflex1_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -1840,7 +2084,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__control = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_control_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -1896,7 +2139,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__i2c1 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_i2c1_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -1904,7 +2146,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__gpio0 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_gpio0_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
+@@ -2237,6 +2478,45 @@ static struct omap_hwmod_ocp_if am33xx_l
+       .user           = OCP_USER_MPU,
+ };
++static struct omap_hwmod_ocp_if am43xx_l3_s__qspi = {
++      .master         = &am33xx_l3_s_hwmod,
++      .slave          = &am43xx_qspi_hwmod,
++      .clk            = "l3s_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_1 -> usb_otg_ss0 */
++static struct omap_hwmod_ocp_if am43xx_l3_s__usbotgss0 = {
++      .master         = &am33xx_l3_s_hwmod,
++      .slave          = &am43xx_usb_otg_ss0_hwmod,
++      .clk            = "l3s_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_1 -> usb_otg_ss1 */
++static struct omap_hwmod_ocp_if am43xx_l3_s__usbotgss1 = {
++      .master         = &am33xx_l3_s_hwmod,
++      .slave          = &am43xx_usb_otg_ss1_hwmod,
++      .clk            = "l3s_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4 ls -> ocp2scp0 */
++static struct omap_hwmod_ocp_if am33xx_l4_ls__ocp2scp0 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_ocp2scp0_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++/* l4 ls -> ocp2scp0 */
++static struct omap_hwmod_ocp_if am33xx_l4_ls__ocp2scp1 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_ocp2scp1_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
+ /* l4 ls -> mcspi0 */
+ static struct omap_hwmod_ocp_if am33xx_l4_ls__mcspi0 = {
+       .master         = &am33xx_l4_ls_hwmod,
+@@ -2257,7 +2537,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__timer1 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_timer1_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -2375,7 +2654,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__uart1 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_uart1_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -2423,7 +2701,6 @@ static struct omap_hwmod_ocp_if am33xx_l
+ static struct omap_hwmod_ocp_if am33xx_l4_wkup__wd_timer1 = {
+       .master         = &am33xx_l4_wkup_hwmod,
+       .slave          = &am33xx_wd_timer1_hwmod,
+-      .clk            = "dpll_core_m4_div2_ck",
+       .user           = OCP_USER_MPU,
+ };
+@@ -2480,8 +2757,473 @@ static struct omap_hwmod_ocp_if am33xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++static struct omap_hwmod_ocp_if am33xx_l4_wkup__synctimer = {
++      .master         = &am33xx_l4_wkup_hwmod,
++      .slave          = &am43xx_synctimer_hwmod,
++      .clk            = "sys_clkin_ck",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__timer8 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_timer8_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__timer9 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_timer9_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__timer10 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_timer10_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__timer11 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_timer11_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__epwmss3 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_epwmss3_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_epwmss3__ehrpwm3 = {
++      .master         = &am43xx_epwmss3_hwmod,
++      .slave          = &am43xx_ehrpwm3_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__epwmss4 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_epwmss4_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_epwmss4__ehrpwm4 = {
++      .master         = &am43xx_epwmss4_hwmod,
++      .slave          = &am43xx_ehrpwm4_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__epwmss5 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_epwmss5_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_epwmss5__ehrpwm5 = {
++      .master         = &am43xx_epwmss5_hwmod,
++      .slave          = &am43xx_ehrpwm5_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__mcspi2 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_spi2_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__mcspi3 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_spi3_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__mcspi4 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_spi4_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__gpio4 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_gpio4_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l4_ls__gpio5 = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_gpio5_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++static struct omap_hwmod_ocp_if am43xx_l3_main__pruss = {
++      .master         = &am33xx_l3_main_hwmod,
++      .slave          = &am33xx_pruss_hwmod,
++      .clk            = "dpll_core_m4_ck",
++      .user           = OCP_USER_MPU,
++};
++
++/* rng */
++static struct omap_hwmod_class_sysconfig am33xx_rng_sysc = {
++      .rev_offs       = 0x1fe0,
++      .sysc_offs      = 0x1fe4,
++      .sysc_flags     = SYSC_HAS_AUTOIDLE | SYSC_HAS_SIDLEMODE,
++      .idlemodes      = SIDLE_FORCE | SIDLE_NO,
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class am33xx_rng_hwmod_class = {
++      .name           = "rng",
++      .sysc           = &am33xx_rng_sysc,
++};
++
++static struct omap_hwmod am33xx_rng_hwmod = {
++      .name           = "rng",
++      .class          = &am33xx_rng_hwmod_class,
++      .clkdm_name     = "l4ls_clkdm",
++      .flags          = HWMOD_SWSUP_SIDLE,
++      .prcm           = {
++              .omap4  = {
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod_ocp_if am33xx_l4_per__rng = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am33xx_rng_hwmod,
++      .clk            = "rng_fck",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_class_sysconfig am43xx_des_sysc = {
++      .rev_offs       = 0x30,
++      .sysc_offs      = 0x34,
++      .syss_offs      = 0x38,
++      .sysc_flags     = SYSS_HAS_RESET_STATUS,
++};
++
++static struct omap_hwmod_class am43xx_des_hwmod_class = {
++      .name           = "des",
++      .sysc           = &am43xx_des_sysc,
++};
++
++static struct omap_hwmod am43xx_des_hwmod = {
++      .name           = "des",
++      .class          = &am43xx_des_hwmod_class,
++      .clkdm_name     = "l3_clkdm",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = AM43XX_CM_PER_DES_CLKCTRL_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod_ocp_if am43xx_l3_main__des = {
++      .master         = &am33xx_l3_main_hwmod,
++      .slave          = &am43xx_des_hwmod,
++      .clk            = "l3_gclk",
++      .user           = OCP_USER_MPU,
++};
++
++/* DSS -> L3 Main */
++static struct omap_hwmod_ocp_if am43xx_dss__l3_main = {
++      .master         = &am43xx_dss_core_hwmod,
++      .slave          = &am33xx_l3_main_hwmod,
++      .clk            = "disp_clk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* L4-ls -> DSS */
++static struct omap_hwmod_ocp_if am43xx_l4_ls__dss = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_dss_core_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* L4_ls -> dss_dispc */
++static struct omap_hwmod_ocp_if am43xx_l4_ls__dss_dispc = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_dss_dispc_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* L4_ls -> dss_rfbi */
++static struct omap_hwmod_ocp_if am43xx_l4_ls__dss_rfbi = {
++      .master         = &am33xx_l4_ls_hwmod,
++      .slave          = &am43xx_dss_rfbi_hwmod,
++      .clk            = "l4ls_gclk",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++#define CLKCTRL(oh, clkctrl) ((oh).prcm.omap4.clkctrl_offs = (clkctrl))
++
++static void am43xx_hwmod_clkctrl(void)
++{
++      CLKCTRL(am33xx_uart2_hwmod, AM43XX_CM_PER_UART1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart3_hwmod, AM43XX_CM_PER_UART2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart4_hwmod, AM43XX_CM_PER_UART3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart5_hwmod, AM43XX_CM_PER_UART4_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart6_hwmod, AM43XX_CM_PER_UART5_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_dcan0_hwmod, AM43XX_CM_PER_DCAN0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_dcan1_hwmod, AM43XX_CM_PER_DCAN1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_elm_hwmod, AM43XX_CM_PER_ELM_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss0_hwmod, AM43XX_CM_PER_EPWMSS0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss1_hwmod, AM43XX_CM_PER_EPWMSS1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss2_hwmod, AM43XX_CM_PER_EPWMSS2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio1_hwmod, AM43XX_CM_PER_GPIO1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio2_hwmod, AM43XX_CM_PER_GPIO2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio3_hwmod, AM43XX_CM_PER_GPIO3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c2_hwmod, AM43XX_CM_PER_I2C1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c3_hwmod, AM43XX_CM_PER_I2C2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mailbox_hwmod, AM43XX_CM_PER_MAILBOX0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc0_hwmod, AM43XX_CM_PER_MMC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc1_hwmod, AM43XX_CM_PER_MMC1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spi0_hwmod, AM43XX_CM_PER_SPI0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spi1_hwmod, AM43XX_CM_PER_SPI1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spinlock_hwmod, AM43XX_CM_PER_SPINLOCK_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer2_hwmod, AM43XX_CM_PER_TIMER2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer3_hwmod, AM43XX_CM_PER_TIMER3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer4_hwmod, AM43XX_CM_PER_TIMER4_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer5_hwmod, AM43XX_CM_PER_TIMER5_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer6_hwmod, AM43XX_CM_PER_TIMER6_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer7_hwmod, AM43XX_CM_PER_TIMER7_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_wkup_m3_hwmod, AM43XX_CM_WKUP_WKUP_M3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_control_hwmod, AM43XX_CM_WKUP_CONTROL_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_smartreflex0_hwmod,
++              AM43XX_CM_WKUP_SMARTREFLEX0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_smartreflex1_hwmod,
++              AM43XX_CM_WKUP_SMARTREFLEX1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart1_hwmod, AM43XX_CM_WKUP_UART0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer1_hwmod, AM43XX_CM_WKUP_TIMER1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c1_hwmod, AM43XX_CM_WKUP_I2C0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio0_hwmod, AM43XX_CM_WKUP_GPIO0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_adc_tsc_hwmod, AM43XX_CM_WKUP_ADC_TSC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_wd_timer1_hwmod, AM43XX_CM_WKUP_WDT1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_wkup_hwmod, AM43XX_CM_WKUP_L4WKUP_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_rtc_hwmod, AM43XX_CM_RTC_RTC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc2_hwmod, AM43XX_CM_PER_MMC2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpmc_hwmod, AM43XX_CM_PER_GPMC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mcasp0_hwmod, AM43XX_CM_PER_MCASP0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mcasp1_hwmod, AM43XX_CM_PER_MCASP1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_ls_hwmod, AM43XX_CM_PER_L4LS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l3_main_hwmod, AM43XX_CM_PER_L3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tpcc_hwmod, AM43XX_CM_PER_TPCC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc0_hwmod, AM43XX_CM_PER_TPTC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc1_hwmod, AM43XX_CM_PER_TPTC1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc2_hwmod, AM43XX_CM_PER_TPTC2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_cpgmac0_hwmod, AM43XX_CM_PER_CPGMAC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_pruss_hwmod, AM43XX_CM_PER_PRUSS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gfx_hwmod, AM43XX_CM_GFX_GFX_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_hs_hwmod, AM43XX_CM_PER_L4HS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mpu_hwmod , AM43XX_CM_MPU_MPU_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l3_instr_hwmod , AM43XX_CM_PER_L3_INSTR_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_ocmcram_hwmod , AM43XX_CM_PER_OCMCRAM_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_sha0_hwmod , AM43XX_CM_PER_SHA0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_aes0_hwmod , AM43XX_CM_PER_AES0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_rng_hwmod , AM43XX_CM_PER_RNG_CLKCTRL_OFFSET);
++}
++
++static void am33xx_hwmod_clkctrl(void)
++{
++      CLKCTRL(am33xx_uart2_hwmod, AM33XX_CM_PER_UART1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart3_hwmod, AM33XX_CM_PER_UART2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart4_hwmod, AM33XX_CM_PER_UART3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart5_hwmod, AM33XX_CM_PER_UART4_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart6_hwmod, AM33XX_CM_PER_UART5_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_dcan0_hwmod, AM33XX_CM_PER_DCAN0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_dcan1_hwmod, AM33XX_CM_PER_DCAN1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_elm_hwmod, AM33XX_CM_PER_ELM_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss0_hwmod, AM33XX_CM_PER_EPWMSS0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss1_hwmod, AM33XX_CM_PER_EPWMSS1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_epwmss2_hwmod, AM33XX_CM_PER_EPWMSS2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio1_hwmod, AM33XX_CM_PER_GPIO1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio2_hwmod, AM33XX_CM_PER_GPIO2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio3_hwmod, AM33XX_CM_PER_GPIO3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c2_hwmod, AM33XX_CM_PER_I2C1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c3_hwmod, AM33XX_CM_PER_I2C2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mailbox_hwmod, AM33XX_CM_PER_MAILBOX0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mcasp0_hwmod, AM33XX_CM_PER_MCASP0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mcasp1_hwmod, AM33XX_CM_PER_MCASP1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc0_hwmod, AM33XX_CM_PER_MMC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc1_hwmod, AM33XX_CM_PER_MMC1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spi0_hwmod, AM33XX_CM_PER_SPI0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spi1_hwmod, AM33XX_CM_PER_SPI1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_spinlock_hwmod, AM33XX_CM_PER_SPINLOCK_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer2_hwmod, AM33XX_CM_PER_TIMER2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer3_hwmod, AM33XX_CM_PER_TIMER3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer4_hwmod, AM33XX_CM_PER_TIMER4_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer5_hwmod, AM33XX_CM_PER_TIMER5_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer6_hwmod, AM33XX_CM_PER_TIMER6_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer7_hwmod, AM33XX_CM_PER_TIMER7_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_wkup_m3_hwmod, AM33XX_CM_WKUP_WKUP_M3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_control_hwmod, AM33XX_CM_WKUP_CONTROL_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_smartreflex0_hwmod,
++              AM33XX_CM_WKUP_SMARTREFLEX0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_smartreflex1_hwmod,
++              AM33XX_CM_WKUP_SMARTREFLEX1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_uart1_hwmod, AM33XX_CM_WKUP_UART0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_timer1_hwmod, AM33XX_CM_WKUP_TIMER1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_i2c1_hwmod, AM33XX_CM_WKUP_I2C0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpio0_hwmod, AM33XX_CM_WKUP_GPIO0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_adc_tsc_hwmod, AM33XX_CM_WKUP_ADC_TSC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_wd_timer1_hwmod, AM33XX_CM_WKUP_WDT1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_rtc_hwmod, AM33XX_CM_RTC_RTC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mmc2_hwmod, AM33XX_CM_PER_MMC2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gpmc_hwmod, AM33XX_CM_PER_GPMC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_ls_hwmod, AM33XX_CM_PER_L4LS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_wkup_hwmod, AM33XX_CM_WKUP_L4WKUP_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l3_main_hwmod, AM33XX_CM_PER_L3_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tpcc_hwmod, AM33XX_CM_PER_TPCC_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc0_hwmod, AM33XX_CM_PER_TPTC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc1_hwmod, AM33XX_CM_PER_TPTC1_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_tptc2_hwmod, AM33XX_CM_PER_TPTC2_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_gfx_hwmod, AM33XX_CM_GFX_GFX_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l4_hs_hwmod, AM33XX_CM_PER_L4HS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_cpgmac0_hwmod, AM33XX_CM_PER_CPGMAC0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_pruss_hwmod, AM33XX_CM_PER_PRUSS_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_mpu_hwmod , AM33XX_CM_MPU_MPU_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_l3_instr_hwmod , AM33XX_CM_PER_L3_INSTR_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_ocmcram_hwmod , AM33XX_CM_PER_OCMCRAM_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_sha0_hwmod , AM33XX_CM_PER_SHA0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_aes0_hwmod , AM33XX_CM_PER_AES0_CLKCTRL_OFFSET);
++      CLKCTRL(am33xx_rng_hwmod, AM33XX_CM_PER_RNG_CLKCTRL_OFFSET);
++}
++
++#define RSTCTRL(oh, rstctrl) ((oh).prcm.omap4.rstctrl_offs = (rstctrl))
++
++static void am43xx_hwmod_rstctrl(void)
++{
++      RSTCTRL(am33xx_pruss_hwmod, AM43XX_RM_PER_RSTCTRL_OFFSET);
++      RSTCTRL(am33xx_gfx_hwmod, AM43XX_RM_GFX_RSTCTRL_OFFSET);
++      RSTCTRL(am33xx_wkup_m3_hwmod, AM43XX_RM_WKUP_RSTCTRL_OFFSET);
++}
++
++static void am33xx_hwmod_rstctrl(void)
++{
++      RSTCTRL(am33xx_pruss_hwmod, AM33XX_RM_PER_RSTCTRL_OFFSET);
++      RSTCTRL(am33xx_gfx_hwmod, AM33XX_RM_GFX_RSTCTRL_OFFSET);
++      RSTCTRL(am33xx_wkup_m3_hwmod, AM33XX_RM_WKUP_RSTCTRL_OFFSET);
++}
++
++#define RSTST(oh, rstst) ((oh).prcm.omap4.rstst_offs = (rstst))
++
++static void am43xx_hwmod_rstst(void)
++{
++      RSTST(am33xx_gfx_hwmod, AM43XX_RM_GFX_RSTST_OFFSET);
++      RSTST(am33xx_wkup_m3_hwmod, AM43XX_RM_WKUP_RSTST_OFFSET);
++}
++
++static void am33xx_hwmod_rstst(void)
++{
++      RSTST(am33xx_gfx_hwmod, AM33XX_RM_GFX_RSTST_OFFSET);
++      RSTST(am33xx_wkup_m3_hwmod, AM33XX_RM_WKUP_RSTST_OFFSET);
++}
++
++static void am43xx_hwmod_clockdomain(void)
++{
++      am33xx_l4_hs_hwmod.clkdm_name = "l3_clkdm";
++      am33xx_adc_tsc_hwmod.clkdm_name = "l3s_tsc_clkdm";
++}
++
++static void am33xx_hwmod_clockdomain(void)
++{
++      am33xx_l4_hs_hwmod.clkdm_name = "l4hs_clkdm";
++      am33xx_adc_tsc_hwmod.clkdm_name = "l4_wkup_clkdm";
++}
++
++#define AM43XX_L4_WKUP_OCPIF_CLK "sys_clkin_ck"
++
++static void am43xx_hwmod_ocpif_clk(void)
++{
++      am33xx_l4_wkup__wkup_m3.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__control.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__smartreflex0.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__smartreflex1.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__uart1.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__timer1.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__i2c1.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__gpio0.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__wd_timer1.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_wkup_m3__l4_wkup.clk = AM43XX_L4_WKUP_OCPIF_CLK;
++      am33xx_control_hwmod.main_clk = AM43XX_L4_WKUP_OCPIF_CLK;
++}
++
++#define AM33XX_L4_WKUP_OCPIF_CLK "dpll_core_m4_div2_ck"
++
++static void am33xx_hwmod_ocpif_clk(void)
++{
++      am33xx_l4_wkup__wkup_m3.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__control.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__smartreflex0.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__smartreflex1.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__uart1.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__timer1.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__i2c1.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__gpio0.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_l4_wkup__wd_timer1.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_wkup_m3__l4_wkup.clk = AM33XX_L4_WKUP_OCPIF_CLK;
++      am33xx_control_hwmod.main_clk = AM33XX_L4_WKUP_OCPIF_CLK;
++}
++
++static struct omap_hwmod_ocp_if *am43xx_hwmod_ocp_ifs[] __initdata = {
++      &am33xx_l4_wkup__synctimer,
++      &am43xx_l4_ls__timer8,
++      &am43xx_l4_ls__timer9,
++      &am43xx_l4_ls__timer10,
++      &am43xx_l4_ls__timer11,
++      &am43xx_l4_ls__epwmss3,
++      &am43xx_epwmss3__ehrpwm3,
++      &am43xx_l4_ls__epwmss4,
++      &am43xx_epwmss4__ehrpwm4,
++      &am43xx_l4_ls__epwmss5,
++      &am43xx_epwmss5__ehrpwm5,
++      &am43xx_l4_ls__mcspi2,
++      &am43xx_l4_ls__mcspi3,
++      &am43xx_l4_ls__mcspi4,
++      &am43xx_l4_ls__gpio4,
++      &am43xx_l4_ls__gpio5,
++      &am43xx_l3_main__pruss,
++      &am43xx_l3_main__des,
++      &am43xx_l3_s__qspi,
++      &am43xx_l3_s__usbotgss0,
++      &am43xx_l3_s__usbotgss1,
++      &am33xx_l4_ls__ocp2scp0,
++      &am33xx_l4_ls__ocp2scp1,
++      &am43xx_dss__l3_main,
++      &am43xx_l4_ls__dss,
++      &am43xx_l4_ls__dss_dispc,
++      &am43xx_l4_ls__dss_rfbi,
++      NULL,
++};
++
+ static struct omap_hwmod_ocp_if *am33xx_hwmod_ocp_ifs[] __initdata = {
+       &am33xx_l3_main__emif,
++      &am33xx_l3_main__debugss,
++      &am33xx_l4_hs__pruss,
++      &am33xx_l3_main__lcdc,
++      &am33xx_l3_s__usbss,
++      &am33xx_l4_wkup__rtc,
++      NULL,
++};
++
++static struct omap_hwmod_ocp_if *amx3xx_hwmod_ocp_ifs[] __initdata = {
+       &am33xx_mpu__l3_main,
+       &am33xx_mpu__prcm,
+       &am33xx_l3_s__l4_ls,
+@@ -2494,19 +3236,16 @@ static struct omap_hwmod_ocp_if *am33xx_
+       &am33xx_pruss__l3_main,
+       &am33xx_wkup_m3__l4_wkup,
+       &am33xx_gfx__l3_main,
+-      &am33xx_l3_main__debugss,
+       &am33xx_l4_wkup__wkup_m3,
+       &am33xx_l4_wkup__control,
+       &am33xx_l4_wkup__smartreflex0,
+       &am33xx_l4_wkup__smartreflex1,
+       &am33xx_l4_wkup__uart1,
+       &am33xx_l4_wkup__timer1,
+-      &am33xx_l4_wkup__rtc,
+       &am33xx_l4_wkup__i2c1,
+       &am33xx_l4_wkup__gpio0,
+       &am33xx_l4_wkup__adc_tsc,
+       &am33xx_l4_wkup__wd_timer1,
+-      &am33xx_l4_hs__pruss,
+       &am33xx_l4_per__dcan0,
+       &am33xx_l4_per__dcan1,
+       &am33xx_l4_per__gpio1,
+@@ -2547,23 +3286,46 @@ static struct omap_hwmod_ocp_if *am33xx_
+       &am33xx_epwmss2__eqep2,
+       &am33xx_epwmss2__ehrpwm2,
+       &am33xx_l3_s__gpmc,
+-      &am33xx_l3_main__lcdc,
+       &am33xx_l4_ls__mcspi0,
+       &am33xx_l4_ls__mcspi1,
+       &am33xx_l3_main__tptc0,
+       &am33xx_l3_main__tptc1,
+       &am33xx_l3_main__tptc2,
+       &am33xx_l3_main__ocmc,
+-      &am33xx_l3_s__usbss,
+       &am33xx_l4_hs__cpgmac0,
+       &am33xx_cpgmac0__mdio,
+       &am33xx_l3_main__sha0,
+       &am33xx_l3_main__aes0,
++      &am33xx_l4_per__rng,
+       NULL,
+ };
+ int __init am33xx_hwmod_init(void)
+ {
++      int ret;
++
+       omap_hwmod_init();
+-      return omap_hwmod_register_links(am33xx_hwmod_ocp_ifs);
++
++      if (soc_is_am33xx()) {
++              am33xx_hwmod_clkctrl();
++              am33xx_hwmod_rstctrl();
++              am33xx_hwmod_rstst();
++              am33xx_hwmod_clockdomain();
++              am33xx_hwmod_ocpif_clk();
++      } else {
++              am43xx_hwmod_clkctrl();
++              am43xx_hwmod_rstctrl();
++              am43xx_hwmod_rstst();
++              am43xx_hwmod_clockdomain();
++              am43xx_hwmod_ocpif_clk();
++      }
++
++      ret = omap_hwmod_register_links(amx3xx_hwmod_ocp_ifs);
++      if (ret < 0)
++              return ret;
++
++      if (soc_is_am33xx())
++              return omap_hwmod_register_links(am33xx_hwmod_ocp_ifs);
++      else
++              return omap_hwmod_register_links(am43xx_hwmod_ocp_ifs);
+ }
+--- a/arch/arm/mach-omap2/omap_hwmod_3xxx_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_3xxx_data.c
+@@ -200,7 +200,6 @@ static struct omap_timer_capability_dev_
+ static struct omap_hwmod omap3xxx_timer1_hwmod = {
+       .name           = "timer1",
+       .mpu_irqs       = omap2_timer1_mpu_irqs,
+-      .main_clk       = "gpt1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -219,7 +218,6 @@ static struct omap_hwmod omap3xxx_timer1
+ static struct omap_hwmod omap3xxx_timer2_hwmod = {
+       .name           = "timer2",
+       .mpu_irqs       = omap2_timer2_mpu_irqs,
+-      .main_clk       = "gpt2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -237,7 +235,6 @@ static struct omap_hwmod omap3xxx_timer2
+ static struct omap_hwmod omap3xxx_timer3_hwmod = {
+       .name           = "timer3",
+       .mpu_irqs       = omap2_timer3_mpu_irqs,
+-      .main_clk       = "gpt3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -255,7 +252,6 @@ static struct omap_hwmod omap3xxx_timer3
+ static struct omap_hwmod omap3xxx_timer4_hwmod = {
+       .name           = "timer4",
+       .mpu_irqs       = omap2_timer4_mpu_irqs,
+-      .main_clk       = "gpt4_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -273,7 +269,6 @@ static struct omap_hwmod omap3xxx_timer4
+ static struct omap_hwmod omap3xxx_timer5_hwmod = {
+       .name           = "timer5",
+       .mpu_irqs       = omap2_timer5_mpu_irqs,
+-      .main_clk       = "gpt5_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -292,7 +287,6 @@ static struct omap_hwmod omap3xxx_timer5
+ static struct omap_hwmod omap3xxx_timer6_hwmod = {
+       .name           = "timer6",
+       .mpu_irqs       = omap2_timer6_mpu_irqs,
+-      .main_clk       = "gpt6_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -311,7 +305,6 @@ static struct omap_hwmod omap3xxx_timer6
+ static struct omap_hwmod omap3xxx_timer7_hwmod = {
+       .name           = "timer7",
+       .mpu_irqs       = omap2_timer7_mpu_irqs,
+-      .main_clk       = "gpt7_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -330,7 +323,6 @@ static struct omap_hwmod omap3xxx_timer7
+ static struct omap_hwmod omap3xxx_timer8_hwmod = {
+       .name           = "timer8",
+       .mpu_irqs       = omap2_timer8_mpu_irqs,
+-      .main_clk       = "gpt8_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -349,7 +341,6 @@ static struct omap_hwmod omap3xxx_timer8
+ static struct omap_hwmod omap3xxx_timer9_hwmod = {
+       .name           = "timer9",
+       .mpu_irqs       = omap2_timer9_mpu_irqs,
+-      .main_clk       = "gpt9_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -368,7 +359,6 @@ static struct omap_hwmod omap3xxx_timer9
+ static struct omap_hwmod omap3xxx_timer10_hwmod = {
+       .name           = "timer10",
+       .mpu_irqs       = omap2_timer10_mpu_irqs,
+-      .main_clk       = "gpt10_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -387,7 +377,6 @@ static struct omap_hwmod omap3xxx_timer1
+ static struct omap_hwmod omap3xxx_timer11_hwmod = {
+       .name           = "timer11",
+       .mpu_irqs       = omap2_timer11_mpu_irqs,
+-      .main_clk       = "gpt11_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -411,7 +400,6 @@ static struct omap_hwmod_irq_info omap3x
+ static struct omap_hwmod omap3xxx_timer12_hwmod = {
+       .name           = "timer12",
+       .mpu_irqs       = omap3xxx_timer12_mpu_irqs,
+-      .main_clk       = "gpt12_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -467,7 +455,6 @@ static struct omap_hwmod_class omap3xxx_
+ static struct omap_hwmod omap3xxx_wd_timer2_hwmod = {
+       .name           = "wd_timer2",
+       .class          = &omap3xxx_wd_timer_hwmod_class,
+-      .main_clk       = "wdt2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -489,7 +476,6 @@ static struct omap_hwmod omap3xxx_uart1_
+       .name           = "uart1",
+       .mpu_irqs       = omap2_uart1_mpu_irqs,
+       .sdma_reqs      = omap2_uart1_sdma_reqs,
+-      .main_clk       = "uart1_fck",
+       .flags          = DEBUG_TI81XXUART1_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+       .prcm           = {
+               .omap2 = {
+@@ -508,7 +494,6 @@ static struct omap_hwmod omap3xxx_uart2_
+       .name           = "uart2",
+       .mpu_irqs       = omap2_uart2_mpu_irqs,
+       .sdma_reqs      = omap2_uart2_sdma_reqs,
+-      .main_clk       = "uart2_fck",
+       .flags          = DEBUG_TI81XXUART2_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+       .prcm           = {
+               .omap2 = {
+@@ -527,7 +512,6 @@ static struct omap_hwmod omap3xxx_uart3_
+       .name           = "uart3",
+       .mpu_irqs       = omap2_uart3_mpu_irqs,
+       .sdma_reqs      = omap2_uart3_sdma_reqs,
+-      .main_clk       = "uart3_fck",
+       .flags          = DEBUG_OMAP3UART3_FLAGS | DEBUG_TI81XXUART3_FLAGS |
+                               HWMOD_SWSUP_SIDLE_ACT,
+       .prcm           = {
+@@ -807,7 +791,6 @@ static struct omap_hwmod omap3xxx_i2c1_h
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+       .mpu_irqs       = omap2_i2c1_mpu_irqs,
+       .sdma_reqs      = omap2_i2c1_sdma_reqs,
+-      .main_clk       = "i2c1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -832,7 +815,6 @@ static struct omap_hwmod omap3xxx_i2c2_h
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+       .mpu_irqs       = omap2_i2c2_mpu_irqs,
+       .sdma_reqs      = omap2_i2c2_sdma_reqs,
+-      .main_clk       = "i2c2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -868,7 +850,6 @@ static struct omap_hwmod omap3xxx_i2c3_h
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+       .mpu_irqs       = i2c3_mpu_irqs,
+       .sdma_reqs      = i2c3_sdma_reqs,
+-      .main_clk       = "i2c3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -911,17 +892,11 @@ static struct omap_gpio_dev_attr gpio_de
+ };
+ /* gpio1 */
+-static struct omap_hwmod_opt_clk gpio1_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio1_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio1_hwmod = {
+       .name           = "gpio1",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap2_gpio1_irqs,
+-      .main_clk       = "gpio1_ick",
+-      .opt_clks       = gpio1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio1_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -936,17 +911,11 @@ static struct omap_hwmod omap3xxx_gpio1_
+ };
+ /* gpio2 */
+-static struct omap_hwmod_opt_clk gpio2_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio2_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio2_hwmod = {
+       .name           = "gpio2",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap2_gpio2_irqs,
+-      .main_clk       = "gpio2_ick",
+-      .opt_clks       = gpio2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio2_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -961,17 +930,11 @@ static struct omap_hwmod omap3xxx_gpio2_
+ };
+ /* gpio3 */
+-static struct omap_hwmod_opt_clk gpio3_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio3_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio3_hwmod = {
+       .name           = "gpio3",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap2_gpio3_irqs,
+-      .main_clk       = "gpio3_ick",
+-      .opt_clks       = gpio3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio3_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -986,17 +949,11 @@ static struct omap_hwmod omap3xxx_gpio3_
+ };
+ /* gpio4 */
+-static struct omap_hwmod_opt_clk gpio4_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio4_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio4_hwmod = {
+       .name           = "gpio4",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap2_gpio4_irqs,
+-      .main_clk       = "gpio4_ick",
+-      .opt_clks       = gpio4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio4_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1016,17 +973,11 @@ static struct omap_hwmod_irq_info omap3x
+       { .irq = -1 },
+ };
+-static struct omap_hwmod_opt_clk gpio5_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio5_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio5_hwmod = {
+       .name           = "gpio5",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap3xxx_gpio5_irqs,
+-      .main_clk       = "gpio5_ick",
+-      .opt_clks       = gpio5_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio5_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1046,17 +997,11 @@ static struct omap_hwmod_irq_info omap3x
+       { .irq = -1 },
+ };
+-static struct omap_hwmod_opt_clk gpio6_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio6_dbck", },
+-};
+ static struct omap_hwmod omap3xxx_gpio6_hwmod = {
+       .name           = "gpio6",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+       .mpu_irqs       = omap3xxx_gpio6_irqs,
+-      .main_clk       = "gpio6_ick",
+-      .opt_clks       = gpio6_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio6_opt_clks),
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1100,7 +1045,6 @@ static struct omap_hwmod omap3xxx_dma_sy
+       .name           = "dma",
+       .class          = &omap3xxx_dma_hwmod_class,
+       .mpu_irqs       = omap2_dma_system_irqs,
+-      .main_clk       = "core_l3_ick",
+       .prcm = {
+               .omap2 = {
+                       .module_offs            = CORE_MOD,
+@@ -1135,15 +1079,7 @@ static struct omap_hwmod_class omap3xxx_
+ };
+ /* McBSP functional clock mapping */
+-static struct omap_hwmod_opt_clk mcbsp15_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "mcbsp_clks" },
+-      { .role = "prcm_fck", .clk = "core_96m_fck" },
+-};
+-static struct omap_hwmod_opt_clk mcbsp234_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "mcbsp_clks" },
+-      { .role = "prcm_fck", .clk = "per_96m_fck" },
+-};
+ /* mcbsp1 */
+ static struct omap_hwmod_irq_info omap3xxx_mcbsp1_irqs[] = {
+@@ -1158,7 +1094,6 @@ static struct omap_hwmod omap3xxx_mcbsp1
+       .class          = &omap3xxx_mcbsp_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp1_irqs,
+       .sdma_reqs      = omap2_mcbsp1_sdma_reqs,
+-      .main_clk       = "mcbsp1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1168,8 +1103,6 @@ static struct omap_hwmod omap3xxx_mcbsp1
+                       .idlest_idle_bit = OMAP3430_ST_MCBSP1_SHIFT,
+               },
+       },
+-      .opt_clks       = mcbsp15_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp15_opt_clks),
+ };
+ /* mcbsp2 */
+@@ -1189,7 +1122,6 @@ static struct omap_hwmod omap3xxx_mcbsp2
+       .class          = &omap3xxx_mcbsp_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp2_irqs,
+       .sdma_reqs      = omap2_mcbsp2_sdma_reqs,
+-      .main_clk       = "mcbsp2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1199,8 +1131,6 @@ static struct omap_hwmod omap3xxx_mcbsp2
+                       .idlest_idle_bit = OMAP3430_ST_MCBSP2_SHIFT,
+               },
+       },
+-      .opt_clks       = mcbsp234_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp234_opt_clks),
+       .dev_attr       = &omap34xx_mcbsp2_dev_attr,
+ };
+@@ -1221,7 +1151,6 @@ static struct omap_hwmod omap3xxx_mcbsp3
+       .class          = &omap3xxx_mcbsp_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp3_irqs,
+       .sdma_reqs      = omap2_mcbsp3_sdma_reqs,
+-      .main_clk       = "mcbsp3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1231,8 +1160,6 @@ static struct omap_hwmod omap3xxx_mcbsp3
+                       .idlest_idle_bit = OMAP3430_ST_MCBSP3_SHIFT,
+               },
+       },
+-      .opt_clks       = mcbsp234_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp234_opt_clks),
+       .dev_attr       = &omap34xx_mcbsp3_dev_attr,
+ };
+@@ -1255,7 +1182,6 @@ static struct omap_hwmod omap3xxx_mcbsp4
+       .class          = &omap3xxx_mcbsp_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp4_irqs,
+       .sdma_reqs      = omap3xxx_mcbsp4_sdma_chs,
+-      .main_clk       = "mcbsp4_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1265,8 +1191,6 @@ static struct omap_hwmod omap3xxx_mcbsp4
+                       .idlest_idle_bit = OMAP3430_ST_MCBSP4_SHIFT,
+               },
+       },
+-      .opt_clks       = mcbsp234_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp234_opt_clks),
+ };
+ /* mcbsp5 */
+@@ -1288,7 +1212,6 @@ static struct omap_hwmod omap3xxx_mcbsp5
+       .class          = &omap3xxx_mcbsp_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp5_irqs,
+       .sdma_reqs      = omap3xxx_mcbsp5_sdma_chs,
+-      .main_clk       = "mcbsp5_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1298,8 +1221,6 @@ static struct omap_hwmod omap3xxx_mcbsp5
+                       .idlest_idle_bit = OMAP3430_ST_MCBSP5_SHIFT,
+               },
+       },
+-      .opt_clks       = mcbsp15_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp15_opt_clks),
+ };
+ /* 'mcbsp sidetone' class */
+@@ -1324,7 +1245,6 @@ static struct omap_hwmod omap3xxx_mcbsp2
+       .name           = "mcbsp2_sidetone",
+       .class          = &omap3xxx_mcbsp_sidetone_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp2_sidetone_irqs,
+-      .main_clk       = "mcbsp2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1346,7 +1266,6 @@ static struct omap_hwmod omap3xxx_mcbsp3
+       .name           = "mcbsp3_sidetone",
+       .class          = &omap3xxx_mcbsp_sidetone_hwmod_class,
+       .mpu_irqs       = omap3xxx_mcbsp3_sidetone_irqs,
+-      .main_clk       = "mcbsp3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1571,7 +1490,6 @@ static struct omap_hwmod omap34xx_mcspi1
+       .name           = "mcspi1",
+       .mpu_irqs       = omap2_mcspi1_mpu_irqs,
+       .sdma_reqs      = omap2_mcspi1_sdma_reqs,
+-      .main_clk       = "mcspi1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1594,7 +1512,6 @@ static struct omap_hwmod omap34xx_mcspi2
+       .name           = "mcspi2",
+       .mpu_irqs       = omap2_mcspi2_mpu_irqs,
+       .sdma_reqs      = omap2_mcspi2_sdma_reqs,
+-      .main_clk       = "mcspi2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1630,7 +1547,6 @@ static struct omap_hwmod omap34xx_mcspi3
+       .name           = "mcspi3",
+       .mpu_irqs       = omap34xx_mcspi3_mpu_irqs,
+       .sdma_reqs      = omap34xx_mcspi3_sdma_reqs,
+-      .main_clk       = "mcspi3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1664,7 +1580,6 @@ static struct omap_hwmod omap34xx_mcspi4
+       .name           = "mcspi4",
+       .mpu_irqs       = omap34xx_mcspi4_mpu_irqs,
+       .sdma_reqs      = omap34xx_mcspi4_sdma_reqs,
+-      .main_clk       = "mcspi4_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1707,7 +1622,6 @@ static struct omap_hwmod_irq_info omap3x
+ static struct omap_hwmod omap3xxx_usbhsotg_hwmod = {
+       .name           = "usb_otg_hs",
+       .mpu_irqs       = omap3xxx_usbhsotg_mpu_irqs,
+-      .main_clk       = "hsotgusb_ick",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1782,9 +1696,6 @@ static struct omap_hwmod_dma_info omap34
+       { .dma_req = -1 }
+ };
+-static struct omap_hwmod_opt_clk omap34xx_mmc1_opt_clks[] = {
+-      { .role = "dbck", .clk = "omap_32k_fck", },
+-};
+ static struct omap_mmc_dev_attr mmc1_dev_attr = {
+       .flags = OMAP_HSMMC_SUPPORTS_DUAL_VOLT,
+@@ -1800,9 +1711,6 @@ static struct omap_hwmod omap3xxx_pre_es
+       .name           = "mmc1",
+       .mpu_irqs       = omap34xx_mmc1_mpu_irqs,
+       .sdma_reqs      = omap34xx_mmc1_sdma_reqs,
+-      .opt_clks       = omap34xx_mmc1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap34xx_mmc1_opt_clks),
+-      .main_clk       = "mmchs1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1820,9 +1728,6 @@ static struct omap_hwmod omap3xxx_es3plu
+       .name           = "mmc1",
+       .mpu_irqs       = omap34xx_mmc1_mpu_irqs,
+       .sdma_reqs      = omap34xx_mmc1_sdma_reqs,
+-      .opt_clks       = omap34xx_mmc1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap34xx_mmc1_opt_clks),
+-      .main_clk       = "mmchs1_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1849,9 +1754,6 @@ static struct omap_hwmod_dma_info omap34
+       { .dma_req = -1 }
+ };
+-static struct omap_hwmod_opt_clk omap34xx_mmc2_opt_clks[] = {
+-      { .role = "dbck", .clk = "omap_32k_fck", },
+-};
+ /* See 35xx errata 2.1.1.128 in SPRZ278F */
+ static struct omap_mmc_dev_attr mmc2_pre_es3_dev_attr = {
+@@ -1862,9 +1764,6 @@ static struct omap_hwmod omap3xxx_pre_es
+       .name           = "mmc2",
+       .mpu_irqs       = omap34xx_mmc2_mpu_irqs,
+       .sdma_reqs      = omap34xx_mmc2_sdma_reqs,
+-      .opt_clks       = omap34xx_mmc2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap34xx_mmc2_opt_clks),
+-      .main_clk       = "mmchs2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1882,9 +1781,6 @@ static struct omap_hwmod omap3xxx_es3plu
+       .name           = "mmc2",
+       .mpu_irqs       = omap34xx_mmc2_mpu_irqs,
+       .sdma_reqs      = omap34xx_mmc2_sdma_reqs,
+-      .opt_clks       = omap34xx_mmc2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap34xx_mmc2_opt_clks),
+-      .main_clk       = "mmchs2_fck",
+       .prcm           = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -1910,17 +1806,11 @@ static struct omap_hwmod_dma_info omap34
+       { .dma_req = -1 }
+ };
+-static struct omap_hwmod_opt_clk omap34xx_mmc3_opt_clks[] = {
+-      { .role = "dbck", .clk = "omap_32k_fck", },
+-};
+ static struct omap_hwmod omap3xxx_mmc3_hwmod = {
+       .name           = "mmc3",
+       .mpu_irqs       = omap34xx_mmc3_mpu_irqs,
+       .sdma_reqs      = omap34xx_mmc3_sdma_reqs,
+-      .opt_clks       = omap34xx_mmc3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap34xx_mmc3_opt_clks),
+-      .main_clk       = "mmchs3_fck",
+       .prcm           = {
+               .omap2 = {
+                       .prcm_reg_id = 1,
+@@ -1954,9 +1844,6 @@ static struct omap_hwmod_class omap3xxx_
+       .sysc = &omap3xxx_usb_host_hs_sysc,
+ };
+-static struct omap_hwmod_opt_clk omap3xxx_usb_host_hs_opt_clks[] = {
+-        { .role = "ehci_logic_fck", .clk = "usbhost_120m_fck", },
+-};
+ static struct omap_hwmod_irq_info omap3xxx_usb_host_hs_irqs[] = {
+       { .name = "ohci-irq", .irq = 76 + OMAP_INTC_START, },
+@@ -1969,7 +1856,6 @@ static struct omap_hwmod omap3xxx_usb_ho
+       .class          = &omap3xxx_usb_host_hs_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+       .mpu_irqs       = omap3xxx_usb_host_hs_irqs,
+-      .main_clk       = "usbhost_48m_fck",
+       .prcm = {
+               .omap2 = {
+                       .module_offs = OMAP3430ES2_USBHOST_MOD,
+@@ -1980,8 +1866,6 @@ static struct omap_hwmod omap3xxx_usb_ho
+                       .idlest_stdby_bit = OMAP3430ES2_ST_USBHOST_STDBY_SHIFT,
+               },
+       },
+-      .opt_clks       = omap3xxx_usb_host_hs_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(omap3xxx_usb_host_hs_opt_clks),
+       /*
+        * Errata: USBHOST Configured In Smart-Idle Can Lead To a Deadlock
+@@ -2062,7 +1946,6 @@ static struct omap_hwmod omap3xxx_usb_tl
+       .class          = &omap3xxx_usb_tll_hs_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+       .mpu_irqs       = omap3xxx_usb_tll_hs_irqs,
+-      .main_clk       = "usbtll_fck",
+       .prcm = {
+               .omap2 = {
+                       .module_offs = CORE_MOD,
+@@ -2139,7 +2022,6 @@ static struct omap_hwmod omap3xxx_counte
+       .class          = &omap3xxx_counter_hwmod_class,
+       .clkdm_name     = "wkup_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "wkup_32k_fck",
+       .prcm           = {
+               .omap2  = {
+                       .module_offs = WKUP_MOD,
+@@ -2181,7 +2063,6 @@ static struct omap_hwmod omap3xxx_gpmc_h
+       .class          = &omap3xxx_gpmc_hwmod_class,
+       .clkdm_name     = "core_l3_clkdm",
+       .mpu_irqs       = omap3xxx_gpmc_irqs,
+-      .main_clk       = "gpmc_fck",
+       /*
+        * XXX HWMOD_INIT_NO_RESET should not be needed for this IP
+        * block.  It is not being added due to any known bugs with
+--- a/arch/arm/mach-omap2/omap_hwmod_44xx_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_44xx_data.c
+@@ -334,7 +334,6 @@ static struct omap_hwmod omap44xx_counte
+       .class          = &omap44xx_counter_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_WKUP_SYNCTIMER_CLKCTRL_OFFSET,
+@@ -479,7 +478,6 @@ static struct omap_hwmod omap44xx_dma_sy
+       .class          = &omap44xx_dma_hwmod_class,
+       .clkdm_name     = "l3_dma_clkdm",
+       .mpu_irqs       = omap44xx_dma_system_irqs,
+-      .main_clk       = "l3_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_SDMA_SDMA_CLKCTRL_OFFSET,
+@@ -514,7 +512,6 @@ static struct omap_hwmod omap44xx_dmic_h
+       .name           = "dmic",
+       .class          = &omap44xx_dmic_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "func_dmic_abe_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_DMIC_CLKCTRL_OFFSET,
+@@ -914,8 +911,6 @@ static struct omap_hwmod omap44xx_emif1_
+       .name           = "emif1",
+       .class          = &omap44xx_emif_hwmod_class,
+       .clkdm_name     = "l3_emif_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
+-      .main_clk       = "ddrphy_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_MEMIF_EMIF_1_CLKCTRL_OFFSET,
+@@ -930,8 +925,6 @@ static struct omap_hwmod omap44xx_emif2_
+       .name           = "emif2",
+       .class          = &omap44xx_emif_hwmod_class,
+       .clkdm_name     = "l3_emif_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
+-      .main_clk       = "ddrphy_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_MEMIF_EMIF_2_CLKCTRL_OFFSET,
+@@ -1015,15 +1008,11 @@ static struct omap_gpio_dev_attr gpio_de
+ };
+ /* gpio1 */
+-static struct omap_hwmod_opt_clk gpio1_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio1_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio1_hwmod = {
+       .name           = "gpio1",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .main_clk       = "l4_wkup_clk_mux_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_WKUP_GPIO1_CLKCTRL_OFFSET,
+@@ -1031,22 +1020,16 @@ static struct omap_hwmod omap44xx_gpio1_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio1_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio2 */
+-static struct omap_hwmod_opt_clk gpio2_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio2_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio2_hwmod = {
+       .name           = "gpio2",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_GPIO2_CLKCTRL_OFFSET,
+@@ -1054,22 +1037,16 @@ static struct omap_hwmod omap44xx_gpio2_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio2_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio3 */
+-static struct omap_hwmod_opt_clk gpio3_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio3_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio3_hwmod = {
+       .name           = "gpio3",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_GPIO3_CLKCTRL_OFFSET,
+@@ -1077,22 +1054,16 @@ static struct omap_hwmod omap44xx_gpio3_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio3_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio4 */
+-static struct omap_hwmod_opt_clk gpio4_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio4_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio4_hwmod = {
+       .name           = "gpio4",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_GPIO4_CLKCTRL_OFFSET,
+@@ -1100,22 +1071,16 @@ static struct omap_hwmod omap44xx_gpio4_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio4_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio5 */
+-static struct omap_hwmod_opt_clk gpio5_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio5_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio5_hwmod = {
+       .name           = "gpio5",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_GPIO5_CLKCTRL_OFFSET,
+@@ -1123,22 +1088,16 @@ static struct omap_hwmod omap44xx_gpio5_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio5_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio5_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio6 */
+-static struct omap_hwmod_opt_clk gpio6_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio6_dbclk" },
+-};
+ static struct omap_hwmod omap44xx_gpio6_hwmod = {
+       .name           = "gpio6",
+       .class          = &omap44xx_gpio_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_div_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_GPIO6_CLKCTRL_OFFSET,
+@@ -1146,8 +1105,6 @@ static struct omap_hwmod omap44xx_gpio6_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio6_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio6_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+@@ -1184,7 +1141,7 @@ static struct omap_hwmod omap44xx_gpmc_h
+        * the kernel from the board file or DT data.
+        * HWMOD_INIT_NO_RESET should be removed ASAP.
+        */
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
++      .flags          = HWMOD_INIT_NO_RESET,
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3_2_GPMC_CLKCTRL_OFFSET,
+@@ -1337,7 +1294,6 @@ static struct omap_hwmod omap44xx_i2c1_h
+       .class          = &omap44xx_i2c_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_I2C1_CLKCTRL_OFFSET,
+@@ -1354,7 +1310,6 @@ static struct omap_hwmod omap44xx_i2c2_h
+       .class          = &omap44xx_i2c_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_I2C2_CLKCTRL_OFFSET,
+@@ -1371,7 +1326,6 @@ static struct omap_hwmod omap44xx_i2c3_h
+       .class          = &omap44xx_i2c_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_I2C3_CLKCTRL_OFFSET,
+@@ -1388,7 +1342,6 @@ static struct omap_hwmod omap44xx_i2c4_h
+       .class          = &omap44xx_i2c_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_I2C4_CLKCTRL_OFFSET,
+@@ -1542,7 +1495,6 @@ static struct omap_hwmod omap44xx_kbd_hw
+       .name           = "kbd",
+       .class          = &omap44xx_kbd_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_WKUP_KEYBOARD_CLKCTRL_OFFSET,
+@@ -1643,16 +1595,11 @@ static struct omap_hwmod_class omap44xx_
+ };
+ /* mcbsp1 */
+-static struct omap_hwmod_opt_clk mcbsp1_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp1_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap44xx_mcbsp1_hwmod = {
+       .name           = "mcbsp1",
+       .class          = &omap44xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "func_mcbsp1_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_MCBSP1_CLKCTRL_OFFSET,
+@@ -1660,21 +1607,14 @@ static struct omap_hwmod omap44xx_mcbsp1
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp1_opt_clks),
+ };
+ /* mcbsp2 */
+-static struct omap_hwmod_opt_clk mcbsp2_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp2_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap44xx_mcbsp2_hwmod = {
+       .name           = "mcbsp2",
+       .class          = &omap44xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "func_mcbsp2_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_MCBSP2_CLKCTRL_OFFSET,
+@@ -1682,21 +1622,14 @@ static struct omap_hwmod omap44xx_mcbsp2
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp2_opt_clks),
+ };
+ /* mcbsp3 */
+-static struct omap_hwmod_opt_clk mcbsp3_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp3_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap44xx_mcbsp3_hwmod = {
+       .name           = "mcbsp3",
+       .class          = &omap44xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "func_mcbsp3_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_MCBSP3_CLKCTRL_OFFSET,
+@@ -1704,21 +1637,14 @@ static struct omap_hwmod omap44xx_mcbsp3
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp3_opt_clks),
+ };
+ /* mcbsp4 */
+-static struct omap_hwmod_opt_clk mcbsp4_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp4_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap44xx_mcbsp4_hwmod = {
+       .name           = "mcbsp4",
+       .class          = &omap44xx_mcbsp_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+-      .main_clk       = "per_mcbsp4_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MCBSP4_CLKCTRL_OFFSET,
+@@ -1726,8 +1652,6 @@ static struct omap_hwmod omap44xx_mcbsp4
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp4_opt_clks),
+ };
+ /*
+@@ -1768,7 +1692,6 @@ static struct omap_hwmod omap44xx_mcpdm_
+        * results 'slow motion' audio playback.
+        */
+       .flags          = HWMOD_EXT_OPT_MAIN_CLK | HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "pad_clks_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_PDM_CLKCTRL_OFFSET,
+@@ -1823,7 +1746,6 @@ static struct omap_hwmod omap44xx_mcspi1
+       .class          = &omap44xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mcspi1_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MCSPI1_CLKCTRL_OFFSET,
+@@ -1853,7 +1775,6 @@ static struct omap_hwmod omap44xx_mcspi2
+       .class          = &omap44xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mcspi2_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MCSPI2_CLKCTRL_OFFSET,
+@@ -1883,7 +1804,6 @@ static struct omap_hwmod omap44xx_mcspi3
+       .class          = &omap44xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mcspi3_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MCSPI3_CLKCTRL_OFFSET,
+@@ -1911,7 +1831,6 @@ static struct omap_hwmod omap44xx_mcspi4
+       .class          = &omap44xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mcspi4_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MCSPI4_CLKCTRL_OFFSET,
+@@ -1961,7 +1880,6 @@ static struct omap_hwmod omap44xx_mmc1_h
+       .class          = &omap44xx_mmc_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+       .sdma_reqs      = omap44xx_mmc1_sdma_reqs,
+-      .main_clk       = "hsmmc1_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_MMC1_CLKCTRL_OFFSET,
+@@ -1984,7 +1902,6 @@ static struct omap_hwmod omap44xx_mmc2_h
+       .class          = &omap44xx_mmc_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+       .sdma_reqs      = omap44xx_mmc2_sdma_reqs,
+-      .main_clk       = "hsmmc2_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_MMC2_CLKCTRL_OFFSET,
+@@ -2006,7 +1923,6 @@ static struct omap_hwmod omap44xx_mmc3_h
+       .class          = &omap44xx_mmc_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mmc3_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MMCSD3_CLKCTRL_OFFSET,
+@@ -2028,7 +1944,6 @@ static struct omap_hwmod omap44xx_mmc4_h
+       .class          = &omap44xx_mmc_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mmc4_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MMCSD4_CLKCTRL_OFFSET,
+@@ -2050,7 +1965,6 @@ static struct omap_hwmod omap44xx_mmc5_h
+       .class          = &omap44xx_mmc_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .sdma_reqs      = omap44xx_mmc5_sdma_reqs,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_MMCSD5_CLKCTRL_OFFSET,
+@@ -2193,7 +2107,7 @@ static struct omap_hwmod omap44xx_mpu_hw
+       .name           = "mpu",
+       .class          = &omap44xx_mpu_hwmod_class,
+       .clkdm_name     = "mpuss_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "dpll_mpu_m2_ck",
+       .prcm = {
+               .omap4 = {
+@@ -2261,7 +2175,6 @@ static struct omap_hwmod omap44xx_ocp2sc
+        * So listing ocp2scp_usb_phy_phy_48m as a main_clk here seems
+        * to be the best workaround.
+        */
+-      .main_clk       = "ocp2scp_usb_phy_phy_48m",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_USBPHYOCP2SCP_CLKCTRL_OFFSET,
+@@ -2629,7 +2542,6 @@ static struct omap_hwmod omap44xx_timer1
+       .class          = &omap44xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "dmt1_clk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_WKUP_TIMER1_CLKCTRL_OFFSET,
+@@ -2646,7 +2558,6 @@ static struct omap_hwmod omap44xx_timer2
+       .class          = &omap44xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "cm2_dm2_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER2_CLKCTRL_OFFSET,
+@@ -2661,7 +2572,6 @@ static struct omap_hwmod omap44xx_timer3
+       .name           = "timer3",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+-      .main_clk       = "cm2_dm3_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER3_CLKCTRL_OFFSET,
+@@ -2676,7 +2586,6 @@ static struct omap_hwmod omap44xx_timer4
+       .name           = "timer4",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+-      .main_clk       = "cm2_dm4_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER4_CLKCTRL_OFFSET,
+@@ -2691,7 +2600,6 @@ static struct omap_hwmod omap44xx_timer5
+       .name           = "timer5",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer5_sync_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_TIMER5_CLKCTRL_OFFSET,
+@@ -2707,7 +2615,6 @@ static struct omap_hwmod omap44xx_timer6
+       .name           = "timer6",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer6_sync_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_TIMER6_CLKCTRL_OFFSET,
+@@ -2723,7 +2630,6 @@ static struct omap_hwmod omap44xx_timer7
+       .name           = "timer7",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer7_sync_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_TIMER7_CLKCTRL_OFFSET,
+@@ -2739,7 +2645,6 @@ static struct omap_hwmod omap44xx_timer8
+       .name           = "timer8",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer8_sync_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM1_ABE_TIMER8_CLKCTRL_OFFSET,
+@@ -2755,7 +2660,6 @@ static struct omap_hwmod omap44xx_timer9
+       .name           = "timer9",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+-      .main_clk       = "cm2_dm9_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER9_CLKCTRL_OFFSET,
+@@ -2772,7 +2676,6 @@ static struct omap_hwmod omap44xx_timer1
+       .class          = &omap44xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "cm2_dm10_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER10_CLKCTRL_OFFSET,
+@@ -2788,7 +2691,6 @@ static struct omap_hwmod omap44xx_timer1
+       .name           = "timer11",
+       .class          = &omap44xx_timer_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+-      .main_clk       = "cm2_dm11_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_DMTIMER11_CLKCTRL_OFFSET,
+@@ -2827,7 +2729,6 @@ static struct omap_hwmod omap44xx_uart1_
+       .class          = &omap44xx_uart_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_UART1_CLKCTRL_OFFSET,
+@@ -2843,7 +2744,6 @@ static struct omap_hwmod omap44xx_uart2_
+       .class          = &omap44xx_uart_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_UART2_CLKCTRL_OFFSET,
+@@ -2859,7 +2759,6 @@ static struct omap_hwmod omap44xx_uart3_
+       .class          = &omap44xx_uart_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = DEBUG_OMAP4UART3_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_UART3_CLKCTRL_OFFSET,
+@@ -2875,7 +2774,6 @@ static struct omap_hwmod omap44xx_uart4_
+       .class          = &omap44xx_uart_hwmod_class,
+       .clkdm_name     = "l4_per_clkdm",
+       .flags          = DEBUG_OMAP4UART4_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L4PER_UART4_CLKCTRL_OFFSET,
+@@ -2954,7 +2852,6 @@ static struct omap_hwmod omap44xx_usb_ho
+       .name           = "usb_host_hs",
+       .class          = &omap44xx_usb_host_hs_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+-      .main_clk       = "usb_host_hs_fck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_USB_HOST_CLKCTRL_OFFSET,
+@@ -3036,16 +2933,12 @@ static struct omap_hwmod_class omap44xx_
+ };
+ /* usb_otg_hs */
+-static struct omap_hwmod_opt_clk usb_otg_hs_opt_clks[] = {
+-      { .role = "xclk", .clk = "usb_otg_hs_xclk" },
+-};
+ static struct omap_hwmod omap44xx_usb_otg_hs_hwmod = {
+       .name           = "usb_otg_hs",
+       .class          = &omap44xx_usb_otg_hs_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY,
+-      .main_clk       = "usb_otg_hs_ick",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_USB_OTG_CLKCTRL_OFFSET,
+@@ -3053,8 +2946,6 @@ static struct omap_hwmod omap44xx_usb_ot
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = usb_otg_hs_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(usb_otg_hs_opt_clks),
+ };
+ /*
+@@ -3082,7 +2973,6 @@ static struct omap_hwmod omap44xx_usb_tl
+       .name           = "usb_tll_hs",
+       .class          = &omap44xx_usb_tll_hs_hwmod_class,
+       .clkdm_name     = "l3_init_clkdm",
+-      .main_clk       = "usb_tll_hs_ick",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_L3INIT_USB_TLL_CLKCTRL_OFFSET,
+@@ -3121,7 +3011,6 @@ static struct omap_hwmod omap44xx_wd_tim
+       .name           = "wd_timer2",
+       .class          = &omap44xx_wd_timer_hwmod_class,
+       .clkdm_name     = "l4_wkup_clkdm",
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP4_CM_WKUP_WDT2_CLKCTRL_OFFSET,
+@@ -4791,6 +4680,105 @@ static struct omap_hwmod_ocp_if omap44xx
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/*
++    Crypto modules AES0/1 belong to:
++      PD_L4_PER power domain
++      CD_L4_SEC clock domain
++      On the L3, the AES modules are mapped to
++      L3_CLK2: Peripherals and multimedia sub clock domain
++*/
++
++static struct omap_hwmod_class_sysconfig omap4_aes1_sysc = {
++      .rev_offs       = 0x80,
++      .sysc_offs      = 0x84,
++      .syss_offs      = 0x88,
++      .sysc_flags     = SYSS_HAS_RESET_STATUS,
++      .sysc_fields    = &omap_hwmod_sysc_type4,
++};
++
++static struct omap_hwmod_class omap4_aes1_hwmod_class = {
++      .name           = "aes1",
++      .sysc           = &omap4_aes1_sysc,
++};
++
++static struct omap_hwmod omap4_aes1_hwmod = {
++      .name           = "aes",
++      .class          = &omap4_aes1_hwmod_class,
++      .clkdm_name     = "l4_secure_clkdm",
++      .main_clk       = "aes1_fck",
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs = OMAP4_CM_L4SEC_AES1_CLKCTRL_OFFSET,
++                      .context_offs = OMAP4_RM_L4SEC_AES1_CONTEXT_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* l3_main_2 -> aes1 */
++static struct omap_hwmod_addr_space omap4_aes1_addrs[] = {
++      {
++              .pa_start       = 0x4B500000,
++              .pa_end         = 0x4B500000 + SZ_1M - 1,
++              .flags          = ADDR_TYPE_RT
++      },
++      { }
++};
++
++static struct omap_hwmod_ocp_if omap4_l3_main_2__aes1 = {
++      .master         = &omap44xx_l3_main_2_hwmod,
++      .slave          = &omap4_aes1_hwmod,
++      .clk            = "aes1_fck",
++      .addr           = omap4_aes1_addrs,
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* DES3DES */
++static struct omap_hwmod_class_sysconfig omap4_des_sysc = {
++      .rev_offs       = 0x30,
++      .sysc_offs      = 0x34,
++      .syss_offs      = 0x38,
++      .sysc_flags     = SYSS_HAS_RESET_STATUS,
++      .sysc_fields    = &omap_hwmod_sysc_type4,
++};
++
++static struct omap_hwmod_class omap4_des_hwmod_class = {
++      .name           = "des",
++      .sysc           = &omap4_des_sysc,
++};
++
++
++static struct omap_hwmod omap4_des_hwmod = {
++      .name           = "des",
++      .class          = &omap4_des_hwmod_class,
++      .clkdm_name     = "l4_secure_clkdm",
++      .main_clk       = "des_fck",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP4_CM_L4SEC_DES3DES_CLKCTRL_OFFSET,
++                      .context_offs = OMAP4_RM_L4SEC_DES3DES_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod_addr_space omap4_des_addrs[] = {
++      {
++              .pa_start       = 0x480A4000,
++              .pa_end         = 0x481A4000,
++              .flags          = ADDR_TYPE_RT
++      },
++      { }
++};
++
++static struct omap_hwmod_ocp_if omap4_l4_per__des = {
++      .master         = &omap44xx_l4_per_hwmod,
++      .slave          = &omap4_des_hwmod,
++      .clk            = "des_fck",
++      .addr           = omap4_des_addrs,
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ static struct omap_hwmod_ocp_if *omap44xx_hwmod_ocp_ifs[] __initdata = {
+       &omap44xx_l3_main_1__dmm,
+       &omap44xx_mpu__dmm,
+@@ -4945,6 +4933,8 @@ static struct omap_hwmod_ocp_if *omap44x
+       &omap44xx_l4_abe__wd_timer3_dma,
+       &omap44xx_mpu__emif1,
+       &omap44xx_mpu__emif2,
++      &omap4_l3_main_2__aes1,
++      &omap4_l4_per__des,
+       NULL,
+ };
+--- a/arch/arm/mach-omap2/omap_hwmod_54xx_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_54xx_data.c
+@@ -234,7 +234,6 @@ static struct omap_hwmod omap54xx_counte
+       .class          = &omap54xx_counter_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "wkupaon_iclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_WKUPAON_COUNTER_32K_CLKCTRL_OFFSET,
+@@ -288,7 +287,6 @@ static struct omap_hwmod omap54xx_dma_sy
+       .class          = &omap54xx_dma_hwmod_class,
+       .clkdm_name     = "dma_clkdm",
+       .mpu_irqs       = omap54xx_dma_system_irqs,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_DMA_DMA_SYSTEM_CLKCTRL_OFFSET,
+@@ -323,7 +321,6 @@ static struct omap_hwmod omap54xx_dmic_h
+       .name           = "dmic",
+       .class          = &omap54xx_dmic_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "dmic_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_DMIC_CLKCTRL_OFFSET,
+@@ -334,6 +331,235 @@ static struct omap_hwmod omap54xx_dmic_h
+ };
+ /*
++ * 'dss' class
++ * display sub-system
++ */
++static struct omap_hwmod_class_sysconfig omap54xx_dss_sysc = {
++      .rev_offs       = 0x0000,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = SYSS_HAS_RESET_STATUS,
++};
++
++static struct omap_hwmod_class omap54xx_dss_hwmod_class = {
++      .name   = "dss",
++      .sysc   = &omap54xx_dss_sysc,
++      .reset  = omap_dss_reset,
++};
++
++/* dss */
++static struct omap_hwmod_opt_clk dss_opt_clks[] = {
++      { .role = "32khz_clk", .clk = "dss_32khz_clk" },
++      { .role = "sys_clk", .clk = "dss_sys_clk" },
++      { .role = "hdmi_clk", .clk = "dss_48mhz_clk" },
++};
++
++static struct omap_hwmod omap54xx_dss_hwmod = {
++      .name           = "dss_core",
++      .class          = &omap54xx_dss_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
++      .main_clk       = "dss_dss_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_DSS_DSS_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .opt_clks       = dss_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_opt_clks),
++};
++
++/*
++ * 'dispc' class
++ * display controller
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_dispc_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE | SYSC_HAS_CLOCKACTIVITY |
++                         SYSC_HAS_ENAWAKEUP | SYSC_HAS_MIDLEMODE |
++                         SYSC_HAS_SIDLEMODE | SYSC_HAS_SOFTRESET |
++                         SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         MSTANDBY_FORCE | MSTANDBY_NO | MSTANDBY_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class omap54xx_dispc_hwmod_class = {
++      .name   = "dispc",
++      .sysc   = &omap54xx_dispc_sysc,
++};
++
++/* dss_dispc */
++static struct omap_hwmod_opt_clk dss_dispc_opt_clks[] = {
++      { .role = "sys_clk", .clk = "dss_sys_clk" },
++};
++
++/* dss_dispc dev_attr */
++static struct omap_dss_dispc_dev_attr dss_dispc_dev_attr = {
++      .has_framedonetv_irq    = 1,
++      .manager_count          = 4,
++};
++
++static struct omap_hwmod omap54xx_dss_dispc_hwmod = {
++      .name           = "dss_dispc",
++      .class          = &omap54xx_dispc_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "dss_dss_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .flags = HWMOD_OMAP4_NO_CONTEXT_LOSS_BIT,
++              },
++      },
++      .opt_clks       = dss_dispc_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_dispc_opt_clks),
++      .dev_attr       = &dss_dispc_dev_attr,
++};
++
++/*
++ * 'dsi1' class
++ * display serial interface controller
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_dsi1_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE | SYSC_HAS_CLOCKACTIVITY |
++                         SYSC_HAS_ENAWAKEUP | SYSC_HAS_SIDLEMODE |
++                         SYSC_HAS_SOFTRESET | SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class omap54xx_dsi1_hwmod_class = {
++      .name   = "dsi1",
++      .sysc   = &omap54xx_dsi1_sysc,
++};
++
++/* dss_dsi1_a */
++static struct omap_hwmod_opt_clk dss_dsi1_a_opt_clks[] = {
++      { .role = "sys_clk", .clk = "dss_sys_clk" },
++};
++
++static struct omap_hwmod omap54xx_dss_dsi1_a_hwmod = {
++      .name           = "dss_dsi1",
++      .class          = &omap54xx_dsi1_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "dss_dss_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .flags = HWMOD_OMAP4_NO_CONTEXT_LOSS_BIT,
++              },
++      },
++      .opt_clks       = dss_dsi1_a_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_dsi1_a_opt_clks),
++};
++
++/* dss_dsi1_c */
++static struct omap_hwmod_opt_clk dss_dsi1_c_opt_clks[] = {
++      { .role = "sys_clk", .clk = "dss_sys_clk" },
++};
++
++static struct omap_hwmod omap54xx_dss_dsi1_c_hwmod = {
++      .name           = "dss_dsi2",
++      .class          = &omap54xx_dsi1_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "dss_dss_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .flags = HWMOD_OMAP4_NO_CONTEXT_LOSS_BIT,
++              },
++      },
++      .opt_clks       = dss_dsi1_c_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_dsi1_c_opt_clks),
++};
++
++/*
++ * 'hdmi' class
++ * hdmi controller
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_hdmi_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_RESET_STATUS | SYSC_HAS_SIDLEMODE |
++                         SYSC_HAS_SOFTRESET),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class omap54xx_hdmi_hwmod_class = {
++      .name   = "hdmi",
++      .sysc   = &omap54xx_hdmi_sysc,
++};
++
++static struct omap_hwmod_opt_clk dss_hdmi_opt_clks[] = {
++      { .role = "sys_clk", .clk = "dss_sys_clk" },
++};
++
++static struct omap_hwmod omap54xx_dss_hdmi_hwmod = {
++      .name           = "dss_hdmi",
++      .class          = &omap54xx_hdmi_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .main_clk       = "dss_48mhz_clk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .flags = HWMOD_OMAP4_NO_CONTEXT_LOSS_BIT,
++              },
++      },
++      .opt_clks       = dss_hdmi_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_hdmi_opt_clks),
++};
++
++/*
++ * 'rfbi' class
++ * remote frame buffer interface
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_rfbi_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE | SYSC_HAS_SIDLEMODE |
++                         SYSC_HAS_SOFTRESET | SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class omap54xx_rfbi_hwmod_class = {
++      .name   = "rfbi",
++      .sysc   = &omap54xx_rfbi_sysc,
++};
++
++/* dss_rfbi */
++static struct omap_hwmod_opt_clk dss_rfbi_opt_clks[] = {
++      { .role = "ick", .clk = "l3_iclk_div" },
++};
++
++static struct omap_hwmod omap54xx_dss_rfbi_hwmod = {
++      .name           = "dss_rfbi",
++      .class          = &omap54xx_rfbi_hwmod_class,
++      .clkdm_name     = "dss_clkdm",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_DSS_DSS_CLKCTRL_OFFSET,
++                      .flags = HWMOD_OMAP4_NO_CONTEXT_LOSS_BIT,
++              },
++      },
++      .opt_clks       = dss_rfbi_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(dss_rfbi_opt_clks),
++};
++
++/*
+  * 'emif' class
+  * external memory interface no1 (wrapper)
+  */
+@@ -352,8 +578,6 @@ static struct omap_hwmod omap54xx_emif1_
+       .name           = "emif1",
+       .class          = &omap54xx_emif_hwmod_class,
+       .clkdm_name     = "emif_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
+-      .main_clk       = "dpll_core_h11x2_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_EMIF_EMIF1_CLKCTRL_OFFSET,
+@@ -368,8 +592,6 @@ static struct omap_hwmod omap54xx_emif2_
+       .name           = "emif2",
+       .class          = &omap54xx_emif_hwmod_class,
+       .clkdm_name     = "emif_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
+-      .main_clk       = "dpll_core_h11x2_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_EMIF_EMIF2_CLKCTRL_OFFSET,
+@@ -409,15 +631,11 @@ static struct omap_gpio_dev_attr gpio_de
+ };
+ /* gpio1 */
+-static struct omap_hwmod_opt_clk gpio1_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio1_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio1_hwmod = {
+       .name           = "gpio1",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "wkupaon_iclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_WKUPAON_GPIO1_CLKCTRL_OFFSET,
+@@ -425,22 +643,16 @@ static struct omap_hwmod omap54xx_gpio1_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio1_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio2 */
+-static struct omap_hwmod_opt_clk gpio2_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio2_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio2_hwmod = {
+       .name           = "gpio2",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO2_CLKCTRL_OFFSET,
+@@ -448,22 +660,16 @@ static struct omap_hwmod omap54xx_gpio2_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio2_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio3 */
+-static struct omap_hwmod_opt_clk gpio3_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio3_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio3_hwmod = {
+       .name           = "gpio3",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO3_CLKCTRL_OFFSET,
+@@ -471,22 +677,16 @@ static struct omap_hwmod omap54xx_gpio3_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio3_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio4 */
+-static struct omap_hwmod_opt_clk gpio4_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio4_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio4_hwmod = {
+       .name           = "gpio4",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO4_CLKCTRL_OFFSET,
+@@ -494,22 +694,16 @@ static struct omap_hwmod omap54xx_gpio4_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio4_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio5 */
+-static struct omap_hwmod_opt_clk gpio5_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio5_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio5_hwmod = {
+       .name           = "gpio5",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO5_CLKCTRL_OFFSET,
+@@ -517,22 +711,16 @@ static struct omap_hwmod omap54xx_gpio5_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio5_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio5_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio6 */
+-static struct omap_hwmod_opt_clk gpio6_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio6_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio6_hwmod = {
+       .name           = "gpio6",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO6_CLKCTRL_OFFSET,
+@@ -540,22 +728,16 @@ static struct omap_hwmod omap54xx_gpio6_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio6_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio6_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio7 */
+-static struct omap_hwmod_opt_clk gpio7_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio7_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio7_hwmod = {
+       .name           = "gpio7",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO7_CLKCTRL_OFFSET,
+@@ -563,22 +745,16 @@ static struct omap_hwmod omap54xx_gpio7_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio7_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio7_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio8 */
+-static struct omap_hwmod_opt_clk gpio8_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio8_dbclk" },
+-};
+ static struct omap_hwmod omap54xx_gpio8_hwmod = {
+       .name           = "gpio8",
+       .class          = &omap54xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l4_root_clk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_GPIO8_CLKCTRL_OFFSET,
+@@ -586,8 +762,6 @@ static struct omap_hwmod omap54xx_gpio8_
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio8_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio8_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+@@ -626,7 +800,6 @@ static struct omap_hwmod omap54xx_i2c1_h
+       .class          = &omap54xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_I2C1_CLKCTRL_OFFSET,
+@@ -643,7 +816,6 @@ static struct omap_hwmod omap54xx_i2c2_h
+       .class          = &omap54xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_I2C2_CLKCTRL_OFFSET,
+@@ -660,7 +832,6 @@ static struct omap_hwmod omap54xx_i2c3_h
+       .class          = &omap54xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_I2C3_CLKCTRL_OFFSET,
+@@ -677,7 +848,6 @@ static struct omap_hwmod omap54xx_i2c4_h
+       .class          = &omap54xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_I2C4_CLKCTRL_OFFSET,
+@@ -694,7 +864,6 @@ static struct omap_hwmod omap54xx_i2c5_h
+       .class          = &omap54xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_I2C5_CLKCTRL_OFFSET,
+@@ -729,7 +898,6 @@ static struct omap_hwmod omap54xx_kbd_hw
+       .name           = "kbd",
+       .class          = &omap54xx_kbd_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_WKUPAON_KBD_CLKCTRL_OFFSET,
+@@ -792,16 +960,11 @@ static struct omap_hwmod_class omap54xx_
+ };
+ /* mcbsp1 */
+-static struct omap_hwmod_opt_clk mcbsp1_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp1_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap54xx_mcbsp1_hwmod = {
+       .name           = "mcbsp1",
+       .class          = &omap54xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "mcbsp1_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_MCBSP1_CLKCTRL_OFFSET,
+@@ -809,21 +972,14 @@ static struct omap_hwmod omap54xx_mcbsp1
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp1_opt_clks),
+ };
+ /* mcbsp2 */
+-static struct omap_hwmod_opt_clk mcbsp2_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp2_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap54xx_mcbsp2_hwmod = {
+       .name           = "mcbsp2",
+       .class          = &omap54xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "mcbsp2_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_MCBSP2_CLKCTRL_OFFSET,
+@@ -831,21 +987,14 @@ static struct omap_hwmod omap54xx_mcbsp2
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp2_opt_clks),
+ };
+ /* mcbsp3 */
+-static struct omap_hwmod_opt_clk mcbsp3_opt_clks[] = {
+-      { .role = "pad_fck", .clk = "pad_clks_ck" },
+-      { .role = "prcm_fck", .clk = "mcbsp3_sync_mux_ck" },
+-};
+ static struct omap_hwmod omap54xx_mcbsp3_hwmod = {
+       .name           = "mcbsp3",
+       .class          = &omap54xx_mcbsp_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "mcbsp3_gfclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_MCBSP3_CLKCTRL_OFFSET,
+@@ -853,8 +1002,6 @@ static struct omap_hwmod omap54xx_mcbsp3
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mcbsp3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mcbsp3_opt_clks),
+ };
+ /*
+@@ -896,7 +1043,6 @@ static struct omap_hwmod omap54xx_mcpdm_
+        */
+       .flags          = HWMOD_EXT_OPT_MAIN_CLK,
+-      .main_clk       = "pad_clks_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_MCPDM_CLKCTRL_OFFSET,
+@@ -938,7 +1084,6 @@ static struct omap_hwmod omap54xx_mcspi1
+       .name           = "mcspi1",
+       .class          = &omap54xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MCSPI1_CLKCTRL_OFFSET,
+@@ -959,7 +1104,6 @@ static struct omap_hwmod omap54xx_mcspi2
+       .name           = "mcspi2",
+       .class          = &omap54xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MCSPI2_CLKCTRL_OFFSET,
+@@ -980,7 +1124,6 @@ static struct omap_hwmod omap54xx_mcspi3
+       .name           = "mcspi3",
+       .class          = &omap54xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MCSPI3_CLKCTRL_OFFSET,
+@@ -1001,7 +1144,6 @@ static struct omap_hwmod omap54xx_mcspi4
+       .name           = "mcspi4",
+       .class          = &omap54xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MCSPI4_CLKCTRL_OFFSET,
+@@ -1035,9 +1177,6 @@ static struct omap_hwmod_class omap54xx_
+ };
+ /* mmc1 */
+-static struct omap_hwmod_opt_clk mmc1_opt_clks[] = {
+-      { .role = "32khz_clk", .clk = "mmc1_32khz_clk" },
+-};
+ /* mmc1 dev_attr */
+ static struct omap_mmc_dev_attr mmc1_dev_attr = {
+@@ -1048,7 +1187,6 @@ static struct omap_hwmod omap54xx_mmc1_h
+       .name           = "mmc1",
+       .class          = &omap54xx_mmc_hwmod_class,
+       .clkdm_name     = "l3init_clkdm",
+-      .main_clk       = "mmc1_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L3INIT_MMC1_CLKCTRL_OFFSET,
+@@ -1056,8 +1194,6 @@ static struct omap_hwmod omap54xx_mmc1_h
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mmc1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mmc1_opt_clks),
+       .dev_attr       = &mmc1_dev_attr,
+ };
+@@ -1066,7 +1202,6 @@ static struct omap_hwmod omap54xx_mmc2_h
+       .name           = "mmc2",
+       .class          = &omap54xx_mmc_hwmod_class,
+       .clkdm_name     = "l3init_clkdm",
+-      .main_clk       = "mmc2_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L3INIT_MMC2_CLKCTRL_OFFSET,
+@@ -1081,7 +1216,6 @@ static struct omap_hwmod omap54xx_mmc3_h
+       .name           = "mmc3",
+       .class          = &omap54xx_mmc_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MMC3_CLKCTRL_OFFSET,
+@@ -1096,7 +1230,6 @@ static struct omap_hwmod omap54xx_mmc4_h
+       .name           = "mmc4",
+       .class          = &omap54xx_mmc_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MMC4_CLKCTRL_OFFSET,
+@@ -1111,7 +1244,6 @@ static struct omap_hwmod omap54xx_mmc5_h
+       .name           = "mmc5",
+       .class          = &omap54xx_mmc_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_MMC5_CLKCTRL_OFFSET,
+@@ -1135,7 +1267,7 @@ static struct omap_hwmod omap54xx_mpu_hw
+       .name           = "mpu",
+       .class          = &omap54xx_mpu_hwmod_class,
+       .clkdm_name     = "mpu_clkdm",
+-      .flags          = HWMOD_INIT_NO_IDLE | HWMOD_INIT_NO_RESET,
++      .flags          = HWMOD_INIT_NO_IDLE,
+       .main_clk       = "dpll_mpu_m2_ck",
+       .prcm = {
+               .omap4 = {
+@@ -1146,6 +1278,42 @@ static struct omap_hwmod omap54xx_mpu_hw
+ };
+ /*
++ * 'ocp2scp' class
++ * bridge to transform ocp interface protocol to scp (serial control port)
++ * protocol
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_ocp2scp_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE | SYSC_HAS_SIDLEMODE |
++                      SYSC_HAS_SOFTRESET | SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class omap54xx_ocp2scp_hwmod_class = {
++      .name   = "ocp2scp",
++      .sysc   = &omap54xx_ocp2scp_sysc,
++};
++
++/* ocp2scp1 */
++static struct omap_hwmod omap54xx_ocp2scp1_hwmod = {
++      .name           = "ocp2scp1",
++      .class          = &omap54xx_ocp2scp_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      .main_clk       = "l4_root_clk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_L3INIT_OCP2SCP1_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_L3INIT_OCP2SCP1_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
++
++/*
+  * 'timer' class
+  * general purpose timer module with accurate 1ms tick
+  * This class contains several variants: ['timer_1ms', 'timer']
+@@ -1187,7 +1355,6 @@ static struct omap_hwmod omap54xx_timer1
+       .name           = "timer1",
+       .class          = &omap54xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "timer1_gfclk_mux",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+       .prcm = {
+               .omap4 = {
+@@ -1203,7 +1370,6 @@ static struct omap_hwmod omap54xx_timer2
+       .name           = "timer2",
+       .class          = &omap54xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer2_gfclk_mux",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+       .prcm = {
+               .omap4 = {
+@@ -1219,7 +1385,6 @@ static struct omap_hwmod omap54xx_timer3
+       .name           = "timer3",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer3_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_TIMER3_CLKCTRL_OFFSET,
+@@ -1234,7 +1399,6 @@ static struct omap_hwmod omap54xx_timer4
+       .name           = "timer4",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer4_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_TIMER4_CLKCTRL_OFFSET,
+@@ -1249,7 +1413,6 @@ static struct omap_hwmod omap54xx_timer5
+       .name           = "timer5",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer5_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_TIMER5_CLKCTRL_OFFSET,
+@@ -1264,7 +1427,6 @@ static struct omap_hwmod omap54xx_timer6
+       .name           = "timer6",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer6_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_TIMER6_CLKCTRL_OFFSET,
+@@ -1279,7 +1441,6 @@ static struct omap_hwmod omap54xx_timer7
+       .name           = "timer7",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer7_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_TIMER7_CLKCTRL_OFFSET,
+@@ -1294,7 +1455,6 @@ static struct omap_hwmod omap54xx_timer8
+       .name           = "timer8",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "abe_clkdm",
+-      .main_clk       = "timer8_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_ABE_TIMER8_CLKCTRL_OFFSET,
+@@ -1309,7 +1469,6 @@ static struct omap_hwmod omap54xx_timer9
+       .name           = "timer9",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer9_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_TIMER9_CLKCTRL_OFFSET,
+@@ -1324,7 +1483,6 @@ static struct omap_hwmod omap54xx_timer1
+       .name           = "timer10",
+       .class          = &omap54xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer10_gfclk_mux",
+       .flags          = HWMOD_SET_DEFAULT_CLOCKACT,
+       .prcm = {
+               .omap4 = {
+@@ -1340,7 +1498,6 @@ static struct omap_hwmod omap54xx_timer1
+       .name           = "timer11",
+       .class          = &omap54xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer11_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_TIMER11_CLKCTRL_OFFSET,
+@@ -1377,7 +1534,6 @@ static struct omap_hwmod omap54xx_uart1_
+       .name           = "uart1",
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART1_CLKCTRL_OFFSET,
+@@ -1392,7 +1548,6 @@ static struct omap_hwmod omap54xx_uart2_
+       .name           = "uart2",
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART2_CLKCTRL_OFFSET,
+@@ -1408,7 +1563,6 @@ static struct omap_hwmod omap54xx_uart3_
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = DEBUG_OMAP4UART3_FLAGS,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART3_CLKCTRL_OFFSET,
+@@ -1424,7 +1578,6 @@ static struct omap_hwmod omap54xx_uart4_
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = DEBUG_OMAP4UART4_FLAGS,
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART4_CLKCTRL_OFFSET,
+@@ -1439,7 +1592,6 @@ static struct omap_hwmod omap54xx_uart5_
+       .name           = "uart5",
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART5_CLKCTRL_OFFSET,
+@@ -1454,7 +1606,6 @@ static struct omap_hwmod omap54xx_uart6_
+       .name           = "uart6",
+       .class          = &omap54xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L4PER_UART6_CLKCTRL_OFFSET,
+@@ -1465,6 +1616,145 @@ static struct omap_hwmod omap54xx_uart6_
+ };
+ /*
++ * 'usb_host_hs' class
++ * high-speed multi-port usb host controller
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_usb_host_hs_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_MIDLEMODE | SYSC_HAS_RESET_STATUS |
++                         SYSC_HAS_SIDLEMODE | SYSC_HAS_SOFTRESET),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class omap54xx_usb_host_hs_hwmod_class = {
++      .name   = "usb_host_hs",
++      .sysc   = &omap54xx_usb_host_hs_sysc,
++};
++
++static struct omap_hwmod_opt_clk usb_host_hs_opt_clks[] = {
++      { .role = "hsic60m_p2_clk", .clk = "usb_host_hs_hsic60m_p2_clk" },
++      { .role = "hsic60m_p3_clk", .clk = "usb_host_hs_hsic60m_p3_clk" },
++      { .role = "utmi_p1_clk", .clk = "usb_host_hs_utmi_p1_clk" },
++      { .role = "utmi_p2_clk", .clk = "usb_host_hs_utmi_p2_clk" },
++      { .role = "utmi_p3_clk", .clk = "usb_host_hs_utmi_p3_clk" },
++      { .role = "hsic480m_p1_clk", .clk = "usb_host_hs_hsic480m_p1_clk" },
++      { .role = "hsic60m_p1_clk", .clk = "usb_host_hs_hsic60m_p1_clk" },
++      { .role = "hsic480m_p3_clk", .clk = "usb_host_hs_hsic480m_p3_clk" },
++      { .role = "hsic480m_p2_clk", .clk = "usb_host_hs_hsic480m_p2_clk" },
++};
++
++static struct omap_hwmod omap54xx_usb_host_hs_hwmod = {
++      .name           = "usb_host_hs",
++      .class          = &omap54xx_usb_host_hs_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      /*
++       * Errata: USBHOST Configured In Smart-Idle Can Lead To a Deadlock
++       * id: i660
++       *
++       * Description:
++       * In the following configuration :
++       * - USBHOST module is set to smart-idle mode
++       * - PRCM asserts idle_req to the USBHOST module ( This typically
++       *   happens when the system is going to a low power mode : all ports
++       *   have been suspended, the master part of the USBHOST module has
++       *   entered the standby state, and SW has cut the functional clocks)
++       * - an USBHOST interrupt occurs before the module is able to answer
++       *   idle_ack, typically a remote wakeup IRQ.
++       * Then the USB HOST module will enter a deadlock situation where it
++       * is no more accessible nor functional.
++       *
++       * Workaround:
++       * Don't use smart idle; use only force idle, hence HWMOD_SWSUP_SIDLE
++       */
++
++      /*
++       * Errata: USB host EHCI may stall when entering smart-standby mode
++       * Id: i571
++       *
++       * Description:
++       * When the USBHOST module is set to smart-standby mode, and when it is
++       * ready to enter the standby state (i.e. all ports are suspended and
++       * all attached devices are in suspend mode), then it can wrongly assert
++       * the Mstandby signal too early while there are still some residual OCP
++       * transactions ongoing. If this condition occurs, the internal state
++       * machine may go to an undefined state and the USB link may be stuck
++       * upon the next resume.
++       *
++       * Workaround:
++       * Don't use smart standby; use only force standby,
++       * hence HWMOD_SWSUP_MSTANDBY
++       */
++
++      /*
++       * During system boot; If the hwmod framework resets the module
++       * the module will have smart idle settings; which can lead to deadlock
++       * (above Errata Id:i660); so, dont reset the module during boot;
++       * Use HWMOD_INIT_NO_RESET.
++       */
++
++      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY |
++                        HWMOD_INIT_NO_RESET,
++      .main_clk       = "l3init_60m_fclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_L3INIT_USB_HOST_HS_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_L3INIT_USB_HOST_HS_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++      .opt_clks       = usb_host_hs_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(usb_host_hs_opt_clks),
++};
++
++/*
++ * 'usb_tll_hs' class
++ * usb_tll_hs module is the adapter on the usb_host_hs ports
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_usb_tll_hs_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .syss_offs      = 0x0014,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE | SYSC_HAS_CLOCKACTIVITY |
++                         SYSC_HAS_ENAWAKEUP | SYSC_HAS_SIDLEMODE |
++                         SYSC_HAS_SOFTRESET | SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type1,
++};
++
++static struct omap_hwmod_class omap54xx_usb_tll_hs_hwmod_class = {
++      .name   = "usb_tll_hs",
++      .sysc   = &omap54xx_usb_tll_hs_sysc,
++};
++
++static struct omap_hwmod_opt_clk usb_tll_hs_opt_clks[] = {
++      { .role = "usb_ch2_clk", .clk = "usb_tll_hs_usb_ch2_clk" },
++      { .role = "usb_ch0_clk", .clk = "usb_tll_hs_usb_ch0_clk" },
++      { .role = "usb_ch1_clk", .clk = "usb_tll_hs_usb_ch1_clk" },
++};
++
++static struct omap_hwmod omap54xx_usb_tll_hs_hwmod = {
++      .name           = "usb_tll_hs",
++      .class          = &omap54xx_usb_tll_hs_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      .main_clk       = "l4_root_clk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_L3INIT_USB_TLL_HS_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_L3INIT_USB_TLL_HS_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++      .opt_clks       = usb_tll_hs_opt_clks,
++      .opt_clks_cnt   = ARRAY_SIZE(usb_tll_hs_opt_clks),
++};
++
++/*
+  * 'usb_otg_ss' class
+  * 2.0 super speed (usb_otg_ss) controller
+  */
+@@ -1486,16 +1776,12 @@ static struct omap_hwmod_class omap54xx_
+ };
+ /* usb_otg_ss */
+-static struct omap_hwmod_opt_clk usb_otg_ss_opt_clks[] = {
+-      { .role = "refclk960m", .clk = "usb_otg_ss_refclk960m" },
+-};
+ static struct omap_hwmod omap54xx_usb_otg_ss_hwmod = {
+       .name           = "usb_otg_ss",
+       .class          = &omap54xx_usb_otg_ss_hwmod_class,
+       .clkdm_name     = "l3init_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "dpll_core_h13x2_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_L3INIT_USB_OTG_SS_CLKCTRL_OFFSET,
+@@ -1503,8 +1789,6 @@ static struct omap_hwmod omap54xx_usb_ot
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = usb_otg_ss_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(usb_otg_ss_opt_clks),
+ };
+ /*
+@@ -1535,7 +1819,6 @@ static struct omap_hwmod omap54xx_wd_tim
+       .name           = "wd_timer2",
+       .class          = &omap54xx_wd_timer_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = OMAP54XX_CM_WKUPAON_WD_TIMER2_CLKCTRL_OFFSET,
+@@ -1545,6 +1828,76 @@ static struct omap_hwmod omap54xx_wd_tim
+       },
+ };
++/*
++ * 'ocp2scp' class
++ * bridge to transform ocp interface protocol to scp (serial control port)
++ * protocol
++ */
++/* ocp2scp3 */
++static struct omap_hwmod omap54xx_ocp2scp3_hwmod;
++/* l4_cfg -> ocp2scp3 */
++static struct omap_hwmod_ocp_if omap54xx_l4_cfg__ocp2scp3 = {
++      .master         = &omap54xx_l4_cfg_hwmod,
++      .slave          = &omap54xx_ocp2scp3_hwmod,
++      .clk            = "l4_root_clk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++static struct omap_hwmod omap54xx_ocp2scp3_hwmod = {
++      .name           = "ocp2scp3",
++      .class          = &omap54xx_ocp2scp_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_L3INIT_OCP2SCP3_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_L3INIT_OCP2SCP3_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
++
++/*
++ * 'sata' class
++ * sata:  serial ata interface  gen2 compliant   ( 1 rx/ 1 tx)
++ */
++
++static struct omap_hwmod_class_sysconfig omap54xx_sata_sysc = {
++      .sysc_offs      = 0x0000,
++      .sysc_flags     = (SYSC_HAS_MIDLEMODE | SYSC_HAS_SIDLEMODE),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class omap54xx_sata_hwmod_class = {
++      .name   = "sata",
++      .sysc   = &omap54xx_sata_sysc,
++};
++
++/* sata */
++static struct omap_hwmod omap54xx_sata_hwmod = {
++      .name           = "sata",
++      .class          = &omap54xx_sata_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      .flags          = HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY,
++      .main_clk       = "func_48m_fclk",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = OMAP54XX_CM_L3INIT_SATA_CLKCTRL_OFFSET,
++                      .context_offs = OMAP54XX_RM_L3INIT_SATA_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/* l4_cfg -> sata */
++static struct omap_hwmod_ocp_if omap54xx_l4_cfg__sata = {
++      .master         = &omap54xx_l4_cfg_hwmod,
++      .slave          = &omap54xx_sata_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
+ /*
+  * Interfaces
+@@ -1712,6 +2065,54 @@ static struct omap_hwmod_ocp_if omap54xx
+       .user           = OCP_USER_MPU,
+ };
++/* l3_main_2 -> dss */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_2 -> dss_dispc */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss_dispc = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_dispc_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_2 -> dss_dsi1_a */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss_dsi1_a = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_dsi1_a_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_2 -> dss_dsi1_c */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss_dsi1_c = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_dsi1_c_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_2 -> dss_hdmi */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss_hdmi = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_hdmi_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l3_main_2 -> dss_rfbi */
++static struct omap_hwmod_ocp_if omap54xx_l3_main_2__dss_rfbi = {
++      .master         = &omap54xx_l3_main_2_hwmod,
++      .slave          = &omap54xx_dss_rfbi_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ /* mpu -> emif1 */
+ static struct omap_hwmod_ocp_if omap54xx_mpu__emif1 = {
+       .master         = &omap54xx_mpu_hwmod,
+@@ -1960,6 +2361,14 @@ static struct omap_hwmod_ocp_if omap54xx
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_cfg -> ocp2scp1 */
++static struct omap_hwmod_ocp_if omap54xx_l4_cfg__ocp2scp1 = {
++      .master         = &omap54xx_l4_cfg_hwmod,
++      .slave          = &omap54xx_ocp2scp1_hwmod,
++      .clk            = "l4_root_clk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ /* l4_wkup -> timer1 */
+ static struct omap_hwmod_ocp_if omap54xx_l4_wkup__timer1 = {
+       .master         = &omap54xx_l4_wkup_hwmod,
+@@ -2096,6 +2505,22 @@ static struct omap_hwmod_ocp_if omap54xx
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_cfg -> usb_host_hs */
++static struct omap_hwmod_ocp_if omap54xx_l4_cfg__usb_host_hs = {
++      .master         = &omap54xx_l4_cfg_hwmod,
++      .slave          = &omap54xx_usb_host_hs_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_cfg -> usb_tll_hs */
++static struct omap_hwmod_ocp_if omap54xx_l4_cfg__usb_tll_hs = {
++      .master         = &omap54xx_l4_cfg_hwmod,
++      .slave          = &omap54xx_usb_tll_hs_hwmod,
++      .clk            = "l4_root_clk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ /* l4_cfg -> usb_otg_ss */
+ static struct omap_hwmod_ocp_if omap54xx_l4_cfg__usb_otg_ss = {
+       .master         = &omap54xx_l4_cfg_hwmod,
+@@ -2132,6 +2557,12 @@ static struct omap_hwmod_ocp_if *omap54x
+       &omap54xx_l4_wkup__counter_32k,
+       &omap54xx_l4_cfg__dma_system,
+       &omap54xx_l4_abe__dmic,
++      &omap54xx_l3_main_2__dss,
++      &omap54xx_l3_main_2__dss_dispc,
++      &omap54xx_l3_main_2__dss_dsi1_a,
++      &omap54xx_l3_main_2__dss_dsi1_c,
++      &omap54xx_l3_main_2__dss_hdmi,
++      &omap54xx_l3_main_2__dss_rfbi,
+       &omap54xx_mpu__emif1,
+       &omap54xx_mpu__emif2,
+       &omap54xx_l4_wkup__gpio1,
+@@ -2163,6 +2594,7 @@ static struct omap_hwmod_ocp_if *omap54x
+       &omap54xx_l4_per__mmc4,
+       &omap54xx_l4_per__mmc5,
+       &omap54xx_l4_cfg__mpu,
++      &omap54xx_l4_cfg__ocp2scp1,
+       &omap54xx_l4_wkup__timer1,
+       &omap54xx_l4_per__timer2,
+       &omap54xx_l4_per__timer3,
+@@ -2180,8 +2612,12 @@ static struct omap_hwmod_ocp_if *omap54x
+       &omap54xx_l4_per__uart4,
+       &omap54xx_l4_per__uart5,
+       &omap54xx_l4_per__uart6,
++      &omap54xx_l4_cfg__usb_host_hs,
++      &omap54xx_l4_cfg__usb_tll_hs,
+       &omap54xx_l4_cfg__usb_otg_ss,
+       &omap54xx_l4_wkup__wd_timer2,
++      &omap54xx_l4_cfg__ocp2scp3,
++      &omap54xx_l4_cfg__sata,
+       NULL,
+ };
+--- a/arch/arm/mach-omap2/omap_hwmod_7xx_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_7xx_data.c
+@@ -242,7 +242,6 @@ static struct omap_hwmod dra7xx_counter_
+       .class          = &dra7xx_counter_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+       .flags          = HWMOD_SWSUP_SIDLE,
+-      .main_clk       = "wkupaon_iclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_WKUPAON_COUNTER_32K_CLKCTRL_OFFSET,
+@@ -273,6 +272,56 @@ static struct omap_hwmod dra7xx_ctrl_mod
+ };
+ /*
++ * 'gmac' class
++ * cpsw/gmac sub system
++ */
++static struct omap_hwmod_class_sysconfig dra7xx_gmac_sysc = {
++      .rev_offs       = 0x0,
++      .sysc_offs      = 0x8,
++      .syss_offs      = 0x4,
++      .sysc_flags     = (SYSC_HAS_SIDLEMODE | SYSC_HAS_MIDLEMODE |
++                         SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | MSTANDBY_FORCE |
++                         MSTANDBY_NO),
++      .sysc_fields    = &omap_hwmod_sysc_type3,
++};
++
++static struct omap_hwmod_class dra7xx_gmac_hwmod_class = {
++      .name           = "gmac",
++      .sysc           = &dra7xx_gmac_sysc,
++};
++
++static struct omap_hwmod dra7xx_gmac_hwmod = {
++      .name           = "gmac",
++      .class          = &dra7xx_gmac_hwmod_class,
++      .clkdm_name     = "gmac_clkdm",
++      .flags          = (HWMOD_SWSUP_SIDLE | HWMOD_SWSUP_MSTANDBY),
++      .main_clk       = "dpll_gmac_ck",
++      .mpu_rt_idx     = 1,
++      .prcm           = {
++              .omap4  = {
++                      .clkctrl_offs   = DRA7XX_CM_GMAC_GMAC_CLKCTRL_OFFSET,
++                      .context_offs   = DRA7XX_RM_GMAC_GMAC_CONTEXT_OFFSET,
++                      .modulemode     = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/*
++ * 'mdio' class
++ */
++static struct omap_hwmod_class dra7xx_mdio_hwmod_class = {
++      .name           = "davinci_mdio",
++};
++
++static struct omap_hwmod dra7xx_mdio_hwmod = {
++      .name           = "davinci_mdio",
++      .class          = &dra7xx_mdio_hwmod_class,
++      .clkdm_name     = "gmac_clkdm",
++      .main_clk       = "dpll_gmac_ck",
++};
++
++/*
+  * 'dcan' class
+  *
+  */
+@@ -325,8 +374,8 @@ static struct omap_hwmod_class_sysconfig
+                          SYSC_HAS_SIDLEMODE | SYSC_HAS_SOFTRESET |
+                          SYSS_HAS_RESET_STATUS),
+       .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
+-                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
+-                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++                         MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART),
+       .sysc_fields    = &omap_hwmod_sysc_type1,
+ };
+@@ -356,7 +405,6 @@ static struct omap_hwmod dra7xx_dma_syst
+       .class          = &dra7xx_dma_hwmod_class,
+       .clkdm_name     = "dma_clkdm",
+       .mpu_irqs       = dra7xx_dma_system_irqs,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_DMA_DMA_SYSTEM_CLKCTRL_OFFSET,
+@@ -561,6 +609,40 @@ static struct omap_hwmod_class dra7xx_gp
+       .rev    = 2,
+ };
++static struct omap_hwmod_class_sysconfig dra7xx_aes_sysc = {
++      .rev_offs       = 0x0080,
++      .sysc_offs      = 0x0084,
++      .syss_offs      = 0x0088,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE |
++                         SYSC_HAS_SIDLEMODE | SYSC_HAS_SOFTRESET |
++                         SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type4,
++};
++
++static struct omap_hwmod_class_sysconfig dra7xx_des_sysc = {
++      .rev_offs       = 0x0030,
++      .sysc_offs      = 0x0034,
++      .syss_offs      = 0x0038,
++      .sysc_flags     = (SYSC_HAS_AUTOIDLE |
++                         SYSC_HAS_SIDLEMODE | SYSC_HAS_SOFTRESET |
++                         SYSS_HAS_RESET_STATUS),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO),
++      .sysc_fields    = &omap_hwmod_sysc_type4,
++};
++
++static struct omap_hwmod_class dra7xx_aes_hwmod_class = {
++      .name   = "aes",
++      .sysc   = &dra7xx_aes_sysc,
++      .rev    = 2,
++};
++
++static struct omap_hwmod_class dra7xx_des_hwmod_class = {
++      .name   = "des",
++      .sysc   = &dra7xx_des_sysc,
++      .rev    = 2,
++};
++
+ /* gpio dev_attr */
+ static struct omap_gpio_dev_attr gpio_dev_attr = {
+       .bank_width     = 32,
+@@ -568,15 +650,11 @@ static struct omap_gpio_dev_attr gpio_de
+ };
+ /* gpio1 */
+-static struct omap_hwmod_opt_clk gpio1_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio1_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio1_hwmod = {
+       .name           = "gpio1",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "wkupaon_iclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_WKUPAON_GPIO1_CLKCTRL_OFFSET,
+@@ -584,22 +662,16 @@ static struct omap_hwmod dra7xx_gpio1_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio1_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio2 */
+-static struct omap_hwmod_opt_clk gpio2_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio2_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio2_hwmod = {
+       .name           = "gpio2",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO2_CLKCTRL_OFFSET,
+@@ -607,22 +679,16 @@ static struct omap_hwmod dra7xx_gpio2_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio2_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio3 */
+-static struct omap_hwmod_opt_clk gpio3_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio3_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio3_hwmod = {
+       .name           = "gpio3",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO3_CLKCTRL_OFFSET,
+@@ -630,22 +696,16 @@ static struct omap_hwmod dra7xx_gpio3_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio3_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio4 */
+-static struct omap_hwmod_opt_clk gpio4_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio4_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio4_hwmod = {
+       .name           = "gpio4",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO4_CLKCTRL_OFFSET,
+@@ -653,22 +713,16 @@ static struct omap_hwmod dra7xx_gpio4_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio4_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio5 */
+-static struct omap_hwmod_opt_clk gpio5_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio5_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio5_hwmod = {
+       .name           = "gpio5",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO5_CLKCTRL_OFFSET,
+@@ -676,22 +730,16 @@ static struct omap_hwmod dra7xx_gpio5_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio5_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio5_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio6 */
+-static struct omap_hwmod_opt_clk gpio6_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio6_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio6_hwmod = {
+       .name           = "gpio6",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO6_CLKCTRL_OFFSET,
+@@ -699,22 +747,16 @@ static struct omap_hwmod dra7xx_gpio6_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio6_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio6_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio7 */
+-static struct omap_hwmod_opt_clk gpio7_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio7_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio7_hwmod = {
+       .name           = "gpio7",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO7_CLKCTRL_OFFSET,
+@@ -722,22 +764,16 @@ static struct omap_hwmod dra7xx_gpio7_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio7_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio7_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
+ /* gpio8 */
+-static struct omap_hwmod_opt_clk gpio8_opt_clks[] = {
+-      { .role = "dbclk", .clk = "gpio8_dbclk" },
+-};
+ static struct omap_hwmod dra7xx_gpio8_hwmod = {
+       .name           = "gpio8",
+       .class          = &dra7xx_gpio_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_CONTROL_OPT_CLKS_IN_RESET,
+-      .main_clk       = "l3_iclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_GPIO8_CLKCTRL_OFFSET,
+@@ -745,11 +781,35 @@ static struct omap_hwmod dra7xx_gpio8_hw
+                       .modulemode   = MODULEMODE_HWCTRL,
+               },
+       },
+-      .opt_clks       = gpio8_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(gpio8_opt_clks),
+       .dev_attr       = &gpio_dev_attr,
+ };
++static struct omap_hwmod dra7xx_aes_hwmod = {
++      .name           = "aes",
++      .class          = &dra7xx_aes_hwmod_class,
++      .clkdm_name     = "l4sec_clkdm",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4SEC_AES1_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4SEC_AES1_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
++
++static struct omap_hwmod dra7xx_des_hwmod = {
++      .name           = "des",
++      .class          = &dra7xx_des_hwmod_class,
++      .clkdm_name     = "l4sec_clkdm",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4SEC_DES3DES_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4SEC_DES3DES_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
++
+ /*
+  * 'gpmc' class
+  *
+@@ -859,7 +919,6 @@ static struct omap_hwmod dra7xx_i2c1_hwm
+       .class          = &dra7xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_I2C1_CLKCTRL_OFFSET,
+@@ -876,7 +935,6 @@ static struct omap_hwmod dra7xx_i2c2_hwm
+       .class          = &dra7xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_I2C2_CLKCTRL_OFFSET,
+@@ -893,7 +951,6 @@ static struct omap_hwmod dra7xx_i2c3_hwm
+       .class          = &dra7xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_I2C3_CLKCTRL_OFFSET,
+@@ -910,7 +967,6 @@ static struct omap_hwmod dra7xx_i2c4_hwm
+       .class          = &dra7xx_i2c_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_I2C4_CLKCTRL_OFFSET,
+@@ -927,7 +983,6 @@ static struct omap_hwmod dra7xx_i2c5_hwm
+       .class          = &dra7xx_i2c_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+       .flags          = HWMOD_16BIT_REG | HWMOD_SET_DEFAULT_CLOCKACT,
+-      .main_clk       = "func_96m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_IPU_I2C5_CLKCTRL_OFFSET,
+@@ -939,6 +994,207 @@ static struct omap_hwmod dra7xx_i2c5_hwm
+ };
+ /*
++ * 'mailbox' class
++ *
++ */
++
++static struct omap_hwmod_class_sysconfig dra7xx_mailbox_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_RESET_STATUS | SYSC_HAS_SIDLEMODE |
++                         SYSC_HAS_SOFTRESET),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class dra7xx_mailbox_hwmod_class = {
++      .name   = "mailbox",
++      .sysc   = &dra7xx_mailbox_sysc,
++};
++
++/* mailbox1 */
++static struct omap_hwmod dra7xx_mailbox1_hwmod = {
++      .name           = "mailbox1",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX1_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX1_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox2 */
++static struct omap_hwmod dra7xx_mailbox2_hwmod = {
++      .name           = "mailbox2",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX2_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX2_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox3 */
++static struct omap_hwmod dra7xx_mailbox3_hwmod = {
++      .name           = "mailbox3",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX3_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX3_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox4 */
++static struct omap_hwmod dra7xx_mailbox4_hwmod = {
++      .name           = "mailbox4",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX4_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX4_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox5 */
++static struct omap_hwmod dra7xx_mailbox5_hwmod = {
++      .name           = "mailbox5",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX5_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX5_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox6 */
++static struct omap_hwmod dra7xx_mailbox6_hwmod = {
++      .name           = "mailbox6",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX6_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX6_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox7 */
++static struct omap_hwmod dra7xx_mailbox7_hwmod = {
++      .name           = "mailbox7",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX7_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX7_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox8 */
++static struct omap_hwmod dra7xx_mailbox8_hwmod = {
++      .name           = "mailbox8",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX8_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX8_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox9 */
++static struct omap_hwmod dra7xx_mailbox9_hwmod = {
++      .name           = "mailbox9",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX9_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX9_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox10 */
++static struct omap_hwmod dra7xx_mailbox10_hwmod = {
++      .name           = "mailbox10",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX10_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX10_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox11 */
++static struct omap_hwmod dra7xx_mailbox11_hwmod = {
++      .name           = "mailbox11",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX11_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX11_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox12 */
++static struct omap_hwmod dra7xx_mailbox12_hwmod = {
++      .name           = "mailbox12",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX12_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX12_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/* mailbox13 */
++static struct omap_hwmod dra7xx_mailbox13_hwmod = {
++      .name           = "mailbox13",
++      .class          = &dra7xx_mailbox_hwmod_class,
++      .clkdm_name     = "l4cfg_clkdm",
++      .main_clk       = "l3_iclk_div",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L4CFG_MAILBOX13_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L4CFG_MAILBOX13_CONTEXT_OFFSET,
++              },
++      },
++};
++
++/*
+  * 'mcspi' class
+  *
+  */
+@@ -969,7 +1225,6 @@ static struct omap_hwmod dra7xx_mcspi1_h
+       .name           = "mcspi1",
+       .class          = &dra7xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MCSPI1_CLKCTRL_OFFSET,
+@@ -990,7 +1245,6 @@ static struct omap_hwmod dra7xx_mcspi2_h
+       .name           = "mcspi2",
+       .class          = &dra7xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MCSPI2_CLKCTRL_OFFSET,
+@@ -1011,7 +1265,6 @@ static struct omap_hwmod dra7xx_mcspi3_h
+       .name           = "mcspi3",
+       .class          = &dra7xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MCSPI3_CLKCTRL_OFFSET,
+@@ -1032,7 +1285,6 @@ static struct omap_hwmod dra7xx_mcspi4_h
+       .name           = "mcspi4",
+       .class          = &dra7xx_mcspi_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "func_48m_fclk",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MCSPI4_CLKCTRL_OFFSET,
+@@ -1066,9 +1318,6 @@ static struct omap_hwmod_class dra7xx_mm
+ };
+ /* mmc1 */
+-static struct omap_hwmod_opt_clk mmc1_opt_clks[] = {
+-      { .role = "clk32k", .clk = "mmc1_clk32k" },
+-};
+ /* mmc1 dev_attr */
+ static struct omap_mmc_dev_attr mmc1_dev_attr = {
+@@ -1079,7 +1328,6 @@ static struct omap_hwmod dra7xx_mmc1_hwm
+       .name           = "mmc1",
+       .class          = &dra7xx_mmc_hwmod_class,
+       .clkdm_name     = "l3init_clkdm",
+-      .main_clk       = "mmc1_fclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L3INIT_MMC1_CLKCTRL_OFFSET,
+@@ -1087,21 +1335,15 @@ static struct omap_hwmod dra7xx_mmc1_hwm
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mmc1_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mmc1_opt_clks),
+       .dev_attr       = &mmc1_dev_attr,
+ };
+ /* mmc2 */
+-static struct omap_hwmod_opt_clk mmc2_opt_clks[] = {
+-      { .role = "clk32k", .clk = "mmc2_clk32k" },
+-};
+ static struct omap_hwmod dra7xx_mmc2_hwmod = {
+       .name           = "mmc2",
+       .class          = &dra7xx_mmc_hwmod_class,
+       .clkdm_name     = "l3init_clkdm",
+-      .main_clk       = "mmc2_fclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L3INIT_MMC2_CLKCTRL_OFFSET,
+@@ -1109,20 +1351,14 @@ static struct omap_hwmod dra7xx_mmc2_hwm
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mmc2_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mmc2_opt_clks),
+ };
+ /* mmc3 */
+-static struct omap_hwmod_opt_clk mmc3_opt_clks[] = {
+-      { .role = "clk32k", .clk = "mmc3_clk32k" },
+-};
+ static struct omap_hwmod dra7xx_mmc3_hwmod = {
+       .name           = "mmc3",
+       .class          = &dra7xx_mmc_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "mmc3_gfclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MMC3_CLKCTRL_OFFSET,
+@@ -1130,20 +1366,14 @@ static struct omap_hwmod dra7xx_mmc3_hwm
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mmc3_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mmc3_opt_clks),
+ };
+ /* mmc4 */
+-static struct omap_hwmod_opt_clk mmc4_opt_clks[] = {
+-      { .role = "clk32k", .clk = "mmc4_clk32k" },
+-};
+ static struct omap_hwmod dra7xx_mmc4_hwmod = {
+       .name           = "mmc4",
+       .class          = &dra7xx_mmc_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "mmc4_gfclk_div",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_MMC4_CLKCTRL_OFFSET,
+@@ -1151,8 +1381,6 @@ static struct omap_hwmod dra7xx_mmc4_hwm
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = mmc4_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(mmc4_opt_clks),
+ };
+ /*
+@@ -1215,6 +1443,30 @@ static struct omap_hwmod dra7xx_ocp2scp1
+       },
+ };
++/* ocp2scp3 */
++static struct omap_hwmod dra7xx_ocp2scp3_hwmod;
++
++/* l4_cfg -> ocp2scp3 */
++static struct omap_hwmod_ocp_if dra7xx_l4_cfg__ocp2scp3 = {
++      .master         = &dra7xx_l4_cfg_hwmod,
++      .slave          = &dra7xx_ocp2scp3_hwmod,
++      .clk            = "l4_root_clk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++static struct omap_hwmod dra7xx_ocp2scp3_hwmod = {
++      .name           = "ocp2scp3",
++      .class          = &dra7xx_ocp2scp_hwmod_class,
++      .clkdm_name     = "l3init_clkdm",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_L3INIT_OCP2SCP3_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_L3INIT_OCP2SCP3_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
++
+ /*
+  * 'qspi' class
+  *
+@@ -1249,6 +1501,38 @@ static struct omap_hwmod dra7xx_qspi_hwm
+ };
+ /*
++ * 'rtcss' class
++ *
++ */
++static struct omap_hwmod_class_sysconfig dra7xx_rtcss_sysc = {
++      .sysc_offs      = 0x0078,
++      .sysc_flags     = SYSC_HAS_SIDLEMODE,
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type3,
++};
++
++static struct omap_hwmod_class dra7xx_rtcss_hwmod_class = {
++      .name   = "rtcss",
++      .sysc   = &dra7xx_rtcss_sysc,
++};
++
++/* rtcss */
++static struct omap_hwmod dra7xx_rtcss_hwmod = {
++      .name           = "rtcss",
++      .class          = &dra7xx_rtcss_hwmod_class,
++      .clkdm_name     = "rtc_clkdm",
++      .main_clk       = "sys_32k_ck",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_RTC_RTCSS_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_RTC_RTCSS_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_SWCTRL,
++              },
++      },
++};
++
++/*
+  * 'sata' class
+  *
+  */
+@@ -1268,9 +1552,6 @@ static struct omap_hwmod_class dra7xx_sa
+ };
+ /* sata */
+-static struct omap_hwmod_opt_clk sata_opt_clks[] = {
+-      { .role = "ref_clk", .clk = "sata_ref_clk" },
+-};
+ static struct omap_hwmod dra7xx_sata_hwmod = {
+       .name           = "sata",
+@@ -1285,8 +1566,6 @@ static struct omap_hwmod dra7xx_sata_hwm
+                       .modulemode   = MODULEMODE_SWCTRL,
+               },
+       },
+-      .opt_clks       = sata_opt_clks,
+-      .opt_clks_cnt   = ARRAY_SIZE(sata_opt_clks),
+ };
+ /*
+@@ -1449,7 +1728,6 @@ static struct omap_hwmod dra7xx_timer1_h
+       .name           = "timer1",
+       .class          = &dra7xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "timer1_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_WKUPAON_TIMER1_CLKCTRL_OFFSET,
+@@ -1464,7 +1742,6 @@ static struct omap_hwmod dra7xx_timer2_h
+       .name           = "timer2",
+       .class          = &dra7xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer2_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER2_CLKCTRL_OFFSET,
+@@ -1479,7 +1756,6 @@ static struct omap_hwmod dra7xx_timer3_h
+       .name           = "timer3",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer3_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER3_CLKCTRL_OFFSET,
+@@ -1494,7 +1770,6 @@ static struct omap_hwmod dra7xx_timer4_h
+       .name           = "timer4",
+       .class          = &dra7xx_timer_secure_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer4_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER4_CLKCTRL_OFFSET,
+@@ -1509,7 +1784,6 @@ static struct omap_hwmod dra7xx_timer5_h
+       .name           = "timer5",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+-      .main_clk       = "timer5_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_IPU_TIMER5_CLKCTRL_OFFSET,
+@@ -1524,7 +1798,6 @@ static struct omap_hwmod dra7xx_timer6_h
+       .name           = "timer6",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+-      .main_clk       = "timer6_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_IPU_TIMER6_CLKCTRL_OFFSET,
+@@ -1539,7 +1812,6 @@ static struct omap_hwmod dra7xx_timer7_h
+       .name           = "timer7",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+-      .main_clk       = "timer7_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_IPU_TIMER7_CLKCTRL_OFFSET,
+@@ -1554,7 +1826,6 @@ static struct omap_hwmod dra7xx_timer8_h
+       .name           = "timer8",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+-      .main_clk       = "timer8_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_IPU_TIMER8_CLKCTRL_OFFSET,
+@@ -1569,7 +1840,6 @@ static struct omap_hwmod dra7xx_timer9_h
+       .name           = "timer9",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer9_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER9_CLKCTRL_OFFSET,
+@@ -1584,7 +1854,6 @@ static struct omap_hwmod dra7xx_timer10_
+       .name           = "timer10",
+       .class          = &dra7xx_timer_1ms_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer10_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER10_CLKCTRL_OFFSET,
+@@ -1599,7 +1868,6 @@ static struct omap_hwmod dra7xx_timer11_
+       .name           = "timer11",
+       .class          = &dra7xx_timer_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "timer11_gfclk_mux",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_TIMER11_CLKCTRL_OFFSET,
+@@ -1636,8 +1904,7 @@ static struct omap_hwmod dra7xx_uart1_hw
+       .name           = "uart1",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "uart1_gfclk_mux",
+-      .flags          = HWMOD_SWSUP_SIDLE_ACT,
++      .flags          = DEBUG_OMAP2UART1_FLAGS | HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_L4PER_UART1_CLKCTRL_OFFSET,
+@@ -1652,7 +1919,6 @@ static struct omap_hwmod dra7xx_uart2_hw
+       .name           = "uart2",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "uart2_gfclk_mux",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+@@ -1668,7 +1934,6 @@ static struct omap_hwmod dra7xx_uart3_hw
+       .name           = "uart3",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "uart3_gfclk_mux",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+@@ -1684,7 +1949,6 @@ static struct omap_hwmod dra7xx_uart4_hw
+       .name           = "uart4",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "uart4_gfclk_mux",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+@@ -1700,7 +1964,6 @@ static struct omap_hwmod dra7xx_uart5_hw
+       .name           = "uart5",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "l4per_clkdm",
+-      .main_clk       = "uart5_gfclk_mux",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+@@ -1716,7 +1979,6 @@ static struct omap_hwmod dra7xx_uart6_hw
+       .name           = "uart6",
+       .class          = &dra7xx_uart_hwmod_class,
+       .clkdm_name     = "ipu_clkdm",
+-      .main_clk       = "uart6_gfclk_mux",
+       .flags          = HWMOD_SWSUP_SIDLE_ACT,
+       .prcm = {
+               .omap4 = {
+@@ -1732,8 +1994,20 @@ static struct omap_hwmod dra7xx_uart6_hw
+  *
+  */
++static struct omap_hwmod_class_sysconfig dra7xx_usb_otg_ss_sysc = {
++      .rev_offs       = 0x0000,
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_DMADISABLE | SYSC_HAS_MIDLEMODE |
++                         SYSC_HAS_SIDLEMODE),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
+ static struct omap_hwmod_class dra7xx_usb_otg_ss_hwmod_class = {
+       .name   = "usb_otg_ss",
++      .sysc   = &dra7xx_usb_otg_ss_sysc,
+ };
+ /* usb_otg_ss1 */
+@@ -1873,7 +2147,6 @@ static struct omap_hwmod dra7xx_wd_timer
+       .name           = "wd_timer2",
+       .class          = &dra7xx_wd_timer_hwmod_class,
+       .clkdm_name     = "wkupaon_clkdm",
+-      .main_clk       = "sys_32k_ck",
+       .prcm = {
+               .omap4 = {
+                       .clkctrl_offs = DRA7XX_CM_WKUPAON_WD_TIMER2_CLKCTRL_OFFSET,
+@@ -1883,6 +2156,39 @@ static struct omap_hwmod dra7xx_wd_timer
+       },
+ };
++/*
++ * 'vpe' class
++ *
++ */
++
++static struct omap_hwmod_class_sysconfig dra7xx_vpe_sysc = {
++      .sysc_offs      = 0x0010,
++      .sysc_flags     = (SYSC_HAS_MIDLEMODE | SYSC_HAS_SIDLEMODE),
++      .idlemodes      = (SIDLE_FORCE | SIDLE_NO | SIDLE_SMART |
++                         SIDLE_SMART_WKUP | MSTANDBY_FORCE | MSTANDBY_NO |
++                         MSTANDBY_SMART | MSTANDBY_SMART_WKUP),
++      .sysc_fields    = &omap_hwmod_sysc_type2,
++};
++
++static struct omap_hwmod_class dra7xx_vpe_hwmod_class = {
++      .name   = "vpe",
++      .sysc   = &dra7xx_vpe_sysc,
++};
++
++/* vpe */
++static struct omap_hwmod dra7xx_vpe_hwmod = {
++      .name           = "vpe",
++      .class          = &dra7xx_vpe_hwmod_class,
++      .clkdm_name     = "vpe_clkdm",
++      .main_clk       = "dpll_core_h23x2_ck",
++      .prcm = {
++              .omap4 = {
++                      .clkctrl_offs = DRA7XX_CM_VPE_VPE_CLKCTRL_OFFSET,
++                      .context_offs = DRA7XX_RM_VPE_VPE_CONTEXT_OFFSET,
++                      .modulemode   = MODULEMODE_HWCTRL,
++              },
++      },
++};
+ /*
+  * Interfaces
+@@ -2000,6 +2306,19 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++static struct omap_hwmod_ocp_if dra7xx_l4_per2__cpgmac0 = {
++      .master         = &dra7xx_l4_per2_hwmod,
++      .slave          = &dra7xx_gmac_hwmod,
++      .clk            = "dpll_gmac_ck",
++      .user           = OCP_USER_MPU,
++};
++
++static struct omap_hwmod_ocp_if dra7xx_gmac__mdio = {
++      .master         = &dra7xx_gmac_hwmod,
++      .slave          = &dra7xx_mdio_hwmod,
++      .user           = OCP_USER_MPU,
++};
++
+ /* l4_wkup -> dcan1 */
+ static struct omap_hwmod_ocp_if dra7xx_l4_wkup__dcan1 = {
+       .master         = &dra7xx_l4_wkup_hwmod,
+@@ -2089,6 +2408,14 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l3_main_1 -> aes */
++static struct omap_hwmod_ocp_if dra7xx_l3_main_1__aes = {
++      .master         = &dra7xx_l3_main_1_hwmod,
++      .slave          = &dra7xx_aes_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ static struct omap_hwmod_addr_space dra7xx_elm_addrs[] = {
+       {
+               .pa_start       = 0x48078000,
+@@ -2171,6 +2498,14 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_per1 -> des */
++static struct omap_hwmod_ocp_if dra7xx_l4_per1__des = {
++      .master         = &dra7xx_l4_per1_hwmod,
++      .slave          = &dra7xx_des_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ static struct omap_hwmod_addr_space dra7xx_gpmc_addrs[] = {
+       {
+               .pa_start       = 0x50000000,
+@@ -2247,6 +2582,110 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_cfg -> mailbox1 */
++static struct omap_hwmod_ocp_if dra7xx_l4_cfg__mailbox1 = {
++      .master         = &dra7xx_l4_cfg_hwmod,
++      .slave          = &dra7xx_mailbox1_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox2 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox2 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox2_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox3 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox3 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox3_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox4 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox4 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox4_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox5 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox5 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox5_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox6 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox6 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox6_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox7 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox7 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox7_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox8 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox8 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox8_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox9 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox9 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox9_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox10 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox10 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox10_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox11 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox11 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox11_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox12 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox12 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox12_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
++/* l4_per3 -> mailbox13 */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__mailbox13 = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_mailbox13_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ /* l4_per1 -> mcspi1 */
+ static struct omap_hwmod_ocp_if dra7xx_l4_per1__mcspi1 = {
+       .master         = &dra7xx_l4_per1_hwmod,
+@@ -2319,21 +2758,11 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
+-static struct omap_hwmod_addr_space dra7xx_ocp2scp1_addrs[] = {
+-      {
+-              .pa_start       = 0x4a080000,
+-              .pa_end         = 0x4a08001f,
+-              .flags          = ADDR_TYPE_RT
+-      },
+-      { }
+-};
+-
+ /* l4_cfg -> ocp2scp1 */
+ static struct omap_hwmod_ocp_if dra7xx_l4_cfg__ocp2scp1 = {
+       .master         = &dra7xx_l4_cfg_hwmod,
+       .slave          = &dra7xx_ocp2scp1_hwmod,
+       .clk            = "l4_root_clk_div",
+-      .addr           = dra7xx_ocp2scp1_addrs,
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
+@@ -2355,6 +2784,14 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_per3 -> rtcss */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__rtcss = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_rtcss_hwmod,
++      .clk            = "l4_root_clk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ static struct omap_hwmod_addr_space dra7xx_sata_addrs[] = {
+       {
+               .name           = "sysc",
+@@ -2636,6 +3073,14 @@ static struct omap_hwmod_ocp_if dra7xx_l
+       .user           = OCP_USER_MPU | OCP_USER_SDMA,
+ };
++/* l4_per3 -> vpe */
++static struct omap_hwmod_ocp_if dra7xx_l4_per3__vpe = {
++      .master         = &dra7xx_l4_per3_hwmod,
++      .slave          = &dra7xx_vpe_hwmod,
++      .clk            = "l3_iclk_div",
++      .user           = OCP_USER_MPU | OCP_USER_SDMA,
++};
++
+ static struct omap_hwmod_ocp_if *dra7xx_hwmod_ocp_ifs[] __initdata = {
+       &dra7xx_l3_main_2__l3_instr,
+       &dra7xx_l4_cfg__l3_main_1,
+@@ -2653,10 +3098,13 @@ static struct omap_hwmod_ocp_if *dra7xx_
+       &dra7xx_l4_wkup__ctrl_module_wkup,
+       &dra7xx_l4_wkup__dcan1,
+       &dra7xx_l4_per2__dcan2,
++      &dra7xx_l4_per2__cpgmac0,
++      &dra7xx_gmac__mdio,
+       &dra7xx_l4_cfg__dma_system,
+       &dra7xx_l3_main_1__dss,
+       &dra7xx_l3_main_1__dispc,
+       &dra7xx_l3_main_1__hdmi,
++      &dra7xx_l3_main_1__aes,
+       &dra7xx_l4_per1__elm,
+       &dra7xx_l4_wkup__gpio1,
+       &dra7xx_l4_per1__gpio2,
+@@ -2673,6 +3121,19 @@ static struct omap_hwmod_ocp_if *dra7xx_
+       &dra7xx_l4_per1__i2c3,
+       &dra7xx_l4_per1__i2c4,
+       &dra7xx_l4_per1__i2c5,
++      &dra7xx_l4_cfg__mailbox1,
++      &dra7xx_l4_per3__mailbox2,
++      &dra7xx_l4_per3__mailbox3,
++      &dra7xx_l4_per3__mailbox4,
++      &dra7xx_l4_per3__mailbox5,
++      &dra7xx_l4_per3__mailbox6,
++      &dra7xx_l4_per3__mailbox7,
++      &dra7xx_l4_per3__mailbox8,
++      &dra7xx_l4_per3__mailbox9,
++      &dra7xx_l4_per3__mailbox10,
++      &dra7xx_l4_per3__mailbox11,
++      &dra7xx_l4_per3__mailbox12,
++      &dra7xx_l4_per3__mailbox13,
+       &dra7xx_l4_per1__mcspi1,
+       &dra7xx_l4_per1__mcspi2,
+       &dra7xx_l4_per1__mcspi3,
+@@ -2683,7 +3144,9 @@ static struct omap_hwmod_ocp_if *dra7xx_
+       &dra7xx_l4_per1__mmc4,
+       &dra7xx_l4_cfg__mpu,
+       &dra7xx_l4_cfg__ocp2scp1,
++      &dra7xx_l4_cfg__ocp2scp3,
+       &dra7xx_l3_main_1__qspi,
++      &dra7xx_l4_per3__rtcss,
+       &dra7xx_l4_cfg__sata,
+       &dra7xx_l4_cfg__smartreflex_core,
+       &dra7xx_l4_cfg__smartreflex_mpu,
+@@ -2705,6 +3168,7 @@ static struct omap_hwmod_ocp_if *dra7xx_
+       &dra7xx_l4_per1__uart4,
+       &dra7xx_l4_per1__uart5,
+       &dra7xx_l4_per1__uart6,
++      &dra7xx_l4_per1__des,
+       &dra7xx_l4_per3__usb_otg_ss1,
+       &dra7xx_l4_per3__usb_otg_ss2,
+       &dra7xx_l4_per3__usb_otg_ss3,
+@@ -2714,6 +3178,7 @@ static struct omap_hwmod_ocp_if *dra7xx_
+       &dra7xx_l3_main_1__vcp2,
+       &dra7xx_l4_per2__vcp2,
+       &dra7xx_l4_wkup__wd_timer2,
++      &dra7xx_l4_per3__vpe,
+       NULL,
+ };
+--- a/arch/arm/mach-omap2/omap_hwmod.c
++++ b/arch/arm/mach-omap2/omap_hwmod.c
+@@ -141,6 +141,7 @@
+ #include <linux/cpu.h>
+ #include <linux/of.h>
+ #include <linux/of_address.h>
++#include <linux/suspend.h>
+ #include <asm/system_misc.h>
+@@ -208,6 +209,9 @@ static struct omap_hwmod *mpu_oh;
+ /* io_chain_lock: used to serialize reconfigurations of the I/O chain */
+ static DEFINE_SPINLOCK(io_chain_lock);
++/* _oh_force_mstandby_repeated_list for tracking nonstandard mstandby hwmods */
++static LIST_HEAD(_oh_force_mstandby_repeated_list);
++
+ /*
+  * linkspace: ptr to a buffer that struct omap_hwmod_link records are
+  * allocated from - used to reduce the number of small memory
+@@ -656,6 +660,8 @@ static struct clockdomain *_get_clkdm(st
+       if (oh->clkdm) {
+               return oh->clkdm;
+       } else if (oh->_clk) {
++              if (__clk_get_flags(oh->_clk) & CLK_IS_BASIC)
++                      return NULL;
+               clk = to_clk_hw_omap(__clk_get_hw(oh->_clk));
+               return  clk->clkdm;
+       }
+@@ -728,14 +734,18 @@ static int _del_initiator_dep(struct oma
+  * functional clock pointer) if a main_clk is present.  Returns 0 on
+  * success or -EINVAL on error.
+  */
+-static int _init_main_clk(struct omap_hwmod *oh)
++static int _init_main_clk(struct omap_hwmod *oh, struct device_node *np)
+ {
+       int ret = 0;
+-      if (!oh->main_clk)
++      if (!oh->main_clk && !of_get_property(np, "clocks", NULL))
+               return 0;
+-      oh->_clk = clk_get(NULL, oh->main_clk);
++      if (oh->main_clk)
++              oh->_clk = clk_get(NULL, oh->main_clk);
++      else
++              oh->_clk = of_clk_get_by_name(np, "fck");
++
+       if (IS_ERR(oh->_clk)) {
+               pr_warning("omap_hwmod: %s: cannot clk_get main_clk %s\n",
+                          oh->name, oh->main_clk);
+@@ -801,6 +811,63 @@ static int _init_interface_clks(struct o
+       return ret;
+ }
++static const char **_parse_opt_clks_dt(struct omap_hwmod *oh,
++                                     struct device_node *np,
++                                     int *opt_clks_cnt)
++{
++      int i, clks_cnt;
++      const char *clk_name;
++      const char **opt_clk_names;
++
++      clks_cnt = of_property_count_strings(np, "clock-names");
++      if (!clks_cnt)
++              return NULL;
++
++      opt_clk_names = kzalloc(sizeof(char *)*clks_cnt, GFP_KERNEL);
++      if (!opt_clk_names)
++              return NULL;
++
++      for (i = 0; i < clks_cnt; i++) {
++              of_property_read_string_index(np, "clock-names", i, &clk_name);
++              if (!strcmp(clk_name, "fck"))
++                      continue;
++              opt_clk_names[(*opt_clks_cnt)++] = clk_name;
++      }
++      return opt_clk_names;
++}
++
++static int _init_opt_clks_dt(struct omap_hwmod *oh, struct device_node *np)
++{
++      struct clk *c;
++      int i, opt_clks_cnt = 0;
++      int ret = 0;
++      const char **opt_clk_names;
++
++      opt_clk_names = _parse_opt_clks_dt(oh, np, &opt_clks_cnt);
++      if (!opt_clk_names)
++              return -EINVAL;
++
++      oh->opt_clks = kzalloc(sizeof(struct omap_hwmod_opt_clk *)
++                             * opt_clks_cnt, GFP_KERNEL);
++      if (!oh->opt_clks)
++              return -ENOMEM;
++
++      oh->opt_clks_cnt = opt_clks_cnt;
++
++      for (i = 0; i < opt_clks_cnt; i++) {
++              c = of_clk_get_by_name(np, opt_clk_names[i]);
++              if (IS_ERR(c)) {
++                      pr_warn("omap_hwmod: %s: cannot clk_get opt_clk %s\n",
++                              oh->name, opt_clk_names[i]);
++                      ret = -EINVAL;
++              }
++              oh->opt_clks[i]._clk = c;
++              oh->opt_clks[i].role = opt_clk_names[i];
++              clk_prepare(oh->opt_clks[i]._clk);
++      }
++      return ret;
++}
++
+ /**
+  * _init_opt_clk - get a struct clk * for the the hwmod's optional clocks
+  * @oh: struct omap_hwmod *
+@@ -808,13 +875,16 @@ static int _init_interface_clks(struct o
+  * Called from _init_clocks().  Populates the @oh omap_hwmod_opt_clk
+  * clock pointers.  Returns 0 on success or -EINVAL on error.
+  */
+-static int _init_opt_clks(struct omap_hwmod *oh)
++static int _init_opt_clks(struct omap_hwmod *oh, struct device_node *np)
+ {
+       struct omap_hwmod_opt_clk *oc;
+       struct clk *c;
+       int i;
+       int ret = 0;
++      if (of_get_property(np, "clocks", NULL))
++              return _init_opt_clks_dt(oh, np);
++
+       for (i = oh->opt_clks_cnt, oc = oh->opt_clks; i > 0; i--, oc++) {
+               c = clk_get(NULL, oc->clk);
+               if (IS_ERR(c)) {
+@@ -1544,7 +1614,7 @@ static int _init_clkdm(struct omap_hwmod
+       if (!oh->clkdm) {
+               pr_warning("omap_hwmod: %s: could not associate to clkdm %s\n",
+                       oh->name, oh->clkdm_name);
+-              return -EINVAL;
++              return 0;
+       }
+       pr_debug("omap_hwmod: %s: associated to clkdm %s\n",
+@@ -1563,7 +1633,8 @@ static int _init_clkdm(struct omap_hwmod
+  * Resolves all clock names embedded in the hwmod.  Returns 0 on
+  * success, or a negative error code on failure.
+  */
+-static int _init_clocks(struct omap_hwmod *oh, void *data)
++static int _init_clocks(struct omap_hwmod *oh, void *data,
++                      struct device_node *np)
+ {
+       int ret = 0;
+@@ -1575,9 +1646,9 @@ static int _init_clocks(struct omap_hwmo
+       if (soc_ops.init_clkdm)
+               ret |= soc_ops.init_clkdm(oh);
+-      ret |= _init_main_clk(oh);
++      ret |= _init_main_clk(oh, np);
+       ret |= _init_interface_clks(oh);
+-      ret |= _init_opt_clks(oh);
++      ret |= _init_opt_clks(oh, np);
+       if (!ret)
+               oh->_state = _HWMOD_STATE_CLKS_INITED;
+@@ -2363,11 +2434,11 @@ static struct device_node *of_dev_hwmod_
+  * are part of the device's address space can be ioremapped properly.
+  * No return value.
+  */
+-static void __init _init_mpu_rt_base(struct omap_hwmod *oh, void *data)
++static void __init _init_mpu_rt_base(struct omap_hwmod *oh, void *data,
++                                   struct device_node *np)
+ {
+       struct omap_hwmod_addr_space *mem;
+       void __iomem *va_start = NULL;
+-      struct device_node *np;
+       if (!oh)
+               return;
+@@ -2383,12 +2454,10 @@ static void __init _init_mpu_rt_base(str
+                        oh->name);
+               /* Extract the IO space from device tree blob */
+-              if (!of_have_populated_dt())
++              if (!np)
+                       return;
+-              np = of_dev_hwmod_lookup(of_find_node_by_name(NULL, "ocp"), oh);
+-              if (np)
+-                      va_start = of_iomap(np, oh->mpu_rt_idx);
++              va_start = of_iomap(np, oh->mpu_rt_idx);
+       } else {
+               va_start = ioremap(mem->pa_start, mem->pa_end - mem->pa_start);
+       }
+@@ -2420,19 +2489,31 @@ static void __init _init_mpu_rt_base(str
+ static int __init _init(struct omap_hwmod *oh, void *data)
+ {
+       int r;
++      struct device_node *np = NULL;
+       if (oh->_state != _HWMOD_STATE_REGISTERED)
+               return 0;
++      /* If booting with DT, parse the DT node for IO space/clocks etc */
++      if (of_have_populated_dt())
++              np = of_dev_hwmod_lookup(of_find_node_by_name(NULL, "ocp"), oh);
++
+       if (oh->class->sysc)
+-              _init_mpu_rt_base(oh, NULL);
++              _init_mpu_rt_base(oh, NULL, np);
+-      r = _init_clocks(oh, NULL);
++      r = _init_clocks(oh, NULL, np);
+       if (r < 0) {
+               WARN(1, "omap_hwmod: %s: couldn't init clocks\n", oh->name);
+               return -EINVAL;
+       }
++      if (np) {
++              if (of_find_property(np, "ti,no-reset", NULL))
++                      oh->flags |= HWMOD_INIT_NO_RESET;
++              if (of_find_property(np, "ti,no-idle", NULL))
++                      oh->flags |= HWMOD_INIT_NO_IDLE;
++      }
++
+       oh->_state = _HWMOD_STATE_INITIALIZED;
+       return 0;
+@@ -3826,6 +3907,75 @@ int omap_hwmod_disable_wakeup(struct oma
+       return 0;
+ }
++/*
++ * There are some IPs that do not have MSTANDBY asserted by default
++ * which is necessary for PER domain transition. If the drivers
++ * are not compiled into the kernel HWMOD code will not change the
++ * state of the IPs if the IP was never enabled, so we keep track of
++ * them here to idle them with a pm_notifier.
++ */
++
++static int _omap_mstandby_pm_notifier(struct notifier_block *self,
++                                      unsigned long action, void *dev)
++{
++      struct omap_hwmod_list *oh_list_item = NULL;
++      switch (action) {
++      case PM_POST_SUSPEND:
++              list_for_each_entry(oh_list_item,
++                      &_oh_force_mstandby_repeated_list, oh_list) {
++                      omap_hwmod_enable(oh_list_item->oh);
++                      omap_hwmod_idle(oh_list_item->oh);
++              }
++      }
++
++      return NOTIFY_DONE;
++}
++
++struct notifier_block pm_nb = {
++      .notifier_call = _omap_mstandby_pm_notifier,
++};
++
++static int _check_for_force_mstandby_repeated(struct omap_hwmod *oh, void *data)
++{
++      if (oh->flags & HWMOD_FORCE_MSTANDBY_REPEATED)
++              omap_hwmod_enable_force_mstandby_repeated(oh);
++
++      return 0;
++}
++
++int omap_hwmod_force_mstandby_repeated(void)
++{
++      omap_hwmod_for_each(_check_for_force_mstandby_repeated, NULL);
++      register_pm_notifier(&pm_nb);
++      return 0;
++}
++
++int omap_hwmod_enable_force_mstandby_repeated(struct omap_hwmod *oh)
++{
++      struct omap_hwmod_list *oh_list_item = NULL;
++
++      oh_list_item = kzalloc(sizeof(*oh_list_item), GFP_KERNEL);
++      oh_list_item->oh = oh;
++      list_add(&oh_list_item->oh_list, &_oh_force_mstandby_repeated_list);
++
++      return 0;
++}
++
++int omap_hwmod_disable_force_mstandby_repeated(struct omap_hwmod *oh)
++{
++      struct omap_hwmod_list *oh_list_item, *tmp;
++
++      list_for_each_entry_safe(oh_list_item, tmp,
++              &_oh_force_mstandby_repeated_list, oh_list) {
++                      if (oh_list_item->oh == oh) {
++                              list_del(&oh_list_item->oh_list);
++                              kfree(oh_list_item);
++                      }
++              }
++
++      return 0;
++}
++
+ /**
+  * omap_hwmod_assert_hardreset - assert the HW reset line of submodules
+  * contained in the hwmod module.
+@@ -4115,6 +4265,7 @@ void __init omap_hwmod_init(void)
+               soc_ops.assert_hardreset = _omap2_assert_hardreset;
+               soc_ops.deassert_hardreset = _omap2_deassert_hardreset;
+               soc_ops.is_hardreset_asserted = _omap2_is_hardreset_asserted;
++              soc_ops.init_clkdm = _init_clkdm;
+       } else if (cpu_is_omap44xx() || soc_is_omap54xx() || soc_is_dra7xx()) {
+               soc_ops.enable_module = _omap4_enable_module;
+               soc_ops.disable_module = _omap4_disable_module;
+@@ -4125,6 +4276,14 @@ void __init omap_hwmod_init(void)
+               soc_ops.init_clkdm = _init_clkdm;
+               soc_ops.update_context_lost = _omap4_update_context_lost;
+               soc_ops.get_context_lost = _omap4_get_context_lost;
++      } else if (soc_is_am43xx()) {
++              soc_ops.enable_module = _omap4_enable_module;
++              soc_ops.disable_module = _omap4_disable_module;
++              soc_ops.wait_target_ready = _omap4_wait_target_ready;
++              soc_ops.assert_hardreset = _omap4_assert_hardreset;
++              soc_ops.deassert_hardreset = _omap4_deassert_hardreset;
++              soc_ops.is_hardreset_asserted = _omap4_is_hardreset_asserted;
++              soc_ops.init_clkdm = _init_clkdm;
+       } else if (soc_is_am33xx()) {
+               soc_ops.enable_module = _am33xx_enable_module;
+               soc_ops.disable_module = _am33xx_disable_module;
+--- a/arch/arm/mach-omap2/omap_hwmod_common_data.c
++++ b/arch/arm/mach-omap2/omap_hwmod_common_data.c
+@@ -59,6 +59,16 @@ struct omap_hwmod_sysc_fields omap_hwmod
+       .sidle_shift    = SYSC_TYPE3_SIDLEMODE_SHIFT,
+ };
++/**
++ * struct omap_hwmod_sysc_type4 - TYPE4 sysconfig scheme.
++ * Used by some IPs on AM33xx
++ */
++struct omap_hwmod_sysc_fields omap_hwmod_sysc_type4 = {
++      .sidle_shift    = SYSC_TYPE4_SIDLEMODE_SHIFT,
++      .srst_shift     = SYSC_TYPE4_SOFTRESET_SHIFT,
++      .autoidle_shift = SYSC_TYPE4_AUTOIDLE_SHIFT,
++};
++
+ struct omap_dss_dispc_dev_attr omap2_3_dss_dispc_dev_attr = {
+       .manager_count          = 2,
+       .has_framedonetv_irq    = 0
+--- a/arch/arm/mach-omap2/omap_hwmod.h
++++ b/arch/arm/mach-omap2/omap_hwmod.h
+@@ -41,6 +41,7 @@ struct omap_device;
+ extern struct omap_hwmod_sysc_fields omap_hwmod_sysc_type1;
+ extern struct omap_hwmod_sysc_fields omap_hwmod_sysc_type2;
+ extern struct omap_hwmod_sysc_fields omap_hwmod_sysc_type3;
++extern struct omap_hwmod_sysc_fields omap_hwmod_sysc_type4;
+ /*
+  * OCP SYSCONFIG bit shifts/masks TYPE1. These are for IPs compliant
+@@ -81,6 +82,16 @@ extern struct omap_hwmod_sysc_fields oma
+ #define SYSC_TYPE3_MIDLEMODE_SHIFT    2
+ #define SYSC_TYPE3_MIDLEMODE_MASK     (0x3 << SYSC_TYPE3_MIDLEMODE_SHIFT)
++/*
++ * OCP SYSCONFIG bit shifts/masks TYPE4.
++ */
++#define SYSC_TYPE4_SIDLEMODE_SHIFT    2
++#define SYSC_TYPE4_SIDLEMODE_MASK     (0x3 << SYSC_TYPE4_SIDLEMODE_SHIFT)
++#define SYSC_TYPE4_SOFTRESET_SHIFT    1
++#define SYSC_TYPE4_SOFTRESET_MASK     (1 << SYSC_TYPE4_SOFTRESET_SHIFT)
++#define SYSC_TYPE4_AUTOIDLE_SHIFT     0
++#define SYSC_TYPE4_AUTOIDLE_MASK      (1 << SYSC_TYPE4_AUTOIDLE_SHIFT)
++
+ /* OCP SYSSTATUS bit shifts/masks */
+ #define SYSS_RESETDONE_SHIFT          0
+ #define SYSS_RESETDONE_MASK           (1 << SYSS_RESETDONE_SHIFT)
+@@ -528,6 +539,7 @@ struct omap_hwmod_omap4_prcm {
+ #define HWMOD_BLOCK_WFI                               (1 << 10)
+ #define HWMOD_FORCE_MSTANDBY                  (1 << 11)
+ #define HWMOD_SWSUP_SIDLE_ACT                 (1 << 12)
++#define HWMOD_FORCE_MSTANDBY_REPEATED         (1 << 13)
+ /*
+  * omap_hwmod._int_flags definitions
+@@ -678,6 +690,11 @@ struct omap_hwmod {
+       u8                              _postsetup_state;
+ };
++struct omap_hwmod_list {
++      struct omap_hwmod *oh;
++      struct list_head oh_list;
++};
++
+ struct omap_hwmod *omap_hwmod_lookup(const char *name);
+ int omap_hwmod_for_each(int (*fn)(struct omap_hwmod *oh, void *data),
+                       void *data);
+@@ -731,6 +748,10 @@ int omap_hwmod_no_setup_reset(struct oma
+ int omap_hwmod_pad_route_irq(struct omap_hwmod *oh, int pad_idx, int irq_idx);
++int omap_hwmod_force_mstandby_repeated(void);
++int omap_hwmod_enable_force_mstandby_repeated(struct omap_hwmod *oh);
++int omap_hwmod_disable_force_mstandby_repeated(struct omap_hwmod *oh);
++
+ extern void __init omap_hwmod_init(void);
+ const char *omap_hwmod_get_main_clk(struct omap_hwmod *oh);
+--- a/arch/arm/mach-omap2/omap-mpuss-lowpower.c
++++ b/arch/arm/mach-omap2/omap-mpuss-lowpower.c
+@@ -56,6 +56,7 @@
+ #include "omap4-sar-layout.h"
+ #include "pm.h"
+ #include "prcm_mpu44xx.h"
++#include "prcm_mpu54xx.h"
+ #include "prminst44xx.h"
+ #include "prcm44xx.h"
+ #include "prm44xx.h"
+@@ -84,11 +85,13 @@ struct cpu_pm_ops {
+       int (*finish_suspend)(unsigned long cpu_state);
+       void (*resume)(void);
+       void (*scu_prepare)(unsigned int cpu_id, unsigned int cpu_state);
++      void (*hotplug_restart)(void);
+ };
+ static DEFINE_PER_CPU(struct omap4_cpu_pm_info, omap4_pm_info);
+ static struct powerdomain *mpuss_pd;
+ static void __iomem *sar_base;
++static u32 cpu_context_offset;
+ static int default_finish_suspend(unsigned long cpu_state)
+ {
+@@ -106,6 +109,7 @@ struct cpu_pm_ops omap_pm_ops = {
+       .finish_suspend         = default_finish_suspend,
+       .resume                 = dummy_cpu_resume,
+       .scu_prepare            = dummy_scu_prepare,
++      .hotplug_restart        = dummy_cpu_resume,
+ };
+ /*
+@@ -116,7 +120,8 @@ static inline void set_cpu_wakeup_addr(u
+ {
+       struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
+-      __raw_writel(addr, pm_info->wkup_sar_addr);
++      if (pm_info->wkup_sar_addr)
++              __raw_writel(addr, pm_info->wkup_sar_addr);
+ }
+ /*
+@@ -127,6 +132,9 @@ static void scu_pwrst_prepare(unsigned i
+       struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
+       u32 scu_pwr_st;
++      if (!pm_info->scu_sar_addr)
++              return;
++
+       switch (cpu_state) {
+       case PWRDM_POWER_RET:
+               scu_pwr_st = SCU_PM_DORMANT;
+@@ -161,14 +169,14 @@ static inline void cpu_clear_prev_logic_
+       if (cpu_id) {
+               reg = omap4_prcm_mpu_read_inst_reg(OMAP4430_PRCM_MPU_CPU1_INST,
+-                                      OMAP4_RM_CPU1_CPU1_CONTEXT_OFFSET);
++                                      cpu_context_offset);
+               omap4_prcm_mpu_write_inst_reg(reg, OMAP4430_PRCM_MPU_CPU1_INST,
+-                                      OMAP4_RM_CPU1_CPU1_CONTEXT_OFFSET);
++                                      cpu_context_offset);
+       } else {
+               reg = omap4_prcm_mpu_read_inst_reg(OMAP4430_PRCM_MPU_CPU0_INST,
+-                                      OMAP4_RM_CPU0_CPU0_CONTEXT_OFFSET);
++                                      cpu_context_offset);
+               omap4_prcm_mpu_write_inst_reg(reg, OMAP4430_PRCM_MPU_CPU0_INST,
+-                                      OMAP4_RM_CPU0_CPU0_CONTEXT_OFFSET);
++                                      cpu_context_offset);
+       }
+ }
+@@ -179,7 +187,8 @@ static void l2x0_pwrst_prepare(unsigned
+ {
+       struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
+-      __raw_writel(save_state, pm_info->l2x0_sar_addr);
++      if (pm_info->l2x0_sar_addr)
++              __raw_writel(save_state, pm_info->l2x0_sar_addr);
+ }
+ /*
+@@ -235,6 +244,8 @@ int omap4_enter_lowpower(unsigned int cp
+               save_state = 1;
+               break;
+       case PWRDM_POWER_RET:
++              save_state = 0;
++              break;
+       default:
+               /*
+                * CPUx CSWR is invalid hardware state. Also CPUx OSWR
+@@ -304,7 +315,7 @@ int omap4_hotplug_cpu(unsigned int cpu,
+       pwrdm_clear_all_prev_pwrst(pm_info->pwrdm);
+       pwrdm_set_next_pwrst(pm_info->pwrdm, power_state);
+-      set_cpu_wakeup_addr(cpu, virt_to_phys(pm_info->secondary_startup));
++      set_cpu_wakeup_addr(cpu, virt_to_phys(omap_pm_ops.hotplug_restart));
+       omap_pm_ops.scu_prepare(cpu, power_state);
+       /*
+@@ -320,11 +331,26 @@ int omap4_hotplug_cpu(unsigned int cpu,
+ /*
++ * Enable Mercury Fast HG retention mode by default.
++ */
++static void enable_mercury_retention_mode(void)
++{
++      u32 reg;
++
++      reg = omap4_prcm_mpu_read_inst_reg(OMAP54XX_PRCM_MPU_DEVICE_INST,
++                      OMAP54XX_PRCM_MPU_PRM_PSCON_COUNT_OFFSET);
++      reg |= BIT(24) | BIT(25);
++      omap4_prcm_mpu_write_inst_reg(reg, OMAP54XX_PRCM_MPU_DEVICE_INST,
++                      OMAP54XX_PRCM_MPU_PRM_PSCON_COUNT_OFFSET);
++}
++
++/*
+  * Initialise OMAP4 MPUSS
+  */
+ int __init omap4_mpuss_init(void)
+ {
+       struct omap4_cpu_pm_info *pm_info;
++      u32 cpu_wakeup_addr = 0;
+       if (omap_rev() == OMAP4430_REV_ES1_0) {
+               WARN(1, "Power Management not supported on OMAP4430 ES1.0\n");
+@@ -334,10 +360,16 @@ int __init omap4_mpuss_init(void)
+       sar_base = omap4_get_sar_ram_base();
+       /* Initilaise per CPU PM information */
++      if (cpu_is_omap44xx())
++              cpu_wakeup_addr = CPU0_WAKEUP_NS_PA_ADDR_OFFSET;
++      else if (soc_is_omap54xx())
++              cpu_wakeup_addr = OMAP5_CPU0_WAKEUP_NS_PA_ADDR_OFFSET;
+       pm_info = &per_cpu(omap4_pm_info, 0x0);
+-      pm_info->scu_sar_addr = sar_base + SCU_OFFSET0;
+-      pm_info->wkup_sar_addr = sar_base + CPU0_WAKEUP_NS_PA_ADDR_OFFSET;
+-      pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET0;
++      if (sar_base) {
++              pm_info->scu_sar_addr = sar_base + SCU_OFFSET0;
++              pm_info->wkup_sar_addr = sar_base + cpu_wakeup_addr;
++              pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET0;
++      }
+       pm_info->pwrdm = pwrdm_lookup("cpu0_pwrdm");
+       if (!pm_info->pwrdm) {
+               pr_err("Lookup failed for CPU0 pwrdm\n");
+@@ -351,14 +383,17 @@ int __init omap4_mpuss_init(void)
+       /* Initialise CPU0 power domain state to ON */
+       pwrdm_set_next_pwrst(pm_info->pwrdm, PWRDM_POWER_ON);
++      if (cpu_is_omap44xx())
++              cpu_wakeup_addr = CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
++      else if (soc_is_omap54xx())
++              cpu_wakeup_addr = OMAP5_CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
++
+       pm_info = &per_cpu(omap4_pm_info, 0x1);
+-      pm_info->scu_sar_addr = sar_base + SCU_OFFSET1;
+-      pm_info->wkup_sar_addr = sar_base + CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
+-      pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET1;
+-      if (cpu_is_omap446x())
+-              pm_info->secondary_startup = omap4460_secondary_startup;
+-      else
+-              pm_info->secondary_startup = omap4_secondary_startup;
++      if (sar_base) {
++              pm_info->scu_sar_addr = sar_base + SCU_OFFSET1;
++              pm_info->wkup_sar_addr = sar_base + cpu_wakeup_addr;
++              pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET1;
++      }
+       pm_info->pwrdm = pwrdm_lookup("cpu1_pwrdm");
+       if (!pm_info->pwrdm) {
+@@ -382,19 +417,32 @@ int __init omap4_mpuss_init(void)
+       mpuss_clear_prev_logic_pwrst();
+       /* Save device type on scratchpad for low level code to use */
+-      if (omap_type() != OMAP2_DEVICE_TYPE_GP)
+-              __raw_writel(1, sar_base + OMAP_TYPE_OFFSET);
+-      else
+-              __raw_writel(0, sar_base + OMAP_TYPE_OFFSET);
++      if (sar_base) {
++              if (omap_type() != OMAP2_DEVICE_TYPE_GP)
++                      __raw_writel(1, sar_base + OMAP_TYPE_OFFSET);
++              else
++                      __raw_writel(0, sar_base + OMAP_TYPE_OFFSET);
+-      save_l2x0_context();
++              save_l2x0_context();
++      }
+       if (cpu_is_omap44xx()) {
+               omap_pm_ops.finish_suspend = omap4_finish_suspend;
++              omap_pm_ops.hotplug_restart = omap4_secondary_startup;
+               omap_pm_ops.resume = omap4_cpu_resume;
+               omap_pm_ops.scu_prepare = scu_pwrst_prepare;
++              cpu_context_offset = OMAP4_RM_CPU0_CPU0_CONTEXT_OFFSET;
++      } else if (soc_is_omap54xx() || soc_is_dra7xx()) {
++              omap_pm_ops.finish_suspend = omap5_finish_suspend;
++              omap_pm_ops.hotplug_restart = omap5_secondary_startup;
++              omap_pm_ops.resume = omap5_cpu_resume;
++              cpu_context_offset = OMAP54XX_RM_CPU0_CPU0_CONTEXT_OFFSET;
++              enable_mercury_retention_mode();
+       }
++      if (cpu_is_omap446x())
++              omap_pm_ops.hotplug_restart = omap4460_secondary_startup;
++
+       return 0;
+ }
+--- a/arch/arm/mach-omap2/omap-secure.h
++++ b/arch/arm/mach-omap2/omap-secure.h
+@@ -34,6 +34,10 @@
+ #define OMAP4_HAL_SAVEHW_INDEX                0x1b
+ #define OMAP4_HAL_SAVEALL_INDEX               0x1c
+ #define OMAP4_HAL_SAVEGIC_INDEX               0x1d
++#define OMAP5_HAL_SAVESECURERAM_INDEX 0x1c
++#define OMAP5_HAL_SAVEHW_INDEX                0x1d
++#define OMAP5_HAL_SAVEALL_INDEX               0x1e
++#define OMAP5_HAL_SAVEGIC_INDEX               0x1f
+ /* Secure Monitor mode APIs */
+ #define OMAP4_MON_SCU_PWR_INDEX               0x108
+@@ -41,6 +45,13 @@
+ #define OMAP4_MON_L2X0_CTRL_INDEX     0x102
+ #define OMAP4_MON_L2X0_AUXCTRL_INDEX  0x109
+ #define OMAP4_MON_L2X0_PREFETCH_INDEX 0x113
++#define OMAP5_MON_CACHES_CLEAN_INDEX  0x103
++#define OMAP5_MON_AUX_CTRL_INDEX      0x107
++#define OMAP5_MON_L2AUX_CTRL_INDEX    0x104
++
++#define OMAP5_MON_AMBA_IF_INDEX               0x108
++
++#define OMAP5_DRA7_MON_SET_CNTFRQ_INDEX       0x109
+ /* Secure PPA(Primary Protected Application) APIs */
+ #define OMAP4_PPA_L2_POR_INDEX                0x23
+--- a/arch/arm/mach-omap2/omap-smp.c
++++ b/arch/arm/mach-omap2/omap-smp.c
+@@ -41,6 +41,8 @@
+ u16 pm44xx_errata;
++extern unsigned long arch_timer_freq;
++
+ /* SCU base address */
+ static void __iomem *scu_base;
+@@ -66,6 +68,13 @@ static void omap4_secondary_init(unsigne
+                                                       4, 0, 0, 0, 0, 0);
+       /*
++       * Configure the CNTFRQ register for the secondary cpu's which
++       * indicates the frequency of the cpu local timers.
++       */
++      if (soc_is_omap54xx() || soc_is_dra7xx())
++              omap_smc1(OMAP5_DRA7_MON_SET_CNTFRQ_INDEX, arch_timer_freq);
++
++      /*
+        * Synchronise with the boot thread.
+        */
+       spin_lock(&boot_lock);
+--- a/arch/arm/mach-omap2/omap-wakeupgen.c
++++ b/arch/arm/mach-omap2/omap-wakeupgen.c
+@@ -33,8 +33,11 @@
+ #include "omap4-sar-layout.h"
+ #include "common.h"
+-#define MAX_NR_REG_BANKS      5
+-#define MAX_IRQS              160
++/* maximum value correspond to that of AM43x */
++#define MAX_NR_REG_BANKS      7
++#define MAX_IRQS              224
++#define DEFAULT_NR_REG_BANKS  5
++#define DEFAULT_IRQS          160
+ #define WKG_MASK_ALL          0x00000000
+ #define WKG_UNMASK_ALL                0xffffffff
+ #define CPU_ENA_OFFSET                0x400
+@@ -47,9 +50,9 @@ static void __iomem *wakeupgen_base;
+ static void __iomem *sar_base;
+ static DEFINE_RAW_SPINLOCK(wakeupgen_lock);
+ static unsigned int irq_target_cpu[MAX_IRQS];
+-static unsigned int irq_banks = MAX_NR_REG_BANKS;
+-static unsigned int max_irqs = MAX_IRQS;
+-static unsigned int omap_secure_apis;
++static unsigned int irq_banks = DEFAULT_NR_REG_BANKS;
++static unsigned int max_irqs = DEFAULT_IRQS;
++static unsigned int omap_secure_apis, secure_api_index;
+ /*
+  * Static helper functions.
+@@ -314,7 +317,7 @@ static void irq_sar_clear(void)
+ static void irq_save_secure_context(void)
+ {
+       u32 ret;
+-      ret = omap_secure_dispatcher(OMAP4_HAL_SAVEGIC_INDEX,
++      ret = omap_secure_dispatcher(secure_api_index,
+                               FLAG_START_CRITICAL,
+                               0, 0, 0, 0, 0);
+       if (ret != API_HAL_RET_VALUE_OK)
+@@ -376,8 +379,8 @@ static struct notifier_block irq_notifie
+ static void __init irq_pm_init(void)
+ {
+-      /* FIXME: Remove this when MPU OSWR support is added */
+-      if (!soc_is_omap54xx())
++      /* No OFF mode support on dra7xx */
++      if (!soc_is_dra7xx())
+               cpu_pm_register_notifier(&irq_notifier_block);
+ }
+ #else
+@@ -402,6 +405,8 @@ int __init omap_wakeupgen_init(void)
+ {
+       int i;
+       unsigned int boot_cpu = smp_processor_id();
++      u32 val;
++      bool am43x = soc_is_am43xx() ? true : false;
+       /* Not supported on OMAP4 ES1.0 silicon */
+       if (omap_rev() == OMAP4430_REV_ES1_0) {
+@@ -418,12 +423,19 @@ int __init omap_wakeupgen_init(void)
+               irq_banks = OMAP4_NR_BANKS;
+               max_irqs = OMAP4_NR_IRQS;
+               omap_secure_apis = 1;
++              secure_api_index = OMAP4_HAL_SAVEGIC_INDEX;
++      } else if (soc_is_omap54xx()) {
++              secure_api_index = OMAP5_HAL_SAVEGIC_INDEX;
++      } else if (am43x) {
++              irq_banks = MAX_NR_REG_BANKS;
++              max_irqs = MAX_IRQS;
+       }
+       /* Clear all IRQ bitmasks at wakeupGen level */
+       for (i = 0; i < irq_banks; i++) {
+               wakeupgen_writel(0, i, CPU0_ID);
+-              wakeupgen_writel(0, i, CPU1_ID);
++              if (!am43x)
++                      wakeupgen_writel(0, i, CPU1_ID);
+       }
+       /*
+@@ -443,6 +455,19 @@ int __init omap_wakeupgen_init(void)
+       for (i = 0; i < max_irqs; i++)
+               irq_target_cpu[i] = boot_cpu;
++      /*
++       * Enables OMAP5 ES2 PM Mode using ES2_PM_MODE in AMBA_IF_MODE
++       * 0x0: ES1 behavior, CPU cores would enter and exit OFF mode together.
++       * 0x1: ES2 behavior, CPU cores are allowed to enter/exit OFF mode
++       * independently.
++       * This needs to be set one time thanks to always ON domain.
++       */
++      if (soc_is_omap54xx()) {
++              val = __raw_readl(wakeupgen_base + OMAP_AMBA_IF_MODE);
++              val |= BIT(5);
++              omap_smc1(OMAP5_MON_AMBA_IF_INDEX, val);
++      }
++
+       irq_hotplug_init();
+       irq_pm_init();
+--- a/arch/arm/mach-omap2/omap-wakeupgen.h
++++ b/arch/arm/mach-omap2/omap-wakeupgen.h
+@@ -27,6 +27,7 @@
+ #define OMAP_WKG_ENB_E_1                      0x420
+ #define OMAP_AUX_CORE_BOOT_0                  0x800
+ #define OMAP_AUX_CORE_BOOT_1                  0x804
++#define OMAP_AMBA_IF_MODE                     0x80c
+ #define OMAP_PTMSYNCREQ_MASK                  0xc00
+ #define OMAP_PTMSYNCREQ_EN                    0xc04
+ #define OMAP_TIMESTAMPCYCLELO                 0xc08
+--- a/arch/arm/mach-omap2/opp.c
++++ b/arch/arm/mach-omap2/opp.c
+@@ -17,6 +17,7 @@
+  * GNU General Public License for more details.
+  */
+ #include <linux/module.h>
++#include <linux/of.h>
+ #include <linux/opp.h>
+ #include <linux/cpu.h>
+@@ -40,6 +41,9 @@ int __init omap_init_opp_table(struct om
+ {
+       int i, r;
++      if (of_have_populated_dt())
++              return -EINVAL;
++
+       if (!opp_def || !opp_def_size) {
+               pr_err("%s: invalid params!\n", __func__);
+               return -EINVAL;
+--- /dev/null
++++ b/arch/arm/mach-omap2/pm33xx.c
+@@ -0,0 +1,387 @@
++/*
++ * AM33XX Power Management Routines
++ *
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com/
++ * Vaibhav Bedia <vaibhav.bedia@ti.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/cpu.h>
++#include <linux/err.h>
++#include <linux/firmware.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <linux/sched.h>
++#include <linux/suspend.h>
++#include <linux/completion.h>
++#include <linux/module.h>
++#include <linux/interrupt.h>
++#include <linux/ti_emif.h>
++#include <linux/omap-mailbox.h>
++
++#include <asm/suspend.h>
++#include <asm/proc-fns.h>
++#include <asm/sizes.h>
++#include <asm/fncpy.h>
++#include <asm/system_misc.h>
++
++#include "pm.h"
++#include "cm33xx.h"
++#include "pm33xx.h"
++#include "common.h"
++#include "clockdomain.h"
++#include "powerdomain.h"
++#include "soc.h"
++#include "sram.h"
++
++static void __iomem *am33xx_emif_base;
++static struct powerdomain *cefuse_pwrdm, *gfx_pwrdm, *per_pwrdm, *mpu_pwrdm;
++static struct clockdomain *gfx_l4ls_clkdm;
++static struct clockdomain *l3s_clkdm, *l4fw_clkdm, *clk_24mhz_clkdm;
++
++static struct am33xx_pm_context *am33xx_pm;
++
++static DECLARE_COMPLETION(am33xx_pm_sync);
++
++static void (*am33xx_do_wfi_sram)(struct am33xx_suspend_params *);
++
++static struct am33xx_suspend_params susp_params;
++
++#ifdef CONFIG_SUSPEND
++
++static int am33xx_do_sram_idle(long unsigned int unused)
++{
++      am33xx_do_wfi_sram(&susp_params);
++      return 0;
++}
++
++static int am33xx_pm_suspend(unsigned int state)
++{
++      int i, ret = 0;
++      int status = 0;
++      struct wkup_m3_wakeup_src wakeup_src;
++
++      if (state == PM_SUSPEND_STANDBY) {
++              clkdm_wakeup(l3s_clkdm);
++              clkdm_wakeup(l4fw_clkdm);
++              clkdm_wakeup(clk_24mhz_clkdm);
++      }
++
++      /* Try to put GFX to sleep */
++      omap_set_pwrdm_state(gfx_pwrdm, PWRDM_POWER_OFF);
++
++      ret = cpu_suspend(0, am33xx_do_sram_idle);
++
++      status = pwrdm_read_pwrst(gfx_pwrdm);
++      if (status != PWRDM_POWER_OFF)
++              pr_err("PM: GFX domain did not transition\n");
++
++      /*
++       * BUG: GFX_L4LS clock domain needs to be woken up to
++       * ensure thet L4LS clock domain does not get stuck in transition
++       * If that happens L3 module does not get disabled, thereby leading
++       * to PER power domain transition failing
++       */
++      clkdm_wakeup(gfx_l4ls_clkdm);
++      clkdm_sleep(gfx_l4ls_clkdm);
++
++      if (ret) {
++              pr_err("PM: Kernel suspend failure\n");
++      } else {
++              i = wkup_m3_pm_status();
++              switch (i) {
++              case 0:
++                      pr_info("PM: Successfully put all powerdomains to target state\n");
++
++                      /*
++                       * The PRCM registers on AM335x do not contain
++                       * previous state information like those present on
++                       * OMAP4 so we must manually indicate transition so
++                       * state counters are properly incremented
++                       */
++                      pwrdm_post_transition(mpu_pwrdm);
++                      pwrdm_post_transition(per_pwrdm);
++                      break;
++              case 1:
++                      pr_err("PM: Could not transition all powerdomains to target state\n");
++                      ret = -1;
++                      break;
++              default:
++                      pr_err("PM: CM3 returned unknown result = %d\n", i);
++                      ret = -1;
++              }
++              /* print the wakeup reason */
++              wakeup_src = wkup_m3_wake_src();
++
++              pr_info("PM: Wakeup source %s\n", wakeup_src.src);
++      }
++
++      return ret;
++}
++
++static int am33xx_pm_enter(suspend_state_t suspend_state)
++{
++      int ret = 0;
++
++      switch (suspend_state) {
++      case PM_SUSPEND_STANDBY:
++      case PM_SUSPEND_MEM:
++              ret = am33xx_pm_suspend(suspend_state);
++              break;
++      default:
++              ret = -EINVAL;
++      }
++
++      return ret;
++}
++
++
++static void am33xx_m3_state_machine_reset(void)
++{
++      int i;
++
++      am33xx_pm->ipc.reg1 = IPC_CMD_RESET;
++
++      wkup_m3_pm_set_cmd(&am33xx_pm->ipc);
++
++      am33xx_pm->state = M3_STATE_MSG_FOR_RESET;
++
++      if (!wkup_m3_ping()) {
++              i = wait_for_completion_timeout(&am33xx_pm_sync,
++                                      msecs_to_jiffies(500));
++              if (!i) {
++                      WARN(1, "PM: MPU<->CM3 sync failure\n");
++                      am33xx_pm->state = M3_STATE_UNKNOWN;
++              }
++      } else {
++              pr_warn("PM: Unable to ping CM3\n");
++      }
++}
++
++static int am33xx_pm_begin(suspend_state_t state)
++{
++      int i;
++
++      cpu_idle_poll_ctrl(true);
++
++      switch (state) {
++      case PM_SUSPEND_MEM:
++              am33xx_pm->ipc.reg1     = IPC_CMD_DS0;
++              break;
++      case PM_SUSPEND_STANDBY:
++              am33xx_pm->ipc.reg1     = IPC_CMD_STANDBY;
++              break;
++      }
++
++      am33xx_pm->ipc.reg2             = DS_IPC_DEFAULT;
++      am33xx_pm->ipc.reg3             = DS_IPC_DEFAULT;
++
++      wkup_m3_pm_set_cmd(&am33xx_pm->ipc);
++
++      am33xx_pm->state = M3_STATE_MSG_FOR_LP;
++
++      if (!wkup_m3_ping()) {
++              i = wait_for_completion_timeout(&am33xx_pm_sync,
++                                      msecs_to_jiffies(500));
++              if (!i) {
++                      WARN(1, "PM: MPU<->CM3 sync failure\n");
++                      return -1;
++              }
++      } else {
++              pr_warn("PM: Unable to ping CM3\n");
++              return -1;
++      }
++
++      return 0;
++}
++
++static void am33xx_pm_end(void)
++{
++      am33xx_m3_state_machine_reset();
++
++      cpu_idle_poll_ctrl(false);
++
++      return;
++}
++
++static int am33xx_pm_valid(suspend_state_t state)
++{
++      switch (state) {
++      case PM_SUSPEND_STANDBY:
++      case PM_SUSPEND_MEM:
++              return 1;
++      default:
++              return 0;
++      }
++}
++
++static const struct platform_suspend_ops am33xx_pm_ops = {
++      .begin          = am33xx_pm_begin,
++      .end            = am33xx_pm_end,
++      .enter          = am33xx_pm_enter,
++      .valid          = am33xx_pm_valid,
++};
++#endif /* CONFIG_SUSPEND */
++
++static void am33xx_txev_handler(void)
++{
++      switch (am33xx_pm->state) {
++      case M3_STATE_RESET:
++              am33xx_pm->state = M3_STATE_INITED;
++              complete(&am33xx_pm_sync);
++              break;
++      case M3_STATE_MSG_FOR_RESET:
++              am33xx_pm->state = M3_STATE_INITED;
++              complete(&am33xx_pm_sync);
++              break;
++      case M3_STATE_MSG_FOR_LP:
++              complete(&am33xx_pm_sync);
++              break;
++      case M3_STATE_UNKNOWN:
++              pr_warn("PM: Unknown CM3 State\n");
++      }
++
++      return;
++}
++
++static void am33xx_m3_fw_ready_cb(void)
++{
++      int ret = 0;
++
++      ret = wkup_m3_prepare();
++      if (ret) {
++              pr_err("PM: Could not prepare WKUP_M3\n");
++              return;
++      }
++
++      ret = wait_for_completion_timeout(&am33xx_pm_sync,
++                                      msecs_to_jiffies(500));
++
++      if (WARN(ret == 0, "PM: MPU<->CM3 sync failure\n"))
++              return;
++
++      am33xx_pm->ver = wkup_m3_fw_version_read();
++
++      if (am33xx_pm->ver == M3_VERSION_UNKNOWN ||
++              am33xx_pm->ver < M3_BASELINE_VERSION) {
++              pr_warn("PM: CM3 Firmware Version %x not supported\n",
++                                      am33xx_pm->ver);
++              return;
++      } else {
++              pr_info("PM: CM3 Firmware Version = 0x%x\n",
++                                      am33xx_pm->ver);
++      }
++
++#ifdef CONFIG_SUSPEND
++      suspend_set_ops(&am33xx_pm_ops);
++#endif /* CONFIG_SUSPEND */
++}
++
++static struct wkup_m3_ops am33xx_wkup_m3_ops = {
++      .txev_handler = am33xx_txev_handler,
++      .firmware_loaded = am33xx_m3_fw_ready_cb,
++};
++
++/*
++ * Push the minimal suspend-resume code to SRAM
++ */
++void am33xx_push_sram_idle(void)
++{
++      am33xx_do_wfi_sram = (void *)omap_sram_push
++                                      (am33xx_do_wfi, am33xx_do_wfi_sz);
++}
++
++static int __init am33xx_map_emif(void)
++{
++      am33xx_emif_base = ioremap(AM33XX_EMIF_BASE, SZ_32K);
++
++      if (!am33xx_emif_base)
++              return -ENOMEM;
++
++      return 0;
++}
++
++int __init am33xx_pm_init(void)
++{
++      int ret;
++      u32 temp;
++
++      if (!soc_is_am33xx())
++              return -ENODEV;
++
++      gfx_pwrdm = pwrdm_lookup("gfx_pwrdm");
++      per_pwrdm = pwrdm_lookup("per_pwrdm");
++      mpu_pwrdm = pwrdm_lookup("mpu_pwrdm");
++
++      gfx_l4ls_clkdm = clkdm_lookup("gfx_l4ls_gfx_clkdm");
++      l3s_clkdm = clkdm_lookup("l3s_clkdm");
++      l4fw_clkdm = clkdm_lookup("l4fw_clkdm");
++      clk_24mhz_clkdm = clkdm_lookup("clk_24mhz_clkdm");
++
++      if ((!gfx_pwrdm) || (!per_pwrdm) || (!mpu_pwrdm) || (!gfx_l4ls_clkdm) ||
++          (!l3s_clkdm) || (!l4fw_clkdm) || (!clk_24mhz_clkdm)) {
++              ret = -ENODEV;
++              goto err;
++      }
++
++      am33xx_pm = kzalloc(sizeof(*am33xx_pm), GFP_KERNEL);
++      if (!am33xx_pm) {
++              pr_err("Memory allocation failed\n");
++              ret = -ENOMEM;
++              return ret;
++      }
++
++      ret = am33xx_map_emif();
++      if (ret) {
++              pr_err("PM: Could not ioremap EMIF\n");
++              goto err;
++      }
++
++      /* Determine Memory Type */
++      temp = readl(am33xx_emif_base + EMIF_SDRAM_CONFIG);
++      temp = (temp & SDRAM_TYPE_MASK) >> SDRAM_TYPE_SHIFT;
++      /* Parameters to pass to aseembly code */
++      susp_params.emif_addr_virt = am33xx_emif_base;
++      susp_params.dram_sync = am33xx_dram_sync;
++      susp_params.mem_type = temp;
++      am33xx_pm->ipc.reg4 = temp;
++
++      (void) clkdm_for_each(omap_pm_clkdms_setup, NULL);
++
++      /* CEFUSE domain can be turned off post bootup */
++      cefuse_pwrdm = pwrdm_lookup("cefuse_pwrdm");
++      if (cefuse_pwrdm)
++              omap_set_pwrdm_state(cefuse_pwrdm, PWRDM_POWER_OFF);
++      else
++              pr_err("PM: Failed to get cefuse_pwrdm\n");
++
++      am33xx_pm->state = M3_STATE_RESET;
++
++      wkup_m3_set_ops(&am33xx_wkup_m3_ops);
++
++      /* m3 may have already loaded but ops were not set yet,
++       * manually invoke */
++
++      if (wkup_m3_is_valid())
++              am33xx_m3_fw_ready_cb();
++
++      /* Physical resume address to be used by ROM code */
++      am33xx_pm->ipc.reg0 = (AM33XX_OCMC_END -
++              am33xx_do_wfi_sz + am33xx_resume_offset + 0x4);
++
++      return 0;
++
++err:
++      kfree(am33xx_pm);
++      return ret;
++}
+--- /dev/null
++++ b/arch/arm/mach-omap2/pm33xx.h
+@@ -0,0 +1,77 @@
++/*
++ * AM33XX Power Management Routines
++ *
++ * Copyright (C) 2012 Texas Instruments Inc.
++ * Vaibhav Bedia <vaibhav.bedia@ti.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++#ifndef __ARCH_ARM_MACH_OMAP2_PM33XX_H
++#define __ARCH_ARM_MACH_OMAP2_PM33XX_H
++
++#include "wkup_m3.h"
++
++#ifndef __ASSEMBLER__
++
++struct am33xx_pm_context {
++      struct am33xx_ipc_regs  ipc;
++      struct firmware         *firmware;
++      struct omap_mbox        *mbox;
++      u8                      state;
++      u32                     ver;
++};
++
++/*
++ * Params passed to suspend routine
++ *
++ * These are used to load into registers by suspend code,
++ * entries here must always be in sync with the suspend code
++ * in arm/mach-omap2/sleep33xx.S
++ */
++struct am33xx_suspend_params {
++      void __iomem *emif_addr_virt;
++      u32 mem_type;
++      void __iomem *dram_sync;
++};
++
++
++#endif
++
++#define       IPC_CMD_DS0                     0x4
++#define       IPC_CMD_STANDBY                 0xc
++#define IPC_CMD_RESET                 0xe
++#define DS_IPC_DEFAULT                        0xffffffff
++#define M3_VERSION_UNKNOWN            0x0000ffff
++#define M3_BASELINE_VERSION           0x21
++
++#define M3_STATE_UNKNOWN              0
++#define M3_STATE_RESET                        1
++#define M3_STATE_INITED                       2
++#define M3_STATE_MSG_FOR_LP           3
++#define M3_STATE_MSG_FOR_RESET        4
++
++#define AM33XX_OCMC_END                       0x40310000
++#define AM33XX_EMIF_BASE              0x4C000000
++
++#define MEM_TYPE_DDR2         2
++
++/*
++ * 9-4 = VTT GPIO PIN (6 Bits)
++ *   3 = VTT Status (1 Bit)
++ * 2-0 = Memory Type (2 Bits)
++*/
++#define MEM_TYPE_SHIFT                (0x0)
++#define MEM_TYPE_MASK         (0x7 << 0)
++#define VTT_STAT_SHIFT                (0x3)
++#define VTT_STAT_MASK         (0x1 << 3)
++#define VTT_GPIO_PIN_SHIFT    (0x4)
++#define VTT_GPIO_PIN_MASK     (0x2f << 4)
++
++#endif
+--- a/arch/arm/mach-omap2/pm44xx.c
++++ b/arch/arm/mach-omap2/pm44xx.c
+@@ -35,6 +35,7 @@ struct power_state {
+ };
+ static LIST_HEAD(pwrst_list);
++u32 cpu_suspend_state;
+ #ifdef CONFIG_SUSPEND
+ static int omap4_pm_suspend(void)
+@@ -52,7 +53,10 @@ static int omap4_pm_suspend(void)
+       /* Set targeted power domain states by suspend */
+       list_for_each_entry(pwrst, &pwrst_list, node) {
+               omap_set_pwrdm_state(pwrst->pwrdm, pwrst->next_state);
+-              pwrdm_set_logic_retst(pwrst->pwrdm, PWRDM_POWER_OFF);
++              if (!strcmp(pwrst->pwrdm->name, "mpu_pwrdm"))
++                      pwrdm_set_logic_retst(pwrst->pwrdm, PWRDM_POWER_ON);
++              else
++                      pwrdm_set_logic_retst(pwrst->pwrdm, PWRDM_POWER_OFF);
+       }
+       /*
+@@ -64,7 +68,7 @@ static int omap4_pm_suspend(void)
+        * domain CSWR is not supported by hardware.
+        * More details can be found in OMAP4430 TRM section 4.3.4.2.
+        */
+-      omap4_enter_lowpower(cpu_id, PWRDM_POWER_OFF);
++      omap4_enter_lowpower(cpu_id, cpu_suspend_state);
+       /* Restore next powerdomain state */
+       list_for_each_entry(pwrst, &pwrst_list, node) {
+@@ -199,6 +203,32 @@ static inline int omap4_init_static_deps
+ }
+ /**
++ * omap5_dra7_init_static_deps - Init static clkdm dependencies on OMAP5
++ * and DRA7
++ *
++ * The dynamic dependency between MPUSS -> EMIF is broken and has
++ * not worked as expected. The hardware recommendation is to
++ * enable static dependencies for these to avoid system
++ * lock ups or random crashes.
++ */
++static inline int omap5_dra7_init_static_deps(void)
++{
++      struct clockdomain *mpuss_clkdm, *emif_clkdm;
++      int ret;
++
++      mpuss_clkdm = clkdm_lookup("mpu_clkdm");
++      emif_clkdm = clkdm_lookup("emif_clkdm");
++      if (!mpuss_clkdm || !emif_clkdm)
++             return -EINVAL;
++
++      ret = clkdm_add_wkdep(mpuss_clkdm, emif_clkdm);
++      if (ret)
++             pr_err("Failed to add MPUSS -> EMIF wakeup dependency\n");
++
++      return ret;
++}
++
++/**
+  * omap4_pm_init - Init routine for OMAP4+ devices
+  *
+  * Initializes all powerdomain and clockdomain target states
+@@ -222,10 +252,14 @@ int __init omap4_pm_init(void)
+               goto err2;
+       }
+-      if (cpu_is_omap44xx()) {
++      if (cpu_is_omap44xx())
+               ret = omap4_init_static_deps();
+-              if (ret)
+-                      goto err2;
++      else if (soc_is_omap54xx() || soc_is_dra7xx())
++              ret = omap5_dra7_init_static_deps();
++
++      if (ret) {
++              pr_err("Failed to initialise static dependencies.\n");
++              goto err2;
+       }
+       ret = omap4_mpuss_init();
+@@ -246,6 +280,11 @@ int __init omap4_pm_init(void)
+       if (cpu_is_omap44xx())
+               omap4_idle_init();
++      if (soc_is_dra7xx())
++              cpu_suspend_state = PWRDM_POWER_RET;
++      else
++              cpu_suspend_state = PWRDM_POWER_OFF;
++
+ err2:
+       return ret;
+ }
+--- a/arch/arm/mach-omap2/pm.c
++++ b/arch/arm/mach-omap2/pm.c
+@@ -266,7 +266,12 @@ static void __init omap4_init_voltages(v
+ static inline void omap_init_cpufreq(void)
+ {
+-      struct platform_device_info devinfo = { .name = "omap-cpufreq", };
++      struct platform_device_info devinfo = { };
++
++      if (!of_have_populated_dt())
++              devinfo.name = "omap-cpufreq";
++      else
++              devinfo.name = "cpufreq-cpu0";
+       platform_device_register_full(&devinfo);
+ }
+@@ -300,13 +305,16 @@ int __init omap2_common_pm_late_init(voi
+               /* Smartreflex device init */
+               omap_devinit_smartreflex();
+-              /* cpufreq dummy device instantiation */
+-              omap_init_cpufreq();
+       }
+-#ifdef CONFIG_SUSPEND
+-      suspend_set_ops(&omap_pm_ops);
+-#endif
++      /* cpufreq dummy device instantiation */
++      omap_init_cpufreq();
+       return 0;
+ }
++
++void __init omap2_common_suspend_init(void)
++{
++      suspend_set_ops(&omap_pm_ops);
++}
++
+--- a/arch/arm/mach-omap2/pm.h
++++ b/arch/arm/mach-omap2/pm.h
+@@ -82,6 +82,11 @@ extern unsigned int omap3_do_wfi_sz;
+ /* ... and its pointer from SRAM after copy */
+ extern void (*omap3_do_wfi_sram)(void);
++/* am33xx_do_wfi function pointer and size, for copy to SRAM */
++extern void am33xx_do_wfi(void);
++extern unsigned int am33xx_do_wfi_sz;
++extern unsigned int am33xx_resume_offset;
++
+ /* save_secure_ram_context function pointer and size, for copy to SRAM */
+ extern int save_secure_ram_context(u32 *addr);
+ extern unsigned int save_secure_ram_context_sz;
+--- a/arch/arm/mach-omap2/powerdomain.h
++++ b/arch/arm/mach-omap2/powerdomain.h
+@@ -254,6 +254,7 @@ extern void omap242x_powerdomains_init(v
+ extern void omap243x_powerdomains_init(void);
+ extern void omap3xxx_powerdomains_init(void);
+ extern void am33xx_powerdomains_init(void);
++extern void am43xx_powerdomains_init(void);
+ extern void omap44xx_powerdomains_init(void);
+ extern void omap54xx_powerdomains_init(void);
+ extern void dra7xx_powerdomains_init(void);
+--- /dev/null
++++ b/arch/arm/mach-omap2/powerdomains43xx_data.c
+@@ -0,0 +1,145 @@
++/*
++ * AM43xx Power domains framework
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * This file is made by modifying the file generated automatically
++ * from the OMAP hardware databases.
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/init.h>
++
++#include "powerdomain.h"
++
++#include "prcm-common.h"
++#include "prcm44xx.h"
++#include "prcm43xx.h"
++
++static struct powerdomain gfx_43xx_pwrdm = {
++      .name             = "gfx_pwrdm",
++      .voltdm           = { .name = "core" },
++      .prcm_offs        = AM43XX_PRM_GFX_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_OFF_ON,
++      .banks            = 1,
++      .pwrsts_mem_ret = {
++              [0] = PWRSTS_OFF_RET,   /* gfx_mem */
++      },
++      .pwrsts_mem_on  = {
++              [0] = PWRSTS_ON,        /* gfx_mem */
++      },
++      .flags            = PWRDM_HAS_LOWPOWERSTATECHANGE,
++};
++
++static struct powerdomain mpu_43xx_pwrdm = {
++      .name             = "mpu_pwrdm",
++      .voltdm           = { .name = "mpu" },
++      .prcm_offs        = AM43XX_PRM_MPU_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_OFF_RET_ON,
++      .pwrsts_logic_ret = PWRSTS_OFF_RET,
++      .banks            = 3,
++      .pwrsts_mem_ret = {
++              [0] = PWRSTS_OFF_RET,   /* mpu_l1 */
++              [1] = PWRSTS_OFF_RET,   /* mpu_l2 */
++              [2] = PWRSTS_OFF_RET,   /* mpu_ram */
++      },
++      .pwrsts_mem_on  = {
++              [0] = PWRSTS_ON,        /* mpu_l1 */
++              [1] = PWRSTS_ON,        /* mpu_l2 */
++              [2] = PWRSTS_ON,        /* mpu_ram */
++      },
++      .flags            = PWRDM_HAS_LOWPOWERSTATECHANGE,
++};
++
++static struct powerdomain rtc_43xx_pwrdm = {
++      .name             = "rtc_pwrdm",
++      .voltdm           = { .name = "rtc" },
++      .prcm_offs        = AM43XX_PRM_RTC_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_ON,
++};
++
++static struct powerdomain wkup_43xx_pwrdm = {
++      .name             = "wkup_pwrdm",
++      .voltdm           = { .name = "core" },
++      .prcm_offs        = AM43XX_PRM_WKUP_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_ON,
++      .banks            = 1,
++      .pwrsts_mem_ret = {
++              [0] = PWRSTS_OFF,       /* debugss_mem */
++      },
++      .pwrsts_mem_on  = {
++              [0] = PWRSTS_ON,        /* debugss_mem */
++      },
++};
++
++static struct powerdomain tamper_43xx_pwrdm = {
++      .name             = "tamper_pwrdm",
++      .voltdm           = { .name = "tamper" },
++      .prcm_offs        = AM43XX_PRM_TAMPER_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_ON,
++};
++
++static struct powerdomain cefuse_43xx_pwrdm = {
++      .name             = "cefuse_pwrdm",
++      .voltdm           = { .name = "core" },
++      .prcm_offs        = AM43XX_PRM_CEFUSE_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_OFF_ON,
++      .flags            = PWRDM_HAS_LOWPOWERSTATECHANGE,
++};
++
++static struct powerdomain per_43xx_pwrdm = {
++      .name             = "per_pwrdm",
++      .voltdm           = { .name = "core" },
++      .prcm_offs        = AM43XX_PRM_PER_INST,
++      .prcm_partition   = AM43XX_PRM_PARTITION,
++      .pwrsts           = PWRSTS_OFF_RET_ON,
++      .pwrsts_logic_ret = PWRSTS_OFF_RET,
++      .banks            = 4,
++      .pwrsts_mem_ret = {
++              [0] = PWRSTS_OFF_RET,   /* icss_mem */
++              [1] = PWRSTS_OFF_RET,   /* per_mem */
++              [2] = PWRSTS_OFF_RET,   /* ram1_mem */
++              [3] = PWRSTS_OFF_RET,   /* ram2_mem */
++      },
++      .pwrsts_mem_on  = {
++              [0] = PWRSTS_OFF_RET,   /* icss_mem */
++              [1] = PWRSTS_ON,        /* per_mem */
++              [2] = PWRSTS_OFF_RET,   /* ram1_mem */
++              [3] = PWRSTS_OFF_RET,   /* ram2_mem */
++      },
++      .flags            = PWRDM_HAS_LOWPOWERSTATECHANGE,
++};
++
++static struct powerdomain *powerdomains_am43xx[] __initdata = {
++      &gfx_43xx_pwrdm,
++      &mpu_43xx_pwrdm,
++      &rtc_43xx_pwrdm,
++      &wkup_43xx_pwrdm,
++      &tamper_43xx_pwrdm,
++      &cefuse_43xx_pwrdm,
++      &per_43xx_pwrdm,
++      NULL
++};
++
++static int am43xx_check_vcvp(void)
++{
++      return 0;
++}
++
++void __init am43xx_powerdomains_init(void)
++{
++      omap4_pwrdm_operations.pwrdm_has_voltdm = am43xx_check_vcvp;
++      pwrdm_register_platform_funcs(&omap4_pwrdm_operations);
++      pwrdm_register_pwrdms(powerdomains_am43xx);
++      pwrdm_complete_init();
++}
+--- /dev/null
++++ b/arch/arm/mach-omap2/prcm43xx.h
+@@ -0,0 +1,149 @@
++/*
++ * AM43x PRCM defines
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * This file is licensed under the terms of the GNU General Public License
++ * version 2.  This program is licensed "as is" without any warranty of any
++ * kind, whether express or implied.
++ */
++
++#ifndef __ARCH_ARM_MACH_OMAP2_PRCM_43XX_H
++#define __ARCH_ARM_MACH_OMAP2_PRCM_43XX_H
++
++#define AM43XX_PRM_PARTITION                          1
++#define AM43XX_CM_PARTITION                           1
++
++/* PRM instances */
++#define AM43XX_PRM_OCP_SOCKET_INST                    0x0000
++#define AM43XX_PRM_MPU_INST                           0x0300
++#define AM43XX_PRM_GFX_INST                           0x0400
++#define AM43XX_PRM_RTC_INST                           0x0500
++#define AM43XX_PRM_TAMPER_INST                                0x0600
++#define AM43XX_PRM_CEFUSE_INST                                0x0700
++#define AM43XX_PRM_PER_INST                           0x0800
++#define AM43XX_PRM_WKUP_INST                          0x2000
++#define AM43XX_PRM_DEVICE_INST                                0x4000
++
++/* RM RSTCTRL offsets */
++#define AM43XX_RM_PER_RSTCTRL_OFFSET                  0x0010
++#define AM43XX_RM_GFX_RSTCTRL_OFFSET                  0x0010
++#define AM43XX_RM_WKUP_RSTCTRL_OFFSET                 0x0010
++
++/* RM RSTST offsets */
++#define AM43XX_RM_GFX_RSTST_OFFSET                    0x0014
++#define AM43XX_RM_WKUP_RSTST_OFFSET                   0x0014
++
++/* CM instances */
++#define AM43XX_CM_WKUP_INST                           0x2800
++#define AM43XX_CM_DEVICE_INST                         0x4100
++#define AM43XX_CM_DPLL_INST                           0x4200
++#define AM43XX_CM_MPU_INST                            0x8300
++#define AM43XX_CM_GFX_INST                            0x8400
++#define AM43XX_CM_RTC_INST                            0x8500
++#define AM43XX_CM_TAMPER_INST                         0x8600
++#define AM43XX_CM_CEFUSE_INST                         0x8700
++#define AM43XX_CM_PER_INST                            0x8800
++
++/* CD offsets */
++#define AM43XX_CM_WKUP_L3_AON_CDOFFS                  0x0000
++#define AM43XX_CM_WKUP_L3S_TSC_CDOFFS                 0x0100
++#define AM43XX_CM_WKUP_L4_WKUP_AON_CDOFFS             0x0200
++#define AM43XX_CM_WKUP_WKUP_CDOFFS                    0x0300
++#define AM43XX_CM_MPU_MPU_CDOFFS                      0x0000
++#define AM43XX_CM_GFX_GFX_L3_CDOFFS                   0x0000
++#define AM43XX_CM_RTC_RTC_CDOFFS                      0x0000
++#define AM43XX_CM_TAMPER_TAMPER_CDOFFS                        0x0000
++#define AM43XX_CM_CEFUSE_CEFUSE_CDOFFS                        0x0000
++#define AM43XX_CM_PER_L3_CDOFFS                               0x0000
++#define AM43XX_CM_PER_L3S_CDOFFS                      0x0200
++#define AM43XX_CM_PER_ICSS_CDOFFS                     0x0300
++#define AM43XX_CM_PER_L4LS_CDOFFS                     0x0400
++#define AM43XX_CM_PER_EMIF_CDOFFS                     0x0700
++#define AM43XX_CM_PER_DSS_CDOFFS                      0x0a00
++#define AM43XX_CM_PER_CPSW_CDOFFS                     0x0b00
++#define AM43XX_CM_PER_OCPWP_L3_CDOFFS                 0x0c00
++
++/* CLK CTRL offsets */
++#define AM43XX_CM_PER_UART1_CLKCTRL_OFFSET            0x0580
++#define AM43XX_CM_PER_UART2_CLKCTRL_OFFSET            0x0588
++#define AM43XX_CM_PER_UART3_CLKCTRL_OFFSET            0x0590
++#define AM43XX_CM_PER_UART4_CLKCTRL_OFFSET            0x0598
++#define AM43XX_CM_PER_UART5_CLKCTRL_OFFSET            0x05a0
++#define AM43XX_CM_PER_DCAN0_CLKCTRL_OFFSET            0x0428
++#define AM43XX_CM_PER_DCAN1_CLKCTRL_OFFSET            0x0430
++#define AM43XX_CM_PER_ELM_CLKCTRL_OFFSET              0x0468
++#define AM43XX_CM_PER_EPWMSS0_CLKCTRL_OFFSET          0x0438
++#define AM43XX_CM_PER_EPWMSS1_CLKCTRL_OFFSET          0x0440
++#define AM43XX_CM_PER_EPWMSS2_CLKCTRL_OFFSET          0x0448
++#define AM43XX_CM_PER_GPIO1_CLKCTRL_OFFSET            0x0478
++#define AM43XX_CM_PER_GPIO2_CLKCTRL_OFFSET            0x0480
++#define AM43XX_CM_PER_GPIO3_CLKCTRL_OFFSET            0x0488
++#define AM43XX_CM_PER_I2C1_CLKCTRL_OFFSET             0x04a8
++#define AM43XX_CM_PER_I2C2_CLKCTRL_OFFSET             0x04b0
++#define AM43XX_CM_PER_MAILBOX0_CLKCTRL_OFFSET         0x04b8
++#define AM43XX_CM_PER_MMC0_CLKCTRL_OFFSET             0x04c0
++#define AM43XX_CM_PER_MMC1_CLKCTRL_OFFSET             0x04c8
++#define AM43XX_CM_PER_DES_CLKCTRL_OFFSET              0x0030
++#define AM43XX_CM_PER_RNG_CLKCTRL_OFFSET              0x04e0
++#define AM43XX_CM_PER_SPI0_CLKCTRL_OFFSET             0x0500
++#define AM43XX_CM_PER_SPI1_CLKCTRL_OFFSET             0x0508
++#define AM43XX_CM_PER_SPINLOCK_CLKCTRL_OFFSET         0x0528
++#define AM43XX_CM_PER_TIMER2_CLKCTRL_OFFSET           0x0530
++#define AM43XX_CM_PER_TIMER3_CLKCTRL_OFFSET           0x0538
++#define AM43XX_CM_PER_TIMER4_CLKCTRL_OFFSET           0x0540
++#define AM43XX_CM_PER_TIMER5_CLKCTRL_OFFSET           0x0548
++#define AM43XX_CM_PER_TIMER6_CLKCTRL_OFFSET           0x0550
++#define AM43XX_CM_PER_TIMER7_CLKCTRL_OFFSET           0x0558
++#define AM43XX_CM_WKUP_WKUP_M3_CLKCTRL_OFFSET         0x0228
++#define AM43XX_CM_WKUP_CONTROL_CLKCTRL_OFFSET         0x0360
++#define AM43XX_CM_WKUP_SMARTREFLEX0_CLKCTRL_OFFSET    0x0350
++#define AM43XX_CM_WKUP_SMARTREFLEX1_CLKCTRL_OFFSET    0x0358
++#define AM43XX_CM_WKUP_UART0_CLKCTRL_OFFSET           0x0348
++#define AM43XX_CM_WKUP_TIMER1_CLKCTRL_OFFSET          0x0328
++#define AM43XX_CM_WKUP_I2C0_CLKCTRL_OFFSET            0x0340
++#define AM43XX_CM_WKUP_GPIO0_CLKCTRL_OFFSET           0x0368
++#define AM43XX_CM_WKUP_ADC_TSC_CLKCTRL_OFFSET         0x0120
++#define AM43XX_CM_WKUP_WDT1_CLKCTRL_OFFSET            0x0338
++#define AM43XX_CM_WKUP_L4WKUP_CLKCTRL_OFFSET          0x0220
++#define AM43XX_CM_RTC_RTC_CLKCTRL_OFFSET              0x0020
++#define AM43XX_CM_PER_MMC2_CLKCTRL_OFFSET             0x0248
++#define AM43XX_CM_PER_QSPI_CLKCTRL_OFFSET               0x0258
++#define AM43XX_CM_PER_USB_OTG_SS0_CLKCTRL_OFFSET      0x0260
++#define AM43XX_CM_PER_USBPHYOCP2SCP0_CLKCTRL_OFFSET   0x05B8
++#define AM43XX_CM_PER_USB_OTG_SS1_CLKCTRL_OFFSET        0x0268
++#define AM43XX_CM_PER_USBPHYOCP2SCP1_CLKCTRL_OFFSET   0x05C0
++#define AM43XX_CM_PER_GPMC_CLKCTRL_OFFSET             0x0220
++#define AM43XX_CM_PER_MCASP0_CLKCTRL_OFFSET           0x0238
++#define AM43XX_CM_PER_MCASP1_CLKCTRL_OFFSET           0x0240
++#define AM43XX_CM_PER_L4LS_CLKCTRL_OFFSET             0x0420
++#define AM43XX_CM_PER_L3_CLKCTRL_OFFSET                       0x0020
++#define AM43XX_CM_PER_TPCC_CLKCTRL_OFFSET             0x0078
++#define AM43XX_CM_PER_TPTC0_CLKCTRL_OFFSET            0x0080
++#define AM43XX_CM_PER_TPTC1_CLKCTRL_OFFSET            0x0088
++#define AM43XX_CM_PER_TPTC2_CLKCTRL_OFFSET            0x0090
++#define AM43XX_CM_PER_CPGMAC0_CLKCTRL_OFFSET          0x0b20
++#define AM43XX_CM_PER_PRUSS_CLKCTRL_OFFSET            0x0320
++#define AM43XX_CM_GFX_GFX_CLKCTRL_OFFSET              0x0020
++#define AM43XX_CM_PER_L4HS_CLKCTRL_OFFSET             0x00a0
++#define AM43XX_CM_MPU_MPU_CLKCTRL_OFFSET              0x0020
++#define AM43XX_CM_PER_L3_INSTR_CLKCTRL_OFFSET         0x0040
++#define AM43XX_CM_PER_OCMCRAM_CLKCTRL_OFFSET          0x0050
++#define AM43XX_CM_PER_SHA0_CLKCTRL_OFFSET             0x0058
++#define AM43XX_CM_PER_AES0_CLKCTRL_OFFSET             0x0028
++#define AM43XX_CM_PER_TIMER8_CLKCTRL_OFFSET           0x0560
++#define AM43XX_CM_PER_TIMER9_CLKCTRL_OFFSET           0x0568
++#define AM43XX_CM_PER_TIMER10_CLKCTRL_OFFSET          0x0570
++#define AM43XX_CM_PER_TIMER11_CLKCTRL_OFFSET          0x0578
++#define AM43XX_CM_WKUP_SYNCTIMER_CLKCTRL_OFFSET               0x0230
++#define AM43XX_CM_PER_EPWMSS3_CLKCTRL_OFFSET          0x0450
++#define AM43XX_CM_PER_EPWMSS4_CLKCTRL_OFFSET          0x0458
++#define AM43XX_CM_PER_EPWMSS5_CLKCTRL_OFFSET          0x0460
++#define AM43XX_CM_PER_SPI2_CLKCTRL_OFFSET             0x0510
++#define AM43XX_CM_PER_SPI3_CLKCTRL_OFFSET             0x0518
++#define AM43XX_CM_PER_SPI4_CLKCTRL_OFFSET             0x0520
++#define AM43XX_CM_PER_GPIO4_CLKCTRL_OFFSET            0x0490
++#define AM43XX_CM_PER_GPIO5_CLKCTRL_OFFSET            0x0498
++#define AM43XX_CM_PER_DSS_CLKCTRL_OFFSET              0x0a20
++
++#endif
+--- a/arch/arm/mach-omap2/prminst44xx.c
++++ b/arch/arm/mach-omap2/prminst44xx.c
+@@ -182,12 +182,10 @@ void omap4_prminst_global_warm_sw_reset(
+       v = omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION, dev_inst,
+                                       OMAP4_PRM_RSTCTRL_OFFSET);
+       v |= OMAP4430_RST_GLOBAL_WARM_SW_MASK;
+-      omap4_prminst_write_inst_reg(v, OMAP4430_PRM_PARTITION,
+-                               OMAP4430_PRM_DEVICE_INST,
++      omap4_prminst_write_inst_reg(v, OMAP4430_PRM_PARTITION, dev_inst,
+                                OMAP4_PRM_RSTCTRL_OFFSET);
+       /* OCP barrier */
+-      v = omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION,
+-                                  OMAP4430_PRM_DEVICE_INST,
++      v = omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION, dev_inst,
+                                   OMAP4_PRM_RSTCTRL_OFFSET);
+ }
+--- /dev/null
++++ b/arch/arm/mach-omap2/sleep33xx.S
+@@ -0,0 +1,362 @@
++/*
++ * Low level suspend code for AM33XX SoCs
++ *
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com/
++ * Vaibhav Bedia <vaibhav.bedia@ti.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/linkage.h>
++#include <linux/ti_emif.h>
++#include <asm/memory.h>
++#include <asm/assembler.h>
++
++#include "cm33xx.h"
++#include "pm33xx.h"
++#include "prm33xx.h"
++
++#define EMIF_POWER_MGMT_WAIT_SELF_REFRESH_8192_CYCLES         0x00a0
++#define EMIF_POWER_MGMT_SR_TIMER_MASK                                 0x00f0
++
++#define EMIF_POWER_MGMT_SELF_REFRESH_MODE                             0x0200
++#define EMIF_POWER_MGMT_SELF_REFRESH_MODE_MASK                0x0700
++#define EMIF_POWER_MGMT_DELAY_PERIOD                                  0x1000
++
++#define AM33XX_CM_CLKCTRL_MODULEMODE_DISABLE                  0x0003
++#define AM33XX_CM_CLKCTRL_MODULEMODE_ENABLE                           0x0002
++
++      .text
++      .align 3
++
++/*
++ * This routine is executed from internal RAM and expects some
++ * parameters to be passed in r0 _strictly_ in following order:
++ * 1) emif_addr_virt - ioremapped EMIF address
++ * 2) mem_type - 2 -> DDR2, 3-> DDR3
++ * 3) dram_sync_word - uncached word in SDRAM
++ *
++ * The code loads these values taking r0 value as reference to
++ * the array in registers starting from r0, i.e emif_addr_virt
++ * goes to r1, mem_type goes to r2 and and so on. These are
++ * then saved into memory locations before proceeding with the
++ * sleep sequence and hence registers r0, r1 etc can still be
++ * used in the rest of the sleep code.
++ */
++
++ENTRY(am33xx_do_wfi)
++      stmfd   sp!, {r4 - r11, lr}     @ save registers on stack
++
++      ldm     r0, {r1-r3}             @ gather values passed
++
++      /* Save the values passed */
++      str     r1, emif_addr_virt
++      str     r2, mem_type
++      str     r3, dram_sync_word
++
++      /*
++       * Flush all data from the L1 and L2 data cache before disabling
++       * SCTLR.C bit.
++       */
++      ldr     r1, kernel_flush
++      blx     r1
++
++      /*
++       * Clear the SCTLR.C bit to prevent further data cache
++       * allocation. Clearing SCTLR.C would make all the data accesses
++       * strongly ordered and would not hit the cache.
++       */
++      mrc     p15, 0, r0, c1, c0, 0
++      bic     r0, r0, #(1 << 2)       @ Disable the C bit
++      mcr     p15, 0, r0, c1, c0, 0
++      isb
++
++      /*
++       * Invalidate L1 and L2 data cache.
++       */
++      ldr     r1, kernel_flush
++      blx     r1
++
++      ldr     r0, emif_addr_virt
++      /* Save EMIF configuration */
++      ldr     r1, [r0, #EMIF_SDRAM_CONFIG]
++      str     r1, emif_sdcfg_val
++      ldr     r1, [r0, #EMIF_SDRAM_REFRESH_CONTROL]
++      str     r1, emif_ref_ctrl_val
++      ldr     r1, [r0, #EMIF_SDRAM_TIMING_1]
++      str     r1, emif_timing1_val
++      ldr     r1, [r0, #EMIF_SDRAM_TIMING_2]
++      str     r1, emif_timing2_val
++      ldr     r1, [r0, #EMIF_SDRAM_TIMING_3]
++      str     r1, emif_timing3_val
++      ldr     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      str     r1, emif_pmcr_val
++      ldr     r1, [r0, #EMIF_POWER_MANAGEMENT_CTRL_SHDW]
++      str     r1, emif_pmcr_shdw_val
++      ldr     r1, [r0, #EMIF_SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG]
++      str     r1, emif_zqcfg_val
++      ldr     r1, [r0, #EMIF_DDR_PHY_CTRL_1]
++      str     r1, emif_rd_lat_val
++
++      /* Put SDRAM in self-refresh */
++      ldr     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      bic     r1, r1, #EMIF_POWER_MGMT_SR_TIMER_MASK
++      orr     r1, r1, #EMIF_POWER_MGMT_WAIT_SELF_REFRESH_8192_CYCLES
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CTRL_SHDW]
++
++      ldr     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      bic     r1, r1, #EMIF_POWER_MGMT_SELF_REFRESH_MODE_MASK
++      orr     r1, r1, #EMIF_POWER_MGMT_SELF_REFRESH_MODE
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++
++      ldr     r1, dram_sync_word      @ a dummy access to DDR as per spec
++      ldr     r2, [r1, #0]
++
++
++      mov     r1, #EMIF_POWER_MGMT_DELAY_PERIOD       @ Wait for system
++wait_self_refresh:                                    @ to enter SR
++      subs    r1, r1, #1
++      bne     wait_self_refresh
++
++      /* Disable EMIF */
++      ldr     r1, virt_emif_clkctrl
++      ldr     r2, [r1]
++      bic     r2, r2, #AM33XX_CM_CLKCTRL_MODULEMODE_DISABLE
++      str     r2, [r1]
++
++      ldr     r1, virt_emif_clkctrl
++wait_emif_disable:
++      ldr     r2, [r1]
++      ldr     r3, module_disabled_val
++      cmp     r2, r3
++      bne     wait_emif_disable
++
++      /*
++       * For the MPU WFI to be registered as an interrupt
++       * to WKUP_M3, MPU_CLKCTRL.MODULEMODE needs to be set
++       * to DISABLED
++       */
++      ldr     r1, virt_mpu_clkctrl
++      ldr     r2, [r1]
++      bic     r2, r2, #AM33XX_CM_CLKCTRL_MODULEMODE_DISABLE
++      str     r2, [r1]
++
++      /*
++       * Execute an ISB instruction to ensure that all of the
++       * CP15 register changes have been committed.
++       */
++      isb
++
++      /*
++       * Execute a barrier instruction to ensure that all cache,
++       * TLB and branch predictor maintenance operations issued
++       * have completed.
++       */
++      dsb
++      dmb
++
++      /*
++       * Execute a WFI instruction and wait until the
++       * STANDBYWFI output is asserted to indicate that the
++       * CPU is in idle and low power state. CPU can specualatively
++       * prefetch the instructions so add NOPs after WFI. Thirteen
++       * NOPs as per Cortex-A8 pipeline.
++       */
++      wfi
++
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++      nop
++
++      /* We come here in case of an abort due to a late interrupt */
++
++      /* Set MPU_CLKCTRL.MODULEMODE back to ENABLE */
++      ldr     r1, virt_mpu_clkctrl
++      mov     r2, #AM33XX_CM_CLKCTRL_MODULEMODE_ENABLE
++      str     r2, [r1]
++
++      /* Re-enable EMIF */
++      ldr     r1, virt_emif_clkctrl
++      mov     r2, #AM33XX_CM_CLKCTRL_MODULEMODE_ENABLE
++      str     r2, [r1]
++wait_emif_enable:
++      ldr     r3, [r1]
++      cmp     r2, r3
++      bne     wait_emif_enable
++
++      /* Disable EMIF self-refresh */
++      ldr     r0, emif_addr_virt
++      ldr     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      bic     r1, r1, #LP_MODE_MASK
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CTRL_SHDW]
++
++      /*
++       * A write to SDRAM CONFIG register triggers
++       * an init sequence and hence it must be done
++       * at the end for DDR2
++       */
++      ldr r0, emif_addr_virt
++      add r0, r0, #EMIF_SDRAM_CONFIG
++      ldr r4, emif_sdcfg_val
++      str r4, [r0]
++
++      /*
++       * Set SCTLR.C bit to allow data cache allocation
++       */
++      mrc     p15, 0, r0, c1, c0, 0
++      orr     r0, r0, #(1 << 2)       @ Enable the C bit
++      mcr     p15, 0, r0, c1, c0, 0
++      isb
++
++      /* EMIF needs some time before read/write possible */
++      mov r0, #EMIF_POWER_MGMT_DELAY_PERIOD
++wait_abt:
++      subs   r0, r0, #1
++      bne wait_abt
++
++      /* Let the suspend code know about the abort */
++      mov     r0, #1
++      ldmfd   sp!, {r4 - r11, pc}     @ restore regs and return
++ENDPROC(am33xx_do_wfi)
++
++      .align
++ENTRY(am33xx_resume_offset)
++      .word . - am33xx_do_wfi
++
++ENTRY(am33xx_resume_from_deep_sleep)
++      /* Re-enable EMIF */
++      ldr     r0, phys_emif_clkctrl
++      mov     r1, #AM33XX_CM_CLKCTRL_MODULEMODE_ENABLE
++      str     r1, [r0]
++wait_emif_enable1:
++      ldr     r2, [r0]
++      cmp     r1, r2
++      bne     wait_emif_enable1
++
++      /* Config EMIF Timings */
++      ldr     r0, emif_phys_addr
++      ldr     r1, emif_rd_lat_val
++      str     r1, [r0, #EMIF_DDR_PHY_CTRL_1]
++      str     r1, [r0, #EMIF_DDR_PHY_CTRL_1_SHDW]
++      ldr     r1, emif_timing1_val
++      str     r1, [r0, #EMIF_SDRAM_TIMING_1]
++      str     r1, [r0, #EMIF_SDRAM_TIMING_1_SHDW]
++      ldr     r1, emif_timing2_val
++      str     r1, [r0, #EMIF_SDRAM_TIMING_2]
++      str     r1, [r0, #EMIF_SDRAM_TIMING_2_SHDW]
++      ldr     r1, emif_timing3_val
++      str     r1, [r0, #EMIF_SDRAM_TIMING_3]
++      str     r1, [r0, #EMIF_SDRAM_TIMING_3_SHDW]
++      ldr     r1, emif_ref_ctrl_val
++      str     r1, [r0, #EMIF_SDRAM_REFRESH_CONTROL]
++      str     r1, [r0, #EMIF_SDRAM_REFRESH_CTRL_SHDW]
++      ldr     r1, emif_pmcr_val
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CONTROL]
++      ldr     r1, emif_pmcr_shdw_val
++      str     r1, [r0, #EMIF_POWER_MANAGEMENT_CTRL_SHDW]
++
++      /*
++       * Output impedence calib needed only for DDR3
++       * but since the initial state of this will be
++       * disabled for DDR2 no harm in restoring the
++       * old configuration
++       */
++      ldr     r1, emif_zqcfg_val
++      str     r1, [r0, #EMIF_SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG]
++
++      /* Write to SDRAM_CONFIG only for DDR2 */
++      ldr     r2, mem_type
++      cmp     r2, #MEM_TYPE_DDR2
++      bne     resume_to_ddr
++
++      /*
++       * A write to SDRAM CONFIG register triggers
++       * an init sequence and hence it must be done
++       * at the end for DDR2
++       */
++      ldr     r1, emif_sdcfg_val
++      str     r1, [r0, #EMIF_SDRAM_CONFIG]
++
++resume_to_ddr:
++      /* EMIF needs some time before read/write possible */
++      mov     r0, #EMIF_POWER_MGMT_DELAY_PERIOD
++wait_resume:
++      subs    r0, r0, #1
++      bne     wait_resume
++
++      /* We are back. Branch to the common CPU resume routine */
++      mov     r0, #0
++      ldr     pc, resume_addr
++ENDPROC(am33xx_resume_from_deep_sleep)
++
++
++/*
++ * Local variables
++ */
++      .align
++resume_addr:
++      .word   cpu_resume - PAGE_OFFSET + 0x80000000
++kernel_flush:
++      .word   v7_flush_dcache_all
++ddr_start:
++      .word   PAGE_OFFSET
++emif_phys_addr:
++      .word   AM33XX_EMIF_BASE
++virt_mpu_clkctrl:
++      .word   AM33XX_CM_MPU_MPU_CLKCTRL
++virt_emif_clkctrl:
++      .word   AM33XX_CM_PER_EMIF_CLKCTRL
++phys_emif_clkctrl:
++      .word   (AM33XX_CM_BASE + AM33XX_CM_PER_MOD + \
++              AM33XX_CM_PER_EMIF_CLKCTRL_OFFSET)
++module_disabled_val:
++      .word   0x30000
++
++/* DDR related defines */
++dram_sync_word:
++      .word   0xDEADBEEF
++mem_type:
++      .word   0xDEADBEEF
++emif_addr_virt:
++      .word   0xDEADBEEF
++emif_rd_lat_val:
++      .word   0xDEADBEEF
++emif_timing1_val:
++      .word   0xDEADBEEF
++emif_timing2_val:
++      .word   0xDEADBEEF
++emif_timing3_val:
++      .word   0xDEADBEEF
++emif_sdcfg_val:
++      .word   0xDEADBEEF
++emif_ref_ctrl_val:
++      .word   0xDEADBEEF
++emif_zqcfg_val:
++      .word   0xDEADBEEF
++emif_pmcr_val:
++      .word   0xDEADBEEF
++emif_pmcr_shdw_val:
++      .word   0xDEADBEEF
++
++      .align 3
++ENTRY(am33xx_do_wfi_sz)
++      .word   . - am33xx_do_wfi
+--- a/arch/arm/mach-omap2/sleep44xx.S
++++ b/arch/arm/mach-omap2/sleep44xx.S
+@@ -330,6 +330,141 @@ skip_l2en:
+ ENDPROC(omap4_cpu_resume)
+ #endif        /* CONFIG_ARCH_OMAP4 */
++#ifdef CONFIG_SOC_OMAP5
++/*
++ * ================================
++ * == OMAP5 CPU suspend finisher ==
++ * ================================
++ *
++ * OMAP5 MPUSS states for the context save:
++ * save_state =
++ *    0 - Nothing lost and no need to save: MPUSS INA/CSWR
++ *    1 - CPUx L1 and logic lost: CPU OFF, MPUSS INA/CSWR
++ *    2 - CPUx L1 and logic lost + GIC lost: MPUSS OSWR
++ *    3 - CPUx L1 and logic lost + GIC + L2 lost: DEVICE OFF
++ */
++ENTRY(omap5_finish_suspend)
++      stmfd   sp!, {r4-r12, lr}
++      cmp     r0, #0x0
++      beq     do_wfi                          @ No lowpower state, jump to WFI
++
++      /*
++       * Flush all data from the L1 data cache before disabling
++       * SCTLR.C bit.
++       */
++      bl      omap4_get_sar_ram_base
++      ldr     r9, [r0, #OMAP_TYPE_OFFSET]
++      cmp     r9, #0x1                        @ Check for HS device
++      bne     skip_secure_l1_clean_op
++      mov     r0, #0                          @ Clean secure L1
++      stmfd   r13!, {r4-r12, r14}
++      ldr     r12, =OMAP5_MON_CACHES_CLEAN_INDEX
++      DO_SMC
++      ldmfd   r13!, {r4-r12, r14}
++skip_secure_l1_clean_op:
++      bl      v7_flush_dcache_louis
++
++      /*
++       * Clear the SCTLR.C bit to prevent further data cache
++       * allocation. Clearing SCTLR.C would make all the data accesses
++       * strongly ordered and would not hit the cache.
++       */
++      mrc     p15, 0, r0, c1, c0, 0
++      bic     r0, r0, #(1 << 2)               @ Disable the C bit
++      mcr     p15, 0, r0, c1, c0, 0
++      isb
++
++      /* Clean and Invalidate L1 data cache. */
++      bl      v7_flush_dcache_louis
++
++      /*
++       * Take CPU out of Symmetric Multiprocessing (SMP) mode and thus
++       * preventing the CPU from receiving cache, TLB, or BTB
++       * maintenance operations broadcast by other CPUs in the cluster.
++       */
++      mrc     p15, 0, r0, c1, c1, 2           @ Read NSACR data
++      tst     r0, #(1 << 18)
++      mrcne   p15, 0, r0, c1, c0, 1
++      bicne   r0, r0, #(1 << 6)               @ Disable SMP bit
++      mcrne   p15, 0, r0, c1, c0, 1
++      isb
++      dsb
++
++      bl      omap4_get_sar_ram_base
++      mov     r8, r0
++      mrc     p15, 0, r5, c0, c0, 5           @ Read MPIDR
++      ands    r5, r5, #0x0f
++      ldreq   r0, [r8, #L2X0_SAVE_OFFSET0]    @ Retrieve L2 state
++      ldrne   r0, [r8, #L2X0_SAVE_OFFSET1]
++      cmp     r0, #3
++      bne     do_wfi
++      bl      omap4_get_sar_ram_base
++      ldr     r9, [r0, #OMAP_TYPE_OFFSET]
++      cmp     r9, #0x1                        @ Check for HS device
++      bne     skip_secure_l2_clean_op
++      mov     r0, #1                          @ Clean secure L2
++      stmfd   r13!, {r4-r12, r14}
++      ldr     r12, =OMAP5_MON_CACHES_CLEAN_INDEX
++      DO_SMC
++      ldmfd   r13!, {r4-r12, r14}
++skip_secure_l2_clean_op:
++      mov     r0, #2                          @ Flush L2
++      bl      v7_flush_dcache_all
++
++do_wfi:
++      bl      omap_do_wfi
++
++      /*
++       * CPU is here when it failed to enter OFF/DORMANT or
++       * no low power state was attempted.
++       */
++      mrc     p15, 0, r0, c1, c0, 0
++      tst     r0, #(1 << 2)                   @ Check C bit enabled?
++      orreq   r0, r0, #(1 << 2)               @ Enable the C bit
++      mcreq   p15, 0, r0, c1, c0, 0
++      isb
++      mrc     p15, 0, r0, c1, c0, 1
++      tst     r0, #(1 << 6)                   @ Check SMP bit enabled?
++      orreq   r0, r0, #(1 << 6)
++      mcreq   p15, 0, r0, c1, c0, 1
++      isb
++      dsb
++      ldmfd   sp!, {r4-r12, pc}
++ENDPROC(omap5_finish_suspend)
++
++ENTRY(omap5_cpu_resume)
++#ifdef CONFIG_ARM_ERRATA_761171
++      /*
++       * Work around for errata for 761171. Streaming write that will not
++       * allocate in L2 could lead to data corruption.
++       */
++      mrc     p15, 0, r0, c0, c0, 0           @ read main ID register
++      and     r5, r0, #0x00f00000             @ variant
++      and     r6, r0, #0x0000000f             @ revision
++      orr     r6, r6, r5, lsr #20-4           @ combine variant and revision
++      cmp     r6, #0x03                       @ Present before r0p3
++      bgt     1f
++      mrc     p15, 0, r0, c1, c0, 1           @ Read Auxctrl
++      orr     r0, r0, #0x3 << 27              @ bits[28:27]-L1_mode3_threshold
++      ldr     r12, =OMAP5_MON_AUX_CTRL_INDEX
++      dsb
++      smc     #0
++      dsb
++1:
++#endif
++      mrc     p15, 1, r0, c15, c0, 0          @ Read L2 ACTLR
++      cmp     r0, #0x118                      @ Check if it is already set
++      beq     skip_sec_l2
++      ldr     r0, =0x118                      @ Setup L2 ACTLR = 0x118
++      ldr     r12, =OMAP5_MON_L2AUX_CTRL_INDEX
++      dsb
++      smc     #0
++      dsb
++skip_sec_l2:
++      b       cpu_resume                      @ Jump to generic resume
++ENDPROC(omap5_cpu_resume)
++#endif        /* CONFIG_SOC_OMAP5 */
++
+ #endif        /* defined(CONFIG_SMP) && defined(CONFIG_PM) */
+ #ifndef CONFIG_OMAP4_ERRATA_I688
+--- a/arch/arm/mach-omap2/sram.c
++++ b/arch/arm/mach-omap2/sram.c
+@@ -154,7 +154,7 @@ static void __init omap2_map_sram(void)
+               omap_sram_size -= SZ_16K;
+       }
+ #endif
+-      if (cpu_is_omap34xx()) {
++      if (cpu_is_omap34xx() || soc_is_am33xx()) {
+               /*
+                * SRAM must be marked as non-cached on OMAP3 since the
+                * CORE DPLL M2 divider change code (in SRAM) runs with the
+@@ -285,10 +285,18 @@ static inline int omap34xx_sram_init(voi
+ }
+ #endif /* CONFIG_ARCH_OMAP3 */
++#ifdef CONFIG_SOC_AM33XX
+ static inline int am33xx_sram_init(void)
+ {
++      am33xx_push_sram_idle();
+       return 0;
+ }
++#else
++static inline int am33xx_sram_init(void)
++{
++      return 0;
++}
++#endif
+ int __init omap_sram_init(void)
+ {
+--- a/arch/arm/mach-omap2/sram.h
++++ b/arch/arm/mach-omap2/sram.h
+@@ -62,8 +62,10 @@ extern unsigned long omap3_sram_configur
+ #ifdef CONFIG_PM
+ extern void omap_push_sram_idle(void);
++extern void am33xx_push_sram_idle(void);
+ #else
+ static inline void omap_push_sram_idle(void) {}
++static inline void am33xx_push_sram_idle(void) {}
+ #endif /* CONFIG_PM */
+ #endif /* __ASSEMBLY__ */
+--- a/arch/arm/mach-omap2/timer.c
++++ b/arch/arm/mach-omap2/timer.c
+@@ -55,6 +55,7 @@
+ #include "soc.h"
+ #include "common.h"
+ #include "powerdomain.h"
++#include "omap-secure.h"
+ #define REALTIME_COUNTER_BASE                         0x48243200
+ #define INCREMENTER_NUMERATOR_OFFSET                  0x10
+@@ -65,6 +66,7 @@
+ static struct omap_dm_timer clkev;
+ static struct clock_event_device clockevent_gpt;
++unsigned long arch_timer_freq;
+ static irqreturn_t omap2_gp_timer_interrupt(int irq, void *dev_id)
+ {
+@@ -118,6 +120,29 @@ static void omap2_gp_timer_set_mode(enum
+       }
+ }
++static void omap_clkevt_suspend(struct clock_event_device *unused)
++{
++      struct omap_hwmod *oh;
++
++      oh = omap_hwmod_lookup(clockevent_gpt.name);
++      if (!oh)
++              return;
++
++      omap_hwmod_idle(oh);
++}
++
++static void omap_clkevt_resume(struct clock_event_device *unused)
++{
++      struct omap_hwmod *oh;
++
++      oh = omap_hwmod_lookup(clockevent_gpt.name);
++      if (!oh)
++              return;
++
++      omap_hwmod_enable(oh);
++      __omap_dm_timer_int_enable(&clkev, OMAP_TIMER_INT_OVERFLOW);
++}
++
+ static struct clock_event_device clockevent_gpt = {
+       .features       = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
+       .rating         = 300,
+@@ -276,8 +301,13 @@ static int __init omap_dm_timer_init_one
+       if (!timer->io_base)
+               return -ENXIO;
++      omap_hwmod_setup_one(oh_name);
++
+       /* After the dmtimer is using hwmod these clocks won't be needed */
+-      timer->fclk = clk_get(NULL, omap_hwmod_get_main_clk(oh));
++      if (oh->_clk)
++              timer->fclk = oh->_clk;
++      else
++              timer->fclk = clk_get(NULL, omap_hwmod_get_main_clk(oh));
+       if (IS_ERR(timer->fclk))
+               return PTR_ERR(timer->fclk);
+@@ -297,7 +327,6 @@ static int __init omap_dm_timer_init_one
+       clk_put(src);
+-      omap_hwmod_setup_one(oh_name);
+       omap_hwmod_enable(oh);
+       __omap_dm_timer_init_regs(timer);
+@@ -323,6 +352,11 @@ static void __init omap2_gp_clockevent_i
+       clkev.id = gptimer_id;
+       clkev.errata = omap_dm_timer_get_errata();
++      if (soc_is_am33xx()) {
++              clockevent_gpt.suspend = omap_clkevt_suspend;
++              clockevent_gpt.resume = omap_clkevt_resume;
++      }
++
+       /*
+        * For clock-event timers we never read the timer counter and
+        * so we are not impacted by errata i103 and i767. Therefore,
+@@ -515,6 +549,10 @@ static void __init realtime_counter_init
+               num = 8;
+               den = 25;
+               break;
++      case 20000000:
++              num = 192;
++              den = 625;
++              break;
+       case 2600000:
+               num = 384;
+               den = 1625;
+@@ -542,6 +580,9 @@ static void __init realtime_counter_init
+       reg |= den;
+       __raw_writel(reg, base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET);
++      arch_timer_freq = (rate / den) * num;
++      omap_smc1(OMAP5_DRA7_MON_SET_CNTFRQ_INDEX, arch_timer_freq);
++
+       iounmap(base);
+ }
+ #else
+--- a/arch/arm/mach-omap2/twl-common.c
++++ b/arch/arm/mach-omap2/twl-common.c
+@@ -24,6 +24,7 @@
+ #include <linux/i2c/twl.h>
+ #include <linux/gpio.h>
+ #include <linux/string.h>
++#include <linux/phy/phy.h>
+ #include <linux/regulator/machine.h>
+ #include <linux/regulator/fixed.h>
+@@ -90,8 +91,18 @@ void __init omap_pmic_late_init(void)
+ }
+ #if defined(CONFIG_ARCH_OMAP3)
++struct phy_consumer consumers[] = {
++      PHY_CONSUMER("musb-hdrc.0", "usb"),
++};
++
++struct phy_init_data init_data = {
++      .consumers = consumers,
++      .num_consumers = ARRAY_SIZE(consumers),
++};
++
+ static struct twl4030_usb_data omap3_usb_pdata = {
+       .usb_mode       = T2_USB_MODE_ULPI,
++      .init_data      = &init_data,
+ };
+ static int omap3_batt_table[] = {
+--- a/arch/arm/mach-omap2/usb.h
++++ b/arch/arm/mach-omap2/usb.h
+@@ -58,7 +58,6 @@ struct usbhs_phy_data {
+       int reset_gpio;
+       int vcc_gpio;
+       bool vcc_polarity;      /* 1 active high, 0 active low */
+-      void *platform_data;
+ };
+ extern void usb_musb_init(struct omap_musb_board_data *board_data);
+--- a/arch/arm/mach-omap2/usb-host.c
++++ b/arch/arm/mach-omap2/usb-host.c
+@@ -435,6 +435,7 @@ int usbhs_init_phys(struct usbhs_phy_dat
+       struct platform_device *pdev;
+       char *phy_id;
+       struct platform_device_info pdevinfo;
++      struct usb_phy_gen_xceiv_platform_data nop_pdata;
+       for (i = 0; i < num_phys; i++) {
+@@ -455,11 +456,18 @@ int usbhs_init_phys(struct usbhs_phy_dat
+                       return -ENOMEM;
+               }
++              /* set platform data */
++              memset(&nop_pdata, 0, sizeof(nop_pdata));
++              if (gpio_is_valid(phy->vcc_gpio))
++                      nop_pdata.needs_vcc = true;
++              nop_pdata.gpio_reset = phy->reset_gpio;
++              nop_pdata.type = USB_PHY_TYPE_USB2;
++
+               /* create a NOP PHY device */
+               memset(&pdevinfo, 0, sizeof(pdevinfo));
+               pdevinfo.name = nop_name;
+               pdevinfo.id = phy->port;
+-              pdevinfo.data = phy->platform_data;
++              pdevinfo.data = &nop_pdata;
+               pdevinfo.size_data =
+                       sizeof(struct usb_phy_gen_xceiv_platform_data);
+               scnprintf(phy_id, MAX_STR, "usb_phy_gen_xceiv.%d",
+@@ -474,14 +482,6 @@ int usbhs_init_phys(struct usbhs_phy_dat
+               usb_bind_phy("ehci-omap.0", phy->port - 1, phy_id);
+-              /* Do we need RESET regulator ? */
+-              if (gpio_is_valid(phy->reset_gpio)) {
+-                      scnprintf(rail_name, MAX_STR,
+-                                      "hsusb%d_reset", phy->port);
+-                      usbhs_add_regulator(rail_name, phy_id, "reset",
+-                                              phy->reset_gpio, 1);
+-              }
+-
+               /* Do we need VCC regulator ? */
+               if (gpio_is_valid(phy->vcc_gpio)) {
+                       scnprintf(rail_name, MAX_STR, "hsusb%d_vcc", phy->port);
+--- a/arch/arm/mach-omap2/wd_timer.c
++++ b/arch/arm/mach-omap2/wd_timer.c
+@@ -123,6 +123,11 @@ static int __init omap_init_wdt(void)
+       pdata.read_reset_sources = prm_read_reset_sources;
++      if (cpu_is_omap44xx() || soc_is_omap54xx())
++              pdata.ip_rev = WDTIMER2_IP4;
++      else
++              pdata.ip_rev = WDTIMER2_IP3;
++
+       pdev = omap_device_build(dev_name, id, oh, &pdata,
+                                sizeof(struct omap_wd_timer_platform_data));
+       WARN(IS_ERR(pdev), "Can't build omap_device for %s:%s.\n",
+--- /dev/null
++++ b/arch/arm/mach-omap2/wkup_m3.c
+@@ -0,0 +1,410 @@
++/*
++* AM33XX Power Management Routines
++ *
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com/
++ * Vaibhav Bedia <vaibhav.bedia@ti.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/init.h>
++#include <linux/slab.h>
++#include <linux/cpu.h>
++#include <linux/err.h>
++#include <linux/firmware.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <linux/pm_runtime.h>
++#include <linux/module.h>
++#include <linux/interrupt.h>
++#include <linux/of.h>
++#include <linux/omap-mailbox.h>
++
++#include "pm33xx.h"
++#include "omap_device.h"
++
++#define WKUP_M3_WAKE_SRC_MASK                 0xFF
++
++#define WKUP_M3_STATUS_RESP_SHIFT             16
++#define WKUP_M3_STATUS_RESP_MASK              (0xffff << 16)
++
++#define WKUP_M3_FW_VERSION_SHIFT              0
++#define WKUP_M3_FW_VERSION_MASK                       0xffff
++
++/* AM33XX M3_TXEV_EOI register */
++#define AM33XX_CONTROL_M3_TXEV_EOI    0x00
++
++#define AM33XX_M3_TXEV_ACK            (0x1 << 0)
++#define AM33XX_M3_TXEV_ENABLE         (0x0 << 0)
++
++/* AM33XX IPC message registers */
++#define AM33XX_CONTROL_IPC_MSG_REG0   0x04
++#define AM33XX_CONTROL_IPC_MSG_REG1   0x08
++#define AM33XX_CONTROL_IPC_MSG_REG2   0x0c
++#define AM33XX_CONTROL_IPC_MSG_REG3   0x10
++#define AM33XX_CONTROL_IPC_MSG_REG4   0x14
++#define AM33XX_CONTROL_IPC_MSG_REG5   0x18
++#define AM33XX_CONTROL_IPC_MSG_REG6   0x1c
++#define AM33XX_CONTROL_IPC_MSG_REG7   0x20
++
++struct wkup_m3_context {
++      struct device   *dev;
++      void __iomem    *code;
++      void __iomem    *ipc;
++      u8              is_valid;
++      struct wkup_m3_ops *ops;
++      struct omap_mbox *mbox;
++};
++
++struct wkup_m3_wakeup_src wakeups[] = {
++      {.irq_nr = 35,  .src = "USB0_PHY"},
++      {.irq_nr = 36,  .src = "USB1_PHY"},
++      {.irq_nr = 40,  .src = "I2C0"},
++      {.irq_nr = 41,  .src = "RTC Timer"},
++      {.irq_nr = 42,  .src = "RTC Alarm"},
++      {.irq_nr = 43,  .src = "Timer0"},
++      {.irq_nr = 44,  .src = "Timer1"},
++      {.irq_nr = 45,  .src = "UART"},
++      {.irq_nr = 46,  .src = "GPIO0"},
++      {.irq_nr = 48,  .src = "MPU_WAKE"},
++      {.irq_nr = 49,  .src = "WDT0"},
++      {.irq_nr = 50,  .src = "WDT1"},
++      {.irq_nr = 51,  .src = "ADC_TSC"},
++      {.irq_nr = 0,   .src = "Unknown"},
++};
++
++static struct wkup_m3_context *wkup_m3;
++
++static void am33xx_txev_eoi(void)
++{
++      writel(AM33XX_M3_TXEV_ACK,
++              wkup_m3->ipc + AM33XX_CONTROL_M3_TXEV_EOI);
++}
++
++static void am33xx_txev_enable(void)
++{
++      writel(AM33XX_M3_TXEV_ENABLE,
++              wkup_m3->ipc + AM33XX_CONTROL_M3_TXEV_EOI);
++}
++
++static void am33xx_ctrl_ipc_write(struct am33xx_ipc_regs *ipc_regs)
++{
++      writel(ipc_regs->reg0,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG0);
++      writel(ipc_regs->reg1,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG1);
++      writel(ipc_regs->reg2,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG2);
++      writel(ipc_regs->reg3,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG3);
++      writel(ipc_regs->reg4,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG4);
++      writel(ipc_regs->reg5,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG5);
++      writel(ipc_regs->reg6,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG6);
++      writel(ipc_regs->reg7,
++              wkup_m3->ipc + AM33XX_CONTROL_IPC_MSG_REG7);
++}
++
++static void am33xx_ctrl_ipc_read(struct am33xx_ipc_regs *ipc_regs)
++{
++      ipc_regs->reg0 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG0);
++      ipc_regs->reg1 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG1);
++      ipc_regs->reg2 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG2);
++      ipc_regs->reg3 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG3);
++      ipc_regs->reg4 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG4);
++      ipc_regs->reg5 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG5);
++      ipc_regs->reg6 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG6);
++      ipc_regs->reg7 = readl(wkup_m3->ipc
++                                      + AM33XX_CONTROL_IPC_MSG_REG7);
++}
++
++int wkup_m3_is_valid()
++{
++      return wkup_m3->is_valid;
++}
++
++int wkup_m3_ping(void)
++{
++      int ret = 0;
++
++      if (!wkup_m3->mbox) {
++              pr_err("PM: No IPC channel to communicate with wkup_m3!\n");
++              return -EIO;
++      }
++
++      /*
++       * Write a dummy message to the mailbox in order to trigger the RX
++       * interrupt to alert the M3 that data is available in the IPC
++       * registers.
++       */
++      ret = omap_mbox_msg_send(wkup_m3->mbox, 0xABCDABCD);
++
++      return ret;
++}
++
++struct wkup_m3_wakeup_src wkup_m3_wake_src(void)
++{
++      struct am33xx_ipc_regs ipc_regs;
++      unsigned int wakeup_src_idx;
++      int j;
++
++      am33xx_ctrl_ipc_read(&ipc_regs);
++
++      wakeup_src_idx = ipc_regs.reg6 & WKUP_M3_WAKE_SRC_MASK;
++
++      for (j = 0; j < ARRAY_SIZE(wakeups)-1; j++) {
++              if (wakeups[j].irq_nr == wakeup_src_idx)
++                      return wakeups[j];
++      }
++
++      return wakeups[j];
++}
++
++
++int wkup_m3_pm_status(void)
++{
++      unsigned int i;
++      struct am33xx_ipc_regs ipc_regs;
++
++      am33xx_ctrl_ipc_read(&ipc_regs);
++
++      i = WKUP_M3_STATUS_RESP_MASK & ipc_regs.reg1;
++      i >>= __ffs(WKUP_M3_STATUS_RESP_MASK);
++
++      return i;
++}
++
++/*
++ * Invalidate M3 firmware version before hardreset.
++ * Write invalid version in lower 4 nibbles of parameter
++ * register (ipc_regs + 0x8).
++ */
++
++static void wkup_m3_fw_version_clear(void)
++{
++      struct am33xx_ipc_regs ipc_regs;
++
++      am33xx_ctrl_ipc_read(&ipc_regs);
++      ipc_regs.reg2 = 0xFFFF0000;
++      am33xx_ctrl_ipc_write(&ipc_regs);
++
++      return;
++}
++
++int wkup_m3_fw_version_read(void)
++{
++      struct am33xx_ipc_regs ipc_regs;
++
++      am33xx_ctrl_ipc_read(&ipc_regs);
++
++      return ipc_regs.reg2 & WKUP_M3_FW_VERSION_MASK;
++}
++
++void wkup_m3_pm_set_cmd(struct am33xx_ipc_regs *ipc_regs)
++{
++      am33xx_ctrl_ipc_write(ipc_regs);
++}
++
++void wkup_m3_set_ops(struct wkup_m3_ops *ops)
++{
++      wkup_m3->ops = ops;
++}
++
++static irqreturn_t wkup_m3_txev_handler(int irq, void *unused)
++{
++      am33xx_txev_eoi();
++
++      if (wkup_m3->ops && wkup_m3->ops->firmware_loaded)
++              wkup_m3->ops->txev_handler();
++
++      am33xx_txev_enable();
++
++      return IRQ_HANDLED;
++}
++
++int wkup_m3_prepare(void)
++{
++      int ret = 0;
++      struct platform_device *pdev = to_platform_device(wkup_m3->dev);
++
++      wkup_m3->mbox = omap_mbox_get("wkup_m3", NULL);
++
++      if (IS_ERR(wkup_m3->mbox)) {
++              ret = -EBUSY;
++              pr_err("PM: IPC Request for A8->M3 Channel failed!\n");
++              return ret;
++      }
++
++      wkup_m3_fw_version_clear();
++
++      /* check that the code is loaded */
++      ret = omap_device_deassert_hardreset(pdev, "wkup_m3");
++
++      return ret;
++}
++
++static int wkup_m3_copy_code(const u8 *data, size_t size)
++{
++      if (size > SZ_16K)
++              return -ENOMEM;
++
++      memcpy_toio(wkup_m3->code, data, size);
++
++      return 0;
++}
++
++static void wkup_m3_firmware_cb(const struct firmware *fw, void *context)
++{
++      int ret = 0;
++
++      /* no firmware found */
++      if (!fw) {
++              pr_err("PM: request_firmware failed\n");
++              return;
++      }
++
++      ret = wkup_m3_copy_code(fw->data, fw->size);
++
++      if (ret) {
++              pr_info("PM: Failed to copy firmware for M3");
++      } else {
++              if (wkup_m3->ops && wkup_m3->ops->firmware_loaded)
++                      wkup_m3->ops->firmware_loaded();
++
++              wkup_m3->is_valid = true;
++      }
++
++      return;
++}
++
++static int wkup_m3_probe(struct platform_device *pdev)
++{
++      int irq, ret = 0;
++      struct resource *res;
++
++      pm_runtime_enable(&pdev->dev);
++
++      ret = pm_runtime_get_sync(&pdev->dev);
++      if (IS_ERR_VALUE(ret)) {
++              dev_err(&pdev->dev, "pm_runtime_get_sync() failed\n");
++              return ret;
++      }
++
++      irq = platform_get_irq(pdev, 0);
++      if (!irq) {
++              dev_err(&pdev->dev, "no irq resource\n");
++              ret = -ENXIO;
++              goto err;
++      }
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "m3_umem");
++      if (!res) {
++              dev_err(&pdev->dev, "no memory resource\n");
++              ret = -ENXIO;
++              goto err;
++      }
++
++      wkup_m3 = devm_kzalloc(&pdev->dev, sizeof(*wkup_m3), GFP_KERNEL);
++      if (!wkup_m3) {
++              pr_err("Memory allocation failed\n");
++              ret = -ENOMEM;
++              goto err;
++      }
++
++      wkup_m3->dev = &pdev->dev;
++
++      wkup_m3->code = devm_request_and_ioremap(wkup_m3->dev, res);
++      if (!wkup_m3->code) {
++              dev_err(wkup_m3->dev, "could not ioremap\n");
++              ret = -EADDRNOTAVAIL;
++              goto err;
++      }
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "ipc_regs");
++      if (!res) {
++              dev_err(&pdev->dev, "no memory resource for ipc\n");
++              ret = -ENXIO;
++              goto err;
++      }
++
++      wkup_m3->ipc = devm_request_and_ioremap(wkup_m3->dev, res);
++      if (!wkup_m3->ipc) {
++              dev_err(wkup_m3->dev, "could not ioremap ipc_mem\n");
++              ret = -EADDRNOTAVAIL;
++              goto err;
++      }
++
++      ret = devm_request_irq(wkup_m3->dev, irq, wkup_m3_txev_handler,
++                IRQF_DISABLED, "wkup_m3_txev", NULL);
++      if (ret) {
++              dev_err(wkup_m3->dev, "request_irq failed\n");
++              goto err;
++      }
++
++      wkup_m3->is_valid = false;
++
++      pr_info("PM: Loading am335x-pm-firmware.bin");
++
++      /* We don't want to delay boot */
++      ret = request_firmware_nowait(THIS_MODULE, 0, "am335x-pm-firmware.bin",
++                              &pdev->dev, GFP_KERNEL, NULL,
++                              wkup_m3_firmware_cb);
++
++err:
++      return ret;
++}
++
++static int wkup_m3_remove(struct platform_device *pdev)
++{
++      return 0;
++}
++
++static struct of_device_id wkup_m3_dt_ids[] = {
++      { .compatible = "ti,am3353-wkup-m3" },
++      { }
++};
++MODULE_DEVICE_TABLE(of, wkup_m3_dt_ids);
++
++static int wkup_m3_rpm_suspend(struct device *dev)
++{
++      return -EBUSY;
++}
++
++static int wkup_m3_rpm_resume(struct device *dev)
++{
++      return 0;
++}
++
++static const struct dev_pm_ops wkup_m3_ops = {
++      SET_RUNTIME_PM_OPS(wkup_m3_rpm_suspend, wkup_m3_rpm_resume, NULL)
++};
++
++static struct platform_driver wkup_m3_driver = {
++      .probe          = wkup_m3_probe,
++      .remove         = wkup_m3_remove,
++      .driver         = {
++              .name   = "wkup_m3",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(wkup_m3_dt_ids),
++              .pm     = &wkup_m3_ops,
++      },
++};
++
++module_platform_driver(wkup_m3_driver);
+--- /dev/null
++++ b/arch/arm/mach-omap2/wkup_m3.h
+@@ -0,0 +1,60 @@
++/*
++ * TI Wakeup M3 Power Management Routines
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ * Dave Gerlach <d-gerlach@ti.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#ifndef __ASSEMBLER__
++
++/**
++ * struct wkup_m3_ops - Callbacks for allowing pm code to interact with wkup_m3.
++ *
++ * @txev_handler: Callback to allow pm code to react to response from wkup_m3
++ *              after pinging it using wkup_m3_ping.
++ *
++ * @firmware_loaded: Callback invoked when the firmware has been loaded to the
++ *                 m3 to allow the pm code to enable suspend/resume ops.
++ */
++
++struct wkup_m3_ops {
++      void (*txev_handler)(void);
++      void (*firmware_loaded)(void);
++};
++
++struct wkup_m3_wakeup_src {
++      int irq_nr;
++      char src[10];
++};
++
++struct am33xx_ipc_regs {
++      u32 reg0;
++      u32 reg1;
++      u32 reg2;
++      u32 reg3;
++      u32 reg4;
++      u32 reg5;
++      u32 reg6;
++      u32 reg7;
++};
++
++int wkup_m3_prepare(void);
++void wkup_m3_set_ops(struct wkup_m3_ops *ops);
++int wkup_m3_ping(void);
++struct wkup_m3_wakeup_src wkup_m3_wake_src(void);
++int wkup_m3_pm_status(void);
++int wkup_m3_is_valid(void);
++int wkup_m3_fw_version_read(void);
++void wkup_m3_pm_set_cmd(struct am33xx_ipc_regs *ipc_regs);
++
++#endif
++
+--- a/arch/arm/Makefile
++++ b/arch/arm/Makefile
+@@ -314,6 +314,8 @@ $(INSTALL_TARGETS):
+ %.dtb: | scripts
+       $(Q)$(MAKE) $(build)=$(boot)/dts MACHINE=$(MACHINE) $(boot)/dts/$@
++uImage.%: uImage
++      $(Q)$(MAKE) $(build)=$(boot) MACHINE=$(MACHINE) $(boot)/$@
+ PHONY += dtbs
+ dtbs: scripts
+--- a/arch/arm/plat-omap/include/plat/dmtimer.h
++++ b/arch/arm/plat-omap/include/plat/dmtimer.h
+@@ -336,8 +336,11 @@ static inline void __omap_dm_timer_enabl
+       if (timer->posted)
+               return;
+-      if (timer->errata & OMAP_TIMER_ERRATA_I103_I767)
++      if (timer->errata & OMAP_TIMER_ERRATA_I103_I767) {
++              timer->posted = OMAP_TIMER_NONPOSTED;
++              __omap_dm_timer_write(timer, OMAP_TIMER_IF_CTRL_REG, 0, 0);
+               return;
++      }
+       __omap_dm_timer_write(timer, OMAP_TIMER_IF_CTRL_REG,
+                             OMAP_TIMER_CTRL_POSTED, 0);
+--- /dev/null
++++ b/Documentation/ABI/testing/configfs-usb-gadget-mass-storage
+@@ -0,0 +1,31 @@
++What:         /config/usb-gadget/gadget/functions/mass_storage.name
++Date:         Oct 2013
++KenelVersion: 3.13
++Description:
++              The attributes:
++
++              stall           - Set to permit function to halt bulk endpoints.
++                              Disabled on some USB devices known not to work
++                              correctly. You should set it to true.
++              num_buffers     - Number of pipeline buffers. Valid numbers
++                              are 2..4. Available only if
++                              CONFIG_USB_GADGET_DEBUG_FILES is set.
++
++What:         /config/usb-gadget/gadget/functions/mass_storage.name/lun.name
++Date:         Oct 2013
++KenelVersion: 3.13
++Description:
++              The attributes:
++
++              file            - The path to the backing file for the LUN.
++                              Required if LUN is not marked as removable.
++              ro              - Flag specifying access to the LUN shall be
++                              read-only. This is implied if CD-ROM emulation
++                              is enabled as well as when it was impossible
++                              to open "filename" in R/W mode.
++              removable       - Flag specifying that LUN shall be indicated as
++                              being removable.
++              cdrom           - Flag specifying that LUN shall be reported as
++                              being a CD-ROM.
++              nofua           - Flag specifying that FUA flag
++                              in SCSI WRITE(10,12)
+--- /dev/null
++++ b/Documentation/devicetree/bindings/arm/omap/crossbar.txt
+@@ -0,0 +1,24 @@
++* TI - IRQ/DMA Crossbar
++
++This version is an implementation of the Crossbar IRQ/DMA IP
++
++Required properties:
++- compatible : Should be "ti,dra-crossbar"
++- crossbar-name: Name of the controller to which crossbar output is routed
++- reg:        Contains crossbar register address range
++- reg-width: Represents the width of the individual registers
++- crossbar-lines:  Default mappings.Should contain the crossbar-name
++                 device name, int/dma request number, crossbar number,
++                 register offset in the same order.
++
++Examples:
++              crossbar_mpu: mpuirq@4a002a48 {
++                      compatible = "crossbar";
++                      crossbar-name = "mpu-irq";
++                      reg = <0x4a002a48 0x0130>;
++                      reg-width = <16>;
++                      crossbar-lines = "mpu-irq", "rtc-ss-alarm", <0x9f 0xd9 0x12c>,
++                                       "mpu-irq", "mcasp3-arevt", <0x9e 0x96 0x12a>,
++                                       "mpu-irq", "mcasp3-axevt", <0x9d 0x97 0x128>;
++              };
++
+--- /dev/null
++++ b/Documentation/devicetree/bindings/arm/omap/dmm.txt
+@@ -0,0 +1,17 @@
++OMAP Dynamic Memory Manager (DMM) bindings
++
++Required properties:
++- compatible: Must be "ti,omap4-dmm" for OMAP4 family
++              Must be "ti,omap5-dmm" for OMAP5 family
++- reg:                Contains timer register address range (base address and length)
++- interrupts: Contains interrupt information (source, etc) for the DMM IRQ
++- ti,hwmods:  Name of the hwmod associated to the counter, which is typically
++              "dmm"
++
++Example:
++
++dmm: dmm@4e000000 {
++      compatible = "ti,omap4-dmm";
++      reg = <0x4e000000 0x800>;
++      ti,hwmods = "dmm";
++};
+--- a/Documentation/devicetree/bindings/arm/omap/omap.txt
++++ b/Documentation/devicetree/bindings/arm/omap/omap.txt
+@@ -21,7 +21,8 @@ Required properties:
+ Optional properties:
+ - ti,no_idle_on_suspend: When present, it prevents the PM to idle the module
+   during suspend.
+-
++- ti,no-reset: When present, the module should not be reset
++- ti,no-idle: When present, the module should not be idled
+ Example:
+@@ -60,5 +61,8 @@ Boards:
+ - AM43x EPOS EVM
+   compatible = "ti,am43x-epos-evm", "ti,am4372", "ti,am43"
++- AM437x GP EVM
++  compatible = "ti,am437x-gp-evm", "ti,am4372", "ti,am43"
++
+ - DRA7 EVM:  Software Developement Board for DRA7XX
+   compatible = "ti,dra7-evm", "ti,dra7"
+--- /dev/null
++++ b/Documentation/devicetree/bindings/arm/omap/prcm.txt
+@@ -0,0 +1,13 @@
++TI Power Reset Clock Manager (PRCM)
++
++Properties:
++- compatible: "ti,am4372-prcm" for prcm in am43x SoC's
++              "ti,am3352-prcm" for prcm in am335x SoC's
++- #reset-cells: 1 (refer generic reset bindings for details)
++
++example:
++      prcm: prcm@44df0000 {
++              compatible = "ti,am4372-prcm";
++              reg = <0x44df0000 0xa000>;
++              #reset-cells = <1>;
++      };
+--- a/Documentation/devicetree/bindings/ata/ahci-platform.txt
++++ b/Documentation/devicetree/bindings/ata/ahci-platform.txt
+@@ -4,7 +4,8 @@ SATA nodes are defined to describe on-ch
+ Each SATA controller should have its own node.
+ Required properties:
+-- compatible        : compatible list, contains "snps,spear-ahci"
++- compatible        : compatible list, contains "snps,spear-ahci",
++                      snps,exynos5440-ahci or "snps,dwc-ahci"
+ - interrupts        : <interrupt mapping for SATA IRQ>
+ - reg               : <registers mapping>
+--- /dev/null
++++ b/Documentation/devicetree/bindings/ata/ti-sata.txt
+@@ -0,0 +1,31 @@
++* Texas Instruments SATA Controller Wrapper
++
++Required properties:
++- compatible  : "ti,sata"
++- ti,hwmods   : "sata"
++- reg         : Register mapping
++- #address-cells: <1>
++- #size-cells : <1>
++- ranges      : allows valid translation between child's address space and parent's
++                address space.
++- Must contain at least one child node for the SATA controller core
++
++Example:
++
++      sata: sata@4a141100 {
++              compatible = "ti,sata";
++              ti,hwmods = "sata";
++              reg = <0x4a141100 0x7>;
++              #address-cells = <1>;
++              #size-cells = <1>;
++              ranges;
++              dwc-ahci@4a140000 {
++                      compatible = "snps,dwc-ahci";
++                      reg = <0x4a140000 0x1100>;
++                      interrupts = <GIC_SPI 54 IRQ_TYPE_LEVEL_HIGH>;
++                      phys = <&sata_phy>;
++                      phy-names = "sata-phy";
++                      clocks = <&sata_ref_clk>;
++                      clock-names = "optclk";
++              };
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/clk-palmas.txt
+@@ -0,0 +1,35 @@
++* Palmas 32KHz clocks *
++
++Palmas device has two clock output pins for 32KHz, KG and KG_AUDIO.
++
++This binding uses the common clock binding ./clock-bindings.txt.
++
++Required properties:
++- compatible :        "ti,palmas-clk32kg" for clk32kg clock
++              "ti,palmas-clk32kgaudio" for clk32kgaudio clock
++- #clock-cells : shall be set to 0.
++
++Optional property:
++- ti,external-sleep-control: The external enable input pins controlled the
++      enable/disable of clocks.  The external enable input pins ENABLE1,
++      ENABLE2 and NSLEEP. The valid values for the external pins are:
++              PALMAS_EXT_CONTROL_PIN_ENABLE1 for ENABLE1 pin
++              PALMAS_EXT_CONTROL_PIN_ENABLE2 for ENABLE2 pin
++              PALMAS_EXT_CONTROL_PIN_NSLEEP for NSLEEP pin
++      Option 0 or missing this property means the clock is enabled/disabled
++      via register access and these pins do not have any control.
++      The macros of external control pins for DTS is defined at
++      dt-bindings/mfd/palmas.h
++
++Example:
++      #include <dt-bindings/mfd/palmas.h>
++      ...
++      palmas: tps65913@58 {
++              ...
++              clk32kg: palmas_clk32k@0 {
++                      compatible = "ti,palmas-clk32kg";
++                      #clock-cells = <0>;
++                      ti,external-sleep-control = <PALMAS_EXT_CONTROL_PIN_NSLEEP>;
++              };
++              ...
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/divider-clock.txt
+@@ -0,0 +1,90 @@
++Binding for simple divider clock.
++
++This binding uses the common clock binding[1].  It assumes a
++register-mapped adjustable clock rate divider that does not gate and has
++only one input clock or parent.  By default the value programmed into
++the register is one less than the actual divisor value.  E.g:
++
++register value                actual divisor value
++0                     1
++1                     2
++2                     3
++
++This assumption may be modified by the following optional properties:
++
++index-starts-at-one - valid divisor values start at 1, not the default
++of 0.  E.g:
++register value                actual divisor value
++1                     1
++2                     2
++3                     3
++
++index-power-of-two - valid divisor values are powers of two.  E.g:
++register value                actual divisor value
++0                     1
++1                     2
++2                     4
++
++index-allow-zero - same as index_one, but zero is divide-by-1.  E.g:
++register value                actual divisor value
++0                     1
++1                     1
++2                     2
++
++Additionally a table of valid dividers may be supplied like so:
++
++      table = <4 0>, <8, 1>;
++
++where the first value in the pair is the divider and the second value is
++the programmed register bitfield.
++
++The binding must also provide the register to control the divider and
++the mask for the corresponding control bits.  Optionally the number of
++bits to shift that mask, if necessary.  If the shift value is missing it
++is the same as supplying a zero shift.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++
++Required properties:
++- compatible : shall be "divider-clock".
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link to phandle of parent clock
++- reg : base address for register controlling adjustable divider
++- bit-mask : arbitrary bitmask for programming the adjustable divider
++
++Optional properties:
++- clock-output-names : from common clock binding.
++- table : array of integer pairs defining divisors & bitfield values
++- bit-shift : number of bits to shift the bit-mask, defaults to
++  (ffs(mask) - 1) if not present
++- minimum-divider : min divisor for dividing the input clock rate, only
++  needed if the first divisor is offset from the default value
++- maximum-divider : max divisor for dividing the input clock rate, only
++  needed if the max divisor is less than (mask + 1).
++- index-starts-at-one : valid divisor programming starts at 1, not zero
++- index-power-of-two : valid divisor programming must be a power of two
++- index-allow-zero : implies index-one, and programming zero results in
++  divide-by-one
++- hiword-mask : lower half of the register programs the divider, upper
++  half of the register indicates bits that were updated in the lower
++  half
++
++Examples:
++      clock_foo: clock_foo@4a008100 {
++              compatible = "divider-clock";
++              #clock-cells = <0>;
++              clocks = <&clock_baz>;
++              reg = <0x4a008100 0x4>
++              mask = <0x3>
++              maximum-divider = <3>
++      };
++
++      clock_bar: clock_bar@4a008108 {
++              #clock-cells = <0>;
++              compatible = "divider-clock";
++              clocks = <&clock_foo>;
++              reg = <0x4a008108 0x4>;
++              mask = <0x1>;
++              shift = <0>;
++              table = < 4 0 >, < 8 1 >;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/gate-clock.txt
+@@ -0,0 +1,36 @@
++Binding for simple gate clock.
++
++This binding uses the common clock binding[1].  It assumes a
++register-mapped clock gate controlled by a single bit that has only one
++input clock or parent.  By default setting the specified bit gates the
++clock signal and clearing the bit ungates it.
++
++The binding must provide the register to control the gate and the bit
++shift for the corresponding gate control bit. Some clocks set the bit to
++gate the clock signal, and clear it to ungate the clock signal. The
++optional "set-bit-to-disable" specifies this behavior.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++
++Required properties:
++- compatible : shall be "gate-clock".
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link to phandle of parent clock
++- reg : base address for register controlling adjustable gate
++- bit-shift : bit shift for programming the clock gate
++
++Optional properties:
++- clock-output-names : from common clock binding.
++- set-bit-to-disable : inverts default gate programming. Setting the bit
++  gates the clock and clearing the bit ungates the clock.
++- hiword-mask : lower half of the register controls the gate, upper half
++  of the register indicates bits that were updated in the lower half
++
++Examples:
++      clock_foo: clock_foo@4a008100 {
++              compatible = "gate-clock";
++              #clock-cells = <0>;
++              clocks = <&clock_bar>;
++              reg = <0x4a008100 0x4>
++              bit-shift = <3>
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/mux-clock.txt
+@@ -0,0 +1,79 @@
++Binding for simple mux clock.
++
++This binding uses the common clock binding[1].  It assumes a
++register-mapped multiplexer with multiple input clock signals or
++parents, one of which can be selected as output.  This clock does not
++gate or adjust the parent rate via a divider or multiplier.
++
++By default the "clocks" property lists the parents in the same order
++as they are programmed into the regster.  E.g:
++
++      clocks = <&foo_clock>, <&bar_clock>, <&baz_clock>;
++
++results in programming the register as follows:
++
++register value                selected parent clock
++0                     foo_clock
++1                     bar_clock
++2                     baz_clock
++
++Some clock controller IPs do not allow a value of zero to be programmed
++into the register, instead indexing begins at 1.  The optional property
++"index-starts-at-one" modified the scheme as follows:
++
++register value                selected clock parent
++1                     foo_clock
++2                     bar_clock
++3                     baz_clock
++
++Additionally an optional table of bit and parent pairs may be supplied
++like so:
++
++      table = <&foo_clock 0x0>, <&bar_clock, 0x2>, <&baz_clock, 0x4>;
++
++where the first value in the pair is the parent clock and the second
++value is the bitfield to be programmed into the register.
++
++The binding must provide the register to control the mux and the mask
++for the corresponding control bits.  Optionally the number of bits to
++shift that mask if necessary.  If the shift value is missing it is the
++same as supplying a zero shift.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++
++Required properties:
++- compatible : shall be "mux-clock".
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link phandles of parent clocks
++- reg : base address for register controlling adjustable mux
++- bit-mask : arbitrary bitmask for programming the adjustable mux
++
++Optional properties:
++- clock-output-names : From common clock binding.
++- table : array of integer pairs defining parents & bitfield values
++- bit-shift : number of bits to shift the bit-mask, defaults to
++  (ffs(mask) - 1) if not present
++- index-starts-at-one : valid input select programming starts at 1, not
++  zero
++- hiword-mask : lower half of the register programs the mux, upper half
++  of the register indicates bits that were updated in the lower half
++
++Examples:
++      clock: clock@4a008100 {
++              compatible = "mux-clock";
++              #clock-cells = <0>;
++              clocks = <&clock_foo>, <&clock_bar>, <&clock_baz>;
++              reg = <0x4a008100 0x4>
++              mask = <0x3>;
++              index-starts-at-one;
++      };
++
++      clock: clock@4a008100 {
++              #clock-cells = <0>;
++              compatible = "mux-clock";
++              clocks = <&clock_foo>, <&clock_bar>, <&clock_baz>;
++              reg = <0x4a008100 0x4>;
++              mask = <0x3>;
++              shift = <0>;
++              table = <&clock_foo 1>, <&clock_bar 2>, <&clock_baz 3>;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/apll.txt
+@@ -0,0 +1,33 @@
++Binding for Texas Instruments APLL clock.
++
++This binding uses the common clock binding[1].  It assumes a
++register-mapped APLL with usually two selectable input clocks
++(reference clock and bypass clock), with analog phase locked
++loop logic for multiplying the input clock to a desired output
++clock. This clock also typically supports different operation
++modes (locked, low power stop etc.) APLL mostly behaves like
++a subtype of a DPLL [2], although a simplified one at that.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++[2] Documentation/devicetree/bindings/clock/ti/dpll.txt
++
++Required properties:
++- compatible : shall be "ti,dra7-apll-clock"
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link phandles of parent clocks (clk-ref and clk-bypass)
++- reg : address and length of the register set for controlling the APLL.
++  It contains the information of registers in the same order as described by
++  reg-names.
++- reg-names: array of the register names for controlling the device, sorted
++  in the same order as the reg property.
++      "control" - contains the control register base address
++      "idlest" - contains the idlest register base address
++
++Examples:
++      apll_pcie_ck: apll_pcie_ck@4a008200 {
++              #clock-cells = <0>;
++              clocks = <&apll_pcie_in_clk_mux>, <&dpll_pcie_ref_ck>;
++              reg = <0x4a00821c 0x4>, <0x4a008220 0x4>;
++              reg-names = "control", "idlest";
++              compatible = "ti,dra7-apll-clock";
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/autoidle.txt
+@@ -0,0 +1,48 @@
++Binding for Texas Instruments autoidling clock.
++
++This binding uses the common clock binding[1]. Autoidle clocks
++are inherited clocks from basic divider-clock [2] or
++fixed-factor-clock [3] and just add autoidle support on top of
++this. Autoidle is an OMAP clock feature, which allows the clock
++to gate autonomously by hardware when they are no longer needed.
++The autoidle feature must be enabled manually for these clocks.
++Otherwise the clocks behave exactly as their base clock type.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++[2] Documentation/devicetree/bindings/clock/divider-clock.txt
++[3] Documentation/devicetree/bindings/clock/fixed-factor-clock.txt
++
++Required properties:
++- compatible : shall be one of:
++              "ti,divider-clock",
++              "ti,fixed-factor-clock"
++- ti,autoidle-shift : bit shift of the autoidle enable bit for the clock
++- reg : base address for the control register of this clock
++
++Optional properties:
++- ti,autoidle-low : autoidle is enabled by setting the bit to 0
++
++Other properties as per the base clock type.
++
++Examples:
++      dpll_abe_m2x2_ck: dpll_abe_m2x2_ck@4a0051f0 {
++              #clock-cells = <0>;
++              compatible = "ti,divider-clock";
++              clocks = <&dpll_abe_x2_ck>;
++              ti,autoidle-shift = <8>;
++              reg = <0x4a0051f0 0x4>;
++              bit-mask = <0x1f>;
++              index-starts-at-one;
++              ti,autoidle-low;
++      };
++
++      dpll_usb_clkdcoldo_ck: dpll_usb_clkdcoldo_ck@4a0081b4 {
++              #clock-cells = <0>;
++              compatible = "ti,fixed-factor-clock";
++              clocks = <&dpll_usb_ck>;
++              ti,autoidle-shift = <8>;
++              clock-div = <1>;
++              reg = <0x4a0081b4 0x4>;
++              clock-mult = <1>;
++              ti,autoidle-low;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/clockdomain.txt
+@@ -0,0 +1,19 @@
++Binding for Texas Instruments clockdomain.
++
++This binding uses the common clock binding[1]. Every clock on
++TI SoC belongs to one clockdomain, but software only needs this
++information for specific clocks which require their parent
++clockdomain to be controlled when the clock is enabled/disabled.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++
++Required properties:
++- compatible : shall be "ti,clockdomain"
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link phandles of clocks within this domain
++
++Examples:
++      dss_clkdm: dss_clkdm {
++              compatible = "ti,clockdomain";
++              clocks = <&dss1_alwon_fck_3430es2>, <&dss_ick_3430es2>;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/dpll.txt
+@@ -0,0 +1,68 @@
++Binding for Texas Instruments DPLL clock.
++
++This binding uses the common clock binding[1].  It assumes a
++register-mapped DPLL with usually two selectable input clocks
++(reference clock and bypass clock), with digital phase locked
++loop logic for multiplying the input clock to a desired output
++clock. This clock also typically supports different operation
++modes (locked, low power stop etc.) This binding has several
++sub-types, which effectively result in slightly different setup
++for the actual DPLL clock.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++
++Required properties:
++- compatible : shall be one of:
++              "ti,omap4-dpll-x2-clock",
++              "ti,omap3-dpll-clock",
++              "ti,omap3-dpll-core-clock",
++              "ti,omap3-dpll-per-clock",
++              "ti,omap3-dpll-per-j-type-clock",
++              "ti,omap4-dpll-clock",
++              "ti,omap4-dpll-core-clock",
++              "ti,omap4-dpll-m4xen-clock",
++              "ti,omap4-dpll-j-type-clock",
++              "ti,omap4-dpll-no-gate-clock",
++              "ti,omap4-dpll-no-gate-j-type-clock",
++
++- #clock-cells : from common clock binding; shall be set to 0.
++- clocks : link phandles of parent clocks, first entry lists reference clock
++  and second entry bypass clock
++- reg : address and length of the register set for controlling the DPLL.
++  It contains the information of registers in the same order as described by
++  reg-names.
++- reg-names : array of the register names for controlling the device, sorted
++  in the same order as the reg property.
++      "control" - contains the control register base address
++        "idlest" - contains the idle status register base address
++        "autoidle" - contains the autoidle register base address
++        "mult-div1" - contains the multiplier / divider register base address
++
++Optional properties:
++- ti,modes : available modes for the DPLL, bitmask of:
++  0x02 - DPLL supports low power stop mode
++  0x20 - DPLL can be put to low power bypass mode
++  0x80 - DPLL can be put to lock mode (running)
++  Other values currently unsupported.
++- ti,clkdm-name : clockdomain name for the DPLL
++
++Examples:
++      dpll_core_ck: dpll_core_ck@44e00490 {
++              #clock-cells = <0>;
++              compatible = "ti,omap4-dpll-core-clock";
++              clocks = <&sys_clkin_ck>, <&sys_clkin_ck>;
++              reg = <0x44e00490 0x4>, <0x44e0045c 0x4>, <0x0 0x4>,
++                              <0x44e00468 0x4>;
++              reg-names = "control", "idlest", "autoidle", "mult-div1";
++      };
++
++      dpll2_ck: dpll2_ck@48004004 {
++              #clock-cells = <0>;
++              compatible = "ti,omap3-dpll-clock";
++              clocks = <&sys_ck>, <&dpll2_fck>;
++              ti,modes = <0xa2>;
++              reg = <0x48004004 0x4>, <0x48004024 0x4>, <0x48004034 0x4>,
++                      <0x48004040 0x4>;
++              reg-names = "control", "idlest", "autoidle", "mult-div1";
++              ti,clkdm-name = "dpll2_clkdm";
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/gate.txt
+@@ -0,0 +1,73 @@
++Binding for Texas Instruments gate clock.
++
++This binding uses the common clock binding[1]. This clock is
++quite much similar to the basic gate-clock [2], however,
++it supports a number of additional features. If no register
++is provided for this clock, the code assumes that a clockdomain
++will be controlled instead and the corresponding hw-ops for
++that is used.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++[2] Documentation/devicetree/bindings/clock/gate-clock.txt
++[3] Documentation/devicetree/bindings/clock/ti/clockdomain.txt
++
++Required properties:
++- compatible : shall be one of:
++  "ti,gate-clock" - basic gate clock
++  "ti,dss-gate-clock" - gate clock with DSS specific hardware handling
++  "ti,am35xx-gate-clock" - gate clock with AM35xx specific hardware handling
++  "ti,clkdm-gate-clock" - clockdomain gate clock, which derives its functional
++                        clock directly from a clockdomain, see [3] how
++                        to map clockdomains properly
++  "ti,hsdiv-gate-clock" - gate clock with OMAP36xx specific hardware handling,
++                        required for a hardware errata
++- #clock-cells : from common clock binding; shall be set to 0
++- clocks : link to phandle of parent clock
++- reg : base address for register controlling adjustable gate, not needed for
++      ti,clkdm-gate-clock type
++- ti,enable-bit : bit shift for programming the clock gate, not needed for
++                ti,clkdm-gate-clock type
++
++Optional properties:
++- ti,set-bit-to-disable : inverts default gate programming. Setting the bit
++  gates the clock and clearing the bit ungates the clock.
++
++Examples:
++      mmchs2_fck: mmchs2_fck@48004a00 {
++              #clock-cells = <0>;
++              compatible = "ti,gate-clock";
++              clocks = <&core_96m_fck>;
++              reg = <0x48004a00 0x4>;
++              ti,enable-bit = <25>;
++      };
++
++      dss1_alwon_fck_3430es2: dss1_alwon_fck_3430es2@48004e00 {
++              #clock-cells = <0>;
++              compatible = "ti,dss-gate-clock";
++              clocks = <&dpll4_m4x2_ck>;
++              reg = <0x48004e00 0x4>;
++              ti,enable-bit = <0>;
++      };
++
++      emac_ick: emac_ick@4800259c {
++              #clock-cells = <0>;
++              compatible = "ti,am35xx-gate-clock";
++              clocks = <&ipss_ick>;
++              reg = <0x4800259c 0x4>;
++              ti,enable-bit = <1>;
++      };
++
++      emu_src_ck: emu_src_ck {
++              #clock-cells = <0>;
++              compatible = "ti,clkdm-gate-clock";
++              clocks = <&emu_src_mux_ck>;
++      };
++
++      dpll4_m2x2_ck: dpll4_m2x2_ck@48004d00 {
++              #clock-cells = <0>;
++              compatible = "ti,hsdiv-gate-clock";
++              clocks = <&dpll4_m2x2_mul_ck>;
++              ti,enable-bit = <0x1b>;
++              reg = <0x48004d00 0x4>;
++              ti,set-bit-to-disable;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/clock/ti/interface.txt
+@@ -0,0 +1,53 @@
++Binding for Texas Instruments interface clock.
++
++This binding uses the common clock binding[1]. This clock is
++quite much similar to the basic gate-clock [2], however,
++it supports a number of additional features, including
++companion clock finding (match corresponding functional gate
++clock) and hardware autoidle enable / disable.
++
++[1] Documentation/devicetree/bindings/clock/clock-bindings.txt
++[2] Documentation/devicetree/bindings/clock/gate-clock.txt
++
++Required properties:
++- compatible : shall be one of:
++  "ti,omap3-interface-clock" - basic OMAP3 interface clock
++  "ti,omap3-no-wait-interface-clock" - interface clock which has no hardware
++                                     capability for waiting clock to be ready
++  "ti,omap3-hsotgusb-interface-clock" - interface clock with USB specific HW
++                                      handling
++  "ti,omap3-dss-interface-clock" - interface clock with DSS specific HW handling
++  "ti,omap3-ssi-interface-clock" - interface clock with SSI specific HW handling
++  "ti,am35xx-interface-clock" - interface clock with AM35xx specific HW handling
++- #clock-cells : from common clock binding; shall be set to 0
++- clocks : link to phandle of parent clock
++- reg : base address for the control register
++
++Optional properties:
++- ti,enable-bit : bit shift for the bit enabling/disabling the clock
++                (default 0)
++
++Examples:
++      aes1_ick: aes1_ick@48004a14 {
++              #clock-cells = <0>;
++              compatible = "ti,omap3-interface-clock";
++              clocks = <&security_l4_ick2>;
++              reg = <0x48004a14 0x4>;
++              ti,enable-bit = <3>;
++      };
++
++      cam_ick: cam_ick@48004f10 {
++              #clock-cells = <0>;
++              compatible = "ti,omap3-no-wait-interface-clock";
++              clocks = <&l4_ick>;
++              reg = <0x48004f10 0x4>;
++              ti,enable-bit = <0>;
++      };
++
++      ssi_ick_3430es2: ssi_ick_3430es2@48004a10 {
++              #clock-cells = <0>;
++              compatible = "ti,omap3-ssi-interface-clock";
++              clocks = <&ssi_l4_ick>;
++              reg = <0x48004a10 0x4>;
++              ti,enable-bit = <0>;
++      };
+--- a/Documentation/devicetree/bindings/dma/atmel-dma.txt
++++ b/Documentation/devicetree/bindings/dma/atmel-dma.txt
+@@ -28,7 +28,7 @@ The three cells in order are:
+ dependent:
+   - bit 7-0: peripheral identifier for the hardware handshaking interface. The
+   identifier can be different for tx and rx.
+-  - bit 11-8: FIFO configuration. 0 for half FIFO, 1 for ALAP, 1 for ASAP.
++  - bit 11-8: FIFO configuration. 0 for half FIFO, 1 for ALAP, 2 for ASAP.
+ Example:
+--- /dev/null
++++ b/Documentation/devicetree/bindings/extcon/extcon-gpio-usbvid.txt
+@@ -0,0 +1,20 @@
++EXTCON FOR USB VIA GPIO
++
++Required Properties:
++ - compatible : Should be "ti,gpio-usb-vid" for USB VBUS-ID detector
++              using gpios or "ti,gpio-usb-id" for USB ID pin detector
++ - gpios : phandle and args ID pin gpio and VBUS gpio.
++         The first gpio used  for ID pin detection
++         and the second used for VBUS detection.
++         ID pin gpio is mandatory and VBUS is optional
++         depending on implementation.
++
++Please refer to ../gpio/gpio.txt for details of the common GPIO bindings
++
++Example:
++
++      gpio_usbvid_extcon1 {
++              compatible = "ti,gpio-usb-vid";
++              gpios = <&gpio1 1 0>,
++                      <&gpio2 2 0>;
++      };
+--- a/Documentation/devicetree/bindings/extcon/extcon-palmas.txt
++++ b/Documentation/devicetree/bindings/extcon/extcon-palmas.txt
+@@ -2,7 +2,8 @@ EXTCON FOR PALMAS/TWL CHIPS
+ PALMAS USB COMPARATOR
+ Required Properties:
+- - compatible : Should be "ti,palmas-usb" or "ti,twl6035-usb"
++ - compatible : Should be "ti,palmas-usb-vid". "ti,twl6035-usb" and
++   "ti,palmas-usb" is deprecated and is kept for backward compatibility.
+ Optional Properties:
+  - ti,wakeup : To enable the wakeup comparator in probe
+--- /dev/null
++++ b/Documentation/devicetree/bindings/gpio/gpio-pcf857x.txt
+@@ -0,0 +1,71 @@
++* PCF857x-compatible I/O expanders
++
++The PCF857x-compatible chips have "quasi-bidirectional" I/O lines that can be
++driven high by a pull-up current source or driven low to ground. This combines
++the direction and output level into a single bit per line, which can't be read
++back. We can't actually know at initialization time whether a line is configured
++(a) as output and driving the signal low/high, or (b) as input and reporting a
++low/high value, without knowing the last value written since the chip came out
++of reset (if any). The only reliable solution for setting up line direction is
++thus to do it explicitly.
++
++Required Properties:
++
++  - compatible: should be one of the following.
++    - "maxim,max7328": For the Maxim MAX7378
++    - "maxim,max7329": For the Maxim MAX7329
++    - "nxp,pca8574": For the NXP PCA8574
++    - "nxp,pca8575": For the NXP PCA8575
++    - "nxp,pca9670": For the NXP PCA9670
++    - "nxp,pca9671": For the NXP PCA9671
++    - "nxp,pca9672": For the NXP PCA9672
++    - "nxp,pca9673": For the NXP PCA9673
++    - "nxp,pca9674": For the NXP PCA9674
++    - "nxp,pca9675": For the NXP PCA9675
++    - "nxp,pcf8574": For the NXP PCF8574
++    - "nxp,pcf8574a": For the NXP PCF8574A
++    - "nxp,pcf8575": For the NXP PCF8575
++    - "ti,tca9554": For the TI TCA9554
++
++  - reg: I2C slave address.
++
++  - gpio-controller: Marks the device node as a gpio controller.
++  - #gpio-cells: Should be 2. The first cell is the GPIO number and the second
++    cell specifies GPIO flags, as defined in <dt-bindings/gpio/gpio.h>. Only the
++    GPIO_ACTIVE_HIGH and GPIO_ACTIVE_LOW flags are supported.
++
++Optional Properties:
++
++  - lines-initial-states: Bitmask that specifies the initial state of each
++  line. When a bit is set to zero, the corresponding line will be initialized to
++  the input (pulled-up) state. When the  bit is set to one, the line will be
++  initialized the the low-level output state. If the property is not specified
++  all lines will be initialized to the input state.
++
++  The I/O expander can detect input state changes, and thus optionally act as
++  an interrupt controller. When the expander interrupt line is connected all the
++  following properties must be set. For more information please see the
++  interrupt controller device tree bindings documentation available at
++  Documentation/devicetree/bindings/interrupt-controller/interrupts.txt.
++
++  - interrupt-controller: Identifies the node as an interrupt controller.
++  - #interrupt-cells: Number of cells to encode an interrupt source, shall be 2.
++  - interrupt-parent: phandle of the parent interrupt controller.
++  - interrupts: Interrupt specifier for the controllers interrupt.
++
++
++Please refer to gpio.txt in this directory for details of the common GPIO
++bindings used by client devices.
++
++Example: PCF8575 I/O expander node
++
++      pcf8575: gpio@20 {
++              compatible = "nxp,pcf8575";
++              reg = <0x20>;
++              interrupt-parent = <&irqpin2>;
++              interrupts = <3 0>;
++              gpio-controller;
++              #gpio-cells = <2>;
++              interrupt-controller;
++              #interrupt-cells = <2>;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/hwrng/omap_rng.txt
+@@ -0,0 +1,22 @@
++OMAP SoC HWRNG Module
++
++Required properties:
++
++- compatible : Should contain entries for this and backward compatible
++  RNG versions:
++  - "ti,omap2-rng" for OMAP2.
++  - "ti,omap4-rng" for OMAP4, OMAP5 and AM33XX.
++  Note that these two versions are incompatible.
++- ti,hwmods: Name of the hwmod associated with the RNG module
++- reg : Offset and length of the register set for the module
++- interrupts : the interrupt number for the RNG module.
++              Only used for "ti,omap4-rng".
++
++Example:
++/* AM335x */
++rng: rng@48310000 {
++      compatible = "ti,omap4-rng";
++      ti,hwmods = "rng";
++      reg = <0x48310000 0x2000>;
++      interrupts = <111>;
++};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/input/touchscreen/atmel_mxt_ts.txt
+@@ -0,0 +1,108 @@
++Atmel MaxTouch Touchscreen
++--------------------------
++Required properties:
++ - compatible: "atmel,mXT244" or "atmel,qt602240_ts"
++                or "atmel,atmel_mxt_ts"
++ - reg: I2C address of the chip
++ - interrupts: interrupt signal to which the chip is connected
++ - atmel,x-line: Number of x lines the touch object occupies in pixels
++ - atmel,y-line: Number of y lines the touch object occupies in pixels
++ - atmel,x-size: Horizontal resolution of touchscreen in pixels
++ - atmel,y-size: Vertical resolution of touchscreen in pixels
++ - atmel,blen: Sets the gain of the analog circuit in front of ADC
++               Gain setting depends on package type. Range: 0-3
++ - atmel,threshold: Channel detection threshold value. Range: 0-255
++                    Typical: 30-80. Lower the threshold, higher the
++                    sensitivity
++ - atmel,voltage: Nominal AVdd in uV for analog circuitry, greater than
++                  or less than base voltage of 2.7V, used for optimizing
++                  capacitive sensing. For example, if you want to
++                  program an optimum voltage of 2.8V in your design,
++                  specify 2800000 for this parameter
++ - atmel,orientation: touchscreen orientation, must be one of following,
++     as defined inside include/linux/i2c/atmel_mxt_ts.h
++     - 0: MXT_NORMAL - normal
++     - 1: MXT_DIAGONAL - diagonal
++     - 2: MXT_HORIZONTAL_FLIP - horizonally flipped
++     - 3: MXT_ROTATED_90_COUNTER - rotated by 90 degrees
++                                  counter-clockwise
++     - 4: MXT_VERTICAL_FLIP - vertically flipped
++     - 5: MXT_ROTATED_90 - rotated by 90 degress clockwise
++     - 6: MXT_ROTATED_180 - rotated by 180 degrees
++     - 7: MXT_DIAGONAL_COUNTER - diagonal counter
++
++Optional properties:
++ - atmel,config: list of 8-bit register values for controller objects
++   in the following order. Number of objects and values depends on the
++   particular model of Atmel touch screen you are using. Please check
++   with your Atmel representative for helping you tune these values
++   GEN_COMMAND, GEN_POWER, GEN_ACQUIRE, TOUCH_MULTI
++   TOUCH_KEYARRAY, MXT244_COMMSCONFIG_T18, SPT_GPIOPWM, PROCI_GRIPFACE,
++   PROCG_NOISE, TOUCH_PROXIMITY, PROCI_ONETOUCH, SPT_SELFTEST,
++   PROCI_TWOTOUCH, SPT_CTECONFIG
++   Note: These register values can be specified here according to
++   the specific controller and platform configuration desired. The
++   driver does not configure these registers by default and leaves it
++   to the platform dts file to supply them
++
++Example:
++
++      &i2c1 {
++              mXT244:mXT244@4a {
++                      reg = <0x4a>;
++              };
++      };
++
++      &mXT244 {
++              compatible = "atmel,mXT244";
++              interrupts = <0 119 0x4>;
++
++              atmel,config = <
++              /* MXT244_GEN_COMMAND(6) */
++              0x00 0x00 0x00 0x00 0x00 0x00
++              /* MXT244_GEN_POWER(7) */
++              0x20 0xff 0x32
++              /* MXT244_GEN_ACQUIRE(8) */
++              0x0a 0x00 0x05 0x00 0x00 0x00 0x09 0x23
++              /* MXT244_TOUCH_MULTI(9) */
++              0x00 0x00 0x00 0x13 0x0b 0x00 0x00 0x00 0x02 0x00
++              0x00 0x01 0x01 0x0e 0x0a 0x0a 0x0a 0x0a 0x00 0x00
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00
++              /* MXT244_TOUCH_KEYARRAY(15) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00
++              /* MXT244_COMMSCONFIG_T18(2) */
++              0x00 0x00
++              /* MXT244_SPT_GPIOPWM(19) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00 0x00 0x00 0x00 0x00 0x00
++              /* MXT244_PROCI_GRIPFACE(20) */
++              0x07 0x00 0x00 0x00 0x00 0x00 0x00 0x50 0x28 0x04
++              0x0f 0x0a
++              /* MXT244_PROCG_NOISE(22) */
++              0x05 0x00 0x00 0x00 0x00 0x00 0x00 0x03 0x23 0x00
++              0x00 0x05 0x0f 0x19 0x23 0x2d 0x03
++              /* MXT244_TOUCH_PROXIMITY(23) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00 0x00 0x00 0x00 0x00
++              /* MXT244_PROCI_ONETOUCH(24) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              /* MXT244_SPT_SELFTEST(25) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              0x00 0x00 0x00 0x00
++              /* MXT244_PROCI_TWOTOUCH(27) */
++              0x00 0x00 0x00 0x00 0x00 0x00 0x00
++              /* MXT244_SPT_CTECONFIG(28) */
++              0x00 0x00 0x02 0x08 0x10 0x00 >;
++
++              atmel,x_line = <18>;
++              atmel,y_line = <12>;
++              atmel,x_size = <800>;
++              atmel,y_size = <480>;
++              atmel,blen = <0x01>;
++              atmel,threshold = <30>;
++              atmel,voltage = <2800000>;
++              atmel,orient = <0x4>;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/input/touchscreen/pixcir_i2c_ts.txt
+@@ -0,0 +1,26 @@
++* Pixcir I2C touchscreen controllers
++
++Required properties:
++- compatible: must be "pixcir,pixcir_ts" or "pixcir,pixcir_tangoc"
++- reg: I2C address of the chip
++- interrupts: interrupt to which the chip is connected
++- attb-gpio: GPIO connected to the ATTB line of the chip
++- x-size: horizontal resolution of touchscreen
++- y-size: vertical resolution of touchscreen
++
++Example:
++
++      i2c@00000000 {
++              /* ... */
++
++              pixcir_ts@5c {
++                      compatible = "pixcir,pixcir_ts";
++                      reg = <0x5c>;
++                      interrupts = <2 0>;
++                      attb-gpio = <&gpf 2 0 2>;
++                      x-size = <800>;
++                      y-size = <600>;
++              };
++
++              /* ... */
++      };
+--- a/Documentation/devicetree/bindings/input/touchscreen/ti-tsc-adc.txt
++++ b/Documentation/devicetree/bindings/input/touchscreen/ti-tsc-adc.txt
+@@ -6,7 +6,7 @@ Required properties:
+       ti,wires: Wires refer to application modes i.e. 4/5/8 wire touchscreen
+                 support on the platform.
+       ti,x-plate-resistance: X plate resistance
+-      ti,coordiante-readouts: The sequencer supports a total of 16
++      ti,coordinate-readouts: The sequencer supports a total of 16
+                               programmable steps each step is used to
+                               read a single coordinate. A single
+                                 readout is enough but multiple reads can
+--- /dev/null
++++ b/Documentation/devicetree/bindings/mailbox/omap-mailbox.txt
+@@ -0,0 +1,76 @@
++OMAP2+ Mailbox Driver
++=====================
++
++The OMAP mailbox hardware facilitates communication between different
++processors using a queued mailbox interrupt mechanism. The IP block is
++external to the various processor subsystems and is connected on an
++interconnect bus. The communication is achieved through a set of
++registers for message storage and interrupt configuration registers.
++
++Each mailbox IP block has a certain number of h/w fifo queues and output
++interrupt lines. An output interrupt line is routed to a specific interrupt
++controller on a processor subsystem, and there can be more than one line
++going to a specific processor's interrupt controller. The interrupt line
++connections are fixed for an instance and are dictated by the IP integration
++into the SoC. Each interrupt line is programmable through a set of interrupt
++configuration registers, and have a rx and tx interrupt source per h/w fifo.
++Communication between different processors is achieved through the appropriate
++programming of the rx and tx interrupt sources on the appropriate interrupt
++lines.
++
++The number of h/w fifo queues and interrupt lines dictate the usable registers.
++All the current OMAP SoCs except for the newest DRA7xx SoC has a single IP
++instance. DRA7xx has multiple instances with different number of h/w fifo
++queues and interrupt lines between different instances. The interrupt lines
++can also be routed to different processor sub-systems on DRA7xx as they are
++routed through the Crossbar, a kind of interrupt router/multiplexer.
++
++The above two varying SoC IP integration parameters are defined specifically
++through the "ti,mbox-num-users" and "ti,mbox-num-fifos" device-tree properties.
++These are defined in the DT nodes since these design parameters can vary between
++one instance to another in an SoC (eg: DRA7xx) even though the base IP design
++is identical.
++
++Required properties:
++--------------------
++- compatible:         Should be one of the following,
++                          "ti,omap2-mailbox" for
++                              OMAP2420, OMAP2430, OMAP3430, OMAP3630 SoCs
++                          "ti,omap4-mailbox" for
++                              OMAP44xx, OMAP54xx, AM33xx, AM43xx, DRA7xx SoCs
++- reg:                        Contains the mailbox register address range (base address
++                      and length)
++- interrupts:                 Contains the interrupt information for the mailbox
++                      device. The format is dependent on which interrupt
++                      controller the OMAP device uses
++- ti,hwmods:          Name of the hwmod associated with the mailbox
++- ti,mbox-num-users:  Number of targets (processor devices) that the mailbox device
++                      can interrupt
++- ti,mbox-num-fifos:  Number of h/w fifos within the mailbox device
++- ti,mbox-names:      Array of the names of the mailboxes
++- ti,mbox-data:               Mailbox descriptor data private to each mailbox. The 4
++                      cells represent the following data,
++                        Cell #1 (tx_id) - mailbox fifo id used for
++                                              transmitting messages
++                        Cell #2 (rx_id) - mailbox fifo id on which messages
++                                              are received
++                        Cell #3 (irq_id) - irq identifier index number to use
++                                              from the interrupts data
++                        Cell #4 (usr_id) - mailbox user id for identifying the
++                                              interrupt into the MPU interrupt
++                                              controller.
++
++Example:
++--------
++
++/* OMAP4 */
++mailbox: mailbox@4a0f4000 {
++      compatible = "ti,omap4-mailbox";
++      reg = <0x4a0f4000 0x200>;
++      interrupts = <GIC_SPI 47 IRQ_TYPE_LEVEL_HIGH>;
++      ti,hwmods = "mailbox";
++      ti,mbox-num-users = <3>;
++      ti,mbox-num-fifos = <8>;
++      ti,mbox-names = "mbox-ipu", "mbox-dsp";
++      ti,mbox-data = <0 1 0 0>, <3 2 0 0>;
++};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/mfd/tps65218.txt
+@@ -0,0 +1,27 @@
++The TPS65218 Integrated Power Management Chips.
++These chips are connected to an i2c bus.
++
++Required properties:
++- compatible : Must be "ti,tps65218";
++- interrupts : This i2c device has an IRQ line connected to the main SoC
++- interrupt-controller : Since the tps65218 support several interrupts
++  internally, it is considered as an interrupt controller cascaded to the SoC.
++- #interrupt-cells = <2>;
++- interrupt-parent : The parent interrupt controller.
++
++Optional node:
++- Child nodes contain in the tps65218.
++  It supports a number of features.
++  The children nodes will thus depend of the capability of the variant.
++
++Example:
++/*
++ * Integrated Power Management Chip
++ */
++tps@24 {
++    compatible = "ti,tps65218";
++    reg = <0x24>;
++    interrupt-controller;
++    #interrupt-cells = <2>;
++    interrupt-parent = <&gic>;
++};
+--- a/Documentation/devicetree/bindings/mfd/twl6040.txt
++++ b/Documentation/devicetree/bindings/mfd/twl6040.txt
+@@ -19,6 +19,8 @@ Required properties:
+ Optional properties, nodes:
+ - enable-active-high: To power on the twl6040 during boot.
++- clocks: phandle to the clk32k clock provider
++- clock-names: Must be "clk32k"
+ Vibra functionality
+ Required properties:
+--- a/Documentation/devicetree/bindings/mmc/ti-omap-hsmmc.txt
++++ b/Documentation/devicetree/bindings/mmc/ti-omap-hsmmc.txt
+@@ -20,8 +20,29 @@ ti,dual-volt: boolean, supports dual vol
+ ti,non-removable: non-removable slot (like eMMC)
+ ti,needs-special-reset: Requires a special softreset sequence
+ ti,needs-special-hs-handling: HSMMC IP needs special setting for handling High Speed
++dmas: List of DMA specifiers with the controller specific format
++as described in the generic DMA client binding. A tx and rx
++specifier is required.
++dma-names: List of DMA request names. These strings correspond
++1:1 with the DMA specifiers listed in dmas. The string naming is
++to be "rx" and "tx" for RX and TX DMA requests, respectively.
++
++Examples:
++
++[hwmod populated DMA resources]
++
++      mmc1: mmc@0x4809c000 {
++              compatible = "ti,omap4-hsmmc";
++              reg = <0x4809c000 0x400>;
++              ti,hwmods = "mmc1";
++              ti,dual-volt;
++              bus-width = <4>;
++              vmmc-supply = <&vmmc>; /* phandle to regulator node */
++              ti,non-removable;
++      };
++
++[generic DMA request binding]
+-Example:
+       mmc1: mmc@0x4809c000 {
+               compatible = "ti,omap4-hsmmc";
+               reg = <0x4809c000 0x400>;
+@@ -30,4 +51,7 @@ Example:
+               bus-width = <4>;
+               vmmc-supply = <&vmmc>; /* phandle to regulator node */
+               ti,non-removable;
++              dmas = <&edma 24
++                      &edma 25>;
++              dma-names = "tx", "rx";
+       };
+--- a/Documentation/devicetree/bindings/mtd/gpmc-nand.txt
++++ b/Documentation/devicetree/bindings/mtd/gpmc-nand.txt
+@@ -21,13 +21,11 @@ Optional properties:
+                               is wired that way. If not specified, a bus
+                               width of 8 is assumed.
+- - ti,nand-ecc-opt:           A string setting the ECC layout to use. One of:
+-
+-              "sw"            Software method (default)
+-              "hw"            Hardware method
+-              "hw-romcode"    gpmc hamming mode method & romcode layout
++ - ti,nand-ecc-scheme:                A string setting the ECC layout to use. One of:
++              "ham1"          1-bit Hamming ecc code
+               "bch4"          4-bit BCH ecc code
+               "bch8"          8-bit BCH ecc code
++              "bch16"         16-bit BCH ecc code
+  - ti,nand-xfer-type:         A string setting the data transfer type. One of:
+@@ -36,8 +34,11 @@ Optional properties:
+               "prefetch-dma"          Prefetch enabled sDMA mode
+               "prefetch-irq"          Prefetch enabled irq mode
+- - elm_id:    Specifies elm device node. This is required to support BCH
+-              error correction using ELM module.
++ - ti,elm-id: Specifies pHandle of the ELM devicetree node.
++              ELM is an on-chip hardware engine on TI SoC which is used for
++              locating ECC errors for BCHx algorithms. SoC devices which have
++              ELM hardware engines should specify this device node in .dtsi
++              Using ELM for ECC error correction frees some CPU cycles.
+ For inline partiton table parsing (optional):
+--- /dev/null
++++ b/Documentation/devicetree/bindings/net/cpsw-phy-sel.txt
+@@ -0,0 +1,28 @@
++TI CPSW Phy mode Selection Device Tree Bindings
++-----------------------------------------------
++
++Required properties:
++- compatible          : Should be "ti,am3352-cpsw-phy-sel"
++- reg                 : physical base address and size of the cpsw
++                        registers map
++- reg-names           : names of the register map given in "reg" node
++
++Optional properties:
++-rmii-clock-ext               : If present, the driver will configure the RMII
++                        interface to external clock usage
++
++Examples:
++
++      phy_sel: cpsw-phy-sel@44e10650 {
++              compatible = "ti,am3352-cpsw-phy-sel";
++              reg= <0x44e10650 0x4>;
++              reg-names = "gmii-sel";
++      };
++
++(or)
++      phy_sel: cpsw-phy-sel@44e10650 {
++              compatible = "ti,am3352-cpsw-phy-sel";
++              reg= <0x44e10650 0x4>;
++              reg-names = "gmii-sel";
++              rmii-clock-ext;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/net/smsc95xx.txt
+@@ -0,0 +1,16 @@
++* Smart Mixed-Signal Connectivity (SMSC) 95xx Controller
++
++Required properties:
++None
++
++Optional properties:
++- mac-address - Read the mac address that was stored by uBoot
++- local-address - Read the mac address that was stored by uBoot
++- address - Read the mac address that was stored by uBoot
++
++Examples:
++
++smsc0: smsc95xx@0 {
++      /* Filled in by U-Boot */
++      mac-address = [ 00 00 00 00 00 00 ];
++};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/phy/omap-phy.txt
+@@ -0,0 +1,78 @@
++OMAP PHY: DT DOCUMENTATION FOR PHYs in OMAP PLATFORM
++
++OMAP CONTROL PHY
++
++Required properties:
++ - compatible: Should be one of
++ "ti,control-phy-otghs" - if it has otghs_control mailbox register as on OMAP4.
++ "ti,control-phy-usb2" - if it has Power down bit in control_dev_conf register
++                      e.g. USB2_PHY on OMAP5.
++ "ti,control-phy-pipe3" - if it has DPLL and individual Rx & Tx power control
++                      e.g. USB3 PHY and SATA PHY on OMAP5.
++ "ti,control-phy-dra7usb2" - if it has power down register like USB2 PHY on
++                      DRA7 platform.
++ "ti,control-phy-am437usb2" - if it has power down register like USB2 PHY on
++                      AM437 platform.
++ - reg : Address and length of the register set for the device. It contains
++   the address of "otghs_control" for control-phy-otghs or "power" register
++   for other types.
++ - reg-names: should be "otghs_control" control-phy-otghs and "power" for
++   other types.
++
++omap_control_otghs: omap-control-phy@4a002300 {
++      compatible = "ti,control-phy-otghs";
++      reg = <0x4a00233c 0x4>;
++      reg-names = "otghs_control";
++};
++
++OMAP USB2 PHY
++
++Required properties:
++ - compatible: Should be either of
++      * "ti,omap-usb2" for OMAP4,OMAP5,DRA7
++      * "ti,am437x-usb2" for AM437x
++ - reg : Address and length of the register set for the device.
++ - #phy-cells: determine the number of cells that should be given in the
++   phandle while referencing this phy.
++
++Optional properties:
++ - ctrl-module : phandle of the control module used by PHY driver to power on
++   the PHY.
++
++This is usually a subnode of ocp2scp to which it is connected.
++
++usb2phy@4a0ad080 {
++      compatible = "ti,omap-usb2";
++      reg = <0x4a0ad080 0x58>;
++      ctrl-module = <&omap_control_usb>;
++      #phy-cells = <0>;
++};
++
++OMAP PIPE3 PHY
++
++Required properties:
++ - compatible: Should be "ti,phy-pipe3-usb3" or "ti,phy-pipe3-sata"
++ - reg : Address and length of the register set for the device.
++ - reg-names: The names of the register addresses corresponding to the registers
++   filled in "reg".
++ - #phy-cells: determine the number of cells that should be given in the
++   phandle while referencing this phy.
++ - clocks: phandle to PHY clocks i.e. 32KHz wakup clock, 960MHz clock and lfps clock.
++   Use as per Documentation/devicetree/bindings/clock/clock-bindings.txt
++ - clock-names: should contain "wkupclk", "refclk1" and "refclk2"
++
++Optional properties:
++ - ctrl-module : phandle of the control module used by PHY driver to power on
++   the PHY.
++
++This is usually a subnode of ocp2scp to which it is connected.
++
++usb3phy@4a084400 {
++      compatible = "ti,omap-usb3";
++      reg = <0x4a084400 0x80>,
++            <0x4a084800 0x64>,
++            <0x4a084c00 0x40>;
++      reg-names = "phy_rx", "phy_tx", "pll_ctrl";
++      ctrl-module = <&omap_control_usb>;
++      #phy-cells = <0>;
++};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/phy/phy-bindings.txt
+@@ -0,0 +1,66 @@
++This document explains only the device tree data binding. For general
++information about PHY subsystem refer to Documentation/phy.txt
++
++PHY device node
++===============
++
++Required Properties:
++#phy-cells:   Number of cells in a PHY specifier;  The meaning of all those
++              cells is defined by the binding for the phy node. The PHY
++              provider can use the values in cells to find the appropriate
++              PHY.
++
++For example:
++
++phys: phy {
++    compatible = "xxx";
++    reg = <...>;
++    .
++    .
++    #phy-cells = <1>;
++    .
++    .
++};
++
++That node describes an IP block (PHY provider) that implements 2 different PHYs.
++In order to differentiate between these 2 PHYs, an additonal specifier should be
++given while trying to get a reference to it.
++
++PHY user node
++=============
++
++Required Properties:
++phys : the phandle for the PHY device (used by the PHY subsystem)
++phy-names : the names of the PHY corresponding to the PHYs present in the
++          *phys* phandle
++
++Example 1:
++usb1: usb_otg_ss@xxx {
++    compatible = "xxx";
++    reg = <xxx>;
++    .
++    .
++    phys = <&usb2_phy>, <&usb3_phy>;
++    phy-names = "usb2phy", "usb3phy";
++    .
++    .
++};
++
++This node represents a controller that uses two PHYs, one for usb2 and one for
++usb3.
++
++Example 2:
++usb2: usb_otg_ss@xxx {
++    compatible = "xxx";
++    reg = <xxx>;
++    .
++    .
++    phys = <&phys 1>;
++    phy-names = "usbphy";
++    .
++    .
++};
++
++This node represents a controller that uses one of the PHYs of the PHY provider
++device defined previously. Note that the phy handle has an additional specifier
++"1" to differentiate between the two PHYs.
+--- /dev/null
++++ b/Documentation/devicetree/bindings/regulator/ti-avs-class0.txt
+@@ -0,0 +1,66 @@
++Texas Instrument SmartReflex AVS Class 0 Regulator
++
++Required properties:
++- compatible: "ti,avsclass0"
++- reg: Should contain Efuse registers location and length
++- avs-supply: The supply for AVS block
++- efuse-settings: An array of 2-tuples items, and each item consists
++  of Voltage index and efuse offset(from reg) like: <voltage offset>
++      voltage: Voltage index in microvolts (also called nominal voltage)
++      offset: ofset in bytes from base provided in reg
++  NOTE: min_uV, max_uV are pickedup from this list
++
++Optional properties:
++- voltage-tolerance: Specify the voltage tolerance in percentage
++- ti,avsclass0-microvolt-values: Boolean property indicating that the efuse
++  values are in microvolts
++
++Example #1: single rails:
++soc.dtsi:
++avs_mpu: regulator-avs@0x40200000 {
++      compatible = "ti,avsclass0";
++      reg = <0x40200000 0x20>;
++      efuse-settings = <975000 0
++              1075000 4
++              1200000 8>;
++};
++
++avs_core: regulator-avs@0x40300000 {
++      compatible = "ti,avsclass0";
++      reg = <0x40300000 0x20>;
++      efuse-settings = <975000 0
++              1050000 4>;
++};
++
++board.dtsi:
++&avs_mpu {
++              avs-supply = <&vcc>;
++};
++&avs_core {
++              avs-supply = <&smps2>;
++};
++
++Example #2: Ganged (combined) rails:
++soc.dtsi:
++avs_mpu: regulator-avs@0x40200000 {
++      compatible = "ti,avsclass0";
++      reg = <0x40200000 0x20>;
++      efuse-settings = <975000 0
++              1075000 4
++              1200000 8>;
++};
++
++avs_core: regulator-avs@0x40300000 {
++      compatible = "ti,avsclass0";
++      reg = <0x40300000 0x20>;
++      efuse-settings = <975000 0
++              1050000 4>;
++};
++
++board.dtsi:
++&avs_mpu {
++              avs-supply = <&smps3>;
++};
++&avs_core {
++              avs-supply = <&smps3>;
++};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/regulator/tps65218.txt
+@@ -0,0 +1,22 @@
++TPS65218 family of regulators
++
++Required properties:
++For tps65218 regulators/LDOs
++- compatible:
++  - "ti,tps65218-dcdc1" for DCDC1
++  - "ti,tps65218-dcdc2" for DCDC2
++  - "ti,tps65218-dcdc3" for DCDC3
++  - "ti,tps65218-dcdc4" for DCDC4
++  - "ti,tps65218-dcdc5" for DCDC5
++  - "ti,tps65218-dcdc6" for DCDC6
++  - "ti,tps65218-ldo1" for LDO1 LDO
++
++Optional properties:
++- Any optional property defined in bindings/regulator/regulator.txt
++
++Example:
++      xyz: regulator@0 {
++              compatible = "ti,tps65218-dcdc1";
++              regulator-min-microvolt  = <1000000>;
++              regulator-max-microvolt  = <3000000>;
++      };
+--- /dev/null
++++ b/Documentation/devicetree/bindings/sound/davinci-evm-audio.txt
+@@ -0,0 +1,58 @@
++* Texas Instruments SoC audio setups with TLV320AIC3X Codec
++
++Required properties:
++- compatible : "ti,da830-evm-audio" : forDM365/DA8xx/OMAPL1x/AM33xx
++- ti,model : The user-visible name of this sound complex.
++- ti,audio-codec : The phandle of the TLV320AIC3x audio codec
++- ti,mcasp-controller : The phandle of the McASP controller
++- ti,codec-clock-rate : The Codec Clock rate (in Hz) applied to the Codec
++- ti,audio-routing : A list of the connections between audio components.
++  Each entry is a pair of strings, the first being the connection's sink,
++  the second being the connection's source. Valid names for sources and
++  sinks are the codec's pins, and the jacks on the board:
++
++  TLV320AIC3X pins:
++
++  * LLOUT
++  * RLOUT
++  * MONO_LOUT
++  * HPLOUT
++  * HPROUT
++  * HPLCOM
++  * HPRCOM
++  * MIC3L
++  * MIC3R
++  * LINE1L
++  * LINE2L
++  * LINE1R
++  * LINE2R
++
++  Board connectors:
++
++  * Headphone Jack
++  * Line Out
++  * Mic Jack
++  * Line In
++
++
++Example:
++
++sound {
++      compatible = "ti,da830-evm-audio";
++      ti,model = "DA830 EVM";
++      ti,audio-codec = <&tlv320aic3x>;
++      ti,mcasp-controller = <&mcasp1>;
++      ti,codec-clock-rate = <12000000>;
++      ti,audio-routing =
++              "Headphone Jack",       "HPLOUT",
++              "Headphone Jack",       "HPROUT",
++              "Line Out",             "LLOUT",
++              "Line Out",             "RLOUT",
++              "MIC3L",                "Mic Bias 2V",
++              "MIC3R",                "Mic Bias 2V",
++              "Mic Bias 2V",          "Mic Jack",
++              "LINE1L",               "Line In",
++              "LINE2L",               "Line In",
++              "LINE1R",               "Line In",
++              "LINE2R",               "Line In";
++};
+--- a/Documentation/devicetree/bindings/sound/davinci-mcasp-audio.txt
++++ b/Documentation/devicetree/bindings/sound/davinci-mcasp-audio.txt
+@@ -6,15 +6,21 @@ Required properties:
+       "ti,da830-mcasp-audio"  : for both DA830 & DA850 platforms
+       "ti,omap2-mcasp-audio"  : for OMAP2 platforms (TI81xx, AM33xx)
+-- reg : Should contain McASP registers offset and length
+-- interrupts : Interrupt number for McASP
++- reg : Should contain McASP registers address and length for mpu and
++      optionally for dma controller access.
++- reg-names : The mandatory reg-range must be named "mpu" and the optional DMA
++            reg-range must be named "dma". For backward compatibility it is
++            good to keep "mpu" first in the list.
+ - op-mode : I2S/DIT ops mode.
+ - tdm-slots : Slots for TDM operation.
+-- num-serializer : Serializers used by McASP.
+-- serial-dir : A list of serializer pin mode. The list number should be equal
+-              to "num-serializer" parameter. Each entry is a number indication
+-              serializer pin direction. (0 - INACTIVE, 1 - TX, 2 - RX)
+-
++- serial-dir : A list of serializer configuration. Each entry is a number
++               indication serializer pin direction.
++               (0 - INACTIVE, 1 - TX, 2 - RX)
++- dmas: two element list of DMA controller phandles and DMA request line
++        ordered pairs.
++- dma-names: identifier string for each DMA request line in the dmas property.
++           These strings correspond 1:1 with the ordered pairs in dmas. The dma
++           identifiers must be "rx" and "tx".
+ Optional properties:
+@@ -23,6 +29,8 @@ Optional properties:
+ - rx-num-evt : FIFO levels.
+ - sram-size-playback : size of sram to be allocated during playback
+ - sram-size-capture  : size of sram to be allocated during capture
++- interrupts : Interrupt numbers for McASP, currently not used by the driver
++- interrupt-names : Known interrupt names are "tx" and "rx"
+ Example:
+@@ -31,10 +39,11 @@ mcasp0: mcasp0@1d00000 {
+       #address-cells = <1>;
+       #size-cells = <0>;
+       reg = <0x100000 0x3000>;
++      reg-names "mpu";
+       interrupts = <82 83>;
++      interrupts-names = "tx", "rx";
+       op-mode = <0>;          /* MCASP_IIS_MODE */
+       tdm-slots = <2>;
+-      num-serializer = <16>;
+       serial-dir = <
+                       0 0 0 0 /* 0: INACTIVE, 1: TX, 2: RX */
+                       0 0 0 0
+--- a/Documentation/devicetree/bindings/sound/tlv320aic3x.txt
++++ b/Documentation/devicetree/bindings/sound/tlv320aic3x.txt
+@@ -24,10 +24,36 @@ Optional properties:
+       3 - MICBIAS output is connected to AVDD,
+       If this node is not mentioned or if the value is incorrect, then MicBias
+       is powered down.
++- AVDD-supply, IOVDD-supply, DRVDD-supply, DVDD-supply : power supplies for the
++  device as covered in Documentation/devicetree/bindings/regulator/regulator.txt
++
++CODEC output pins:
++  * LLOUT
++  * RLOUT
++  * MONO_LOUT
++  * HPLOUT
++  * HPROUT
++  * HPLCOM
++  * HPRCOM
++
++CODEC input pins:
++  * MIC3L
++  * MIC3R
++  * LINE1L
++  * LINE2L
++  * LINE1R
++  * LINE2R
++
++The pins can be used in referring sound node's audio-routing property.
+ Example:
+ tlv320aic3x: tlv320aic3x@1b {
+       compatible = "ti,tlv320aic3x";
+       reg = <0x1b>;
++
++      AVDD-supply = <&regulator>;
++      IOVDD-supply = <&regulator>;
++      DRVDD-supply = <&regulator>;
++      DVDD-supply = <&regulator>;
+ };
+--- a/Documentation/devicetree/bindings/spi/omap-spi.txt
++++ b/Documentation/devicetree/bindings/spi/omap-spi.txt
+@@ -2,8 +2,8 @@ OMAP2+ McSPI device
+ Required properties:
+ - compatible :
+-  - "ti,omap2-spi" for OMAP2 & OMAP3.
+-  - "ti,omap4-spi" for OMAP4+.
++  - "ti,omap2-mcspi" for OMAP2 & OMAP3.
++  - "ti,omap4-mcspi" for OMAP4+.
+ - ti,spi-num-cs : Number of chipselect supported  by the instance.
+ - ti,hwmods: Name of the hwmod associated to the McSPI
+ - ti,pindir-d0-out-d1-in: Select the D0 pin as output and D1 as
+--- a/Documentation/devicetree/bindings/usb/dwc3.txt
++++ b/Documentation/devicetree/bindings/usb/dwc3.txt
+@@ -6,11 +6,13 @@ Required properties:
+  - compatible: must be "snps,dwc3"
+  - reg : Address and length of the register set for the device
+  - interrupts: Interrupts used by the dwc3 controller.
++
++Optional properties:
+  - usb-phy : array of phandle for the PHY device.  The first element
+    in the array is expected to be a handle to the USB2/HS PHY and
+    the second element is expected to be a handle to the USB3/SS PHY
+-
+-Optional properties:
++ - phys: from the *Generic PHY* bindings
++ - phy-names: from the *Generic PHY* bindings
+  - tx-fifo-resize: determines if the FIFO *has* to be reallocated.
+ This is usually a subnode to DWC3 glue to which it is connected.
+--- a/Documentation/devicetree/bindings/usb/omap-usb.txt
++++ b/Documentation/devicetree/bindings/usb/omap-usb.txt
+@@ -3,9 +3,6 @@ OMAP GLUE AND OTHER OMAP SPECIFIC COMPON
+ OMAP MUSB GLUE
+  - compatible : Should be "ti,omap4-musb" or "ti,omap3-musb"
+  - ti,hwmods : must be "usb_otg_hs"
+- - ti,has-mailbox : to specify that omap uses an external mailbox
+-   (in control module) to communicate with the musb core during device connect
+-   and disconnect.
+  - multipoint : Should be "1" indicating the musb controller supports
+    multipoint. This is a MUSB configuration-specific setting.
+  - num-eps : Specifies the number of endpoints. This is also a
+@@ -19,6 +16,9 @@ OMAP MUSB GLUE
+  - power : Should be "50". This signifies the controller can supply up to
+    100mA when operating in host mode.
+  - usb-phy : the phandle for the PHY device
++ - phys : the phandle for the PHY device (used by generic PHY framework)
++ - phy-names : the names of the PHY corresponding to the PHYs present in the
++   *phy* phandle.
+ Optional properties:
+  - ctrl-module : phandle of the control module this glue uses to write to
+@@ -28,11 +28,12 @@ SOC specific device node entry
+ usb_otg_hs: usb_otg_hs@4a0ab000 {
+       compatible = "ti,omap4-musb";
+       ti,hwmods = "usb_otg_hs";
+-      ti,has-mailbox;
+       multipoint = <1>;
+       num-eps = <16>;
+       ram-bits = <12>;
+       ctrl-module = <&omap_control_usb>;
++      phys = <&usb2_phy>;
++      phy-names = "usb2-phy";
+ };
+ Board specific device node entry
+@@ -74,26 +75,3 @@ omap_dwc3 {
+       utmi-mode = <2>;
+       ranges;
+ };
+-
+-OMAP CONTROL USB
+-
+-Required properties:
+- - compatible: Should be "ti,omap-control-usb"
+- - reg : Address and length of the register set for the device. It contains
+-   the address of "control_dev_conf" and "otghs_control" or "phy_power_usb"
+-   depending upon omap4 or omap5.
+- - reg-names: The names of the register addresses corresponding to the registers
+-   filled in "reg".
+- - ti,type: This is used to differentiate whether the control module has
+-   usb mailbox or usb3 phy power. omap4 has usb mailbox in control module to
+-   notify events to the musb core and omap5 has usb3 phy power register to
+-   power on usb3 phy. Should be "1" if it has mailbox and "2" if it has usb3
+-   phy power.
+-
+-omap_control_usb: omap-control-usb@4a002300 {
+-      compatible = "ti,omap-control-usb";
+-      reg = <0x4a002300 0x4>,
+-            <0x4a00233c 0x4>;
+-      reg-names = "control_dev_conf", "otghs_control";
+-      ti,type = <1>;
+-};
+--- a/Documentation/devicetree/bindings/usb/usb-nop-xceiv.txt
++++ b/Documentation/devicetree/bindings/usb/usb-nop-xceiv.txt
+@@ -15,7 +15,7 @@ Optional properties:
+ - vcc-supply: phandle to the regulator that provides RESET to the PHY.
+-- reset-supply: phandle to the regulator that provides power to the PHY.
++- reset-gpios: Should specify the GPIO for reset.
+ Example:
+@@ -25,10 +25,9 @@ Example:
+               clocks = <&osc 0>;
+               clock-names = "main_clk";
+               vcc-supply = <&hsusb1_vcc_regulator>;
+-              reset-supply = <&hsusb1_reset_regulator>;
++              reset-gpios = <&gpio1 7 GPIO_ACTIVE_LOW>;
+       };
+ hsusb1_phy is a NOP USB PHY device that gets its clock from an oscillator
+ and expects that clock to be configured to 19.2MHz by the NOP PHY driver.
+-hsusb1_vcc_regulator provides power to the PHY and hsusb1_reset_regulator
+-controls RESET.
++hsusb1_vcc_regulator provides power to the PHY and GPIO 7 controls RESET.
+--- a/Documentation/devicetree/bindings/usb/usb-phy.txt
++++ /dev/null
+@@ -1,42 +0,0 @@
+-USB PHY
+-
+-OMAP USB2 PHY
+-
+-Required properties:
+- - compatible: Should be "ti,omap-usb2"
+- - reg : Address and length of the register set for the device.
+-
+-Optional properties:
+- - ctrl-module : phandle of the control module used by PHY driver to power on
+-   the PHY.
+-
+-This is usually a subnode of ocp2scp to which it is connected.
+-
+-usb2phy@4a0ad080 {
+-      compatible = "ti,omap-usb2";
+-      reg = <0x4a0ad080 0x58>;
+-      ctrl-module = <&omap_control_usb>;
+-};
+-
+-OMAP USB3 PHY
+-
+-Required properties:
+- - compatible: Should be "ti,omap-usb3"
+- - reg : Address and length of the register set for the device.
+- - reg-names: The names of the register addresses corresponding to the registers
+-   filled in "reg".
+-
+-Optional properties:
+- - ctrl-module : phandle of the control module used by PHY driver to power on
+-   the PHY.
+-
+-This is usually a subnode of ocp2scp to which it is connected.
+-
+-usb3phy@4a084400 {
+-      compatible = "ti,omap-usb3";
+-      reg = <0x4a084400 0x80>,
+-            <0x4a084800 0x64>,
+-            <0x4a084c00 0x40>;
+-      reg-names = "phy_rx", "phy_tx", "pll_ctrl";
+-      ctrl-module = <&omap_control_usb>;
+-};
+--- /dev/null
++++ b/Documentation/devicetree/bindings/video/da8xx-fb.txt
+@@ -0,0 +1,42 @@
++TI LCD Controller on DA830/DA850/AM335x SoC's
++
++Required properties:
++- compatible:
++      DA830, DA850 - "ti,da8xx-tilcdc"
++      AM335x SoC's - "ti,am33xx-tilcdc"
++- reg: Address range of lcdc register set
++- interrupts: lcdc interrupt
++- display-timings: typical videomode of lcd panel, represented as child.
++  Refer Documentation/devicetree/bindings/video/display-timing.txt for
++  display timing binding details. If multiple videomodes are mentioned
++  in display timings node, typical videomode has to be mentioned as the
++  native mode or it has to be first child (driver cares only for native
++  videomode).
++
++Recommended properties:
++- ti,hwmods: Name of the hwmod associated to the LCDC
++
++Example for am335x SoC's:
++
++lcdc@4830e000 {
++      compatible = "ti,am33xx-tilcdc";
++      reg =  <0x4830e000 0x1000>;
++      interrupts = <36>;
++      ti,hwmods = "lcdc";
++      status = "okay";
++      display-timings {
++              800x480p62 {
++                      clock-frequency = <30000000>;
++                      hactive = <800>;
++                      vactive = <480>;
++                      hfront-porch = <39>;
++                      hback-porch = <39>;
++                      hsync-len = <47>;
++                      vback-porch = <29>;
++                      vfront-porch = <13>;
++                      vsync-len = <2>;
++                      hsync-active = <1>;
++                      vsync-active = <1>;
++              };
++      };
++};
+--- /dev/null
++++ b/Documentation/phy.txt
+@@ -0,0 +1,166 @@
++                          PHY SUBSYSTEM
++                Kishon Vijay Abraham I <kishon@ti.com>
++
++This document explains the Generic PHY Framework along with the APIs provided,
++and how-to-use.
++
++1. Introduction
++
++*PHY* is the abbreviation for physical layer. It is used to connect a device
++to the physical medium e.g., the USB controller has a PHY to provide functions
++such as serialization, de-serialization, encoding, decoding and is responsible
++for obtaining the required data transmission rate. Note that some USB
++controllers have PHY functionality embedded into it and others use an external
++PHY. Other peripherals that use PHY include Wireless LAN, Ethernet,
++SATA etc.
++
++The intention of creating this framework is to bring the PHY drivers spread
++all over the Linux kernel to drivers/phy to increase code re-use and for
++better code maintainability.
++
++This framework will be of use only to devices that use external PHY (PHY
++functionality is not embedded within the controller).
++
++2. Registering/Unregistering the PHY provider
++
++PHY provider refers to an entity that implements one or more PHY instances.
++For the simple case where the PHY provider implements only a single instance of
++the PHY, the framework provides its own implementation of of_xlate in
++of_phy_simple_xlate. If the PHY provider implements multiple instances, it
++should provide its own implementation of of_xlate. of_xlate is used only for
++dt boot case.
++
++#define of_phy_provider_register(dev, xlate)    \
++        __of_phy_provider_register((dev), THIS_MODULE, (xlate))
++
++#define devm_of_phy_provider_register(dev, xlate)       \
++        __devm_of_phy_provider_register((dev), THIS_MODULE, (xlate))
++
++of_phy_provider_register and devm_of_phy_provider_register macros can be used to
++register the phy_provider and it takes device and of_xlate as
++arguments. For the dt boot case, all PHY providers should use one of the above
++2 macros to register the PHY provider.
++
++void devm_of_phy_provider_unregister(struct device *dev,
++      struct phy_provider *phy_provider);
++void of_phy_provider_unregister(struct phy_provider *phy_provider);
++
++devm_of_phy_provider_unregister and of_phy_provider_unregister can be used to
++unregister the PHY.
++
++3. Creating the PHY
++
++The PHY driver should create the PHY in order for other peripheral controllers
++to make use of it. The PHY framework provides 2 APIs to create the PHY.
++
++struct phy *phy_create(struct device *dev, const struct phy_ops *ops,
++        struct phy_init_data *init_data);
++struct phy *devm_phy_create(struct device *dev, const struct phy_ops *ops,
++      struct phy_init_data *init_data);
++
++The PHY drivers can use one of the above 2 APIs to create the PHY by passing
++the device pointer, phy ops and init_data.
++phy_ops is a set of function pointers for performing PHY operations such as
++init, exit, power_on and power_off. *init_data* is mandatory to get a reference
++to the PHY in the case of non-dt boot. See section *Board File Initialization*
++on how init_data should be used.
++
++Inorder to dereference the private data (in phy_ops), the phy provider driver
++can use phy_set_drvdata() after creating the PHY and use phy_get_drvdata() in
++phy_ops to get back the private data.
++
++4. Getting a reference to the PHY
++
++Before the controller can make use of the PHY, it has to get a reference to
++it. This framework provides the following APIs to get a reference to the PHY.
++
++struct phy *phy_get(struct device *dev, const char *string);
++struct phy *devm_phy_get(struct device *dev, const char *string);
++
++phy_get and devm_phy_get can be used to get the PHY. In the case of dt boot,
++the string arguments should contain the phy name as given in the dt data and
++in the case of non-dt boot, it should contain the label of the PHY.
++The only difference between the two APIs is that devm_phy_get associates the
++device with the PHY using devres on successful PHY get. On driver detach,
++release function is invoked on the the devres data and devres data is freed.
++
++5. Releasing a reference to the PHY
++
++When the controller no longer needs the PHY, it has to release the reference
++to the PHY it has obtained using the APIs mentioned in the above section. The
++PHY framework provides 2 APIs to release a reference to the PHY.
++
++void phy_put(struct phy *phy);
++void devm_phy_put(struct device *dev, struct phy *phy);
++
++Both these APIs are used to release a reference to the PHY and devm_phy_put
++destroys the devres associated with this PHY.
++
++6. Destroying the PHY
++
++When the driver that created the PHY is unloaded, it should destroy the PHY it
++created using one of the following 2 APIs.
++
++void phy_destroy(struct phy *phy);
++void devm_phy_destroy(struct device *dev, struct phy *phy);
++
++Both these APIs destroy the PHY and devm_phy_destroy destroys the devres
++associated with this PHY.
++
++7. PM Runtime
++
++This subsystem is pm runtime enabled. So while creating the PHY,
++pm_runtime_enable of the phy device created by this subsystem is called and
++while destroying the PHY, pm_runtime_disable is called. Note that the phy
++device created by this subsystem will be a child of the device that calls
++phy_create (PHY provider device).
++
++So pm_runtime_get_sync of the phy_device created by this subsystem will invoke
++pm_runtime_get_sync of PHY provider device because of parent-child relationship.
++It should also be noted that phy_power_on and phy_power_off performs
++phy_pm_runtime_get_sync and phy_pm_runtime_put respectively.
++There are exported APIs like phy_pm_runtime_get, phy_pm_runtime_get_sync,
++phy_pm_runtime_put, phy_pm_runtime_put_sync, phy_pm_runtime_allow and
++phy_pm_runtime_forbid for performing PM operations.
++
++8. Board File Initialization
++
++Certain board file initialization is necessary in order to get a reference
++to the PHY in the case of non-dt boot.
++Say we have a single device that implements 3 PHYs that of USB, SATA and PCIe,
++then in the board file the following initialization should be done.
++
++struct phy_consumer consumers[] = {
++      PHY_CONSUMER("dwc3.0", "usb"),
++      PHY_CONSUMER("pcie.0", "pcie"),
++      PHY_CONSUMER("sata.0", "sata"),
++};
++PHY_CONSUMER takes 2 parameters, first is the device name of the controller
++(PHY consumer) and second is the port name.
++
++struct phy_init_data init_data = {
++      .consumers = consumers,
++      .num_consumers = ARRAY_SIZE(consumers),
++};
++
++static const struct platform_device pipe3_phy_dev = {
++      .name = "pipe3-phy",
++      .id = -1,
++      .dev = {
++              .platform_data = {
++                      .init_data = &init_data,
++              },
++      },
++};
++
++then, while doing phy_create, the PHY driver should pass this init_data
++      phy_create(dev, ops, pdata->init_data);
++
++and the controller driver (phy consumer) should pass the port name along with
++the device to get a reference to the PHY
++      phy_get(dev, "pcie");
++
++9. DeviceTree Binding
++
++The documentation for PHY dt binding can be found @
++Documentation/devicetree/bindings/phy/phy-bindings.txt
+--- a/drivers/ata/ahci.h
++++ b/drivers/ata/ahci.h
+@@ -322,6 +322,7 @@ struct ahci_host_priv {
+       u32                     em_buf_sz;      /* EM buffer size in byte */
+       u32                     em_msg_type;    /* EM message type */
+       struct clk              *clk;           /* Only for platforms supporting clk */
++      struct phy              *phy;           /* If platforms use phy */
+       void                    *plat_data;     /* Other platform data */
+ };
+--- a/drivers/ata/ahci_platform.c
++++ b/drivers/ata/ahci_platform.c
+@@ -23,6 +23,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/libata.h>
+ #include <linux/ahci_platform.h>
++#include <linux/phy/phy.h>
+ #include "ahci.h"
+ static void ahci_host_stop(struct ata_host *host);
+@@ -141,16 +142,32 @@ static int ahci_probe(struct platform_de
+               }
+       }
++      hpriv->phy = devm_phy_get(dev, "sata-phy");
++      if (IS_ERR(hpriv->phy)) {
++              dev_dbg(dev, "can't get sata-phy\n");
++              /* return only if -EPROBE_DEFER */
++              if (PTR_ERR(hpriv->phy) == -EPROBE_DEFER) {
++                      rc = -EPROBE_DEFER;
++                      goto disable_unprepare_clk;
++              }
++      }
++
++      if (!IS_ERR(hpriv->phy)) {
++              phy_init(hpriv->phy);
++              phy_power_on(hpriv->phy);
++      }
++
+       /*
+        * Some platforms might need to prepare for mmio region access,
+        * which could be done in the following init call. So, the mmio
+        * region shouldn't be accessed before init (if provided) has
+        * returned successfully.
+        */
++
+       if (pdata && pdata->init) {
+               rc = pdata->init(dev, hpriv->mmio);
+               if (rc)
+-                      goto disable_unprepare_clk;
++                      goto disable_phy;
+       }
+       ahci_save_initial_config(dev, hpriv,
+@@ -220,6 +237,12 @@ static int ahci_probe(struct platform_de
+ pdata_exit:
+       if (pdata && pdata->exit)
+               pdata->exit(dev);
++disable_phy:
++      if (!IS_ERR(hpriv->phy)) {
++              phy_power_off(hpriv->phy);
++              phy_exit(hpriv->phy);
++      }
++
+ disable_unprepare_clk:
+       if (!IS_ERR(hpriv->clk))
+               clk_disable_unprepare(hpriv->clk);
+@@ -238,6 +261,11 @@ static void ahci_host_stop(struct ata_ho
+       if (pdata && pdata->exit)
+               pdata->exit(dev);
++      if (!IS_ERR(hpriv->phy)) {
++              phy_power_off(hpriv->phy);
++              phy_exit(hpriv->phy);
++      }
++
+       if (!IS_ERR(hpriv->clk)) {
+               clk_disable_unprepare(hpriv->clk);
+               clk_put(hpriv->clk);
+@@ -328,6 +356,7 @@ static SIMPLE_DEV_PM_OPS(ahci_pm_ops, ah
+ static const struct of_device_id ahci_of_match[] = {
+       { .compatible = "snps,spear-ahci", },
+       { .compatible = "snps,exynos5440-ahci", },
++      { .compatible = "snps,dwc-ahci", },
+       {},
+ };
+ MODULE_DEVICE_TABLE(of, ahci_of_match);
+--- a/drivers/ata/Kconfig
++++ b/drivers/ata/Kconfig
+@@ -137,6 +137,13 @@ config SATA_SIL24
+         If unsure, say N.
++config SATA_TI
++      tristate "Texas Instruments SATA Wrapper driver"
++      depends on ARCH_OMAP
++      help
++        This options enables SATA Wrapper driver for Texas Instruments SoCs.
++        It is found on OMAP5 and DRA7.
++
+ config ATA_SFF
+       bool "ATA SFF support (for legacy IDE and PATA)"
+       default y
+--- a/drivers/ata/Makefile
++++ b/drivers/ata/Makefile
+@@ -11,6 +11,7 @@ obj-$(CONFIG_SATA_SIL24)     += sata_sil24.o
+ obj-$(CONFIG_SATA_DWC)                += sata_dwc_460ex.o
+ obj-$(CONFIG_SATA_HIGHBANK)   += sata_highbank.o libahci.o
+ obj-$(CONFIG_AHCI_IMX)                += ahci_imx.o
++obj-$(CONFIG_SATA_TI)         += sata_ti.o
+ # SFF w/ custom DMA
+ obj-$(CONFIG_PDC_ADMA)                += pdc_adma.o
+--- /dev/null
++++ b/drivers/ata/sata_ti.c
+@@ -0,0 +1,160 @@
++/**
++ * sata-ti.c - Texas Instruments Specific SATA Glue layer
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ *
++ * Authors: Roger Quadros <rogerq@ti.com>
++ *
++ * This program is free software: you can redistribute it and/or modify
++ * it under the terms of the GNU General Public License version 2  of
++ * the License 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.
++ */
++
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/slab.h>
++#include <linux/platform_device.h>
++#include <linux/ioport.h>
++#include <linux/io.h>
++#include <linux/pm_runtime.h>
++#include <linux/of.h>
++#include <linux/of_platform.h>
++
++/*
++ * All these registers belong to OMAP's Wrapper around the
++ * DesignWare SATA Core.
++ */
++
++#define SATA_SYSCONFIG                                0x0000
++#define SATA_CDRLOCK                          0x0004
++
++struct ti_sata {
++      struct device *dev;
++      void __iomem *base;
++};
++
++static int ti_sata_probe(struct platform_device *pdev)
++{
++      struct device_node *np = pdev->dev.of_node;
++      struct device *dev = &pdev->dev;
++      struct ti_sata *sata;
++      struct resource *res;
++      void __iomem *base;
++      int ret;
++
++      if (!np) {
++              dev_err(dev, "device node not found\n");
++              return -EINVAL;
++      }
++
++      sata = devm_kzalloc(dev, sizeof(*sata), GFP_KERNEL);
++      if (!sata)
++              return -ENOMEM;
++
++      platform_set_drvdata(pdev, sata);
++
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      if (!res) {
++              dev_err(dev, "missing memory base resource\n");
++              return -EINVAL;
++      }
++
++      base = devm_ioremap_resource(dev, res);
++      if (IS_ERR(base))
++              return PTR_ERR(base);
++
++      sata->dev = dev;
++      sata->base = base;
++
++      pm_runtime_enable(dev);
++      ret = pm_runtime_get_sync(dev);
++      if (ret < 0) {
++              dev_err(dev, "pm_runtime_get_sync failed with err %d\n",
++                                                                      ret);
++              goto runtime_disable;
++      }
++
++      ret = of_platform_populate(np, NULL, NULL, dev);
++      if (ret) {
++              dev_err(&pdev->dev, "failed to create TI SATA children\n");
++              goto runtime_put;
++      }
++
++      return 0;
++
++runtime_put:
++      pm_runtime_put_sync(dev);
++
++runtime_disable:
++      pm_runtime_disable(dev);
++
++      return ret;
++}
++
++static int ti_sata_remove_child(struct device *dev, void *c)
++{
++      struct platform_device *pdev = to_platform_device(dev);
++
++      platform_device_unregister(pdev);
++
++      return 0;
++}
++
++static int ti_sata_remove(struct platform_device *pdev)
++{
++      pm_runtime_put_sync(&pdev->dev);
++      pm_runtime_disable(&pdev->dev);
++      device_for_each_child(&pdev->dev, NULL, ti_sata_remove_child);
++
++      return 0;
++}
++
++static const struct of_device_id of_ti_sata_match[] = {
++      {
++              .compatible =   "ti,sata"
++      },
++      { },
++};
++MODULE_DEVICE_TABLE(of, of_ti_sata_match);
++
++#ifdef CONFIG_PM
++
++static int ti_sata_resume(struct device *dev)
++{
++      pm_runtime_disable(dev);
++      pm_runtime_set_active(dev);
++      pm_runtime_enable(dev);
++
++      return 0;
++}
++
++static const struct dev_pm_ops ti_sata_dev_pm_ops = {
++      .resume = ti_sata_resume,
++};
++
++#define DEV_PM_OPS    (&ti_sata_dev_pm_ops)
++#else
++#define DEV_PM_OPS    NULL
++#endif /* CONFIG_PM */
++
++static struct platform_driver ti_sata_driver = {
++      .probe          = ti_sata_probe,
++      .remove         = ti_sata_remove,
++      .driver         = {
++              .name   = "ti-sata",
++              .of_match_table = of_ti_sata_match,
++              .pm     = DEV_PM_OPS,
++      },
++};
++
++module_platform_driver(ti_sata_driver);
++
++MODULE_ALIAS("platform:ti-sata");
++MODULE_AUTHOR("Roger Quadros <rogerq@ti.com>");
++MODULE_LICENSE("GPL v2");
++MODULE_DESCRIPTION("TI SATA Glue Layer");
+--- a/drivers/clk/clk.c
++++ b/drivers/clk/clk.c
+@@ -2196,6 +2196,12 @@ struct clk *of_clk_get_from_provider(str
+       return clk;
+ }
++int of_clk_get_parent_count(struct device_node *np)
++{
++      return of_count_phandle_with_args(np, "clocks", "#clock-cells");
++}
++EXPORT_SYMBOL_GPL(of_clk_get_parent_count);
++
+ const char *of_clk_get_parent_name(struct device_node *np, int index)
+ {
+       struct of_phandle_args clkspec;
+--- a/drivers/clk/clk-divider.c
++++ b/drivers/clk/clk-divider.c
+@@ -1,7 +1,7 @@
+ /*
+  * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
+  * Copyright (C) 2011 Richard Zhao, Linaro <richard.zhao@linaro.org>
+- * Copyright (C) 2011-2012 Mike Turquette, Linaro Ltd <mturquette@linaro.org>
++ * Copyright (C) 2011-2013 Mike Turquette, Linaro Ltd <mturquette@linaro.org>
+  *
+  * 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
+@@ -17,6 +17,8 @@
+ #include <linux/err.h>
+ #include <linux/string.h>
+ #include <linux/log2.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
+ /*
+  * DOC: basic adjustable divider clock that cannot gate
+@@ -30,8 +32,6 @@
+ #define to_clk_divider(_hw) container_of(_hw, struct clk_divider, hw)
+-#define div_mask(d)   ((1 << ((d)->width)) - 1)
+-
+ static unsigned int _get_table_maxdiv(const struct clk_div_table *table)
+ {
+       unsigned int maxdiv = 0;
+@@ -46,12 +46,12 @@ static unsigned int _get_table_maxdiv(co
+ static unsigned int _get_maxdiv(struct clk_divider *divider)
+ {
+       if (divider->flags & CLK_DIVIDER_ONE_BASED)
+-              return div_mask(divider);
++              return divider->mask;
+       if (divider->flags & CLK_DIVIDER_POWER_OF_TWO)
+-              return 1 << div_mask(divider);
++              return 1 << divider->mask;
+       if (divider->table)
+               return _get_table_maxdiv(divider->table);
+-      return div_mask(divider) + 1;
++      return divider->mask + 1;
+ }
+ static unsigned int _get_table_div(const struct clk_div_table *table,
+@@ -105,7 +105,7 @@ static unsigned long clk_divider_recalc_
+       unsigned int div, val;
+       val = clk_readl(divider->reg) >> divider->shift;
+-      val &= div_mask(divider);
++      val &= divider->mask;
+       div = _get_div(divider, val);
+       if (!div) {
+@@ -221,17 +221,17 @@ static int clk_divider_set_rate(struct c
+       div = parent_rate / rate;
+       value = _get_val(divider, div);
+-      if (value > div_mask(divider))
+-              value = div_mask(divider);
++      if (value > divider->mask)
++              value = divider->mask;
+       if (divider->lock)
+               spin_lock_irqsave(divider->lock, flags);
+       if (divider->flags & CLK_DIVIDER_HIWORD_MASK) {
+-              val = div_mask(divider) << (divider->shift + 16);
++              val = divider->mask << (divider->shift + 16);
+       } else {
+               val = clk_readl(divider->reg);
+-              val &= ~(div_mask(divider) << divider->shift);
++              val &= ~(divider->mask << divider->shift);
+       }
+       val |= value << divider->shift;
+       clk_writel(val, divider->reg);
+@@ -251,7 +251,7 @@ EXPORT_SYMBOL_GPL(clk_divider_ops);
+ static struct clk *_register_divider(struct device *dev, const char *name,
+               const char *parent_name, unsigned long flags,
+-              void __iomem *reg, u8 shift, u8 width,
++              void __iomem *reg, u8 shift, u32 mask,
+               u8 clk_divider_flags, const struct clk_div_table *table,
+               spinlock_t *lock)
+ {
+@@ -260,8 +260,9 @@ static struct clk *_register_divider(str
+       struct clk_init_data init;
+       if (clk_divider_flags & CLK_DIVIDER_HIWORD_MASK) {
+-              if (width + shift > 16) {
+-                      pr_warn("divider value exceeds LOWORD field\n");
++              if ((mask << shift) & 0xffff0000) {
++                      pr_warn("%s: divider value exceeds LOWORD field\n",
++                                      __func__);
+                       return ERR_PTR(-EINVAL);
+               }
+       }
+@@ -282,7 +283,7 @@ static struct clk *_register_divider(str
+       /* struct clk_divider assignments */
+       div->reg = reg;
+       div->shift = shift;
+-      div->width = width;
++      div->mask = mask;
+       div->flags = clk_divider_flags;
+       div->lock = lock;
+       div->hw.init = &init;
+@@ -315,7 +316,7 @@ struct clk *clk_register_divider(struct
+               u8 clk_divider_flags, spinlock_t *lock)
+ {
+       return _register_divider(dev, name, parent_name, flags, reg, shift,
+-                      width, clk_divider_flags, NULL, lock);
++                      ((1 << width) - 1), clk_divider_flags, NULL, lock);
+ }
+ EXPORT_SYMBOL_GPL(clk_register_divider);
+@@ -340,6 +341,103 @@ struct clk *clk_register_divider_table(s
+               spinlock_t *lock)
+ {
+       return _register_divider(dev, name, parent_name, flags, reg, shift,
+-                      width, clk_divider_flags, table, lock);
++                      ((1 << width) - 1), clk_divider_flags, table, lock);
+ }
+ EXPORT_SYMBOL_GPL(clk_register_divider_table);
++
++#ifdef CONFIG_OF
++struct clk_div_table *of_clk_get_div_table(struct device_node *node)
++{
++      int i;
++      u32 table_size;
++      struct clk_div_table *table;
++      const __be32 *tablespec;
++      u32 val;
++
++      tablespec = of_get_property(node, "table", &table_size);
++
++      if (!tablespec)
++              return NULL;
++
++      table_size /= sizeof(struct clk_div_table);
++
++      table = kzalloc(sizeof(struct clk_div_table) * table_size, GFP_KERNEL);
++      if (!table) {
++              pr_err("%s: unable to allocate memory for %s table\n", __func__, node->name);
++              return NULL;
++      }
++
++      for (i = 0; i < table_size; i++) {
++              of_property_read_u32_index(node, "table", i * 2, &val);
++              table[i].div = val;
++              of_property_read_u32_index(node, "table", i * 2 + 1, &val);
++              table[i].val = val;
++      }
++
++      return table;
++}
++
++/**
++ * of_divider_clk_setup() - Setup function for simple div rate clock
++ */
++void of_divider_clk_setup(struct device_node *node)
++{
++      struct clk *clk;
++      const char *clk_name = node->name;
++      void __iomem *reg;
++      const char *parent_name;
++      u8 clk_divider_flags = 0;
++      u32 mask = 0;
++      u32 shift = 0;
++      struct clk_div_table *table;
++      u32 flags = 0;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      parent_name = of_clk_get_parent_name(node, 0);
++
++      reg = of_iomap(node, 0);
++      if (!reg) {
++              pr_err("%s: no memory mapped for property reg\n", __func__);
++              return;
++      }
++
++      if (of_property_read_u32(node, "bit-mask", &mask)) {
++              pr_err("%s: missing bit-mask property for %s\n", __func__, node->name);
++              return;
++      }
++
++      if (of_property_read_u32(node, "bit-shift", &shift)) {
++              shift = __ffs(mask);
++              pr_debug("%s: bit-shift property defaults to 0x%x for %s\n",
++                              __func__, shift, node->name);
++      }
++
++      if (of_property_read_bool(node, "index-starts-at-one"))
++              clk_divider_flags |= CLK_DIVIDER_ONE_BASED;
++
++      if (of_property_read_bool(node, "index-power-of-two"))
++              clk_divider_flags |= CLK_DIVIDER_POWER_OF_TWO;
++
++      if (of_property_read_bool(node, "index-allow-zero"))
++              clk_divider_flags |= CLK_DIVIDER_ALLOW_ZERO;
++
++      if (of_property_read_bool(node, "hiword-mask"))
++              clk_divider_flags |= CLK_DIVIDER_HIWORD_MASK;
++
++      if (of_property_read_bool(node, "set-rate-parent"))
++              flags |= CLK_SET_RATE_PARENT;
++
++      table = of_clk_get_div_table(node);
++      if (IS_ERR(table))
++              return;
++
++      clk = _register_divider(NULL, clk_name, parent_name, flags, reg, shift,
++                      mask, clk_divider_flags, table, NULL);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++}
++EXPORT_SYMBOL_GPL(of_divider_clk_setup);
++CLK_OF_DECLARE(divider_clk, "divider-clock", of_divider_clk_setup);
++#endif
+--- a/drivers/clk/clk-fixed-factor.c
++++ b/drivers/clk/clk-fixed-factor.c
+@@ -109,6 +109,7 @@ void __init of_fixed_factor_clk_setup(st
+       const char *clk_name = node->name;
+       const char *parent_name;
+       u32 div, mult;
++      u32 flags = 0;
+       if (of_property_read_u32(node, "clock-div", &div)) {
+               pr_err("%s Fixed factor clock <%s> must have a clock-div property\n",
+@@ -125,7 +126,10 @@ void __init of_fixed_factor_clk_setup(st
+       of_property_read_string(node, "clock-output-names", &clk_name);
+       parent_name = of_clk_get_parent_name(node, 0);
+-      clk = clk_register_fixed_factor(NULL, clk_name, parent_name, 0,
++      if (of_property_read_bool(node, "set-rate-parent"))
++              flags |= CLK_SET_RATE_PARENT;
++
++      clk = clk_register_fixed_factor(NULL, clk_name, parent_name, flags,
+                                       mult, div);
+       if (!IS_ERR(clk))
+               of_clk_add_provider(node, of_clk_src_simple_get, clk);
+--- a/drivers/clk/clk-gate.c
++++ b/drivers/clk/clk-gate.c
+@@ -15,6 +15,8 @@
+ #include <linux/io.h>
+ #include <linux/err.h>
+ #include <linux/string.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
+ /**
+  * DOC: basic gatable clock which can gate and ungate it's ouput
+@@ -162,3 +164,52 @@ struct clk *clk_register_gate(struct dev
+       return clk;
+ }
+ EXPORT_SYMBOL_GPL(clk_register_gate);
++
++#ifdef CONFIG_OF
++/**
++ * of_gate_clk_setup() - Setup function for simple gate rate clock
++ */
++void of_gate_clk_setup(struct device_node *node)
++{
++      struct clk *clk;
++      const char *clk_name = node->name;
++      void __iomem *reg;
++      const char *parent_name;
++      u8 clk_gate_flags = 0;
++      u32 bit_idx = 0;
++      u32 flags = 0;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      parent_name = of_clk_get_parent_name(node, 0);
++
++      reg = of_iomap(node, 0);
++      if (!reg) {
++              pr_err("%s: no memory mapped for property reg\n", __func__);
++              return;
++      }
++
++      if (of_property_read_u32(node, "bit-shift", &bit_idx)) {
++              pr_err("%s: missing bit-shift property for %s\n",
++                              __func__, node->name);
++              return;
++      }
++
++      if (of_property_read_bool(node, "set-bit-to-disable"))
++              clk_gate_flags |= CLK_GATE_SET_TO_DISABLE;
++
++      if (of_property_read_bool(node, "hiword-mask"))
++              clk_gate_flags |= CLK_GATE_HIWORD_MASK;
++
++      if (of_property_read_bool(node, "set-rate-parent"))
++              flags |= CLK_SET_RATE_PARENT;
++
++      clk = clk_register_gate(NULL, clk_name, parent_name, flags, reg,
++                      bit_idx, clk_gate_flags, NULL);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++}
++EXPORT_SYMBOL_GPL(of_gate_clk_setup);
++CLK_OF_DECLARE(gate_clk, "gate-clock", of_gate_clk_setup);
++#endif
+--- a/drivers/clk/clk-mux.c
++++ b/drivers/clk/clk-mux.c
+@@ -1,7 +1,7 @@
+ /*
+  * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
+  * Copyright (C) 2011 Richard Zhao, Linaro <richard.zhao@linaro.org>
+- * Copyright (C) 2011-2012 Mike Turquette, Linaro Ltd <mturquette@linaro.org>
++ * Copyright (C) 2011-2013 Mike Turquette, Linaro Ltd <mturquette@linaro.org>
+  *
+  * 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
+@@ -16,6 +16,8 @@
+ #include <linux/slab.h>
+ #include <linux/io.h>
+ #include <linux/err.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
+ /*
+  * DOC: basic adjustable multiplexer clock that cannot gate
+@@ -177,3 +179,71 @@ struct clk *clk_register_mux(struct devi
+                                     NULL, lock);
+ }
+ EXPORT_SYMBOL_GPL(clk_register_mux);
++
++#ifdef CONFIG_OF
++/**
++ * of_mux_clk_setup() - Setup function for simple mux rate clock
++ */
++void of_mux_clk_setup(struct device_node *node)
++{
++      struct clk *clk;
++      const char *clk_name = node->name;
++      void __iomem *reg;
++      int num_parents;
++      const char **parent_names;
++      int i;
++      u8 clk_mux_flags = 0;
++      u32 mask = 0;
++      u32 shift = 0;
++      u32 flags = 0;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      num_parents = of_clk_get_parent_count(node);
++      if (num_parents < 1) {
++              pr_err("%s: mux-clock %s must have parent(s)\n",
++                              __func__, node->name);
++              return;
++      }
++
++      parent_names = kzalloc((sizeof(char*) * num_parents),
++                      GFP_KERNEL);
++
++      for (i = 0; i < num_parents; i++)
++              parent_names[i] = of_clk_get_parent_name(node, i);
++
++      reg = of_iomap(node, 0);
++      if (!reg) {
++              pr_err("%s: no memory mapped for property reg\n", __func__);
++              return;
++      }
++
++      if (of_property_read_u32(node, "bit-mask", &mask)) {
++              pr_err("%s: missing bit-mask property for %s\n", __func__, node->name);
++              return;
++      }
++
++      if (of_property_read_u32(node, "bit-shift", &shift)) {
++              shift = __ffs(mask);
++              pr_debug("%s: bit-shift property defaults to 0x%x for %s\n",
++                              __func__, shift, node->name);
++      }
++
++      if (of_property_read_bool(node, "index-starts-at-one"))
++              clk_mux_flags |= CLK_MUX_INDEX_ONE;
++
++      if (of_property_read_bool(node, "hiword-mask"))
++              clk_mux_flags |= CLK_MUX_HIWORD_MASK;
++
++      if (of_property_read_bool(node, "set-rate-parent"))
++              flags |= CLK_SET_RATE_PARENT;
++
++      clk = clk_register_mux_table(NULL, clk_name, parent_names, num_parents,
++                      flags, reg, shift, mask, clk_mux_flags, NULL, NULL);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++}
++EXPORT_SYMBOL_GPL(of_mux_clk_setup);
++CLK_OF_DECLARE(mux_clk, "mux-clock", of_mux_clk_setup);
++#endif
+--- /dev/null
++++ b/drivers/clk/clk-palmas.c
+@@ -0,0 +1,305 @@
++/*
++ * Clock driver for Palmas device.
++ *
++ * Copyright (c) 2013, NVIDIA Corporation.
++ *
++ * Author: Laxman Dewangan <ldewangan@nvidia.com>
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
++ * whether express or implied; 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., 59 Temple Place, Suite 330, Boston, MA
++ * 02111-1307, USA
++ */
++
++#include <linux/clk.h>
++#include <linux/clkdev.h>
++#include <linux/clk-provider.h>
++#include <linux/mfd/palmas.h>
++#include <linux/module.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++
++#define PALMAS_CLOCK_DT_EXT_CONTROL_ENABLE1   1
++#define PALMAS_CLOCK_DT_EXT_CONTROL_ENABLE2   2
++#define PALMAS_CLOCK_DT_EXT_CONTROL_NSLEEP    3
++
++struct palmas_clk32k_desc {
++      const char *clk_name;
++      unsigned int control_reg;
++      unsigned int enable_mask;
++      unsigned int sleep_mask;
++      unsigned int sleep_reqstr_id;
++      int delay;
++};
++
++struct palmas_clock_info {
++      struct device *dev;
++      struct clk *clk;
++      struct clk_hw hw;
++      struct palmas *palmas;
++      struct palmas_clk32k_desc *clk_desc;
++      int ext_control_pin;
++};
++
++static inline struct palmas_clock_info *to_palmas_clks_info(struct clk_hw *hw)
++{
++      return container_of(hw, struct palmas_clock_info, hw);
++}
++
++static unsigned long palmas_clks_recalc_rate(struct clk_hw *hw,
++                                           unsigned long parent_rate)
++{
++      return 32768;
++}
++
++static int palmas_clks_prepare(struct clk_hw *hw)
++{
++      struct palmas_clock_info *cinfo = to_palmas_clks_info(hw);
++      int ret;
++
++      ret = palmas_update_bits(cinfo->palmas, PALMAS_RESOURCE_BASE,
++                               cinfo->clk_desc->control_reg,
++                               cinfo->clk_desc->enable_mask,
++                               cinfo->clk_desc->enable_mask);
++      if (ret < 0)
++              dev_err(cinfo->dev, "Reg 0x%02x update failed, %d\n",
++                      cinfo->clk_desc->control_reg, ret);
++      else if (cinfo->clk_desc->delay)
++              udelay(cinfo->clk_desc->delay);
++
++      return ret;
++}
++
++static void palmas_clks_unprepare(struct clk_hw *hw)
++{
++      struct palmas_clock_info *cinfo = to_palmas_clks_info(hw);
++      int ret;
++
++      /*
++       * Clock can be disabled through external pin if it is externally
++       * controlled.
++       */
++      if (cinfo->ext_control_pin)
++              return;
++
++      ret = palmas_update_bits(cinfo->palmas, PALMAS_RESOURCE_BASE,
++                               cinfo->clk_desc->control_reg,
++                               cinfo->clk_desc->enable_mask, 0);
++      if (ret < 0)
++              dev_err(cinfo->dev, "Reg 0x%02x update failed, %d\n",
++                      cinfo->clk_desc->control_reg, ret);
++
++}
++
++static int palmas_clks_is_prepared(struct clk_hw *hw)
++{
++      struct palmas_clock_info *cinfo = to_palmas_clks_info(hw);
++      int ret;
++      u32 val;
++
++      if (cinfo->ext_control_pin)
++              return 1;
++
++      ret = palmas_read(cinfo->palmas, PALMAS_RESOURCE_BASE,
++                        cinfo->clk_desc->control_reg, &val);
++      if (ret < 0) {
++              dev_err(cinfo->dev, "Reg 0x%02x read failed, %d\n",
++                      cinfo->clk_desc->control_reg, ret);
++              return ret;
++      }
++      return !!(val & cinfo->clk_desc->enable_mask);
++}
++
++static struct clk_ops palmas_clks_ops = {
++      .prepare        = palmas_clks_prepare,
++      .unprepare      = palmas_clks_unprepare,
++      .is_prepared    = palmas_clks_is_prepared,
++      .recalc_rate    = palmas_clks_recalc_rate,
++};
++
++struct palmas_clks_of_match {
++      struct clk_init_data init;
++      struct palmas_clk32k_desc desc;
++};
++
++static struct palmas_clks_of_match palmas_of_clk32kg = {
++      .init = {
++              .name = "clk32kg",
++              .ops = &palmas_clks_ops,
++              .flags = CLK_IS_ROOT | CLK_IGNORE_UNUSED,
++      },
++      .desc = {
++              .clk_name = "clk32kg",
++              .control_reg = PALMAS_CLK32KG_CTRL,
++              .enable_mask = PALMAS_CLK32KG_CTRL_MODE_ACTIVE,
++              .sleep_mask = PALMAS_CLK32KG_CTRL_MODE_SLEEP,
++              .sleep_reqstr_id = PALMAS_EXTERNAL_REQSTR_ID_CLK32KG,
++              .delay = 200,
++      },
++};
++
++static struct palmas_clks_of_match palmas_of_clk32kgaudio = {
++      .init = {
++              .name = "clk32kgaudio",
++              .ops = &palmas_clks_ops,
++              .flags = CLK_IS_ROOT | CLK_IGNORE_UNUSED,
++      },
++      .desc = {
++              .clk_name = "clk32kgaudio",
++              .control_reg = PALMAS_CLK32KGAUDIO_CTRL,
++              .enable_mask = PALMAS_CLK32KG_CTRL_MODE_ACTIVE,
++              .sleep_mask = PALMAS_CLK32KG_CTRL_MODE_SLEEP,
++              .sleep_reqstr_id = PALMAS_EXTERNAL_REQSTR_ID_CLK32KGAUDIO,
++              .delay = 200,
++      },
++};
++
++static struct of_device_id of_palmas_clks_match_tbl[] = {
++      { .compatible = "ti,palmas-clk32kg", .data = &palmas_of_clk32kg, },
++      { .compatible = "ti,palmas-clk32kgaudio", .data = &palmas_of_clk32kgaudio, },
++      {},
++};
++MODULE_DEVICE_TABLE(of, of_palmas_clks_match_tbl);
++
++static void palmas_clks_get_clk_data(struct platform_device *pdev,
++                                   struct palmas_clock_info *cinfo)
++{
++      struct device_node *node = pdev->dev.of_node;
++      unsigned int prop;
++      int ret;
++
++      ret = of_property_read_u32(node, "ti,external-sleep-control",
++                                 &prop);
++      if (ret)
++              return;
++
++      switch (prop) {
++      case PALMAS_CLOCK_DT_EXT_CONTROL_ENABLE1:
++              prop = PALMAS_EXT_CONTROL_ENABLE1;
++              break;
++      case PALMAS_CLOCK_DT_EXT_CONTROL_ENABLE2:
++              prop = PALMAS_EXT_CONTROL_ENABLE2;
++              break;
++      case PALMAS_CLOCK_DT_EXT_CONTROL_NSLEEP:
++              prop = PALMAS_EXT_CONTROL_NSLEEP;
++              break;
++      default:
++              dev_warn(&pdev->dev, "%s: Invalid ext control option: %u\n",
++                       node->name, prop);
++              prop = 0;
++              break;
++      }
++      cinfo->ext_control_pin = prop;
++}
++
++static int palmas_clks_init_configure(struct palmas_clock_info *cinfo)
++{
++      int ret;
++
++      ret = palmas_update_bits(cinfo->palmas, PALMAS_RESOURCE_BASE,
++                               cinfo->clk_desc->control_reg,
++                               cinfo->clk_desc->sleep_mask, 0);
++      if (ret < 0) {
++              dev_err(cinfo->dev, "Reg 0x%02x update failed, %d\n",
++                      cinfo->clk_desc->control_reg, ret);
++              return ret;
++      }
++
++      if (cinfo->ext_control_pin) {
++              ret = clk_prepare(cinfo->clk);
++              if (ret < 0) {
++                      dev_err(cinfo->dev, "Clock prep failed, %d\n", ret);
++                      return ret;
++              }
++
++              ret = palmas_ext_control_req_config(cinfo->palmas,
++                                      cinfo->clk_desc->sleep_reqstr_id,
++                                      cinfo->ext_control_pin, true);
++              if (ret < 0) {
++                      dev_err(cinfo->dev, "Ext config for %s failed, %d\n",
++                              cinfo->clk_desc->clk_name, ret);
++                      return ret;
++              }
++      }
++
++      return ret;
++}
++static int palmas_clks_probe(struct platform_device *pdev)
++{
++      struct palmas *palmas = dev_get_drvdata(pdev->dev.parent);
++      struct device_node *node = pdev->dev.of_node;
++      struct palmas_clks_of_match *match_data;
++      const struct of_device_id *match;
++      struct palmas_clock_info *cinfo;
++      struct clk *clk;
++      int ret;
++
++      match = of_match_device(of_palmas_clks_match_tbl, &pdev->dev);
++      match_data = (struct palmas_clks_of_match *) match->data;
++
++      cinfo = devm_kzalloc(&pdev->dev, sizeof(*cinfo), GFP_KERNEL);
++      if (!cinfo)
++              return -ENOMEM;
++
++      palmas_clks_get_clk_data(pdev, cinfo);
++      platform_set_drvdata(pdev, cinfo);
++
++      cinfo->dev = &pdev->dev;
++      cinfo->palmas = palmas;
++
++      cinfo->clk_desc = &match_data->desc;
++      cinfo->hw.init = &match_data->init;
++      clk = devm_clk_register(&pdev->dev, &cinfo->hw);
++      if (IS_ERR(clk)) {
++              ret = PTR_ERR(clk);
++              dev_err(&pdev->dev, "Fail to register clock %s, %d\n",
++                      match_data->desc.clk_name, ret);
++              return ret;
++      }
++
++      cinfo->clk = clk;
++      ret = palmas_clks_init_configure(cinfo);
++      if (ret < 0) {
++              dev_err(&pdev->dev, "Clock config failed, %d\n", ret);
++              return ret;
++      }
++
++      ret = of_clk_add_provider(node, of_clk_src_simple_get, cinfo->clk);
++      if (ret < 0)
++              dev_err(&pdev->dev, "Fail to add clock driver, %d\n", ret);
++      return ret;
++}
++
++static int palmas_clks_remove(struct platform_device *pdev)
++{
++      of_clk_del_provider(pdev->dev.of_node);
++      return 0;
++}
++
++static struct platform_driver palmas_clks_driver = {
++      .driver = {
++              .name = "palmas-clk",
++              .owner = THIS_MODULE,
++              .of_match_table = of_palmas_clks_match_tbl,
++      },
++      .probe = palmas_clks_probe,
++      .remove = palmas_clks_remove,
++};
++
++module_platform_driver(palmas_clks_driver);
++
++MODULE_DESCRIPTION("Clock driver for Palmas Series Devices");
++MODULE_ALIAS("platform:palmas-clk");
++MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
++MODULE_LICENSE("GPL v2");
+--- a/drivers/clk/Kconfig
++++ b/drivers/clk/Kconfig
+@@ -93,6 +93,13 @@ config CLK_PPC_CORENET
+         This adds the clock driver support for Freescale PowerPC corenet
+         platforms using common clock framework.
++config COMMON_CLK_PALMAS
++      bool "Clock driver for TI Palmas devices"
++      depends on MFD_PALMAS
++      ---help---
++        This driver supports TI Palmas devices 32KHz output KG and KG_AUDIO
++        using common clock framework.
++
+ endmenu
+ source "drivers/clk/mvebu/Kconfig"
+--- a/drivers/clk/Makefile
++++ b/drivers/clk/Makefile
+@@ -32,6 +32,7 @@ obj-$(CONFIG_ARCH_VT8500)    += clk-vt8500.
+ obj-$(CONFIG_ARCH_ZYNQ)               += zynq/
+ obj-$(CONFIG_ARCH_TEGRA)      += tegra/
+ obj-$(CONFIG_PLAT_SAMSUNG)    += samsung/
++obj-$(CONFIG_ARCH_OMAP)               += ti/
+ obj-$(CONFIG_X86)             += x86/
+@@ -43,3 +44,4 @@ obj-$(CONFIG_COMMON_CLK_SI5351) += clk-s
+ obj-$(CONFIG_COMMON_CLK_S2MPS11) += clk-s2mps11.o
+ obj-$(CONFIG_CLK_TWL6040)     += clk-twl6040.o
+ obj-$(CONFIG_CLK_PPC_CORENET) += clk-ppc-corenet.o
++obj-$(CONFIG_COMMON_CLK_PALMAS)       += clk-palmas.o
+--- /dev/null
++++ b/drivers/clk/ti/apll.c
+@@ -0,0 +1,212 @@
++/*
++ * OMAP APLL clock support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * J Keerthy <j-keerthy@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/module.h>
++#include <linux/slab.h>
++#include <linux/io.h>
++#include <linux/err.h>
++#include <linux/string.h>
++#include <linux/log2.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++#include <linux/clk/ti.h>
++#include <linux/delay.h>
++
++#define APLL_FORCE_LOCK 0x1
++#define APLL_AUTO_IDLE        0x2
++#define MAX_APLL_WAIT_TRIES           1000000
++
++static int dra7_apll_enable(struct clk_hw *hw)
++{
++      struct clk_hw_omap *clk = to_clk_hw_omap(hw);
++      int r = 0, i = 0;
++      struct dpll_data *ad;
++      const char *clk_name;
++      u8 state = 1;
++      u32 v;
++
++      ad = clk->dpll_data;
++      if (!ad)
++              return -EINVAL;
++
++      clk_name = __clk_get_name(clk->hw.clk);
++
++      state <<= __ffs(ad->idlest_mask);
++
++      /* Check is already locked */
++      if ((readl(ad->idlest_reg) & ad->idlest_mask) == state)
++              return r;
++
++      v = readl(ad->control_reg);
++      v &= ~ad->enable_mask;
++      v |= APLL_FORCE_LOCK << __ffs(ad->enable_mask);
++      writel(v, ad->control_reg);
++
++      state <<= __ffs(ad->idlest_mask);
++
++      while (((readl(ad->idlest_reg) & ad->idlest_mask) != state) &&
++             i < MAX_APLL_WAIT_TRIES) {
++              i++;
++              udelay(1);
++      }
++
++      if (i == MAX_APLL_WAIT_TRIES) {
++              pr_warn("clock: %s failed transition to '%s'\n",
++                      clk_name, (state) ? "locked" : "bypassed");
++      } else {
++              pr_debug("clock: %s transition to '%s' in %d loops\n",
++                       clk_name, (state) ? "locked" : "bypassed", i);
++
++              r = 0;
++      }
++
++      return r;
++}
++
++static void dra7_apll_disable(struct clk_hw *hw)
++{
++      struct clk_hw_omap *clk = to_clk_hw_omap(hw);
++      struct dpll_data *ad;
++      u8 state = 1;
++      u32 v;
++
++      ad = clk->dpll_data;
++
++      state <<= __ffs(ad->idlest_mask);
++
++      v = readl(ad->control_reg);
++      v &= ~ad->enable_mask;
++      v |= APLL_AUTO_IDLE << __ffs(ad->enable_mask);
++      writel(v, ad->control_reg);
++}
++
++static u8 dra7_init_apll_parent(struct clk_hw *hw)
++{
++      return 0;
++}
++
++static const struct clk_ops apll_ck_ops = {
++      .enable         = &dra7_apll_enable,
++      .disable        = &dra7_apll_disable,
++      .get_parent     = &dra7_init_apll_parent,
++};
++
++static struct clk *omap_clk_register_apll(struct device *dev, const char *name,
++              const char **parent_names, int num_parents, unsigned long flags,
++              struct dpll_data *dpll_data, const char *clkdm_name,
++              const struct clk_ops *ops)
++{
++      struct clk *clk;
++      struct clk_init_data init = { 0 };
++      struct clk_hw_omap *clk_hw;
++
++      clk_hw = kzalloc(sizeof(*clk_hw), GFP_KERNEL);
++      if (!clk_hw) {
++              pr_err("%s: could not allocate clk_hw_omap\n", __func__);
++              return ERR_PTR(-ENOMEM);
++      }
++
++      clk_hw->dpll_data = dpll_data;
++      clk_hw->hw.init = &init;
++
++      init.name = name;
++      init.ops = ops;
++      init.flags = flags;
++      init.parent_names = parent_names;
++      init.num_parents = num_parents;
++
++      /* register the clock */
++      clk = clk_register(dev, &clk_hw->hw);
++
++      return clk;
++}
++
++void __init of_dra7_apll_setup(struct device_node *node)
++{
++      const struct clk_ops *ops;
++      struct clk *clk;
++      const char *clk_name = node->name;
++      int num_parents;
++      const char **parent_names = NULL;
++      u8 apll_flags = 0;
++      struct dpll_data *ad;
++      u32 idlest_mask = 0x1;
++      u32 autoidle_mask = 0x3;
++      int i;
++
++      ops = &apll_ck_ops;
++      ad = kzalloc(sizeof(*ad), GFP_KERNEL);
++      if (!ad) {
++              pr_err("%s: could not allocate dpll_data\n", __func__);
++              return;
++      }
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      num_parents = of_clk_get_parent_count(node);
++      if (num_parents < 1) {
++              pr_err("%s: omap dpll %s must have parent(s)\n",
++                     __func__, node->name);
++              goto cleanup;
++      }
++
++      parent_names = kzalloc(sizeof(char *) * num_parents, GFP_KERNEL);
++
++      for (i = 0; i < num_parents; i++)
++              parent_names[i] = of_clk_get_parent_name(node, i);
++
++      ad->clk_ref = of_clk_get(node, 0);
++      ad->clk_bypass = of_clk_get(node, 1);
++
++      if (IS_ERR(ad->clk_ref)) {
++              pr_err("%s: ti,clk-ref for %s not found\n", __func__,
++                     clk_name);
++              goto cleanup;
++      }
++
++      if (IS_ERR(ad->clk_bypass)) {
++              pr_err("%s: ti,clk-bypass for %s not found\n", __func__,
++                     clk_name);
++              goto cleanup;
++      }
++
++      i = of_property_match_string(node, "reg-names", "control");
++      if (i >= 0)
++              ad->control_reg = of_iomap(node, i);
++
++      i = of_property_match_string(node, "reg-names", "idlest");
++      if (i >= 0)
++              ad->idlest_reg = of_iomap(node, i);
++
++      ad->idlest_mask = idlest_mask;
++      ad->enable_mask = autoidle_mask;
++
++      clk = omap_clk_register_apll(NULL, clk_name, parent_names,
++                              num_parents, apll_flags, ad,
++                              NULL, ops);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++      return;
++
++cleanup:
++      kfree(parent_names);
++      kfree(ad);
++      return;
++}
++CLK_OF_DECLARE(dra7_apll_clock, "ti,dra7-apll-clock", of_dra7_apll_setup);
+--- /dev/null
++++ b/drivers/clk/ti/autoidle.c
+@@ -0,0 +1,121 @@
++/*
++ * OMAP clock autoidle support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/slab.h>
++#include <linux/io.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++
++struct clk_omap_autoidle {
++      void __iomem            *reg;
++      u8                      shift;
++      u8                      flags;
++      const char              *name;
++      struct list_head        node;
++};
++
++#define AUTOIDLE_LOW          0x1
++
++static LIST_HEAD(autoidle_clks);
++
++static void omap_allow_autoidle(struct clk_omap_autoidle *clk)
++{
++      u32 val;
++
++      val = readl(clk->reg);
++
++      if (clk->flags & AUTOIDLE_LOW)
++              val &= ~(1 << clk->shift);
++      else
++              val |= (1 << clk->shift);
++
++      writel(val, clk->reg);
++}
++
++static void omap_deny_autoidle(struct clk_omap_autoidle *clk)
++{
++      u32 val;
++
++      val = readl(clk->reg);
++
++      if (clk->flags & AUTOIDLE_LOW)
++              val |= (1 << clk->shift);
++      else
++              val &= ~(1 << clk->shift);
++
++      writel(val, clk->reg);
++}
++
++void of_omap_clk_allow_autoidle_all(void)
++{
++      struct clk_omap_autoidle *c;
++
++      list_for_each_entry(c, &autoidle_clks, node)
++              omap_allow_autoidle(c);
++}
++
++void of_omap_clk_deny_autoidle_all(void)
++{
++      struct clk_omap_autoidle *c;
++
++      list_for_each_entry(c, &autoidle_clks, node)
++              omap_deny_autoidle(c);
++}
++
++static void __init of_omap_autoidle_setup(struct device_node *node)
++{
++      u32 shift;
++      void __iomem *reg;
++      struct clk_omap_autoidle *clk;
++
++      if (of_property_read_u32(node, "ti,autoidle-shift", &shift))
++              return;
++
++      reg = of_iomap(node, 0);
++
++      clk = kzalloc(sizeof(*clk), GFP_KERNEL);
++
++      if (!clk) {
++              pr_err("%s: kzalloc failed\n", __func__);
++              return;
++      }
++
++      clk->shift = shift;
++      clk->name = node->name;
++      clk->reg = reg;
++
++      if (of_property_read_bool(node, "ti,autoidle-low"))
++              clk->flags |= AUTOIDLE_LOW;
++
++      list_add(&clk->node, &autoidle_clks);
++}
++
++static void __init of_omap_divider_setup(struct device_node *node)
++{
++      of_divider_clk_setup(node);
++      of_omap_autoidle_setup(node);
++}
++CLK_OF_DECLARE(omap_divider_clock, "ti,divider-clock", of_omap_divider_setup);
++
++static void __init of_omap_fixed_factor_setup(struct device_node *node)
++{
++      of_fixed_factor_clk_setup(node);
++      of_omap_autoidle_setup(node);
++}
++CLK_OF_DECLARE(omap_fixed_factor_clock, "ti,fixed-factor-clock",
++             of_omap_fixed_factor_setup);
+--- /dev/null
++++ b/drivers/clk/ti/clk-33xx.c
+@@ -0,0 +1,163 @@
++/*
++ * AM33XX Clock init
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc
++ *     Tero Kristo (t-kristo@ti.com)
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-provider.h>
++#include <linux/clk/ti.h>
++
++static struct omap_dt_clk am33xx_clks[] = {
++      DT_CLK(NULL, "clk_32768_ck", "clk_32768_ck"),
++      DT_CLK(NULL, "clk_rc32k_ck", "clk_rc32k_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_24000000_ck", "virt_24000000_ck"),
++      DT_CLK(NULL, "virt_25000000_ck", "virt_25000000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "sys_clkin_ck", "sys_clkin_ck"),
++      DT_CLK(NULL, "tclkin_ck", "tclkin_ck"),
++      DT_CLK(NULL, "dpll_core_ck", "dpll_core_ck"),
++      DT_CLK(NULL, "dpll_core_x2_ck", "dpll_core_x2_ck"),
++      DT_CLK(NULL, "dpll_core_m4_ck", "dpll_core_m4_ck"),
++      DT_CLK(NULL, "dpll_core_m5_ck", "dpll_core_m5_ck"),
++      DT_CLK(NULL, "dpll_core_m6_ck", "dpll_core_m6_ck"),
++      DT_CLK(NULL, "dpll_mpu_ck", "dpll_mpu_ck"),
++      DT_CLK("cpu0", NULL, "dpll_mpu_ck"),
++      DT_CLK(NULL, "dpll_mpu_m2_ck", "dpll_mpu_m2_ck"),
++      DT_CLK(NULL, "dpll_ddr_ck", "dpll_ddr_ck"),
++      DT_CLK(NULL, "dpll_ddr_m2_ck", "dpll_ddr_m2_ck"),
++      DT_CLK(NULL, "dpll_ddr_m2_div2_ck", "dpll_ddr_m2_div2_ck"),
++      DT_CLK(NULL, "dpll_disp_ck", "dpll_disp_ck"),
++      DT_CLK(NULL, "dpll_disp_m2_ck", "dpll_disp_m2_ck"),
++      DT_CLK(NULL, "dpll_per_ck", "dpll_per_ck"),
++      DT_CLK(NULL, "dpll_per_m2_ck", "dpll_per_m2_ck"),
++      DT_CLK(NULL, "dpll_per_m2_div4_wkupdm_ck", "dpll_per_m2_div4_wkupdm_ck"),
++      DT_CLK(NULL, "dpll_per_m2_div4_ck", "dpll_per_m2_div4_ck"),
++      DT_CLK(NULL, "adc_tsc_fck", "adc_tsc_fck"),
++      DT_CLK(NULL, "cefuse_fck", "cefuse_fck"),
++      DT_CLK(NULL, "clkdiv32k_ck", "clkdiv32k_ck"),
++      DT_CLK(NULL, "clkdiv32k_ick", "clkdiv32k_ick"),
++      DT_CLK(NULL, "dcan0_fck", "dcan0_fck"),
++      DT_CLK("481cc000.d_can", NULL, "dcan0_fck"),
++      DT_CLK(NULL, "dcan1_fck", "dcan1_fck"),
++      DT_CLK("481d0000.d_can", NULL, "dcan1_fck"),
++      DT_CLK(NULL, "pruss_ocp_gclk", "pruss_ocp_gclk"),
++      DT_CLK(NULL, "mcasp0_fck", "mcasp0_fck"),
++      DT_CLK(NULL, "mcasp1_fck", "mcasp1_fck"),
++      DT_CLK(NULL, "mmu_fck", "mmu_fck"),
++      DT_CLK(NULL, "smartreflex0_fck", "smartreflex0_fck"),
++      DT_CLK(NULL, "smartreflex1_fck", "smartreflex1_fck"),
++      DT_CLK(NULL, "sha0_fck", "sha0_fck"),
++      DT_CLK(NULL, "rng_fck", "rng_fck"),
++      DT_CLK(NULL, "aes0_fck", "aes0_fck"),
++      DT_CLK(NULL, "timer1_fck", "timer1_fck"),
++      DT_CLK(NULL, "timer2_fck", "timer2_fck"),
++      DT_CLK(NULL, "timer3_fck", "timer3_fck"),
++      DT_CLK(NULL, "timer4_fck", "timer4_fck"),
++      DT_CLK(NULL, "timer5_fck", "timer5_fck"),
++      DT_CLK(NULL, "timer6_fck", "timer6_fck"),
++      DT_CLK(NULL, "timer7_fck", "timer7_fck"),
++      DT_CLK(NULL, "usbotg_fck", "usbotg_fck"),
++      DT_CLK(NULL, "ieee5000_fck", "ieee5000_fck"),
++      DT_CLK(NULL, "wdt1_fck", "wdt1_fck"),
++      DT_CLK(NULL, "l4_rtc_gclk", "l4_rtc_gclk"),
++      DT_CLK(NULL, "l3_gclk", "l3_gclk"),
++      DT_CLK(NULL, "dpll_core_m4_div2_ck", "dpll_core_m4_div2_ck"),
++      DT_CLK(NULL, "l4hs_gclk", "l4hs_gclk"),
++      DT_CLK(NULL, "l3s_gclk", "l3s_gclk"),
++      DT_CLK(NULL, "l4fw_gclk", "l4fw_gclk"),
++      DT_CLK(NULL, "l4ls_gclk", "l4ls_gclk"),
++      DT_CLK(NULL, "clk_24mhz", "clk_24mhz"),
++      DT_CLK(NULL, "sysclk_div_ck", "sysclk_div_ck"),
++      DT_CLK(NULL, "cpsw_125mhz_gclk", "cpsw_125mhz_gclk"),
++      DT_CLK(NULL, "cpsw_cpts_rft_clk", "cpsw_cpts_rft_clk"),
++      DT_CLK(NULL, "gpio0_dbclk_mux_ck", "gpio0_dbclk_mux_ck"),
++      DT_CLK(NULL, "gpio0_dbclk", "gpio0_dbclk"),
++      DT_CLK(NULL, "gpio1_dbclk", "gpio1_dbclk"),
++      DT_CLK(NULL, "gpio2_dbclk", "gpio2_dbclk"),
++      DT_CLK(NULL, "gpio3_dbclk", "gpio3_dbclk"),
++      DT_CLK(NULL, "lcd_gclk", "lcd_gclk"),
++      DT_CLK(NULL, "mmc_clk", "mmc_clk"),
++      DT_CLK(NULL, "gfx_fclk_clksel_ck", "gfx_fclk_clksel_ck"),
++      DT_CLK(NULL, "gfx_fck_div_ck", "gfx_fck_div_ck"),
++      DT_CLK(NULL, "sysclkout_pre_ck", "sysclkout_pre_ck"),
++      DT_CLK(NULL, "clkout2_div_ck", "clkout2_div_ck"),
++      DT_CLK(NULL, "timer_32k_ck", "clkdiv32k_ick"),
++      DT_CLK(NULL, "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK(NULL, "dbg_sysclk_ck", "dbg_sysclk_ck"),
++      DT_CLK(NULL, "dbg_clka_ck", "dbg_clka_ck"),
++      DT_CLK(NULL, "stm_pmd_clock_mux_ck", "stm_pmd_clock_mux_ck"),
++      DT_CLK(NULL, "trace_pmd_clk_mux_ck", "trace_pmd_clk_mux_ck"),
++      DT_CLK(NULL, "stm_clk_div_ck", "stm_clk_div_ck"),
++      DT_CLK(NULL, "trace_clk_div_ck", "trace_clk_div_ck"),
++      DT_CLK(NULL, "clkout2_ck", "clkout2_ck"),
++      DT_CLK("48300200.ehrpwm", "tbclk", "ehrpwm0_tbclk"),
++      DT_CLK("48302200.ehrpwm", "tbclk", "ehrpwm1_tbclk"),
++      DT_CLK("48304200.ehrpwm", "tbclk", "ehrpwm2_tbclk"),
++      { .node_name = NULL },
++};
++
++static const char *enable_init_clks[] = {
++      "dpll_ddr_m2_ck",
++      "dpll_mpu_m2_ck",
++      "l3_gclk",
++      "l4hs_gclk",
++      "l4fw_gclk",
++      "l4ls_gclk",
++      /* Required for external peripherals like, Audio codecs */
++      "clkout2_ck",
++};
++
++int __init am33xx_clk_init(void)
++{
++      struct clk *clk1, *clk2;
++
++      of_clk_init(NULL);
++
++      omap_dt_clocks_register(am33xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      omap2_clk_enable_init_clocks(enable_init_clks,
++                                   ARRAY_SIZE(enable_init_clks));
++
++      /* TRM ERRATA: Timer 3 & 6 default parent (TCLKIN) may not be always
++       *    physically present, in such a case HWMOD enabling of
++       *    clock would be failure with default parent. And timer
++       *    probe thinks clock is already enabled, this leads to
++       *    crash upon accessing timer 3 & 6 registers in probe.
++       *    Fix by setting parent of both these timers to master
++       *    oscillator clock.
++       */
++
++      clk1 = clk_get_sys(NULL, "sys_clkin_ck");
++      clk2 = clk_get_sys(NULL, "timer3_fck");
++      clk_set_parent(clk2, clk1);
++
++      clk2 = clk_get_sys(NULL, "timer6_fck");
++      clk_set_parent(clk2, clk1);
++      /*
++       * The On-Chip 32K RC Osc clock is not an accurate clock-source as per
++       * the design/spec, so as a result, for example, timer which supposed
++       * to get expired @60Sec, but will expire somewhere ~@40Sec, which is
++       * not expected by any use-case, so change WDT1 clock source to PRCM
++       * 32KHz clock.
++       */
++      clk1 = clk_get_sys(NULL, "wdt1_fck");
++      clk2 = clk_get_sys(NULL, "clkdiv32k_ick");
++      clk_set_parent(clk1, clk2);
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk-3xxx.c
+@@ -0,0 +1,388 @@
++/*
++ * OMAP3 Clock init
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc
++ *     Tero Kristo (t-kristo@ti.com)
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-provider.h>
++#include <linux/clk/ti.h>
++
++
++static struct omap_dt_clk omap3xxx_clks[] = {
++      DT_CLK(NULL, "apb_pclk", "dummy_apb_pclk"),
++      DT_CLK(NULL, "omap_32k_fck", "omap_32k_fck"),
++      DT_CLK(NULL, "virt_12m_ck", "virt_12m_ck"),
++      DT_CLK(NULL, "virt_13m_ck", "virt_13m_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "virt_38_4m_ck", "virt_38_4m_ck"),
++      DT_CLK(NULL, "osc_sys_ck", "osc_sys_ck"),
++      DT_CLK("twl", "fck", "osc_sys_ck"),
++      DT_CLK(NULL, "sys_ck", "sys_ck"),
++      DT_CLK(NULL, "omap_96m_alwon_fck", "omap_96m_alwon_fck"),
++      DT_CLK("etb", "emu_core_alwon_ck", "emu_core_alwon_ck"),
++      DT_CLK(NULL, "sys_altclk", "sys_altclk"),
++      DT_CLK(NULL, "mcbsp_clks", "mcbsp_clks"),
++      DT_CLK(NULL, "sys_clkout1", "sys_clkout1"),
++      DT_CLK(NULL, "dpll1_ck", "dpll1_ck"),
++      DT_CLK(NULL, "dpll1_x2_ck", "dpll1_x2_ck"),
++      DT_CLK(NULL, "dpll1_x2m2_ck", "dpll1_x2m2_ck"),
++      DT_CLK(NULL, "dpll3_ck", "dpll3_ck"),
++      DT_CLK(NULL, "core_ck", "core_ck"),
++      DT_CLK(NULL, "dpll3_x2_ck", "dpll3_x2_ck"),
++      DT_CLK(NULL, "dpll3_m2_ck", "dpll3_m2_ck"),
++      DT_CLK(NULL, "dpll3_m2x2_ck", "dpll3_m2x2_ck"),
++      DT_CLK(NULL, "dpll3_m3_ck", "dpll3_m3_ck"),
++      DT_CLK(NULL, "dpll3_m3x2_ck", "dpll3_m3x2_ck"),
++      DT_CLK(NULL, "dpll4_ck", "dpll4_ck"),
++      DT_CLK(NULL, "dpll4_x2_ck", "dpll4_x2_ck"),
++      DT_CLK(NULL, "omap_96m_fck", "omap_96m_fck"),
++      DT_CLK(NULL, "cm_96m_fck", "cm_96m_fck"),
++      DT_CLK(NULL, "omap_54m_fck", "omap_54m_fck"),
++      DT_CLK(NULL, "omap_48m_fck", "omap_48m_fck"),
++      DT_CLK(NULL, "omap_12m_fck", "omap_12m_fck"),
++      DT_CLK(NULL, "dpll4_m2_ck", "dpll4_m2_ck"),
++      DT_CLK(NULL, "dpll4_m2x2_ck", "dpll4_m2x2_ck"),
++      DT_CLK(NULL, "dpll4_m3_ck", "dpll4_m3_ck"),
++      DT_CLK(NULL, "dpll4_m3x2_ck", "dpll4_m3x2_ck"),
++      DT_CLK(NULL, "dpll4_m4_ck", "dpll4_m4_ck"),
++      DT_CLK(NULL, "dpll4_m4x2_ck", "dpll4_m4x2_ck"),
++      DT_CLK(NULL, "dpll4_m5_ck", "dpll4_m5_ck"),
++      DT_CLK(NULL, "dpll4_m5x2_ck", "dpll4_m5x2_ck"),
++      DT_CLK(NULL, "dpll4_m6_ck", "dpll4_m6_ck"),
++      DT_CLK(NULL, "dpll4_m6x2_ck", "dpll4_m6x2_ck"),
++      DT_CLK("etb", "emu_per_alwon_ck", "emu_per_alwon_ck"),
++      DT_CLK(NULL, "clkout2_src_ck", "clkout2_src_ck"),
++      DT_CLK(NULL, "sys_clkout2", "sys_clkout2"),
++      DT_CLK(NULL, "corex2_fck", "corex2_fck"),
++      DT_CLK(NULL, "dpll1_fck", "dpll1_fck"),
++      DT_CLK(NULL, "mpu_ck", "mpu_ck"),
++      DT_CLK(NULL, "arm_fck", "arm_fck"),
++      DT_CLK("etb", "emu_mpu_alwon_ck", "emu_mpu_alwon_ck"),
++      DT_CLK(NULL, "l3_ick", "l3_ick"),
++      DT_CLK(NULL, "l4_ick", "l4_ick"),
++      DT_CLK(NULL, "rm_ick", "rm_ick"),
++      DT_CLK(NULL, "gpt10_fck", "gpt10_fck"),
++      DT_CLK(NULL, "gpt11_fck", "gpt11_fck"),
++      DT_CLK(NULL, "core_96m_fck", "core_96m_fck"),
++      DT_CLK(NULL, "mmchs2_fck", "mmchs2_fck"),
++      DT_CLK(NULL, "mmchs1_fck", "mmchs1_fck"),
++      DT_CLK(NULL, "i2c3_fck", "i2c3_fck"),
++      DT_CLK(NULL, "i2c2_fck", "i2c2_fck"),
++      DT_CLK(NULL, "i2c1_fck", "i2c1_fck"),
++      DT_CLK(NULL, "mcbsp5_fck", "mcbsp5_fck"),
++      DT_CLK(NULL, "mcbsp1_fck", "mcbsp1_fck"),
++      DT_CLK(NULL, "core_48m_fck", "core_48m_fck"),
++      DT_CLK(NULL, "mcspi4_fck", "mcspi4_fck"),
++      DT_CLK(NULL, "mcspi3_fck", "mcspi3_fck"),
++      DT_CLK(NULL, "mcspi2_fck", "mcspi2_fck"),
++      DT_CLK(NULL, "mcspi1_fck", "mcspi1_fck"),
++      DT_CLK(NULL, "uart2_fck", "uart2_fck"),
++      DT_CLK(NULL, "uart1_fck", "uart1_fck"),
++      DT_CLK(NULL, "core_12m_fck", "core_12m_fck"),
++      DT_CLK("omap_hdq.0", "fck", "hdq_fck"),
++      DT_CLK(NULL, "hdq_fck", "hdq_fck"),
++      DT_CLK(NULL, "core_l3_ick", "core_l3_ick"),
++      DT_CLK(NULL, "sdrc_ick", "sdrc_ick"),
++      DT_CLK(NULL, "gpmc_fck", "gpmc_fck"),
++      DT_CLK(NULL, "core_l4_ick", "core_l4_ick"),
++      DT_CLK("omap_hsmmc.1", "ick", "mmchs2_ick"),
++      DT_CLK("omap_hsmmc.0", "ick", "mmchs1_ick"),
++      DT_CLK(NULL, "mmchs2_ick", "mmchs2_ick"),
++      DT_CLK(NULL, "mmchs1_ick", "mmchs1_ick"),
++      DT_CLK("omap_hdq.0", "ick", "hdq_ick"),
++      DT_CLK(NULL, "hdq_ick", "hdq_ick"),
++      DT_CLK("omap2_mcspi.4", "ick", "mcspi4_ick"),
++      DT_CLK("omap2_mcspi.3", "ick", "mcspi3_ick"),
++      DT_CLK("omap2_mcspi.2", "ick", "mcspi2_ick"),
++      DT_CLK("omap2_mcspi.1", "ick", "mcspi1_ick"),
++      DT_CLK(NULL, "mcspi4_ick", "mcspi4_ick"),
++      DT_CLK(NULL, "mcspi3_ick", "mcspi3_ick"),
++      DT_CLK(NULL, "mcspi2_ick", "mcspi2_ick"),
++      DT_CLK(NULL, "mcspi1_ick", "mcspi1_ick"),
++      DT_CLK("omap_i2c.3", "ick", "i2c3_ick"),
++      DT_CLK("omap_i2c.2", "ick", "i2c2_ick"),
++      DT_CLK("omap_i2c.1", "ick", "i2c1_ick"),
++      DT_CLK(NULL, "i2c3_ick", "i2c3_ick"),
++      DT_CLK(NULL, "i2c2_ick", "i2c2_ick"),
++      DT_CLK(NULL, "i2c1_ick", "i2c1_ick"),
++      DT_CLK(NULL, "uart2_ick", "uart2_ick"),
++      DT_CLK(NULL, "uart1_ick", "uart1_ick"),
++      DT_CLK(NULL, "gpt11_ick", "gpt11_ick"),
++      DT_CLK(NULL, "gpt10_ick", "gpt10_ick"),
++      DT_CLK("omap-mcbsp.5", "ick", "mcbsp5_ick"),
++      DT_CLK("omap-mcbsp.1", "ick", "mcbsp1_ick"),
++      DT_CLK(NULL, "mcbsp5_ick", "mcbsp5_ick"),
++      DT_CLK(NULL, "mcbsp1_ick", "mcbsp1_ick"),
++      DT_CLK(NULL, "omapctrl_ick", "omapctrl_ick"),
++      DT_CLK(NULL, "dss_tv_fck", "dss_tv_fck"),
++      DT_CLK(NULL, "dss_96m_fck", "dss_96m_fck"),
++      DT_CLK(NULL, "dss2_alwon_fck", "dss2_alwon_fck"),
++      DT_CLK(NULL, "gpt1_fck", "gpt1_fck"),
++      DT_CLK(NULL, "aes2_ick", "aes2_ick"),
++      DT_CLK(NULL, "wkup_32k_fck", "wkup_32k_fck"),
++      DT_CLK(NULL, "gpio1_dbck", "gpio1_dbck"),
++      DT_CLK(NULL, "sha12_ick", "sha12_ick"),
++      DT_CLK(NULL, "wdt2_fck", "wdt2_fck"),
++      DT_CLK("omap_wdt", "ick", "wdt2_ick"),
++      DT_CLK(NULL, "wdt2_ick", "wdt2_ick"),
++      DT_CLK(NULL, "wdt1_ick", "wdt1_ick"),
++      DT_CLK(NULL, "gpio1_ick", "gpio1_ick"),
++      DT_CLK(NULL, "omap_32ksync_ick", "omap_32ksync_ick"),
++      DT_CLK(NULL, "gpt12_ick", "gpt12_ick"),
++      DT_CLK(NULL, "gpt1_ick", "gpt1_ick"),
++      DT_CLK(NULL, "per_96m_fck", "per_96m_fck"),
++      DT_CLK(NULL, "per_48m_fck", "per_48m_fck"),
++      DT_CLK(NULL, "uart3_fck", "uart3_fck"),
++      DT_CLK(NULL, "gpt2_fck", "gpt2_fck"),
++      DT_CLK(NULL, "gpt3_fck", "gpt3_fck"),
++      DT_CLK(NULL, "gpt4_fck", "gpt4_fck"),
++      DT_CLK(NULL, "gpt5_fck", "gpt5_fck"),
++      DT_CLK(NULL, "gpt6_fck", "gpt6_fck"),
++      DT_CLK(NULL, "gpt7_fck", "gpt7_fck"),
++      DT_CLK(NULL, "gpt8_fck", "gpt8_fck"),
++      DT_CLK(NULL, "gpt9_fck", "gpt9_fck"),
++      DT_CLK(NULL, "per_32k_alwon_fck", "per_32k_alwon_fck"),
++      DT_CLK(NULL, "gpio6_dbck", "gpio6_dbck"),
++      DT_CLK(NULL, "gpio5_dbck", "gpio5_dbck"),
++      DT_CLK(NULL, "gpio4_dbck", "gpio4_dbck"),
++      DT_CLK(NULL, "gpio3_dbck", "gpio3_dbck"),
++      DT_CLK(NULL, "gpio2_dbck", "gpio2_dbck"),
++      DT_CLK(NULL, "wdt3_fck", "wdt3_fck"),
++      DT_CLK(NULL, "per_l4_ick", "per_l4_ick"),
++      DT_CLK(NULL, "gpio6_ick", "gpio6_ick"),
++      DT_CLK(NULL, "gpio5_ick", "gpio5_ick"),
++      DT_CLK(NULL, "gpio4_ick", "gpio4_ick"),
++      DT_CLK(NULL, "gpio3_ick", "gpio3_ick"),
++      DT_CLK(NULL, "gpio2_ick", "gpio2_ick"),
++      DT_CLK(NULL, "wdt3_ick", "wdt3_ick"),
++      DT_CLK(NULL, "uart3_ick", "uart3_ick"),
++      DT_CLK(NULL, "uart4_ick", "uart4_ick"),
++      DT_CLK(NULL, "gpt9_ick", "gpt9_ick"),
++      DT_CLK(NULL, "gpt8_ick", "gpt8_ick"),
++      DT_CLK(NULL, "gpt7_ick", "gpt7_ick"),
++      DT_CLK(NULL, "gpt6_ick", "gpt6_ick"),
++      DT_CLK(NULL, "gpt5_ick", "gpt5_ick"),
++      DT_CLK(NULL, "gpt4_ick", "gpt4_ick"),
++      DT_CLK(NULL, "gpt3_ick", "gpt3_ick"),
++      DT_CLK(NULL, "gpt2_ick", "gpt2_ick"),
++      DT_CLK("omap-mcbsp.2", "ick", "mcbsp2_ick"),
++      DT_CLK("omap-mcbsp.3", "ick", "mcbsp3_ick"),
++      DT_CLK("omap-mcbsp.4", "ick", "mcbsp4_ick"),
++      DT_CLK(NULL, "mcbsp4_ick", "mcbsp2_ick"),
++      DT_CLK(NULL, "mcbsp3_ick", "mcbsp3_ick"),
++      DT_CLK(NULL, "mcbsp2_ick", "mcbsp4_ick"),
++      DT_CLK(NULL, "mcbsp2_fck", "mcbsp2_fck"),
++      DT_CLK(NULL, "mcbsp3_fck", "mcbsp3_fck"),
++      DT_CLK(NULL, "mcbsp4_fck", "mcbsp4_fck"),
++      DT_CLK("etb", "emu_src_ck", "emu_src_ck"),
++      DT_CLK(NULL, "emu_src_ck", "emu_src_ck"),
++      DT_CLK(NULL, "pclk_fck", "pclk_fck"),
++      DT_CLK(NULL, "pclkx2_fck", "pclkx2_fck"),
++      DT_CLK(NULL, "atclk_fck", "atclk_fck"),
++      DT_CLK(NULL, "traceclk_src_fck", "traceclk_src_fck"),
++      DT_CLK(NULL, "traceclk_fck", "traceclk_fck"),
++      DT_CLK(NULL, "secure_32k_fck", "secure_32k_fck"),
++      DT_CLK(NULL, "gpt12_fck", "gpt12_fck"),
++      DT_CLK(NULL, "wdt1_fck", "wdt1_fck"),
++      DT_CLK(NULL, "timer_32k_ck", "omap_32k_fck"),
++      DT_CLK(NULL, "timer_sys_ck", "sys_ck"),
++      DT_CLK(NULL, "cpufreq_ck", "dpll1_ck"),
++      { .node_name = NULL },
++};
++
++static struct omap_dt_clk omap34xx_omap36xx_clks[] = {
++      DT_CLK(NULL, "aes1_ick", "aes1_ick"),
++      DT_CLK("omap_rng", "ick", "rng_ick"),
++      DT_CLK(NULL, "sha11_ick", "sha11_ick"),
++      DT_CLK(NULL, "des1_ick", "des1_ick"),
++      DT_CLK(NULL, "cam_mclk", "cam_mclk"),
++      DT_CLK(NULL, "cam_ick", "cam_ick"),
++      DT_CLK(NULL, "csi2_96m_fck", "csi2_96m_fck"),
++      DT_CLK(NULL, "security_l3_ick", "security_l3_ick"),
++      DT_CLK(NULL, "pka_ick", "pka_ick"),
++      DT_CLK(NULL, "icr_ick", "icr_ick"),
++      DT_CLK("omap-aes", "ick", "aes2_ick"),
++      DT_CLK("omap-sham", "ick", "sha12_ick"),
++      DT_CLK(NULL, "des2_ick", "des2_ick"),
++      DT_CLK(NULL, "mspro_ick", "mspro_ick"),
++      DT_CLK(NULL, "mailboxes_ick", "mailboxes_ick"),
++      DT_CLK(NULL, "ssi_l4_ick", "ssi_l4_ick"),
++      DT_CLK(NULL, "sr1_fck", "sr1_fck"),
++      DT_CLK(NULL, "sr2_fck", "sr2_fck"),
++      DT_CLK(NULL, "sr_l4_ick", "sr_l4_ick"),
++      DT_CLK(NULL, "security_l4_ick2", "security_l4_ick2"),
++      DT_CLK(NULL, "wkup_l4_ick", "wkup_l4_ick"),
++      DT_CLK(NULL, "dpll2_fck", "dpll2_fck"),
++      DT_CLK(NULL, "iva2_ck", "iva2_ck"),
++      DT_CLK(NULL, "modem_fck", "modem_fck"),
++      DT_CLK(NULL, "sad2d_ick", "sad2d_ick"),
++      DT_CLK(NULL, "mad2d_ick", "mad2d_ick"),
++      DT_CLK(NULL, "mspro_fck", "mspro_fck"),
++      DT_CLK(NULL, "dpll2_ck", "dpll2_ck"),
++      DT_CLK(NULL, "dpll2_m2_ck", "dpll2_m2_ck"),
++      { .node_name = NULL },
++};
++
++static struct omap_dt_clk omap36xx_omap3430es2plus_clks[] = {
++      DT_CLK(NULL, "ssi_ssr_fck", "ssi_ssr_fck_3430es2"),
++      DT_CLK(NULL, "ssi_sst_fck", "ssi_sst_fck_3430es2"),
++      DT_CLK("musb-omap2430", "ick", "hsotgusb_ick_3430es2"),
++      DT_CLK(NULL, "hsotgusb_ick", "hsotgusb_ick_3430es2"),
++      DT_CLK(NULL, "ssi_ick", "ssi_ick_3430es2"),
++      DT_CLK(NULL, "usim_fck", "usim_fck"),
++      DT_CLK(NULL, "usim_ick", "usim_ick"),
++      { .node_name = NULL },
++};
++
++static struct omap_dt_clk omap3430es1_clks[] = {
++      DT_CLK(NULL, "gfx_l3_ck", "gfx_l3_ck"),
++      DT_CLK(NULL, "gfx_l3_fck", "gfx_l3_fck"),
++      DT_CLK(NULL, "gfx_l3_ick", "gfx_l3_ick"),
++      DT_CLK(NULL, "gfx_cg1_ck", "gfx_cg1_ck"),
++      DT_CLK(NULL, "gfx_cg2_ck", "gfx_cg2_ck"),
++      DT_CLK(NULL, "d2d_26m_fck", "d2d_26m_fck"),
++      DT_CLK(NULL, "fshostusb_fck", "fshostusb_fck"),
++      DT_CLK(NULL, "ssi_ssr_fck", "ssi_ssr_fck_3430es1"),
++      DT_CLK(NULL, "ssi_sst_fck", "ssi_sst_fck_3430es1"),
++      DT_CLK("musb-omap2430", "ick", "hsotgusb_ick_3430es1"),
++      DT_CLK(NULL, "hsotgusb_ick", "hsotgusb_ick_3430es1"),
++      DT_CLK(NULL, "fac_ick", "fac_ick"),
++      DT_CLK(NULL, "ssi_ick", "ssi_ick_3430es1"),
++      DT_CLK(NULL, "usb_l4_ick", "usb_l4_ick"),
++      DT_CLK(NULL, "dss1_alwon_fck", "dss1_alwon_fck_3430es1"),
++      DT_CLK("omapdss_dss", "ick", "dss_ick_3430es1"),
++      DT_CLK(NULL, "dss_ick", "dss_ick_3430es1"),
++      { .node_name = NULL },
++};
++
++static struct omap_dt_clk omap36xx_am35xx_omap3430es2plus_clks[] = {
++      DT_CLK(NULL, "virt_16_8m_ck", "virt_16_8m_ck"),
++      DT_CLK(NULL, "dpll5_ck", "dpll5_ck"),
++      DT_CLK(NULL, "dpll5_m2_ck", "dpll5_m2_ck"),
++      DT_CLK(NULL, "sgx_fck", "sgx_fck"),
++      DT_CLK(NULL, "sgx_ick", "sgx_ick"),
++      DT_CLK(NULL, "cpefuse_fck", "cpefuse_fck"),
++      DT_CLK(NULL, "ts_fck", "ts_fck"),
++      DT_CLK(NULL, "usbtll_fck", "usbtll_fck"),
++      DT_CLK(NULL, "usbtll_ick", "usbtll_ick"),
++      DT_CLK("omap_hsmmc.2", "ick", "mmchs3_ick"),
++      DT_CLK(NULL, "mmchs3_ick", "mmchs3_ick"),
++      DT_CLK(NULL, "mmchs3_fck", "mmchs3_fck"),
++      DT_CLK(NULL, "dss1_alwon_fck", "dss1_alwon_fck_3430es2"),
++      DT_CLK("omapdss_dss", "ick", "dss_ick_3430es2"),
++      DT_CLK(NULL, "dss_ick", "dss_ick_3430es2"),
++      DT_CLK(NULL, "usbhost_120m_fck", "usbhost_120m_fck"),
++      DT_CLK(NULL, "usbhost_48m_fck", "usbhost_48m_fck"),
++      DT_CLK(NULL, "usbhost_ick", "usbhost_ick"),
++      { .node_name = NULL },
++};
++
++static struct omap_dt_clk am35xx_clks[] = {
++      DT_CLK(NULL, "ipss_ick", "ipss_ick"),
++      DT_CLK(NULL, "rmii_ck", "rmii_ck"),
++      DT_CLK(NULL, "pclk_ck", "pclk_ck"),
++      DT_CLK(NULL, "emac_ick", "emac_ick"),
++      DT_CLK(NULL, "emac_fck", "emac_fck"),
++      DT_CLK("davinci_emac.0", NULL, "emac_ick"),
++      DT_CLK("davinci_mdio.0", NULL, "emac_fck"),
++      DT_CLK("vpfe-capture", "master", "vpfe_ick"),
++      DT_CLK("vpfe-capture", "slave", "vpfe_fck"),
++      DT_CLK(NULL, "hsotgusb_ick", "hsotgusb_ick_am35xx"),
++      DT_CLK(NULL, "hsotgusb_fck", "hsotgusb_fck_am35xx"),
++      DT_CLK(NULL, "hecc_ck", "hecc_ck"),
++      DT_CLK(NULL, "uart4_ick", "uart4_ick_am35xx"),
++      DT_CLK(NULL, "uart4_fck", "uart4_fck_am35xx"),
++      { .node_name = NULL },
++};
++
++static const char *enable_init_clks[] = {
++      "sdrc_ick",
++      "gpmc_fck",
++      "omapctrl_ick",
++};
++
++enum {
++      OMAP3_SOC_AM35XX,
++      OMAP3_SOC_OMAP3430_ES1,
++      OMAP3_SOC_OMAP3430_ES2_PLUS,
++      OMAP3_SOC_OMAP3630,
++      OMAP3_SOC_TI81XX,
++};
++
++static int __init omap3xxx_clk_init(int soc_type)
++{
++      of_clk_init(NULL);
++
++      if (soc_type == OMAP3_SOC_AM35XX || soc_type == OMAP3_SOC_OMAP3630 ||
++          soc_type == OMAP3_SOC_OMAP3430_ES1 ||
++          soc_type == OMAP3_SOC_OMAP3430_ES2_PLUS)
++              omap_dt_clocks_register(omap3xxx_clks);
++
++      if (soc_type == OMAP3_SOC_AM35XX)
++              omap_dt_clocks_register(am35xx_clks);
++
++      if (soc_type == OMAP3_SOC_OMAP3630 || soc_type == OMAP3_SOC_AM35XX ||
++          soc_type == OMAP3_SOC_OMAP3430_ES2_PLUS)
++              omap_dt_clocks_register(omap36xx_am35xx_omap3430es2plus_clks);
++
++      if (soc_type == OMAP3_SOC_OMAP3430_ES1)
++              omap_dt_clocks_register(omap3430es1_clks);
++
++      if (soc_type == OMAP3_SOC_OMAP3430_ES2_PLUS ||
++          soc_type == OMAP3_SOC_OMAP3630)
++              omap_dt_clocks_register(omap36xx_omap3430es2plus_clks);
++
++      if (soc_type == OMAP3_SOC_OMAP3430_ES1 ||
++          soc_type == OMAP3_SOC_OMAP3430_ES2_PLUS ||
++          soc_type == OMAP3_SOC_OMAP3630)
++              omap_dt_clocks_register(omap34xx_omap36xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      omap2_clk_enable_init_clocks(enable_init_clks,
++                                   ARRAY_SIZE(enable_init_clks));
++
++      pr_info("Clocking rate (Crystal/Core/MPU): %ld.%01ld/%ld/%ld MHz\n",
++              (clk_get_rate(clk_get_sys(NULL, "osc_sys_ck")) / 1000000),
++              (clk_get_rate(clk_get_sys(NULL, "osc_sys_ck")) / 100000) % 10,
++              (clk_get_rate(clk_get_sys(NULL, "core_ck")) / 1000000),
++              (clk_get_rate(clk_get_sys(NULL, "arm_fck")) / 1000000));
++
++      if (soc_type != OMAP3_SOC_TI81XX && soc_type != OMAP3_SOC_OMAP3430_ES1)
++              omap3_clk_lock_dpll5();
++
++      return 0;
++}
++
++int __init omap3430_clk_init(void)
++{
++      return omap3xxx_clk_init(OMAP3_SOC_OMAP3430_ES2_PLUS);
++}
++
++int __init omap3630_clk_init(void)
++{
++      return omap3xxx_clk_init(OMAP3_SOC_OMAP3630);
++}
++
++int __init am35xx_clk_init(void)
++{
++      return omap3xxx_clk_init(OMAP3_SOC_AM35XX);
++}
++
++int __init ti81xx_clk_init(void)
++{
++      return omap3xxx_clk_init(OMAP3_SOC_TI81XX);
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk-43xx.c
+@@ -0,0 +1,136 @@
++/*
++ * AM43XX Clock init
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc
++ *     Tero Kristo (t-kristo@ti.com)
++ *
++ * 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 version 2.
++ *
++ * This program is distributed "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-provider.h>
++#include <linux/clk/ti.h>
++
++
++static struct omap_dt_clk am43xx_clks[] = {
++      DT_CLK(NULL, "clk_32768_ck", "clk_32768_ck"),
++      DT_CLK(NULL, "clk_rc32k_ck", "clk_rc32k_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_24000000_ck", "virt_24000000_ck"),
++      DT_CLK(NULL, "virt_25000000_ck", "virt_25000000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "sys_clkin_ck", "sys_clkin_ck"),
++      DT_CLK(NULL, "tclkin_ck", "tclkin_ck"),
++      DT_CLK(NULL, "dpll_core_ck", "dpll_core_ck"),
++      DT_CLK(NULL, "dpll_core_x2_ck", "dpll_core_x2_ck"),
++      DT_CLK(NULL, "dpll_core_m4_ck", "dpll_core_m4_ck"),
++      DT_CLK(NULL, "dpll_core_m5_ck", "dpll_core_m5_ck"),
++      DT_CLK(NULL, "dpll_core_m6_ck", "dpll_core_m6_ck"),
++      DT_CLK(NULL, "dpll_mpu_ck", "dpll_mpu_ck"),
++      DT_CLK(NULL, "dpll_mpu_m2_ck", "dpll_mpu_m2_ck"),
++      DT_CLK(NULL, "dpll_ddr_ck", "dpll_ddr_ck"),
++      DT_CLK(NULL, "dpll_ddr_m2_ck", "dpll_ddr_m2_ck"),
++      DT_CLK(NULL, "dpll_disp_ck", "dpll_disp_ck"),
++      DT_CLK(NULL, "dpll_disp_m2_ck", "dpll_disp_m2_ck"),
++      DT_CLK(NULL, "dpll_per_ck", "dpll_per_ck"),
++      DT_CLK(NULL, "dpll_per_m2_ck", "dpll_per_m2_ck"),
++      DT_CLK(NULL, "dpll_per_m2_div4_wkupdm_ck", "dpll_per_m2_div4_wkupdm_ck"),
++      DT_CLK(NULL, "dpll_per_m2_div4_ck", "dpll_per_m2_div4_ck"),
++      DT_CLK(NULL, "adc_tsc_fck", "adc_tsc_fck"),
++      DT_CLK(NULL, "clkdiv32k_ck", "clkdiv32k_ck"),
++      DT_CLK(NULL, "clkdiv32k_ick", "clkdiv32k_ick"),
++      DT_CLK(NULL, "dcan0_fck", "dcan0_fck"),
++      DT_CLK(NULL, "dcan1_fck", "dcan1_fck"),
++      DT_CLK(NULL, "pruss_ocp_gclk", "pruss_ocp_gclk"),
++      DT_CLK(NULL, "mcasp0_fck", "mcasp0_fck"),
++      DT_CLK(NULL, "mcasp1_fck", "mcasp1_fck"),
++      DT_CLK(NULL, "smartreflex0_fck", "smartreflex0_fck"),
++      DT_CLK(NULL, "smartreflex1_fck", "smartreflex1_fck"),
++      DT_CLK(NULL, "sha0_fck", "sha0_fck"),
++      DT_CLK(NULL, "rng_fck", "rng_fck"),
++      DT_CLK(NULL, "aes0_fck", "aes0_fck"),
++      DT_CLK(NULL, "timer1_fck", "timer1_fck"),
++      DT_CLK(NULL, "timer2_fck", "timer2_fck"),
++      DT_CLK(NULL, "timer3_fck", "timer3_fck"),
++      DT_CLK(NULL, "timer4_fck", "timer4_fck"),
++      DT_CLK(NULL, "timer5_fck", "timer5_fck"),
++      DT_CLK(NULL, "timer6_fck", "timer6_fck"),
++      DT_CLK(NULL, "timer7_fck", "timer7_fck"),
++      DT_CLK(NULL, "wdt1_fck", "wdt1_fck"),
++      DT_CLK(NULL, "l3_gclk", "l3_gclk"),
++      DT_CLK(NULL, "dpll_core_m4_div2_ck", "dpll_core_m4_div2_ck"),
++      DT_CLK(NULL, "l4hs_gclk", "l4hs_gclk"),
++      DT_CLK(NULL, "l3s_gclk", "l3s_gclk"),
++      DT_CLK(NULL, "l4ls_gclk", "l4ls_gclk"),
++      DT_CLK(NULL, "clk_24mhz", "clk_24mhz"),
++      DT_CLK(NULL, "cpsw_125mhz_gclk", "cpsw_125mhz_gclk"),
++      DT_CLK(NULL, "cpsw_cpts_rft_clk", "cpsw_cpts_rft_clk"),
++      DT_CLK(NULL, "gpio0_dbclk_mux_ck", "gpio0_dbclk_mux_ck"),
++      DT_CLK(NULL, "gpio0_dbclk", "gpio0_dbclk"),
++      DT_CLK(NULL, "gpio1_dbclk", "gpio1_dbclk"),
++      DT_CLK(NULL, "gpio2_dbclk", "gpio2_dbclk"),
++      DT_CLK(NULL, "gpio3_dbclk", "gpio3_dbclk"),
++      DT_CLK(NULL, "gpio4_dbclk", "gpio4_dbclk"),
++      DT_CLK(NULL, "gpio5_dbclk", "gpio5_dbclk"),
++      DT_CLK(NULL, "mmc_clk", "mmc_clk"),
++      DT_CLK(NULL, "gfx_fclk_clksel_ck", "gfx_fclk_clksel_ck"),
++      DT_CLK(NULL, "gfx_fck_div_ck", "gfx_fck_div_ck"),
++      DT_CLK(NULL, "timer_32k_ck", "clkdiv32k_ick"),
++      DT_CLK(NULL, "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK(NULL, "sysclk_div", "sysclk_div"),
++      DT_CLK(NULL, "disp_clk", "disp_clk"),
++      DT_CLK(NULL, "clk_32k_mosc_ck", "clk_32k_mosc_ck"),
++      DT_CLK(NULL, "clk_32k_tpm_ck", "clk_32k_tpm_ck"),
++      DT_CLK(NULL, "dpll_extdev_ck", "dpll_extdev_ck"),
++      DT_CLK(NULL, "dpll_extdev_m2_ck", "dpll_extdev_m2_ck"),
++      DT_CLK(NULL, "mux_synctimer32k_ck", "mux_synctimer32k_ck"),
++      DT_CLK(NULL, "synctimer_32kclk", "synctimer_32kclk"),
++      DT_CLK(NULL, "timer8_fck", "timer8_fck"),
++      DT_CLK(NULL, "timer9_fck", "timer9_fck"),
++      DT_CLK(NULL, "timer10_fck", "timer10_fck"),
++      DT_CLK(NULL, "timer11_fck", "timer11_fck"),
++      DT_CLK(NULL, "cpsw_50m_clkdiv", "cpsw_50m_clkdiv"),
++      DT_CLK(NULL, "cpsw_5m_clkdiv", "cpsw_5m_clkdiv"),
++      DT_CLK(NULL, "dpll_ddr_x2_ck", "dpll_ddr_x2_ck"),
++      DT_CLK(NULL, "dpll_ddr_m4_ck", "dpll_ddr_m4_ck"),
++      DT_CLK(NULL, "dpll_per_clkdcoldo", "dpll_per_clkdcoldo"),
++      DT_CLK(NULL, "dll_aging_clk_div", "dll_aging_clk_div"),
++      DT_CLK(NULL, "div_core_25m_ck", "div_core_25m_ck"),
++      DT_CLK(NULL, "func_12m_clk", "func_12m_clk"),
++      DT_CLK(NULL, "vtp_clk_div", "vtp_clk_div"),
++      DT_CLK(NULL, "usbphy_32khz_clkmux", "usbphy_32khz_clkmux"),
++      { .node_name = NULL },
++};
++
++int __init am43xx_clk_init(void)
++{
++      struct clk *clk1, *clk2;
++
++      of_clk_init(NULL);
++
++      omap_dt_clocks_register(am43xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      /*
++       * The external 32KHz RTC clock source may not always be available
++       * on board like in the case of ePOS EVM. By default sync timer, which
++       * is used as clock source, feeds of this clock. This is a problem.
++       * Change the parent of sync timer to PER PLL 32KHz clock instead
++       * which is always present. This has a side effect that in low power
++       * modes, sync timer will stop.
++       */
++      clk1 = clk_get_sys(NULL, "mux_synctimer32k_ck");
++      clk2 = clk_get_sys(NULL, "clkdiv32k_ick");
++      clk_set_parent(clk1, clk2);
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk-44xx.c
+@@ -0,0 +1,307 @@
++/*
++ * OMAP4 Clock data
++ *
++ * Copyright (C) 2009-2012 Texas Instruments, Inc.
++ * Copyright (C) 2009-2010 Nokia Corporation
++ *
++ * Paul Walmsley (paul@pwsan.com)
++ * Rajendra Nayak (rnayak@ti.com)
++ * Benoit Cousson (b-cousson@ti.com)
++ * Mike Turquette (mturquette@ti.com)
++ *
++ * 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.
++ *
++ * XXX Some of the ES1 clocks have been removed/changed; once support
++ * is added for discriminating clocks by ES level, these should be added back
++ * in.
++ *
++ * XXX All of the remaining MODULEMODE clock nodes should be removed
++ * once the drivers are updated to use pm_runtime or to use the appropriate
++ * upstream clock node for rate/parent selection.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-private.h>
++#include <linux/clkdev.h>
++#include <linux/clk/ti.h>
++
++/*
++ * OMAP4 ABE DPLL default frequency. In OMAP4460 TRM version V, section
++ * "3.6.3.2.3 CM1_ABE Clock Generator" states that the "DPLL_ABE_X2_CLK
++ * must be set to 196.608 MHz" and hence, the DPLL locked frequency is
++ * half of this value.
++ */
++#define OMAP4_DPLL_ABE_DEFFREQ                                98304000
++
++/*
++ * OMAP4 USB DPLL default frequency. In OMAP4430 TRM version V, section
++ * "3.6.3.9.5 DPLL_USB Preferred Settings" shows that the preferred
++ * locked frequency for the USB DPLL is 960MHz.
++ */
++#define OMAP4_DPLL_USB_DEFFREQ                                960000000
++
++static struct omap_dt_clk omap44xx_clks[] = {
++      DT_CLK(NULL, "extalt_clkin_ck", "extalt_clkin_ck"),
++      DT_CLK(NULL, "pad_clks_src_ck", "pad_clks_src_ck"),
++      DT_CLK(NULL, "pad_clks_ck", "pad_clks_ck"),
++      DT_CLK(NULL, "pad_slimbus_core_clks_ck", "pad_slimbus_core_clks_ck"),
++      DT_CLK(NULL, "secure_32k_clk_src_ck", "secure_32k_clk_src_ck"),
++      DT_CLK(NULL, "slimbus_src_clk", "slimbus_src_clk"),
++      DT_CLK(NULL, "slimbus_clk", "slimbus_clk"),
++      DT_CLK(NULL, "sys_32k_ck", "sys_32k_ck"),
++      DT_CLK(NULL, "virt_12000000_ck", "virt_12000000_ck"),
++      DT_CLK(NULL, "virt_13000000_ck", "virt_13000000_ck"),
++      DT_CLK(NULL, "virt_16800000_ck", "virt_16800000_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "virt_27000000_ck", "virt_27000000_ck"),
++      DT_CLK(NULL, "virt_38400000_ck", "virt_38400000_ck"),
++      DT_CLK(NULL, "sys_clkin_ck", "sys_clkin_ck"),
++      DT_CLK(NULL, "tie_low_clock_ck", "tie_low_clock_ck"),
++      DT_CLK(NULL, "utmi_phy_clkout_ck", "utmi_phy_clkout_ck"),
++      DT_CLK(NULL, "xclk60mhsp1_ck", "xclk60mhsp1_ck"),
++      DT_CLK(NULL, "xclk60mhsp2_ck", "xclk60mhsp2_ck"),
++      DT_CLK(NULL, "xclk60motg_ck", "xclk60motg_ck"),
++      DT_CLK(NULL, "abe_dpll_bypass_clk_mux_ck", "abe_dpll_bypass_clk_mux_ck"),
++      DT_CLK(NULL, "abe_dpll_refclk_mux_ck", "abe_dpll_refclk_mux_ck"),
++      DT_CLK(NULL, "dpll_abe_ck", "dpll_abe_ck"),
++      DT_CLK(NULL, "dpll_abe_x2_ck", "dpll_abe_x2_ck"),
++      DT_CLK(NULL, "dpll_abe_m2x2_ck", "dpll_abe_m2x2_ck"),
++      DT_CLK(NULL, "abe_24m_fclk", "abe_24m_fclk"),
++      DT_CLK(NULL, "abe_clk", "abe_clk"),
++      DT_CLK(NULL, "aess_fclk", "aess_fclk"),
++      DT_CLK(NULL, "dpll_abe_m3x2_ck", "dpll_abe_m3x2_ck"),
++      DT_CLK(NULL, "core_hsd_byp_clk_mux_ck", "core_hsd_byp_clk_mux_ck"),
++      DT_CLK(NULL, "dpll_core_ck", "dpll_core_ck"),
++      DT_CLK(NULL, "dpll_core_x2_ck", "dpll_core_x2_ck"),
++      DT_CLK(NULL, "dpll_core_m6x2_ck", "dpll_core_m6x2_ck"),
++      DT_CLK(NULL, "dbgclk_mux_ck", "dbgclk_mux_ck"),
++      DT_CLK(NULL, "dpll_core_m2_ck", "dpll_core_m2_ck"),
++      DT_CLK(NULL, "ddrphy_ck", "ddrphy_ck"),
++      DT_CLK(NULL, "dpll_core_m5x2_ck", "dpll_core_m5x2_ck"),
++      DT_CLK(NULL, "div_core_ck", "div_core_ck"),
++      DT_CLK(NULL, "div_iva_hs_clk", "div_iva_hs_clk"),
++      DT_CLK(NULL, "div_mpu_hs_clk", "div_mpu_hs_clk"),
++      DT_CLK(NULL, "dpll_core_m4x2_ck", "dpll_core_m4x2_ck"),
++      DT_CLK(NULL, "dll_clk_div_ck", "dll_clk_div_ck"),
++      DT_CLK(NULL, "dpll_abe_m2_ck", "dpll_abe_m2_ck"),
++      DT_CLK(NULL, "dpll_core_m3x2_ck", "dpll_core_m3x2_ck"),
++      DT_CLK(NULL, "dpll_core_m7x2_ck", "dpll_core_m7x2_ck"),
++      DT_CLK(NULL, "iva_hsd_byp_clk_mux_ck", "iva_hsd_byp_clk_mux_ck"),
++      DT_CLK(NULL, "dpll_iva_ck", "dpll_iva_ck"),
++      DT_CLK(NULL, "dpll_iva_x2_ck", "dpll_iva_x2_ck"),
++      DT_CLK(NULL, "dpll_iva_m4x2_ck", "dpll_iva_m4x2_ck"),
++      DT_CLK(NULL, "dpll_iva_m5x2_ck", "dpll_iva_m5x2_ck"),
++      DT_CLK(NULL, "dpll_mpu_ck", "dpll_mpu_ck"),
++      DT_CLK(NULL, "dpll_mpu_m2_ck", "dpll_mpu_m2_ck"),
++      DT_CLK(NULL, "per_hs_clk_div_ck", "per_hs_clk_div_ck"),
++      DT_CLK(NULL, "per_hsd_byp_clk_mux_ck", "per_hsd_byp_clk_mux_ck"),
++      DT_CLK(NULL, "dpll_per_ck", "dpll_per_ck"),
++      DT_CLK(NULL, "dpll_per_m2_ck", "dpll_per_m2_ck"),
++      DT_CLK(NULL, "dpll_per_x2_ck", "dpll_per_x2_ck"),
++      DT_CLK(NULL, "dpll_per_m2x2_ck", "dpll_per_m2x2_ck"),
++      DT_CLK(NULL, "dpll_per_m3x2_ck", "dpll_per_m3x2_ck"),
++      DT_CLK(NULL, "dpll_per_m4x2_ck", "dpll_per_m4x2_ck"),
++      DT_CLK(NULL, "dpll_per_m5x2_ck", "dpll_per_m5x2_ck"),
++      DT_CLK(NULL, "dpll_per_m6x2_ck", "dpll_per_m6x2_ck"),
++      DT_CLK(NULL, "dpll_per_m7x2_ck", "dpll_per_m7x2_ck"),
++      DT_CLK(NULL, "usb_hs_clk_div_ck", "usb_hs_clk_div_ck"),
++      DT_CLK(NULL, "dpll_usb_ck", "dpll_usb_ck"),
++      DT_CLK(NULL, "dpll_usb_clkdcoldo_ck", "dpll_usb_clkdcoldo_ck"),
++      DT_CLK(NULL, "dpll_usb_m2_ck", "dpll_usb_m2_ck"),
++      DT_CLK(NULL, "ducati_clk_mux_ck", "ducati_clk_mux_ck"),
++      DT_CLK(NULL, "func_12m_fclk", "func_12m_fclk"),
++      DT_CLK(NULL, "func_24m_clk", "func_24m_clk"),
++      DT_CLK(NULL, "func_24mc_fclk", "func_24mc_fclk"),
++      DT_CLK(NULL, "func_48m_fclk", "func_48m_fclk"),
++      DT_CLK(NULL, "func_48mc_fclk", "func_48mc_fclk"),
++      DT_CLK(NULL, "func_64m_fclk", "func_64m_fclk"),
++      DT_CLK(NULL, "func_96m_fclk", "func_96m_fclk"),
++      DT_CLK(NULL, "init_60m_fclk", "init_60m_fclk"),
++      DT_CLK(NULL, "l3_div_ck", "l3_div_ck"),
++      DT_CLK(NULL, "l4_div_ck", "l4_div_ck"),
++      DT_CLK(NULL, "lp_clk_div_ck", "lp_clk_div_ck"),
++      DT_CLK(NULL, "l4_wkup_clk_mux_ck", "l4_wkup_clk_mux_ck"),
++      DT_CLK("smp_twd", NULL, "mpu_periphclk"),
++      DT_CLK(NULL, "ocp_abe_iclk", "ocp_abe_iclk"),
++      DT_CLK(NULL, "per_abe_24m_fclk", "per_abe_24m_fclk"),
++      DT_CLK(NULL, "per_abe_nc_fclk", "per_abe_nc_fclk"),
++      DT_CLK(NULL, "syc_clk_div_ck", "syc_clk_div_ck"),
++      DT_CLK(NULL, "aes1_fck", "aes1_fck"),
++      DT_CLK(NULL, "aes2_fck", "aes2_fck"),
++      DT_CLK(NULL, "dmic_sync_mux_ck", "dmic_sync_mux_ck"),
++      DT_CLK(NULL, "func_dmic_abe_gfclk", "func_dmic_abe_gfclk"),
++      DT_CLK(NULL, "dss_sys_clk", "dss_sys_clk"),
++      DT_CLK(NULL, "dss_tv_clk", "dss_tv_clk"),
++      DT_CLK(NULL, "dss_dss_clk", "dss_dss_clk"),
++      DT_CLK(NULL, "dss_48mhz_clk", "dss_48mhz_clk"),
++      DT_CLK(NULL, "dss_fck", "dss_fck"),
++      DT_CLK("omapdss_dss", "ick", "dss_fck"),
++      DT_CLK(NULL, "fdif_fck", "fdif_fck"),
++      DT_CLK(NULL, "gpio1_dbclk", "gpio1_dbclk"),
++      DT_CLK(NULL, "gpio2_dbclk", "gpio2_dbclk"),
++      DT_CLK(NULL, "gpio3_dbclk", "gpio3_dbclk"),
++      DT_CLK(NULL, "gpio4_dbclk", "gpio4_dbclk"),
++      DT_CLK(NULL, "gpio5_dbclk", "gpio5_dbclk"),
++      DT_CLK(NULL, "gpio6_dbclk", "gpio6_dbclk"),
++      DT_CLK(NULL, "sgx_clk_mux", "sgx_clk_mux"),
++      DT_CLK(NULL, "hsi_fck", "hsi_fck"),
++      DT_CLK(NULL, "iss_ctrlclk", "iss_ctrlclk"),
++      DT_CLK(NULL, "mcasp_sync_mux_ck", "mcasp_sync_mux_ck"),
++      DT_CLK(NULL, "func_mcasp_abe_gfclk", "func_mcasp_abe_gfclk"),
++      DT_CLK(NULL, "mcbsp1_sync_mux_ck", "mcbsp1_sync_mux_ck"),
++      DT_CLK(NULL, "func_mcbsp1_gfclk", "func_mcbsp1_gfclk"),
++      DT_CLK(NULL, "mcbsp2_sync_mux_ck", "mcbsp2_sync_mux_ck"),
++      DT_CLK(NULL, "func_mcbsp2_gfclk", "func_mcbsp2_gfclk"),
++      DT_CLK(NULL, "mcbsp3_sync_mux_ck", "mcbsp3_sync_mux_ck"),
++      DT_CLK(NULL, "func_mcbsp3_gfclk", "func_mcbsp3_gfclk"),
++      DT_CLK(NULL, "mcbsp4_sync_mux_ck", "mcbsp4_sync_mux_ck"),
++      DT_CLK(NULL, "per_mcbsp4_gfclk", "per_mcbsp4_gfclk"),
++      DT_CLK(NULL, "hsmmc1_fclk", "hsmmc1_fclk"),
++      DT_CLK(NULL, "hsmmc2_fclk", "hsmmc2_fclk"),
++      DT_CLK(NULL, "ocp2scp_usb_phy_phy_48m", "ocp2scp_usb_phy_phy_48m"),
++      DT_CLK(NULL, "sha2md5_fck", "sha2md5_fck"),
++      DT_CLK(NULL, "slimbus1_fclk_1", "slimbus1_fclk_1"),
++      DT_CLK(NULL, "slimbus1_fclk_0", "slimbus1_fclk_0"),
++      DT_CLK(NULL, "slimbus1_fclk_2", "slimbus1_fclk_2"),
++      DT_CLK(NULL, "slimbus1_slimbus_clk", "slimbus1_slimbus_clk"),
++      DT_CLK(NULL, "slimbus2_fclk_1", "slimbus2_fclk_1"),
++      DT_CLK(NULL, "slimbus2_fclk_0", "slimbus2_fclk_0"),
++      DT_CLK(NULL, "slimbus2_slimbus_clk", "slimbus2_slimbus_clk"),
++      DT_CLK(NULL, "smartreflex_core_fck", "smartreflex_core_fck"),
++      DT_CLK(NULL, "smartreflex_iva_fck", "smartreflex_iva_fck"),
++      DT_CLK(NULL, "smartreflex_mpu_fck", "smartreflex_mpu_fck"),
++      DT_CLK(NULL, "dmt1_clk_mux", "dmt1_clk_mux"),
++      DT_CLK(NULL, "cm2_dm10_mux", "cm2_dm10_mux"),
++      DT_CLK(NULL, "cm2_dm11_mux", "cm2_dm11_mux"),
++      DT_CLK(NULL, "cm2_dm2_mux", "cm2_dm2_mux"),
++      DT_CLK(NULL, "cm2_dm3_mux", "cm2_dm3_mux"),
++      DT_CLK(NULL, "cm2_dm4_mux", "cm2_dm4_mux"),
++      DT_CLK(NULL, "timer5_sync_mux", "timer5_sync_mux"),
++      DT_CLK(NULL, "timer6_sync_mux", "timer6_sync_mux"),
++      DT_CLK(NULL, "timer7_sync_mux", "timer7_sync_mux"),
++      DT_CLK(NULL, "timer8_sync_mux", "timer8_sync_mux"),
++      DT_CLK(NULL, "cm2_dm9_mux", "cm2_dm9_mux"),
++      DT_CLK(NULL, "usb_host_fs_fck", "usb_host_fs_fck"),
++      DT_CLK("usbhs_omap", "fs_fck", "usb_host_fs_fck"),
++      DT_CLK(NULL, "utmi_p1_gfclk", "utmi_p1_gfclk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p1_clk", "usb_host_hs_utmi_p1_clk"),
++      DT_CLK(NULL, "utmi_p2_gfclk", "utmi_p2_gfclk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p2_clk", "usb_host_hs_utmi_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p3_clk", "usb_host_hs_utmi_p3_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic480m_p1_clk", "usb_host_hs_hsic480m_p1_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic60m_p1_clk", "usb_host_hs_hsic60m_p1_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic60m_p2_clk", "usb_host_hs_hsic60m_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic480m_p2_clk", "usb_host_hs_hsic480m_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_func48mclk", "usb_host_hs_func48mclk"),
++      DT_CLK(NULL, "usb_host_hs_fck", "usb_host_hs_fck"),
++      DT_CLK("usbhs_omap", "hs_fck", "usb_host_hs_fck"),
++      DT_CLK(NULL, "otg_60m_gfclk", "otg_60m_gfclk"),
++      DT_CLK(NULL, "usb_otg_hs_xclk", "usb_otg_hs_xclk"),
++      DT_CLK(NULL, "usb_otg_hs_ick", "usb_otg_hs_ick"),
++      DT_CLK("musb-omap2430", "ick", "usb_otg_hs_ick"),
++      DT_CLK(NULL, "usb_phy_cm_clk32k", "usb_phy_cm_clk32k"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch2_clk", "usb_tll_hs_usb_ch2_clk"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch0_clk", "usb_tll_hs_usb_ch0_clk"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch1_clk", "usb_tll_hs_usb_ch1_clk"),
++      DT_CLK(NULL, "usb_tll_hs_ick", "usb_tll_hs_ick"),
++      DT_CLK("usbhs_omap", "usbtll_ick", "usb_tll_hs_ick"),
++      DT_CLK("usbhs_tll", "usbtll_ick", "usb_tll_hs_ick"),
++      DT_CLK(NULL, "usim_ck", "usim_ck"),
++      DT_CLK(NULL, "usim_fclk", "usim_fclk"),
++      DT_CLK(NULL, "pmd_stm_clock_mux_ck", "pmd_stm_clock_mux_ck"),
++      DT_CLK(NULL, "pmd_trace_clk_mux_ck", "pmd_trace_clk_mux_ck"),
++      DT_CLK(NULL, "stm_clk_div_ck", "stm_clk_div_ck"),
++      DT_CLK(NULL, "trace_clk_div_ck", "trace_clk_div_ck"),
++      DT_CLK(NULL, "auxclk0_src_ck", "auxclk0_src_ck"),
++      DT_CLK(NULL, "auxclk0_ck", "auxclk0_ck"),
++      DT_CLK(NULL, "auxclkreq0_ck", "auxclkreq0_ck"),
++      DT_CLK(NULL, "auxclk1_src_ck", "auxclk1_src_ck"),
++      DT_CLK(NULL, "auxclk1_ck", "auxclk1_ck"),
++      DT_CLK(NULL, "auxclkreq1_ck", "auxclkreq1_ck"),
++      DT_CLK(NULL, "auxclk2_src_ck", "auxclk2_src_ck"),
++      DT_CLK(NULL, "auxclk2_ck", "auxclk2_ck"),
++      DT_CLK(NULL, "auxclkreq2_ck", "auxclkreq2_ck"),
++      DT_CLK(NULL, "auxclk3_src_ck", "auxclk3_src_ck"),
++      DT_CLK(NULL, "auxclk3_ck", "auxclk3_ck"),
++      DT_CLK(NULL, "auxclkreq3_ck", "auxclkreq3_ck"),
++      DT_CLK(NULL, "auxclk4_src_ck", "auxclk4_src_ck"),
++      DT_CLK(NULL, "auxclk4_ck", "auxclk4_ck"),
++      DT_CLK(NULL, "auxclkreq4_ck", "auxclkreq4_ck"),
++      DT_CLK(NULL, "auxclk5_src_ck", "auxclk5_src_ck"),
++      DT_CLK(NULL, "auxclk5_ck", "auxclk5_ck"),
++      DT_CLK(NULL, "auxclkreq5_ck", "auxclkreq5_ck"),
++      DT_CLK(NULL, "timer_32k_ck", "sys_32k_ck"),
++      DT_CLK("omap_timer.1", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.2", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.3", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.4", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.9", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.10", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.11", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("omap_timer.5", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("omap_timer.6", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("omap_timer.7", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("omap_timer.8", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("4a318000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("48032000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("48034000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("48036000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("4803e000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("48086000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("48088000.timer", "timer_sys_ck", "sys_clkin_ck"),
++      DT_CLK("40138000.timer", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("4013a000.timer", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("4013c000.timer", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK("4013e000.timer", "timer_sys_ck", "syc_clk_div_ck"),
++      DT_CLK(NULL, "cpufreq_ck", "dpll_mpu_ck"),
++      DT_CLK(NULL, "bandgap_fclk", "bandgap_fclk"),
++      DT_CLK(NULL, "div_ts_ck", "div_ts_ck"),
++      DT_CLK(NULL, "bandgap_ts_fclk", "bandgap_ts_fclk"),
++      { .node_name = NULL },
++};
++
++int __init omap4xxx_clk_init(void)
++{
++      int rc;
++      struct clk *abe_dpll_ref, *abe_dpll, *sys_32k_ck, *usb_dpll;
++
++      of_clk_init(NULL);
++
++      omap_dt_clocks_register(omap44xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      /*
++       * A set rate of ABE DPLL inturn triggers a set rate of USB DPLL
++       * when its in bypass. So always lock USB before ABE DPLL.
++       */
++      /*
++       * Lock USB DPLL on OMAP4 devices so that the L3INIT power
++       * domain can transition to retention state when not in use.
++       */
++      usb_dpll = clk_get_sys(NULL, "dpll_usb_ck");
++      rc = clk_set_rate(usb_dpll, OMAP4_DPLL_USB_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure USB DPLL!\n", __func__);
++
++      /*
++       * On OMAP4460 the ABE DPLL fails to turn on if in idle low-power
++       * state when turning the ABE clock domain. Workaround this by
++       * locking the ABE DPLL on boot.
++       * Lock the ABE DPLL in any case to avoid issues with audio.
++       */
++      abe_dpll_ref = clk_get_sys(NULL, "abe_dpll_refclk_mux_ck");
++      sys_32k_ck = clk_get_sys(NULL, "sys_32k_ck");
++      rc = clk_set_parent(abe_dpll_ref, sys_32k_ck);
++      abe_dpll = clk_get_sys(NULL, "dpll_abe_ck");
++      if (!rc)
++              rc = clk_set_rate(abe_dpll, OMAP4_DPLL_ABE_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure ABE DPLL!\n", __func__);
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk-54xx.c
+@@ -0,0 +1,231 @@
++/*
++ * OMAP5 Clock init
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo (t-kristo@ti.com)
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-private.h>
++#include <linux/clkdev.h>
++#include <linux/io.h>
++#include <linux/clk/ti.h>
++
++#define OMAP5_DPLL_ABE_DEFFREQ                                98304000
++
++/*
++ * OMAP543x TRM, section "3.6.3.9.5 DPLL_USB Preferred Settings"
++ * states it must be at 960MHz
++ */
++#define OMAP5_DPLL_USB_DEFFREQ                                960000000
++
++static struct omap_dt_clk omap54xx_clks[] = {
++      DT_CLK(NULL, "pad_clks_src_ck", "pad_clks_src_ck"),
++      DT_CLK(NULL, "pad_clks_ck", "pad_clks_ck"),
++      DT_CLK(NULL, "secure_32k_clk_src_ck", "secure_32k_clk_src_ck"),
++      DT_CLK(NULL, "slimbus_src_clk", "slimbus_src_clk"),
++      DT_CLK(NULL, "slimbus_clk", "slimbus_clk"),
++      DT_CLK(NULL, "sys_32k_ck", "sys_32k_ck"),
++      DT_CLK(NULL, "virt_12000000_ck", "virt_12000000_ck"),
++      DT_CLK(NULL, "virt_13000000_ck", "virt_13000000_ck"),
++      DT_CLK(NULL, "virt_16800000_ck", "virt_16800000_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "virt_27000000_ck", "virt_27000000_ck"),
++      DT_CLK(NULL, "virt_38400000_ck", "virt_38400000_ck"),
++      DT_CLK(NULL, "sys_clkin", "sys_clkin"),
++      DT_CLK(NULL, "xclk60mhsp1_ck", "xclk60mhsp1_ck"),
++      DT_CLK(NULL, "xclk60mhsp2_ck", "xclk60mhsp2_ck"),
++      DT_CLK(NULL, "abe_dpll_bypass_clk_mux", "abe_dpll_bypass_clk_mux"),
++      DT_CLK(NULL, "abe_dpll_clk_mux", "abe_dpll_clk_mux"),
++      DT_CLK(NULL, "dpll_abe_ck", "dpll_abe_ck"),
++      DT_CLK(NULL, "dpll_abe_x2_ck", "dpll_abe_x2_ck"),
++      DT_CLK(NULL, "dpll_abe_m2x2_ck", "dpll_abe_m2x2_ck"),
++      DT_CLK(NULL, "abe_24m_fclk", "abe_24m_fclk"),
++      DT_CLK(NULL, "abe_clk", "abe_clk"),
++      DT_CLK(NULL, "abe_iclk", "abe_iclk"),
++      DT_CLK(NULL, "abe_lp_clk_div", "abe_lp_clk_div"),
++      DT_CLK(NULL, "dpll_abe_m3x2_ck", "dpll_abe_m3x2_ck"),
++      DT_CLK(NULL, "dpll_core_ck", "dpll_core_ck"),
++      DT_CLK(NULL, "dpll_core_x2_ck", "dpll_core_x2_ck"),
++      DT_CLK(NULL, "dpll_core_h21x2_ck", "dpll_core_h21x2_ck"),
++      DT_CLK(NULL, "c2c_fclk", "c2c_fclk"),
++      DT_CLK(NULL, "c2c_iclk", "c2c_iclk"),
++      DT_CLK(NULL, "custefuse_sys_gfclk_div", "custefuse_sys_gfclk_div"),
++      DT_CLK(NULL, "dpll_core_h11x2_ck", "dpll_core_h11x2_ck"),
++      DT_CLK(NULL, "dpll_core_h12x2_ck", "dpll_core_h12x2_ck"),
++      DT_CLK(NULL, "dpll_core_h13x2_ck", "dpll_core_h13x2_ck"),
++      DT_CLK(NULL, "dpll_core_h14x2_ck", "dpll_core_h14x2_ck"),
++      DT_CLK(NULL, "dpll_core_h22x2_ck", "dpll_core_h22x2_ck"),
++      DT_CLK(NULL, "dpll_core_h23x2_ck", "dpll_core_h23x2_ck"),
++      DT_CLK(NULL, "dpll_core_h24x2_ck", "dpll_core_h24x2_ck"),
++      DT_CLK(NULL, "dpll_core_m2_ck", "dpll_core_m2_ck"),
++      DT_CLK(NULL, "dpll_core_m3x2_ck", "dpll_core_m3x2_ck"),
++      DT_CLK(NULL, "iva_dpll_hs_clk_div", "iva_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_iva_ck", "dpll_iva_ck"),
++      DT_CLK(NULL, "dpll_iva_x2_ck", "dpll_iva_x2_ck"),
++      DT_CLK(NULL, "dpll_iva_h11x2_ck", "dpll_iva_h11x2_ck"),
++      DT_CLK(NULL, "dpll_iva_h12x2_ck", "dpll_iva_h12x2_ck"),
++      DT_CLK(NULL, "mpu_dpll_hs_clk_div", "mpu_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_mpu_ck", "dpll_mpu_ck"),
++      DT_CLK(NULL, "dpll_mpu_m2_ck", "dpll_mpu_m2_ck"),
++      DT_CLK(NULL, "per_dpll_hs_clk_div", "per_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_per_ck", "dpll_per_ck"),
++      DT_CLK(NULL, "dpll_per_x2_ck", "dpll_per_x2_ck"),
++      DT_CLK(NULL, "dpll_per_h11x2_ck", "dpll_per_h11x2_ck"),
++      DT_CLK(NULL, "dpll_per_h12x2_ck", "dpll_per_h12x2_ck"),
++      DT_CLK(NULL, "dpll_per_h14x2_ck", "dpll_per_h14x2_ck"),
++      DT_CLK(NULL, "dpll_per_m2_ck", "dpll_per_m2_ck"),
++      DT_CLK(NULL, "dpll_per_m2x2_ck", "dpll_per_m2x2_ck"),
++      DT_CLK(NULL, "dpll_per_m3x2_ck", "dpll_per_m3x2_ck"),
++      DT_CLK(NULL, "dpll_unipro1_ck", "dpll_unipro1_ck"),
++      DT_CLK(NULL, "dpll_unipro1_clkdcoldo", "dpll_unipro1_clkdcoldo"),
++      DT_CLK(NULL, "dpll_unipro1_m2_ck", "dpll_unipro1_m2_ck"),
++      DT_CLK(NULL, "dpll_unipro2_ck", "dpll_unipro2_ck"),
++      DT_CLK(NULL, "dpll_unipro2_clkdcoldo", "dpll_unipro2_clkdcoldo"),
++      DT_CLK(NULL, "dpll_unipro2_m2_ck", "dpll_unipro2_m2_ck"),
++      DT_CLK(NULL, "usb_dpll_hs_clk_div", "usb_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_usb_ck", "dpll_usb_ck"),
++      DT_CLK(NULL, "dpll_usb_clkdcoldo", "dpll_usb_clkdcoldo"),
++      DT_CLK(NULL, "dpll_usb_m2_ck", "dpll_usb_m2_ck"),
++      DT_CLK(NULL, "dss_syc_gfclk_div", "dss_syc_gfclk_div"),
++      DT_CLK(NULL, "func_128m_clk", "func_128m_clk"),
++      DT_CLK(NULL, "func_12m_fclk", "func_12m_fclk"),
++      DT_CLK(NULL, "func_24m_clk", "func_24m_clk"),
++      DT_CLK(NULL, "func_48m_fclk", "func_48m_fclk"),
++      DT_CLK(NULL, "func_96m_fclk", "func_96m_fclk"),
++      DT_CLK(NULL, "l3_iclk_div", "l3_iclk_div"),
++      DT_CLK(NULL, "gpu_l3_iclk", "gpu_l3_iclk"),
++      DT_CLK(NULL, "l3init_60m_fclk", "l3init_60m_fclk"),
++      DT_CLK(NULL, "wkupaon_iclk_mux", "wkupaon_iclk_mux"),
++      DT_CLK(NULL, "l3instr_ts_gclk_div", "l3instr_ts_gclk_div"),
++      DT_CLK(NULL, "l4_root_clk_div", "l4_root_clk_div"),
++      DT_CLK(NULL, "dss_32khz_clk", "dss_32khz_clk"),
++      DT_CLK(NULL, "dss_48mhz_clk", "dss_48mhz_clk"),
++      DT_CLK(NULL, "dss_dss_clk", "dss_dss_clk"),
++      DT_CLK(NULL, "dss_sys_clk", "dss_sys_clk"),
++      DT_CLK(NULL, "gpio1_dbclk", "gpio1_dbclk"),
++      DT_CLK(NULL, "gpio2_dbclk", "gpio2_dbclk"),
++      DT_CLK(NULL, "gpio3_dbclk", "gpio3_dbclk"),
++      DT_CLK(NULL, "gpio4_dbclk", "gpio4_dbclk"),
++      DT_CLK(NULL, "gpio5_dbclk", "gpio5_dbclk"),
++      DT_CLK(NULL, "gpio6_dbclk", "gpio6_dbclk"),
++      DT_CLK(NULL, "gpio7_dbclk", "gpio7_dbclk"),
++      DT_CLK(NULL, "gpio8_dbclk", "gpio8_dbclk"),
++      DT_CLK(NULL, "iss_ctrlclk", "iss_ctrlclk"),
++      DT_CLK(NULL, "lli_txphy_clk", "lli_txphy_clk"),
++      DT_CLK(NULL, "lli_txphy_ls_clk", "lli_txphy_ls_clk"),
++      DT_CLK(NULL, "mmc1_32khz_clk", "mmc1_32khz_clk"),
++      DT_CLK(NULL, "sata_ref_clk", "sata_ref_clk"),
++      DT_CLK(NULL, "slimbus1_slimbus_clk", "slimbus1_slimbus_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic480m_p1_clk", "usb_host_hs_hsic480m_p1_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic480m_p2_clk", "usb_host_hs_hsic480m_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic480m_p3_clk", "usb_host_hs_hsic480m_p3_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic60m_p1_clk", "usb_host_hs_hsic60m_p1_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic60m_p2_clk", "usb_host_hs_hsic60m_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_hsic60m_p3_clk", "usb_host_hs_hsic60m_p3_clk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p1_clk", "usb_host_hs_utmi_p1_clk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p2_clk", "usb_host_hs_utmi_p2_clk"),
++      DT_CLK(NULL, "usb_host_hs_utmi_p3_clk", "usb_host_hs_utmi_p3_clk"),
++      DT_CLK(NULL, "usb_otg_ss_refclk960m", "usb_otg_ss_refclk960m"),
++      DT_CLK(NULL, "usb_phy_cm_clk32k", "usb_phy_cm_clk32k"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch0_clk", "usb_tll_hs_usb_ch0_clk"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch1_clk", "usb_tll_hs_usb_ch1_clk"),
++      DT_CLK(NULL, "usb_tll_hs_usb_ch2_clk", "usb_tll_hs_usb_ch2_clk"),
++      DT_CLK(NULL, "aess_fclk", "aess_fclk"),
++      DT_CLK(NULL, "dmic_sync_mux_ck", "dmic_sync_mux_ck"),
++      DT_CLK(NULL, "dmic_gfclk", "dmic_gfclk"),
++      DT_CLK(NULL, "fdif_fclk", "fdif_fclk"),
++      DT_CLK(NULL, "gpu_core_gclk_mux", "gpu_core_gclk_mux"),
++      DT_CLK(NULL, "gpu_hyd_gclk_mux", "gpu_hyd_gclk_mux"),
++      DT_CLK(NULL, "hsi_fclk", "hsi_fclk"),
++      DT_CLK(NULL, "mcasp_sync_mux_ck", "mcasp_sync_mux_ck"),
++      DT_CLK(NULL, "mcasp_gfclk", "mcasp_gfclk"),
++      DT_CLK(NULL, "mcbsp1_sync_mux_ck", "mcbsp1_sync_mux_ck"),
++      DT_CLK(NULL, "mcbsp1_gfclk", "mcbsp1_gfclk"),
++      DT_CLK(NULL, "mcbsp2_sync_mux_ck", "mcbsp2_sync_mux_ck"),
++      DT_CLK(NULL, "mcbsp2_gfclk", "mcbsp2_gfclk"),
++      DT_CLK(NULL, "mcbsp3_sync_mux_ck", "mcbsp3_sync_mux_ck"),
++      DT_CLK(NULL, "mcbsp3_gfclk", "mcbsp3_gfclk"),
++      DT_CLK(NULL, "mmc1_fclk_mux", "mmc1_fclk_mux"),
++      DT_CLK(NULL, "mmc1_fclk", "mmc1_fclk"),
++      DT_CLK(NULL, "mmc2_fclk_mux", "mmc2_fclk_mux"),
++      DT_CLK(NULL, "mmc2_fclk", "mmc2_fclk"),
++      DT_CLK(NULL, "timer10_gfclk_mux", "timer10_gfclk_mux"),
++      DT_CLK(NULL, "timer11_gfclk_mux", "timer11_gfclk_mux"),
++      DT_CLK(NULL, "timer1_gfclk_mux", "timer1_gfclk_mux"),
++      DT_CLK(NULL, "timer2_gfclk_mux", "timer2_gfclk_mux"),
++      DT_CLK(NULL, "timer3_gfclk_mux", "timer3_gfclk_mux"),
++      DT_CLK(NULL, "timer4_gfclk_mux", "timer4_gfclk_mux"),
++      DT_CLK(NULL, "timer5_gfclk_mux", "timer5_gfclk_mux"),
++      DT_CLK(NULL, "timer6_gfclk_mux", "timer6_gfclk_mux"),
++      DT_CLK(NULL, "timer7_gfclk_mux", "timer7_gfclk_mux"),
++      DT_CLK(NULL, "timer8_gfclk_mux", "timer8_gfclk_mux"),
++      DT_CLK(NULL, "timer9_gfclk_mux", "timer9_gfclk_mux"),
++      DT_CLK(NULL, "utmi_p1_gfclk", "utmi_p1_gfclk"),
++      DT_CLK(NULL, "utmi_p2_gfclk", "utmi_p2_gfclk"),
++      DT_CLK(NULL, "auxclk0_src_ck", "auxclk0_src_ck"),
++      DT_CLK(NULL, "auxclk0_ck", "auxclk0_ck"),
++      DT_CLK(NULL, "auxclkreq0_ck", "auxclkreq0_ck"),
++      DT_CLK(NULL, "auxclk1_src_ck", "auxclk1_src_ck"),
++      DT_CLK(NULL, "auxclk1_ck", "auxclk1_ck"),
++      DT_CLK(NULL, "auxclkreq1_ck", "auxclkreq1_ck"),
++      DT_CLK(NULL, "auxclk2_src_ck", "auxclk2_src_ck"),
++      DT_CLK(NULL, "auxclk2_ck", "auxclk2_ck"),
++      DT_CLK(NULL, "auxclkreq2_ck", "auxclkreq2_ck"),
++      DT_CLK(NULL, "auxclk3_src_ck", "auxclk3_src_ck"),
++      DT_CLK(NULL, "auxclk3_ck", "auxclk3_ck"),
++      DT_CLK(NULL, "auxclkreq3_ck", "auxclkreq3_ck"),
++      DT_CLK(NULL, "timer_32k_ck", "sys_32k_ck"),
++      DT_CLK("omap_timer.1", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.2", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.3", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.4", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.9", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.10", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.11", "sys_ck", "sys_clkin"),
++      DT_CLK("omap_timer.5", "sys_ck", "dss_syc_gfclk_div"),
++      DT_CLK("omap_timer.6", "sys_ck", "dss_syc_gfclk_div"),
++      DT_CLK("omap_timer.7", "sys_ck", "dss_syc_gfclk_div"),
++      DT_CLK("omap_timer.8", "sys_ck", "dss_syc_gfclk_div"),
++      { .node_name = NULL },
++};
++
++int __init omap5xxx_clk_init(void)
++{
++      int rc;
++      struct clk *abe_dpll_ref, *abe_dpll, *sys_32k_ck, *usb_dpll;
++
++      of_clk_init(NULL);
++
++      omap_dt_clocks_register(omap54xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      abe_dpll_ref = clk_get_sys(NULL, "abe_dpll_clk_mux");
++      sys_32k_ck = clk_get_sys(NULL, "sys_32k_ck");
++      rc = clk_set_parent(abe_dpll_ref, sys_32k_ck);
++      abe_dpll = clk_get_sys(NULL, "dpll_abe_ck");
++      if (!rc)
++              rc = clk_set_rate(abe_dpll, OMAP5_DPLL_ABE_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure ABE DPLL!\n", __func__);
++
++      usb_dpll = clk_get_sys(NULL, "dpll_usb_ck");
++      rc = clk_set_rate(usb_dpll, OMAP5_DPLL_USB_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure USB DPLL!\n", __func__);
++
++      usb_dpll = clk_get_sys(NULL, "dpll_usb_m2_ck");
++      rc = clk_set_rate(usb_dpll, OMAP5_DPLL_USB_DEFFREQ/2);
++      if (rc)
++              pr_err("%s: failed to set USB_DPLL M2 OUT\n", __func__);
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk-7xx.c
+@@ -0,0 +1,325 @@
++/*
++ * DRA7 Clock init
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo (t-kristo@ti.com)
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/list.h>
++#include <linux/clk-private.h>
++#include <linux/clkdev.h>
++#include <linux/clk/ti.h>
++
++#define DRA7_DPLL_ABE_DEFFREQ                         361267200
++#define DRA7_DPLL_GMAC_DEFFREQ                                1000000000
++#define DRA7_DPLL_USB_DEFFREQ                         960000000
++
++
++static struct omap_dt_clk dra7xx_clks[] = {
++      DT_CLK(NULL, "atl_clkin0_ck", "atl_clkin0_ck"),
++      DT_CLK(NULL, "atl_clkin1_ck", "atl_clkin1_ck"),
++      DT_CLK(NULL, "atl_clkin2_ck", "atl_clkin2_ck"),
++      DT_CLK(NULL, "atlclkin3_ck", "atlclkin3_ck"),
++      DT_CLK(NULL, "hdmi_clkin_ck", "hdmi_clkin_ck"),
++      DT_CLK(NULL, "mlb_clkin_ck", "mlb_clkin_ck"),
++      DT_CLK(NULL, "mlbp_clkin_ck", "mlbp_clkin_ck"),
++      DT_CLK(NULL, "pciesref_acs_clk_ck", "pciesref_acs_clk_ck"),
++      DT_CLK(NULL, "ref_clkin0_ck", "ref_clkin0_ck"),
++      DT_CLK(NULL, "ref_clkin1_ck", "ref_clkin1_ck"),
++      DT_CLK(NULL, "ref_clkin2_ck", "ref_clkin2_ck"),
++      DT_CLK(NULL, "ref_clkin3_ck", "ref_clkin3_ck"),
++      DT_CLK(NULL, "rmii_clk_ck", "rmii_clk_ck"),
++      DT_CLK(NULL, "sdvenc_clkin_ck", "sdvenc_clkin_ck"),
++      DT_CLK(NULL, "secure_32k_clk_src_ck", "secure_32k_clk_src_ck"),
++      DT_CLK(NULL, "sys_32k_ck", "sys_32k_ck"),
++      DT_CLK(NULL, "virt_12000000_ck", "virt_12000000_ck"),
++      DT_CLK(NULL, "virt_13000000_ck", "virt_13000000_ck"),
++      DT_CLK(NULL, "virt_16800000_ck", "virt_16800000_ck"),
++      DT_CLK(NULL, "virt_19200000_ck", "virt_19200000_ck"),
++      DT_CLK(NULL, "virt_20000000_ck", "virt_20000000_ck"),
++      DT_CLK(NULL, "virt_26000000_ck", "virt_26000000_ck"),
++      DT_CLK(NULL, "virt_27000000_ck", "virt_27000000_ck"),
++      DT_CLK(NULL, "virt_38400000_ck", "virt_38400000_ck"),
++      DT_CLK(NULL, "sys_clkin1", "sys_clkin1"),
++      DT_CLK(NULL, "sys_clkin2", "sys_clkin2"),
++      DT_CLK(NULL, "usb_otg_clkin_ck", "usb_otg_clkin_ck"),
++      DT_CLK(NULL, "video1_clkin_ck", "video1_clkin_ck"),
++      DT_CLK(NULL, "video1_m2_clkin_ck", "video1_m2_clkin_ck"),
++      DT_CLK(NULL, "video2_clkin_ck", "video2_clkin_ck"),
++      DT_CLK(NULL, "video2_m2_clkin_ck", "video2_m2_clkin_ck"),
++      DT_CLK(NULL, "abe_dpll_sys_clk_mux", "abe_dpll_sys_clk_mux"),
++      DT_CLK(NULL, "abe_dpll_bypass_clk_mux", "abe_dpll_bypass_clk_mux"),
++      DT_CLK(NULL, "abe_dpll_clk_mux", "abe_dpll_clk_mux"),
++      DT_CLK(NULL, "dpll_abe_ck", "dpll_abe_ck"),
++      DT_CLK(NULL, "dpll_abe_x2_ck", "dpll_abe_x2_ck"),
++      DT_CLK(NULL, "dpll_abe_m2x2_ck", "dpll_abe_m2x2_ck"),
++      DT_CLK(NULL, "abe_24m_fclk", "abe_24m_fclk"),
++      DT_CLK(NULL, "abe_clk", "abe_clk"),
++      DT_CLK(NULL, "aess_fclk", "aess_fclk"),
++      DT_CLK(NULL, "abe_giclk_div", "abe_giclk_div"),
++      DT_CLK(NULL, "abe_lp_clk_div", "abe_lp_clk_div"),
++      DT_CLK(NULL, "abe_sys_clk_div", "abe_sys_clk_div"),
++      DT_CLK(NULL, "adc_gfclk_mux", "adc_gfclk_mux"),
++      DT_CLK(NULL, "dpll_pcie_ref_ck", "dpll_pcie_ref_ck"),
++      DT_CLK(NULL, "dpll_pcie_ref_m2ldo_ck", "dpll_pcie_ref_m2ldo_ck"),
++      DT_CLK(NULL, "apll_pcie_ck", "apll_pcie_ck"),
++      DT_CLK(NULL, "apll_pcie_clkvcoldo", "apll_pcie_clkvcoldo"),
++      DT_CLK(NULL, "apll_pcie_clkvcoldo_div", "apll_pcie_clkvcoldo_div"),
++      DT_CLK(NULL, "apll_pcie_m2_ck", "apll_pcie_m2_ck"),
++      DT_CLK(NULL, "sys_clk1_dclk_div", "sys_clk1_dclk_div"),
++      DT_CLK(NULL, "sys_clk2_dclk_div", "sys_clk2_dclk_div"),
++      DT_CLK(NULL, "dpll_abe_m2_ck", "dpll_abe_m2_ck"),
++      DT_CLK(NULL, "per_abe_x1_dclk_div", "per_abe_x1_dclk_div"),
++      DT_CLK(NULL, "dpll_abe_m3x2_ck", "dpll_abe_m3x2_ck"),
++      DT_CLK(NULL, "dpll_core_ck", "dpll_core_ck"),
++      DT_CLK(NULL, "dpll_core_x2_ck", "dpll_core_x2_ck"),
++      DT_CLK(NULL, "dpll_core_h12x2_ck", "dpll_core_h12x2_ck"),
++      DT_CLK(NULL, "mpu_dpll_hs_clk_div", "mpu_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_mpu_ck", "dpll_mpu_ck"),
++      DT_CLK(NULL, "dpll_mpu_m2_ck", "dpll_mpu_m2_ck"),
++      DT_CLK(NULL, "mpu_dclk_div", "mpu_dclk_div"),
++      DT_CLK(NULL, "dsp_dpll_hs_clk_div", "dsp_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_dsp_ck", "dpll_dsp_ck"),
++      DT_CLK(NULL, "dpll_dsp_m2_ck", "dpll_dsp_m2_ck"),
++      DT_CLK(NULL, "dsp_gclk_div", "dsp_gclk_div"),
++      DT_CLK(NULL, "iva_dpll_hs_clk_div", "iva_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_iva_ck", "dpll_iva_ck"),
++      DT_CLK(NULL, "dpll_iva_m2_ck", "dpll_iva_m2_ck"),
++      DT_CLK(NULL, "iva_dclk", "iva_dclk"),
++      DT_CLK(NULL, "dpll_gpu_ck", "dpll_gpu_ck"),
++      DT_CLK(NULL, "dpll_gpu_m2_ck", "dpll_gpu_m2_ck"),
++      DT_CLK(NULL, "gpu_dclk", "gpu_dclk"),
++      DT_CLK(NULL, "dpll_core_m2_ck", "dpll_core_m2_ck"),
++      DT_CLK(NULL, "core_dpll_out_dclk_div", "core_dpll_out_dclk_div"),
++      DT_CLK(NULL, "dpll_ddr_ck", "dpll_ddr_ck"),
++      DT_CLK(NULL, "dpll_ddr_m2_ck", "dpll_ddr_m2_ck"),
++      DT_CLK(NULL, "emif_phy_dclk_div", "emif_phy_dclk_div"),
++      DT_CLK(NULL, "dpll_gmac_ck", "dpll_gmac_ck"),
++      DT_CLK(NULL, "dpll_gmac_m2_ck", "dpll_gmac_m2_ck"),
++      DT_CLK(NULL, "gmac_250m_dclk_div", "gmac_250m_dclk_div"),
++      DT_CLK(NULL, "video2_dclk_div", "video2_dclk_div"),
++      DT_CLK(NULL, "video1_dclk_div", "video1_dclk_div"),
++      DT_CLK(NULL, "hdmi_dclk_div", "hdmi_dclk_div"),
++      DT_CLK(NULL, "per_dpll_hs_clk_div", "per_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_per_ck", "dpll_per_ck"),
++      DT_CLK(NULL, "dpll_per_m2_ck", "dpll_per_m2_ck"),
++      DT_CLK(NULL, "func_96m_aon_dclk_div", "func_96m_aon_dclk_div"),
++      DT_CLK(NULL, "usb_dpll_hs_clk_div", "usb_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_usb_ck", "dpll_usb_ck"),
++      DT_CLK(NULL, "dpll_usb_m2_ck", "dpll_usb_m2_ck"),
++      DT_CLK(NULL, "l3init_480m_dclk_div", "l3init_480m_dclk_div"),
++      DT_CLK(NULL, "usb_otg_dclk_div", "usb_otg_dclk_div"),
++      DT_CLK(NULL, "sata_dclk_div", "sata_dclk_div"),
++      DT_CLK(NULL, "dpll_pcie_ref_m2_ck", "dpll_pcie_ref_m2_ck"),
++      DT_CLK(NULL, "pcie2_dclk_div", "pcie2_dclk_div"),
++      DT_CLK(NULL, "pcie_dclk_div", "pcie_dclk_div"),
++      DT_CLK(NULL, "emu_dclk_div", "emu_dclk_div"),
++      DT_CLK(NULL, "secure_32k_dclk_div", "secure_32k_dclk_div"),
++      DT_CLK(NULL, "eve_dpll_hs_clk_div", "eve_dpll_hs_clk_div"),
++      DT_CLK(NULL, "dpll_eve_ck", "dpll_eve_ck"),
++      DT_CLK(NULL, "dpll_eve_m2_ck", "dpll_eve_m2_ck"),
++      DT_CLK(NULL, "eve_dclk_div", "eve_dclk_div"),
++      DT_CLK(NULL, "clkoutmux0_clk_mux", "clkoutmux0_clk_mux"),
++      DT_CLK(NULL, "clkoutmux1_clk_mux", "clkoutmux1_clk_mux"),
++      DT_CLK(NULL, "clkoutmux2_clk_mux", "clkoutmux2_clk_mux"),
++      DT_CLK(NULL, "custefuse_sys_gfclk_div", "custefuse_sys_gfclk_div"),
++      DT_CLK(NULL, "dpll_core_h13x2_ck", "dpll_core_h13x2_ck"),
++      DT_CLK(NULL, "dpll_core_h14x2_ck", "dpll_core_h14x2_ck"),
++      DT_CLK(NULL, "dpll_core_h22x2_ck", "dpll_core_h22x2_ck"),
++      DT_CLK(NULL, "dpll_core_h23x2_ck", "dpll_core_h23x2_ck"),
++      DT_CLK(NULL, "dpll_core_h24x2_ck", "dpll_core_h24x2_ck"),
++      DT_CLK(NULL, "dpll_ddr_x2_ck", "dpll_ddr_x2_ck"),
++      DT_CLK(NULL, "dpll_ddr_h11x2_ck", "dpll_ddr_h11x2_ck"),
++      DT_CLK(NULL, "dpll_dsp_x2_ck", "dpll_dsp_x2_ck"),
++      DT_CLK(NULL, "dpll_dsp_m3x2_ck", "dpll_dsp_m3x2_ck"),
++      DT_CLK(NULL, "dpll_gmac_x2_ck", "dpll_gmac_x2_ck"),
++      DT_CLK(NULL, "dpll_gmac_h11x2_ck", "dpll_gmac_h11x2_ck"),
++      DT_CLK(NULL, "dpll_gmac_h12x2_ck", "dpll_gmac_h12x2_ck"),
++      DT_CLK(NULL, "dpll_gmac_h13x2_ck", "dpll_gmac_h13x2_ck"),
++      DT_CLK(NULL, "dpll_gmac_m3x2_ck", "dpll_gmac_m3x2_ck"),
++      DT_CLK(NULL, "dpll_per_x2_ck", "dpll_per_x2_ck"),
++      DT_CLK(NULL, "dpll_per_h11x2_ck", "dpll_per_h11x2_ck"),
++      DT_CLK(NULL, "dpll_per_h12x2_ck", "dpll_per_h12x2_ck"),
++      DT_CLK(NULL, "dpll_per_h13x2_ck", "dpll_per_h13x2_ck"),
++      DT_CLK(NULL, "dpll_per_h14x2_ck", "dpll_per_h14x2_ck"),
++      DT_CLK(NULL, "dpll_per_m2x2_ck", "dpll_per_m2x2_ck"),
++      DT_CLK(NULL, "dpll_usb_clkdcoldo", "dpll_usb_clkdcoldo"),
++      DT_CLK(NULL, "eve_clk", "eve_clk"),
++      DT_CLK(NULL, "func_128m_clk", "func_128m_clk"),
++      DT_CLK(NULL, "func_12m_fclk", "func_12m_fclk"),
++      DT_CLK(NULL, "func_24m_clk", "func_24m_clk"),
++      DT_CLK(NULL, "func_48m_fclk", "func_48m_fclk"),
++      DT_CLK(NULL, "func_96m_fclk", "func_96m_fclk"),
++      DT_CLK(NULL, "gmii_m_clk_div", "gmii_m_clk_div"),
++      DT_CLK(NULL, "hdmi_clk2_div", "hdmi_clk2_div"),
++      DT_CLK(NULL, "hdmi_div_clk", "hdmi_div_clk"),
++      DT_CLK(NULL, "hdmi_dpll_clk_mux", "hdmi_dpll_clk_mux"),
++      DT_CLK(NULL, "l3_iclk_div", "l3_iclk_div"),
++      DT_CLK(NULL, "l3init_60m_fclk", "l3init_60m_fclk"),
++      DT_CLK(NULL, "l4_root_clk_div", "l4_root_clk_div"),
++      DT_CLK(NULL, "mlb_clk", "mlb_clk"),
++      DT_CLK(NULL, "mlbp_clk", "mlbp_clk"),
++      DT_CLK(NULL, "per_abe_x1_gfclk2_div", "per_abe_x1_gfclk2_div"),
++      DT_CLK(NULL, "timer_sys_clk_div", "timer_sys_clk_div"),
++      DT_CLK(NULL, "video1_clk2_div", "video1_clk2_div"),
++      DT_CLK(NULL, "video1_div_clk", "video1_div_clk"),
++      DT_CLK(NULL, "video1_dpll_clk_mux", "video1_dpll_clk_mux"),
++      DT_CLK(NULL, "video2_clk2_div", "video2_clk2_div"),
++      DT_CLK(NULL, "video2_div_clk", "video2_div_clk"),
++      DT_CLK(NULL, "video2_dpll_clk_mux", "video2_dpll_clk_mux"),
++      DT_CLK(NULL, "wkupaon_iclk_mux", "wkupaon_iclk_mux"),
++      DT_CLK(NULL, "dss_32khz_clk", "dss_32khz_clk"),
++      DT_CLK(NULL, "dss_48mhz_clk", "dss_48mhz_clk"),
++      DT_CLK(NULL, "dss_dss_clk", "dss_dss_clk"),
++      DT_CLK(NULL, "dss_hdmi_clk", "dss_hdmi_clk"),
++      DT_CLK(NULL, "dss_video1_clk", "dss_video1_clk"),
++      DT_CLK(NULL, "dss_video2_clk", "dss_video2_clk"),
++      DT_CLK(NULL, "dss_deshdcp_clk", "dss_deshdcp_clk"),
++      DT_CLK(NULL, "gpio1_dbclk", "gpio1_dbclk"),
++      DT_CLK(NULL, "gpio2_dbclk", "gpio2_dbclk"),
++      DT_CLK(NULL, "gpio3_dbclk", "gpio3_dbclk"),
++      DT_CLK(NULL, "gpio4_dbclk", "gpio4_dbclk"),
++      DT_CLK(NULL, "gpio5_dbclk", "gpio5_dbclk"),
++      DT_CLK(NULL, "gpio6_dbclk", "gpio6_dbclk"),
++      DT_CLK(NULL, "gpio7_dbclk", "gpio7_dbclk"),
++      DT_CLK(NULL, "gpio8_dbclk", "gpio8_dbclk"),
++      DT_CLK(NULL, "mmc1_clk32k", "mmc1_clk32k"),
++      DT_CLK(NULL, "mmc2_clk32k", "mmc2_clk32k"),
++      DT_CLK(NULL, "mmc3_clk32k", "mmc3_clk32k"),
++      DT_CLK(NULL, "mmc4_clk32k", "mmc4_clk32k"),
++      DT_CLK(NULL, "sata_ref_clk", "sata_ref_clk"),
++      DT_CLK(NULL, "usb_otg_ss1_refclk960m", "usb_otg_ss1_refclk960m"),
++      DT_CLK(NULL, "usb_otg_ss2_refclk960m", "usb_otg_ss2_refclk960m"),
++      DT_CLK(NULL, "usb_phy1_always_on_clk32k", "usb_phy1_always_on_clk32k"),
++      DT_CLK(NULL, "usb_phy2_always_on_clk32k", "usb_phy2_always_on_clk32k"),
++      DT_CLK(NULL, "usb_phy3_always_on_clk32k", "usb_phy3_always_on_clk32k"),
++      DT_CLK(NULL, "atl_dpll_clk_mux", "atl_dpll_clk_mux"),
++      DT_CLK(NULL, "atl_gfclk_mux", "atl_gfclk_mux"),
++      DT_CLK(NULL, "dcan1_sys_clk_mux", "dcan1_sys_clk_mux"),
++      DT_CLK(NULL, "gmac_gmii_ref_clk_div", "gmac_gmii_ref_clk_div"),
++      DT_CLK(NULL, "gmac_rft_clk_mux", "gmac_rft_clk_mux"),
++      DT_CLK(NULL, "gpu_core_gclk_mux", "gpu_core_gclk_mux"),
++      DT_CLK(NULL, "gpu_hyd_gclk_mux", "gpu_hyd_gclk_mux"),
++      DT_CLK(NULL, "ipu1_gfclk_mux", "ipu1_gfclk_mux"),
++      DT_CLK(NULL, "l3instr_ts_gclk_div", "l3instr_ts_gclk_div"),
++      DT_CLK(NULL, "mcasp1_ahclkr_mux", "mcasp1_ahclkr_mux"),
++      DT_CLK(NULL, "mcasp1_ahclkx_mux", "mcasp1_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp1_aux_gfclk_mux", "mcasp1_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp2_ahclkr_mux", "mcasp2_ahclkr_mux"),
++      DT_CLK(NULL, "mcasp2_ahclkx_mux", "mcasp2_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp2_aux_gfclk_mux", "mcasp2_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp3_ahclkx_mux", "mcasp3_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp3_aux_gfclk_mux", "mcasp3_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp4_ahclkx_mux", "mcasp4_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp4_aux_gfclk_mux", "mcasp4_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp5_ahclkx_mux", "mcasp5_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp5_aux_gfclk_mux", "mcasp5_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp6_ahclkx_mux", "mcasp6_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp6_aux_gfclk_mux", "mcasp6_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp7_ahclkx_mux", "mcasp7_ahclkx_mux"),
++      DT_CLK(NULL, "mcasp7_aux_gfclk_mux", "mcasp7_aux_gfclk_mux"),
++      DT_CLK(NULL, "mcasp8_ahclk_mux", "mcasp8_ahclk_mux"),
++      DT_CLK(NULL, "mcasp8_aux_gfclk_mux", "mcasp8_aux_gfclk_mux"),
++      DT_CLK(NULL, "mmc1_fclk_mux", "mmc1_fclk_mux"),
++      DT_CLK(NULL, "mmc1_fclk_div", "mmc1_fclk_div"),
++      DT_CLK(NULL, "mmc2_fclk_mux", "mmc2_fclk_mux"),
++      DT_CLK(NULL, "mmc2_fclk_div", "mmc2_fclk_div"),
++      DT_CLK(NULL, "mmc3_gfclk_mux", "mmc3_gfclk_mux"),
++      DT_CLK(NULL, "mmc3_gfclk_div", "mmc3_gfclk_div"),
++      DT_CLK(NULL, "mmc4_gfclk_mux", "mmc4_gfclk_mux"),
++      DT_CLK(NULL, "mmc4_gfclk_div", "mmc4_gfclk_div"),
++      DT_CLK(NULL, "qspi_gfclk_mux", "qspi_gfclk_mux"),
++      DT_CLK(NULL, "qspi_gfclk_div", "qspi_gfclk_div"),
++      DT_CLK(NULL, "timer10_gfclk_mux", "timer10_gfclk_mux"),
++      DT_CLK(NULL, "timer11_gfclk_mux", "timer11_gfclk_mux"),
++      DT_CLK(NULL, "timer13_gfclk_mux", "timer13_gfclk_mux"),
++      DT_CLK(NULL, "timer14_gfclk_mux", "timer14_gfclk_mux"),
++      DT_CLK(NULL, "timer15_gfclk_mux", "timer15_gfclk_mux"),
++      DT_CLK(NULL, "timer16_gfclk_mux", "timer16_gfclk_mux"),
++      DT_CLK(NULL, "timer1_gfclk_mux", "timer1_gfclk_mux"),
++      DT_CLK(NULL, "timer2_gfclk_mux", "timer2_gfclk_mux"),
++      DT_CLK(NULL, "timer3_gfclk_mux", "timer3_gfclk_mux"),
++      DT_CLK(NULL, "timer4_gfclk_mux", "timer4_gfclk_mux"),
++      DT_CLK(NULL, "timer5_gfclk_mux", "timer5_gfclk_mux"),
++      DT_CLK(NULL, "timer6_gfclk_mux", "timer6_gfclk_mux"),
++      DT_CLK(NULL, "timer7_gfclk_mux", "timer7_gfclk_mux"),
++      DT_CLK(NULL, "timer8_gfclk_mux", "timer8_gfclk_mux"),
++      DT_CLK(NULL, "timer9_gfclk_mux", "timer9_gfclk_mux"),
++      DT_CLK(NULL, "uart10_gfclk_mux", "uart10_gfclk_mux"),
++      DT_CLK(NULL, "uart1_gfclk_mux", "uart1_gfclk_mux"),
++      DT_CLK(NULL, "uart2_gfclk_mux", "uart2_gfclk_mux"),
++      DT_CLK(NULL, "uart3_gfclk_mux", "uart3_gfclk_mux"),
++      DT_CLK(NULL, "uart4_gfclk_mux", "uart4_gfclk_mux"),
++      DT_CLK(NULL, "uart5_gfclk_mux", "uart5_gfclk_mux"),
++      DT_CLK(NULL, "uart6_gfclk_mux", "uart6_gfclk_mux"),
++      DT_CLK(NULL, "uart7_gfclk_mux", "uart7_gfclk_mux"),
++      DT_CLK(NULL, "uart8_gfclk_mux", "uart8_gfclk_mux"),
++      DT_CLK(NULL, "uart9_gfclk_mux", "uart9_gfclk_mux"),
++      DT_CLK(NULL, "vip1_gclk_mux", "vip1_gclk_mux"),
++      DT_CLK(NULL, "vip2_gclk_mux", "vip2_gclk_mux"),
++      DT_CLK(NULL, "vip3_gclk_mux", "vip3_gclk_mux"),
++      DT_CLK(NULL, "timer_32k_ck", "sys_32k_ck"),
++      DT_CLK("4ae18000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48032000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48034000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48036000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("4803e000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48086000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48088000.timer", "timer_sys_ck", "sys_clkin2"),
++      DT_CLK("48820000.timer", "timer_sys_ck", "timer_sys_clk_div"),
++      DT_CLK("48822000.timer", "timer_sys_ck", "timer_sys_clk_div"),
++      DT_CLK("48824000.timer", "timer_sys_ck", "timer_sys_clk_div"),
++      DT_CLK("48826000.timer", "timer_sys_ck", "timer_sys_clk_div"),
++      DT_CLK(NULL, "sys_clkin", "sys_clkin1"),
++      { .node_name = NULL },
++};
++
++int __init dra7xx_clk_init(void)
++{
++      int rc;
++      struct clk *abe_dpll_mux, *sys_clkin2, *dpll_ck, *deshdcp_clk;
++
++      of_clk_init(NULL);
++
++      omap_dt_clocks_register(dra7xx_clks);
++
++      omap2_clk_disable_autoidle_all();
++
++      abe_dpll_mux = clk_get_sys(NULL, "abe_dpll_sys_clk_mux");
++      sys_clkin2 = clk_get_sys(NULL, "sys_clkin2");
++      dpll_ck = clk_get_sys(NULL, "dpll_abe_ck");
++
++      rc = clk_set_parent(abe_dpll_mux, sys_clkin2);
++      if (!rc)
++              rc = clk_set_rate(dpll_ck, DRA7_DPLL_ABE_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure ABE DPLL!\n", __func__);
++
++      dpll_ck = clk_get_sys(NULL, "dpll_gmac_ck");
++      rc = clk_set_rate(dpll_ck, DRA7_DPLL_GMAC_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure GMAC DPLL!\n", __func__);
++
++      dpll_ck = clk_get_sys(NULL, "dpll_usb_ck");
++      rc = clk_set_rate(dpll_ck, DRA7_DPLL_USB_DEFFREQ);
++      if (rc)
++              pr_err("%s: failed to configure USB DPLL!\n", __func__);
++
++      dpll_ck = clk_get_sys(NULL, "dpll_usb_m2_ck");
++      rc = clk_set_rate(dpll_ck, DRA7_DPLL_USB_DEFFREQ/2);
++      if (rc)
++              pr_err("%s: failed to set USB_DPLL M2 OUT\n", __func__);
++
++      deshdcp_clk = clk_get_sys(NULL, "dss_deshdcp_clk");
++      rc = clk_prepare_enable(deshdcp_clk);
++      if (rc)
++              pr_err("%s: failed to enable DESHDCP clock\n", __func__);
++
++      return rc;
++}
+--- /dev/null
++++ b/drivers/clk/ti/clk.c
+@@ -0,0 +1,52 @@
++/*
++ * TI clock support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/clkdev.h>
++#include <linux/clk/ti.h>
++#include <linux/of.h>
++
++/**
++ * omap_dt_clocks_register - register DT duplicate clocks during boot
++ * @oclks: list of clocks to register
++ *
++ * Register duplicate or non-standard DT clock entries during boot. By
++ * default, DT clocks are found based on their node name. If any
++ * additional con-id / dev-id -> clock mapping is required, use this
++ * function to list these.
++ */
++void __init omap_dt_clocks_register(struct omap_dt_clk oclks[])
++{
++      struct omap_dt_clk *c;
++      struct device_node *node;
++      struct clk *clk;
++      struct of_phandle_args clkspec;
++
++      for (c = oclks; c->node_name != NULL; c++) {
++              node = of_find_node_by_name(NULL, c->node_name);
++              clkspec.np = node;
++              clk = of_clk_get_from_provider(&clkspec);
++
++              if (!IS_ERR(clk)) {
++                      c->lk.clk = clk;
++                      clkdev_add(&c->lk);
++              } else {
++                      pr_warn("%s: failed to lookup clock node %s\n",
++                              __func__, c->node_name);
++              }
++      }
++}
+--- /dev/null
++++ b/drivers/clk/ti/clockdomain.c
+@@ -0,0 +1,46 @@
++/*
++ * OMAP clockdomain support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++#include <linux/clk/ti.h>
++
++void __init of_omap_clockdomain_setup(struct device_node *node)
++{
++      struct clk *clk;
++      struct clk_hw *clk_hw;
++      const char *clkdm_name = node->name;
++      int i;
++      int num_clks;
++
++      num_clks = of_count_phandle_with_args(node, "clocks", "#clock-cells");
++
++      for (i = 0; i < num_clks; i++) {
++              clk = of_clk_get(node, i);
++              if (__clk_get_flags(clk) & CLK_IS_BASIC) {
++                      pr_warn("%s: can't setup clkdm for basic clk %s\n",
++                              __func__, __clk_get_name(clk));
++                      continue;
++              }
++              clk_hw = __clk_get_hw(clk);
++              to_clk_hw_omap(clk_hw)->clkdm_name = clkdm_name;
++              omap2_init_clk_clkdm(clk_hw);
++      }
++}
++CLK_OF_DECLARE(omap_clockdomain, "ti,clockdomain", of_omap_clockdomain_setup);
+--- /dev/null
++++ b/drivers/clk/ti/dpll.c
+@@ -0,0 +1,476 @@
++/*
++ * OMAP DPLL clock support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/slab.h>
++#include <linux/err.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++#include <linux/clk/ti.h>
++
++static const struct clk_ops dpll_m4xen_ck_ops = {
++      .enable         = &omap3_noncore_dpll_enable,
++      .disable        = &omap3_noncore_dpll_disable,
++      .recalc_rate    = &omap4_dpll_regm4xen_recalc,
++      .round_rate     = &omap4_dpll_regm4xen_round_rate,
++      .set_rate       = &omap3_noncore_dpll_set_rate,
++      .get_parent     = &omap2_init_dpll_parent,
++};
++
++static const struct clk_ops dpll_core_ck_ops = {
++      .recalc_rate    = &omap3_dpll_recalc,
++      .get_parent     = &omap2_init_dpll_parent,
++};
++
++static const struct clk_ops omap3_dpll_core_ck_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .get_parent     = &omap2_init_dpll_parent,
++      .recalc_rate    = &omap3_dpll_recalc,
++      .round_rate     = &omap2_dpll_round_rate,
++};
++
++static const struct clk_ops dpll_ck_ops = {
++      .enable         = &omap3_noncore_dpll_enable,
++      .disable        = &omap3_noncore_dpll_disable,
++      .recalc_rate    = &omap3_dpll_recalc,
++      .round_rate     = &omap2_dpll_round_rate,
++      .set_rate       = &omap3_noncore_dpll_set_rate,
++      .get_parent     = &omap2_init_dpll_parent,
++      .init           = &omap2_init_clk_clkdm,
++};
++
++static const struct clk_ops dpll_no_gate_ck_ops = {
++      .recalc_rate    = &omap3_dpll_recalc,
++      .get_parent     = &omap2_init_dpll_parent,
++      .round_rate     = &omap2_dpll_round_rate,
++      .set_rate       = &omap3_noncore_dpll_set_rate,
++};
++
++static const struct clk_ops omap3_dpll_ck_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap3_noncore_dpll_enable,
++      .disable        = &omap3_noncore_dpll_disable,
++      .get_parent     = &omap2_init_dpll_parent,
++      .recalc_rate    = &omap3_dpll_recalc,
++      .set_rate       = &omap3_noncore_dpll_set_rate,
++      .round_rate     = &omap2_dpll_round_rate,
++};
++
++static const struct clk_ops omap3_dpll_per_ck_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap3_noncore_dpll_enable,
++      .disable        = &omap3_noncore_dpll_disable,
++      .get_parent     = &omap2_init_dpll_parent,
++      .recalc_rate    = &omap3_dpll_recalc,
++      .set_rate       = &omap3_dpll4_set_rate,
++      .round_rate     = &omap2_dpll_round_rate,
++};
++
++static const struct clk_ops dpll_x2_ck_ops = {
++      .recalc_rate    = &omap3_clkoutx2_recalc,
++};
++
++static struct clk *omap_clk_register_dpll(struct device *dev, const char *name,
++              const char **parent_names, int num_parents, unsigned long flags,
++              struct dpll_data *dpll_data, const char *clkdm_name,
++              const struct clk_ops *ops)
++{
++      struct clk *clk;
++      struct clk_init_data init = { 0 };
++      struct clk_hw_omap *clk_hw;
++
++      /* allocate the divider */
++      clk_hw = kzalloc(sizeof(*clk_hw), GFP_KERNEL);
++      if (!clk_hw) {
++              pr_err("%s: could not allocate clk_hw_omap\n", __func__);
++              return ERR_PTR(-ENOMEM);
++      }
++
++      clk_hw->dpll_data = dpll_data;
++      clk_hw->ops = &clkhwops_omap3_dpll;
++      clk_hw->clkdm_name = clkdm_name;
++      clk_hw->hw.init = &init;
++
++      init.name = name;
++      init.ops = ops;
++      init.flags = flags;
++      init.parent_names = parent_names;
++      init.num_parents = num_parents;
++
++      /* register the clock */
++      clk = clk_register(dev, &clk_hw->hw);
++
++      if (IS_ERR(clk))
++              kfree(clk_hw);
++      else
++              omap2_init_clk_hw_omap_clocks(clk);
++
++      return clk;
++}
++
++static struct clk *omap_clk_register_dpll_x2(struct device *dev,
++              const char *name, const char *parent_name, void __iomem *reg,
++              const struct clk_ops *ops)
++{
++      struct clk *clk;
++      struct clk_init_data init = { 0 };
++      struct clk_hw_omap *clk_hw;
++
++      if (!parent_name) {
++              pr_err("%s: dpll_x2 must have parent\n", __func__);
++              return ERR_PTR(-EINVAL);
++      }
++
++      clk_hw = kzalloc(sizeof(*clk_hw), GFP_KERNEL);
++      if (!clk_hw) {
++              pr_err("%s: could not allocate clk_hw_omap\n", __func__);
++              return ERR_PTR(-ENOMEM);
++      }
++
++      clk_hw->ops = &clkhwops_omap4_dpllmx;
++      clk_hw->clksel_reg = reg;
++      clk_hw->hw.init = &init;
++
++      init.name = name;
++      init.ops = ops;
++      init.parent_names = &parent_name;
++      init.num_parents = 1;
++
++      /* register the clock */
++      clk = clk_register(dev, &clk_hw->hw);
++
++      if (IS_ERR(clk))
++              kfree(clk_hw);
++      else
++              omap2_init_clk_hw_omap_clocks(clk);
++
++      return clk;
++}
++
++/**
++ * of_omap_dpll_setup() - Setup function for OMAP DPLL clocks
++ *
++ * @node: device node containing the DPLL info
++ * @ops: ops for the DPLL
++ * @ddt: DPLL data template to use
++ */
++static void __init of_omap_dpll_setup(struct device_node *node,
++                                      const struct clk_ops *ops,
++                                      const struct dpll_data *ddt)
++{
++      struct clk *clk;
++      const char *clk_name = node->name;
++      int num_parents;
++      const char **parent_names = NULL;
++      const char *clkdm_name = NULL;
++      u8 dpll_flags = 0;
++      struct dpll_data *dd;
++      int i;
++      u32 val;
++
++      dd = kzalloc(sizeof(*dd), GFP_KERNEL);
++      if (!dd) {
++              pr_err("%s: could not allocate dpll_data\n", __func__);
++              return;
++      }
++
++      memcpy(dd, ddt, sizeof(*dd));
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      num_parents = of_clk_get_parent_count(node);
++      if (num_parents < 1) {
++              pr_err("%s: omap dpll %s must have parent(s)\n",
++                     __func__, node->name);
++              goto cleanup;
++      }
++
++      parent_names = kzalloc(sizeof(char *) * num_parents, GFP_KERNEL);
++
++      for (i = 0; i < num_parents; i++)
++              parent_names[i] = of_clk_get_parent_name(node, i);
++
++      dd->clk_ref = of_clk_get(node, 0);
++      dd->clk_bypass = of_clk_get(node, 1);
++
++      if (IS_ERR(dd->clk_ref)) {
++              pr_err("%s: ti,clk-ref for %s not found\n", __func__,
++                     clk_name);
++              goto cleanup;
++      }
++
++      if (IS_ERR(dd->clk_bypass)) {
++              pr_err("%s: ti,clk-bypass for %s not found\n", __func__,
++                     clk_name);
++              goto cleanup;
++      }
++
++      of_property_read_string(node, "ti,clkdm-name", &clkdm_name);
++
++      i = of_property_match_string(node, "reg-names", "control");
++      if (i >= 0)
++              dd->control_reg = of_iomap(node, i);
++
++      i = of_property_match_string(node, "reg-names", "idlest");
++      if (i >= 0)
++              dd->idlest_reg = of_iomap(node, i);
++
++      i = of_property_match_string(node, "reg-names", "autoidle");
++      if (i >= 0)
++              dd->autoidle_reg = of_iomap(node, i);
++
++      i = of_property_match_string(node, "reg-names", "mult-div1");
++      if (i >= 0)
++              dd->mult_div1_reg = of_iomap(node, i);
++
++      if (!of_property_read_u32(node, "ti,modes", &val))
++              dd->modes = val;
++
++      clk = omap_clk_register_dpll(NULL, clk_name, parent_names,
++                              num_parents, dpll_flags, dd,
++                              clkdm_name, ops);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++      return;
++
++cleanup:
++      kfree(dd);
++      kfree(parent_names);
++      return;
++}
++
++static void __init of_omap_dpll_x2_setup(struct device_node *node)
++{
++      struct clk *clk;
++      const char *clk_name = node->name;
++      void __iomem *reg;
++      const char *parent_name;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      parent_name = of_clk_get_parent_name(node, 0);
++
++      reg = of_iomap(node, 0);
++
++      clk = omap_clk_register_dpll_x2(NULL, clk_name, parent_name,
++                              reg, &dpll_x2_ck_ops);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++}
++CLK_OF_DECLARE(omap_dpll_x2_clock, "ti,omap4-dpll-x2-clock",
++             of_omap_dpll_x2_setup);
++
++static void __init of_omap3_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .freqsel_mask = 0xf0,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &omap3_dpll_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap3_dpll_clock, "ti,omap3-dpll-clock", of_omap3_dpll_setup);
++
++static void __init of_omap3_core_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 16,
++              .div1_mask = 0x7f << 8,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .freqsel_mask = 0xf0,
++      };
++
++      of_omap_dpll_setup(node, &omap3_dpll_core_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap3_core_dpll_clock, "ti,omap3-dpll-core-clock",
++             of_omap3_core_dpll_setup);
++
++static void __init of_omap3_per_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1 << 1,
++              .enable_mask = 0x7 << 16,
++              .autoidle_mask = 0x7 << 3,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .freqsel_mask = 0xf00000,
++              .modes = (1 << DPLL_LOW_POWER_STOP) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &omap3_dpll_per_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap3_per_dpll_clock, "ti,omap3-dpll-per-clock",
++             of_omap3_per_dpll_setup);
++
++static void __init of_omap3_per_jtype_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1 << 1,
++              .enable_mask = 0x7 << 16,
++              .autoidle_mask = 0x7 << 3,
++              .mult_mask = 0xfff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 4095,
++              .max_divider = 128,
++              .min_divider = 1,
++              .sddiv_mask = 0xff << 24,
++              .dco_mask = 0xe << 20,
++              .flags = DPLL_J_TYPE,
++              .modes = (1 << DPLL_LOW_POWER_STOP) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &omap3_dpll_per_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap3_per_jtype_dpll_clock, "ti,omap3-dpll-per-j-type-clock",
++             of_omap3_per_jtype_dpll_setup);
++
++static void __init of_omap4_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_dpll_clock, "ti,omap4-dpll-clock", of_omap4_dpll_setup);
++
++static void __init of_omap4_core_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_core_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_core_dpll_clock, "ti,omap4-dpll-core-clock",
++             of_omap4_core_dpll_setup);
++
++static void __init of_omap4_m4xen_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .m4xen_mask = 0x800,
++              .lpmode_mask = 1 << 10,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_m4xen_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_m4xen_dpll_clock, "ti,omap4-dpll-m4xen-clock",
++             of_omap4_m4xen_dpll_setup);
++
++static void __init of_omap4_jtype_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0xfff << 8,
++              .div1_mask = 0xff,
++              .max_multiplier = 4095,
++              .max_divider = 256,
++              .min_divider = 1,
++              .sddiv_mask = 0xff << 24,
++              .flags = DPLL_J_TYPE,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_m4xen_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_jtype_dpll_clock, "ti,omap4-dpll-j-type-clock",
++             of_omap4_jtype_dpll_setup);
++
++static void __init of_omap4_no_gate_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_no_gate_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_no_gate_dpll_clock, "ti,omap4-dpll-no-gate-clock",
++             of_omap4_no_gate_dpll_setup);
++
++static void __init of_omap4_no_gate_jtype_dpll_setup(struct device_node *node)
++{
++      const struct dpll_data dd = {
++              .idlest_mask = 0x1,
++              .enable_mask = 0x7,
++              .autoidle_mask = 0x7,
++              .mult_mask = 0x7ff << 8,
++              .div1_mask = 0x7f,
++              .max_multiplier = 2047,
++              .max_divider = 128,
++              .min_divider = 1,
++              .flags = DPLL_J_TYPE,
++              .modes = (1 << DPLL_LOW_POWER_BYPASS) | (1 << DPLL_LOCKED),
++      };
++
++      of_omap_dpll_setup(node, &dpll_no_gate_ck_ops, &dd);
++}
++CLK_OF_DECLARE(omap4_no_gate_jtype_dpll_clock,
++             "ti,omap4-dpll-no-gate-j-type-clock",
++             of_omap4_no_gate_jtype_dpll_setup);
+--- /dev/null
++++ b/drivers/clk/ti/gate.c
+@@ -0,0 +1,174 @@
++/*
++ * OMAP gate clock support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/slab.h>
++#include <linux/io.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++#include <linux/clk/ti.h>
++
++#define to_clk_divider(_hw) container_of(_hw, struct clk_divider, hw)
++
++static int omap36xx_gate_clk_enable_with_hsdiv_restore(struct clk_hw *clk);
++
++static const struct clk_ops omap_gate_clkdm_clk_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap2_clkops_enable_clkdm,
++      .disable        = &omap2_clkops_disable_clkdm,
++};
++
++static const struct clk_ops omap_gate_clk_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap2_dflt_clk_enable,
++      .disable        = &omap2_dflt_clk_disable,
++      .is_enabled     = &omap2_dflt_clk_is_enabled,
++};
++
++static const struct clk_ops omap_gate_clk_hsdiv_restore_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap36xx_gate_clk_enable_with_hsdiv_restore,
++      .disable        = &omap2_dflt_clk_disable,
++      .is_enabled     = &omap2_dflt_clk_is_enabled,
++};
++
++/**
++ * omap36xx_gate_clk_enable_with_hsdiv_restore - enable clocks suffering
++ *         from HSDivider PWRDN problem Implements Errata ID: i556.
++ * @clk: DPLL output struct clk
++ *
++ * 3630 only: dpll3_m3_ck, dpll4_m2_ck, dpll4_m3_ck, dpll4_m4_ck,
++ * dpll4_m5_ck & dpll4_m6_ck dividers gets loaded with reset
++ * valueafter their respective PWRDN bits are set.  Any dummy write
++ * (Any other value different from the Read value) to the
++ * corresponding CM_CLKSEL register will refresh the dividers.
++ */
++static int omap36xx_gate_clk_enable_with_hsdiv_restore(struct clk_hw *clk)
++{
++      struct clk_divider *parent;
++      struct clk_hw *parent_hw;
++      u32 dummy_v, orig_v;
++      int ret;
++
++      /* Clear PWRDN bit of HSDIVIDER */
++      ret = omap2_dflt_clk_enable(clk);
++
++      /* Parent is the x2 node, get parent of parent for the m2 div */
++      parent_hw = __clk_get_hw(__clk_get_parent(__clk_get_parent(clk->clk)));
++      parent = to_clk_divider(parent_hw);
++
++      /* Restore the dividers */
++      if (!ret) {
++              orig_v = __raw_readl(parent->reg);
++              dummy_v = orig_v;
++
++              /* Write any other value different from the Read value */
++              dummy_v ^= (1 << parent->shift);
++              __raw_writel(dummy_v, parent->reg);
++
++              /* Write the original divider */
++              __raw_writel(orig_v, parent->reg);
++      }
++
++      return ret;
++}
++
++static void __init _of_omap_gate_clk_setup(struct device_node *node,
++                                        void __iomem *reg,
++                                        const struct clk_ops *ops,
++                                        const struct clk_hw_omap_ops *hw_ops)
++{
++      struct clk *clk;
++      struct clk_init_data init = { 0 };
++      struct clk_hw_omap *clk_hw;
++      const char *clk_name = node->name;
++      const char *parent_name;
++      u32 val;
++
++      clk_hw = kzalloc(sizeof(*clk_hw), GFP_KERNEL);
++      if (!clk_hw) {
++              pr_err("%s: could not allocate clk_hw_omap\n", __func__);
++              return;
++      }
++
++      clk_hw->hw.init = &init;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      init.name = clk_name;
++      init.ops = ops;
++      clk_hw->enable_reg = reg;
++      if (!of_property_read_u32(node, "ti,enable-bit", &val))
++              clk_hw->enable_bit = val;
++      clk_hw->ops = hw_ops;
++
++      parent_name = of_clk_get_parent_name(node, 0);
++      init.parent_names = &parent_name;
++      init.num_parents = 1;
++
++      if (of_property_read_bool(node, "ti,set-rate-parent"))
++              init.flags |= CLK_SET_RATE_PARENT;
++
++      if (of_property_read_bool(node, "ti,set-bit-to-disable"))
++              clk_hw->flags |= INVERT_ENABLE;
++
++      clk = clk_register(NULL, &clk_hw->hw);
++
++      if (!IS_ERR(clk))
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++}
++
++static void __init of_omap_clkdm_gate_clk_setup(struct device_node *node)
++{
++      _of_omap_gate_clk_setup(node, NULL, &omap_gate_clkdm_clk_ops, NULL);
++}
++CLK_OF_DECLARE(omap_clkdm_gate_clk, "ti,clkdm-gate-clock",
++             of_omap_clkdm_gate_clk_setup);
++
++static void __init of_omap_hsdiv_gate_clk_setup(struct device_node *node)
++{
++      void __iomem *reg = of_iomap(node, 0);
++      _of_omap_gate_clk_setup(node, reg, &omap_gate_clk_hsdiv_restore_ops,
++                              &clkhwops_wait);
++}
++CLK_OF_DECLARE(omap_hsdiv_gate_clk, "ti,hsdiv-gate-clock",
++             of_omap_hsdiv_gate_clk_setup);
++
++static void __init of_omap_gate_clk_setup(struct device_node *node)
++{
++      void __iomem *reg = of_iomap(node, 0);
++      _of_omap_gate_clk_setup(node, reg, &omap_gate_clk_ops, &clkhwops_wait);
++}
++CLK_OF_DECLARE(omap_gate_clk, "ti,gate-clock", of_omap_gate_clk_setup);
++
++static void __init of_omap_am35xx_gate_clk_setup(struct device_node *node)
++{
++      void __iomem *reg = of_iomap(node, 0);
++      _of_omap_gate_clk_setup(node, reg, &omap_gate_clk_ops,
++                              &clkhwops_am35xx_ipss_module_wait);
++}
++CLK_OF_DECLARE(omap_am35xx_gate_clk, "ti,am35xx-gate-clock",
++             of_omap_am35xx_gate_clk_setup);
++
++static void __init of_omap_dss_gate_clk_setup(struct device_node *node)
++{
++      void __iomem *reg = of_iomap(node, 0);
++      _of_omap_gate_clk_setup(node, reg, &omap_gate_clk_ops,
++                              &clkhwops_omap3430es2_dss_usbhost_wait);
++}
++CLK_OF_DECLARE(omap_dss_gate_clk, "ti,dss-gate-clock",
++             of_omap_dss_gate_clk_setup);
+--- /dev/null
++++ b/drivers/clk/ti/interface.c
+@@ -0,0 +1,124 @@
++/*
++ * OMAP interface clock support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * Tero Kristo <t-kristo@ti.com>
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/clk-provider.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_address.h>
++#include <linux/clk/ti.h>
++
++static const struct clk_ops omap_interface_clk_ops = {
++      .init           = &omap2_init_clk_clkdm,
++      .enable         = &omap2_dflt_clk_enable,
++      .disable        = &omap2_dflt_clk_disable,
++      .is_enabled     = &omap2_dflt_clk_is_enabled,
++};
++
++void __init _of_omap_interface_clk_setup(struct device_node *node,
++                                       const struct clk_hw_omap_ops *ops)
++{
++      struct clk *clk;
++      struct clk_init_data init = { 0 };
++      struct clk_hw_omap *clk_hw;
++      const char *clk_name = node->name;
++      const char *parent_name;
++      u32 val;
++
++      clk_hw = kzalloc(sizeof(*clk_hw), GFP_KERNEL);
++      if (!clk_hw) {
++              pr_err("%s: could not allocate clk_hw_omap\n", __func__);
++              return;
++      }
++
++      clk_hw->hw.init = &init;
++      clk_hw->ops = ops;
++      clk_hw->enable_reg = of_iomap(node, 0);
++
++      if (!of_property_read_u32(node, "ti,enable-bit", &val))
++              clk_hw->enable_bit = val;
++
++      of_property_read_string(node, "clock-output-names", &clk_name);
++
++      init.name = clk_name;
++      init.ops = &omap_interface_clk_ops;
++      init.flags = 0;
++
++      parent_name = of_clk_get_parent_name(node, 0);
++      if (!parent_name) {
++              pr_err("%s: %s must have a parent\n", __func__, clk_name);
++              goto cleanup;
++      }
++
++      init.num_parents = 1;
++      init.parent_names = &parent_name;
++
++      clk = clk_register(NULL, &clk_hw->hw);
++
++      if (!IS_ERR(clk)) {
++              of_clk_add_provider(node, of_clk_src_simple_get, clk);
++              omap2_init_clk_hw_omap_clocks(clk);
++              return;
++      }
++
++cleanup:
++      kfree(clk_hw);
++}
++
++static void __init of_omap_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node, &clkhwops_iclk_wait);
++}
++CLK_OF_DECLARE(omap_interface_clk, "ti,omap3-interface-clock",
++             of_omap_interface_clk_setup);
++
++static void __init of_omap_no_wait_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node, &clkhwops_iclk);
++}
++CLK_OF_DECLARE(omap_no_wait_interface_clk, "ti,omap3-no-wait-interface-clock",
++             of_omap_no_wait_interface_clk_setup);
++
++static void __init
++of_omap_hsotgusb_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node,
++                                   &clkhwops_omap3430es2_iclk_hsotgusb_wait);
++}
++CLK_OF_DECLARE(omap_hsotgusb_interface_clk, "ti,omap3-hsotgusb-interface-clock",
++             of_omap_hsotgusb_interface_clk_setup);
++
++static void __init of_omap_dss_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node,
++              &clkhwops_omap3430es2_iclk_dss_usbhost_wait);
++}
++CLK_OF_DECLARE(omap_dss_interface_clk, "ti,omap3-dss-interface-clock",
++             of_omap_dss_interface_clk_setup);
++
++static void __init of_omap_ssi_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node, &clkhwops_omap3430es2_iclk_ssi_wait);
++}
++CLK_OF_DECLARE(omap_ssi_interface_clk, "ti,omap3-ssi-interface-clock",
++             of_omap_ssi_interface_clk_setup);
++
++static void __init of_omap_am35xx_interface_clk_setup(struct device_node *node)
++{
++      _of_omap_interface_clk_setup(node, &clkhwops_am35xx_ipss_wait);
++}
++CLK_OF_DECLARE(omap_am35xx_interface_clk, "ti,am35xx-interface-clock",
++             of_omap_am35xx_interface_clk_setup);
+--- /dev/null
++++ b/drivers/clk/ti/Makefile
+@@ -0,0 +1,6 @@
++ifneq ($(CONFIG_OF),)
++obj-y                                 += clk.o dpll.o autoidle.o gate.o \
++                                         clockdomain.o apll.o clk-44xx.o \
++                                         clk-54xx.o clk-7xx.o clk-33xx.o \
++                                         clk-43xx.o interface.o clk-3xxx.o
++endif
+--- a/drivers/cpufreq/cpufreq-cpu0.c
++++ b/drivers/cpufreq/cpufreq-cpu0.c
+@@ -21,6 +21,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/regulator/consumer.h>
+ #include <linux/slab.h>
++#include <linux/suspend.h>
+ static unsigned int transition_latency;
+ static unsigned int voltage_tolerance; /* in percentage */
+@@ -29,6 +30,8 @@ static struct device *cpu_dev;
+ static struct clk *cpu_clk;
+ static struct regulator *cpu_reg;
+ static struct cpufreq_frequency_table *freq_table;
++static DEFINE_MUTEX(cpu_lock);
++static bool is_suspended;
+ static int cpu0_verify_speed(struct cpufreq_policy *policy)
+ {
+@@ -50,12 +53,19 @@ static int cpu0_set_target(struct cpufre
+       unsigned int index;
+       int ret;
++      mutex_lock(&cpu_lock);
++
++      if (is_suspended) {
++              ret = -EBUSY;
++              goto out;
++      }
++
+       ret = cpufreq_frequency_table_target(policy, freq_table, target_freq,
+                                            relation, &index);
+       if (ret) {
+               pr_err("failed to match target freqency %d: %d\n",
+                      target_freq, ret);
+-              return ret;
++              goto out;
+       }
+       freq_Hz = clk_round_rate(cpu_clk, freq_table[index].frequency * 1000);
+@@ -65,8 +75,10 @@ static int cpu0_set_target(struct cpufre
+       freqs.new = freq_Hz / 1000;
+       freqs.old = clk_get_rate(cpu_clk) / 1000;
+-      if (freqs.old == freqs.new)
+-              return 0;
++      if (freqs.old == freqs.new) {
++              ret = 0;
++              goto out;
++      }
+       cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
+@@ -122,9 +134,32 @@ static int cpu0_set_target(struct cpufre
+ post_notify:
+       cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
++out:
++      mutex_unlock(&cpu_lock);
+       return ret;
+ }
++static int cpu0_pm_notify(struct notifier_block *nb, unsigned long event,
++      void *dummy)
++{
++      mutex_lock(&cpu_lock);
++      switch (event) {
++      case PM_SUSPEND_PREPARE:
++              is_suspended = true;
++              break;
++      case PM_POST_SUSPEND:
++              is_suspended = false;
++              break;
++      }
++      mutex_unlock(&cpu_lock);
++
++      return NOTIFY_OK;
++}
++
++static struct notifier_block cpu_pm_notifier = {
++      .notifier_call = cpu0_pm_notify,
++};
++
+ static int cpu0_cpufreq_init(struct cpufreq_policy *policy)
+ {
+       int ret;
+@@ -147,11 +182,17 @@ static int cpu0_cpufreq_init(struct cpuf
+       cpufreq_frequency_table_get_attr(freq_table, policy->cpu);
++      if (!IS_ERR(cpu_reg))
++              register_pm_notifier(&cpu_pm_notifier);
++
+       return 0;
+ }
+ static int cpu0_cpufreq_exit(struct cpufreq_policy *policy)
+ {
++      if (!IS_ERR(cpu_reg))
++              unregister_pm_notifier(&cpu_pm_notifier);
++
+       cpufreq_frequency_table_put_attr(policy->cpu);
+       return 0;
+--- a/drivers/crypto/Kconfig
++++ b/drivers/crypto/Kconfig
+@@ -263,6 +263,17 @@ config CRYPTO_DEV_OMAP_AES
+         OMAP processors have AES module accelerator. Select this if you
+         want to use the OMAP module for AES algorithms.
++config CRYPTO_DEV_OMAP_DES
++      tristate "Support for OMAP DES3DES hw engine"
++      depends on ARCH_OMAP2PLUS
++      select CRYPTO_DES
++      select CRYPTO_BLKCIPHER2
++      help
++        OMAP processors have DES/3DES module accelerator. Select this if you
++        want to use the OMAP module for DES and 3DES algorithms. Currently
++        the ECB and CBC modes of operation supported by the driver. Also
++        accesses made on unaligned boundaries are also supported.
++
+ config CRYPTO_DEV_PICOXCELL
+       tristate "Support for picoXcell IPSEC and Layer2 crypto engines"
+       depends on ARCH_PICOXCELL && HAVE_CLK
+--- a/drivers/crypto/Makefile
++++ b/drivers/crypto/Makefile
+@@ -11,6 +11,7 @@ obj-$(CONFIG_CRYPTO_DEV_IXP4XX) += ixp4x
+ obj-$(CONFIG_CRYPTO_DEV_PPC4XX) += amcc/
+ obj-$(CONFIG_CRYPTO_DEV_OMAP_SHAM) += omap-sham.o
+ obj-$(CONFIG_CRYPTO_DEV_OMAP_AES) += omap-aes.o
++obj-$(CONFIG_CRYPTO_DEV_OMAP_DES) += omap-des.o
+ obj-$(CONFIG_CRYPTO_DEV_PICOXCELL) += picoxcell_crypto.o
+ obj-$(CONFIG_CRYPTO_DEV_SAHARA) += sahara.o
+ obj-$(CONFIG_CRYPTO_DEV_DCP) += dcp.o
+--- a/drivers/crypto/omap-aes.c
++++ b/drivers/crypto/omap-aes.c
+@@ -275,7 +275,7 @@ static int omap_aes_write_ctrl(struct om
+       if (dd->flags & FLAGS_CBC)
+               val |= AES_REG_CTRL_CBC;
+       if (dd->flags & FLAGS_CTR) {
+-              val |= AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_32;
++              val |= AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_128;
+               mask = AES_REG_CTRL_CTR | AES_REG_CTRL_CTR_WIDTH_MASK;
+       }
+       if (dd->flags & FLAGS_ENCRYPT)
+--- /dev/null
++++ b/drivers/crypto/omap-des.c
+@@ -0,0 +1,1239 @@
++/*
++ * Cryptographic API.
++ *
++ * Support for OMAP DES and Triple DES HW acceleration.
++ *
++ * Copyright (c) 2012 Texas Instruments Incorporated
++ * Author: Joel Fernandes <joelf@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#define pr_fmt(fmt) "%s: " fmt, __func__
++
++#ifdef DEBUG
++#define prn(num) printk(#num "=%d\n", num)
++#define prx(num) printk(#num "=%x\n", num)
++#else
++#define prn(num) do { } while (0)
++#define prx(num)  do { } while (0)
++#endif
++
++#include <linux/err.h>
++#include <linux/module.h>
++#include <linux/init.h>
++#include <linux/errno.h>
++#include <linux/kernel.h>
++#include <linux/platform_device.h>
++#include <linux/scatterlist.h>
++#include <linux/dma-mapping.h>
++#include <linux/dmaengine.h>
++#include <linux/omap-dma.h>
++#include <linux/pm_runtime.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
++#include <linux/of_address.h>
++#include <linux/io.h>
++#include <linux/crypto.h>
++#include <linux/interrupt.h>
++#include <crypto/scatterwalk.h>
++#include <crypto/des.h>
++
++#define DST_MAXBURST                  2
++
++#define DES_BLOCK_WORDS               (DES_BLOCK_SIZE >> 2)
++
++#define _calc_walked(inout) (dd->inout##_walk.offset - dd->inout##_sg->offset)
++
++#define DES_REG_KEY(dd, x)            ((dd)->pdata->key_ofs - \
++                                              ((x ^ 0x01) * 0x04))
++
++#define DES_REG_IV(dd, x)             ((dd)->pdata->iv_ofs + ((x) * 0x04))
++
++#define DES_REG_CTRL(dd)              ((dd)->pdata->ctrl_ofs)
++#define DES_REG_CTRL_CBC              (1 << 4)
++#define DES_REG_CTRL_TDES             (1 << 3)
++#define DES_REG_CTRL_DIRECTION                (1 << 2)
++#define DES_REG_CTRL_INPUT_READY      (1 << 1)
++#define DES_REG_CTRL_OUTPUT_READY     (1 << 0)
++
++#define DES_REG_DATA_N(dd, x)         ((dd)->pdata->data_ofs + ((x) * 0x04))
++
++#define DES_REG_REV(dd)                       ((dd)->pdata->rev_ofs)
++
++#define DES_REG_MASK(dd)              ((dd)->pdata->mask_ofs)
++
++#define DES_REG_LENGTH_N(x)           (0x24 + ((x) * 0x04))
++
++#define DES_REG_IRQ_STATUS(dd)         ((dd)->pdata->irq_status_ofs)
++#define DES_REG_IRQ_ENABLE(dd)         ((dd)->pdata->irq_enable_ofs)
++#define DES_REG_IRQ_DATA_IN            BIT(1)
++#define DES_REG_IRQ_DATA_OUT           BIT(2)
++
++#define FLAGS_MODE_MASK               0x000f
++#define FLAGS_ENCRYPT         BIT(0)
++#define FLAGS_CBC             BIT(1)
++#define FLAGS_INIT            BIT(4)
++#define FLAGS_BUSY            BIT(6)
++
++struct omap_des_ctx {
++      struct omap_des_dev *dd;
++
++      int             keylen;
++      u32             key[(3 * DES_KEY_SIZE) / sizeof(u32)];
++      unsigned long   flags;
++};
++
++struct omap_des_reqctx {
++      unsigned long mode;
++};
++
++#define OMAP_DES_QUEUE_LENGTH 1
++#define OMAP_DES_CACHE_SIZE   0
++
++struct omap_des_algs_info {
++      struct crypto_alg       *algs_list;
++      unsigned int            size;
++      unsigned int            registered;
++};
++
++struct omap_des_pdata {
++      struct omap_des_algs_info       *algs_info;
++      unsigned int    algs_info_size;
++
++      void            (*trigger)(struct omap_des_dev *dd, int length);
++
++      u32             key_ofs;
++      u32             iv_ofs;
++      u32             ctrl_ofs;
++      u32             data_ofs;
++      u32             rev_ofs;
++      u32             mask_ofs;
++      u32             irq_enable_ofs;
++      u32             irq_status_ofs;
++
++      u32             dma_enable_in;
++      u32             dma_enable_out;
++      u32             dma_start;
++
++      u32             major_mask;
++      u32             major_shift;
++      u32             minor_mask;
++      u32             minor_shift;
++};
++
++struct omap_des_dev {
++      struct list_head        list;
++      unsigned long           phys_base;
++      void __iomem            *io_base;
++      struct omap_des_ctx     *ctx;
++      struct device           *dev;
++      unsigned long           flags;
++      int                     err;
++
++      /* spinlock used for queues */
++      spinlock_t              lock;
++      struct crypto_queue     queue;
++
++      struct tasklet_struct   done_task;
++      struct tasklet_struct   queue_task;
++
++      struct ablkcipher_request       *req;
++      /*
++       * total is used by PIO mode for book keeping so introduce
++       * variable total_save as need it to calc page_order
++       */
++      size_t                          total;
++      size_t                          total_save;
++
++      struct scatterlist              *in_sg;
++      struct scatterlist              *out_sg;
++
++      /* Buffers for copying for unaligned cases */
++      struct scatterlist              in_sgl;
++      struct scatterlist              out_sgl;
++      struct scatterlist              *orig_out;
++      int                             sgs_copied;
++
++      struct scatter_walk             in_walk;
++      struct scatter_walk             out_walk;
++      int                     dma_in;
++      struct dma_chan         *dma_lch_in;
++      int                     dma_out;
++      struct dma_chan         *dma_lch_out;
++      int                     in_sg_len;
++      int                     out_sg_len;
++      int                     pio_only;
++      const struct omap_des_pdata     *pdata;
++};
++
++/* keep registered devices data here */
++static LIST_HEAD(dev_list);
++static DEFINE_SPINLOCK(list_lock);
++
++#ifdef DEBUG
++#define omap_des_read(dd, offset)                               \
++      ({                                                              \
++       int _read_ret;                                          \
++       _read_ret = __raw_readl(dd->io_base + offset);          \
++       pr_err("omap_des_read(" #offset "=%#x)= %#x\n",       \
++               offset, _read_ret);                            \
++       _read_ret;                                              \
++       })
++#else
++static inline u32 omap_des_read(struct omap_des_dev *dd, u32 offset)
++{
++      return __raw_readl(dd->io_base + offset);
++}
++#endif
++
++#ifdef DEBUG
++#define omap_des_write(dd, offset, value)                               \
++      do {                                                            \
++              pr_err("omap_des_write(" #offset "=%#x) value=%#x\n", \
++                              offset, value);                                \
++              __raw_writel(value, dd->io_base + offset);              \
++      } while (0)
++#else
++static inline void omap_des_write(struct omap_des_dev *dd, u32 offset,
++              u32 value)
++{
++      __raw_writel(value, dd->io_base + offset);
++}
++#endif
++
++static inline void omap_des_write_mask(struct omap_des_dev *dd, u32 offset,
++                                      u32 value, u32 mask)
++{
++      u32 val;
++
++      val = omap_des_read(dd, offset);
++      val &= ~mask;
++      val |= value;
++      omap_des_write(dd, offset, val);
++}
++
++static void omap_des_write_n(struct omap_des_dev *dd, u32 offset,
++                                      u32 *value, int count)
++{
++      for (; count--; value++, offset += 4)
++              omap_des_write(dd, offset, *value);
++}
++
++static int omap_des_hw_init(struct omap_des_dev *dd)
++{
++      /*
++       * clocks are enabled when request starts and disabled when finished.
++       * It may be long delays between requests.
++       * Device might go to off mode to save power.
++       */
++      pm_runtime_get_sync(dd->dev);
++
++      if (!(dd->flags & FLAGS_INIT)) {
++              dd->flags |= FLAGS_INIT;
++              dd->err = 0;
++      }
++
++      return 0;
++}
++
++static int omap_des_write_ctrl(struct omap_des_dev *dd)
++{
++      unsigned int key32;
++      int i, err;
++      u32 val = 0, mask = 0;
++
++      err = omap_des_hw_init(dd);
++      if (err)
++              return err;
++
++      key32 = dd->ctx->keylen / sizeof(u32);
++
++      /* it seems a key should always be set even if it has not changed */
++      for (i = 0; i < key32; i++) {
++              omap_des_write(dd, DES_REG_KEY(dd, i),
++                             __le32_to_cpu(dd->ctx->key[i]));
++      }
++
++      if ((dd->flags & FLAGS_CBC) && dd->req->info)
++              omap_des_write_n(dd, DES_REG_IV(dd, 0), dd->req->info, 2);
++
++      if (dd->flags & FLAGS_CBC)
++              val |= DES_REG_CTRL_CBC;
++      if (dd->flags & FLAGS_ENCRYPT)
++              val |= DES_REG_CTRL_DIRECTION;
++      if (key32 == 6)
++              val |= DES_REG_CTRL_TDES;
++
++      mask |= DES_REG_CTRL_CBC | DES_REG_CTRL_DIRECTION | DES_REG_CTRL_TDES;
++
++      omap_des_write_mask(dd, DES_REG_CTRL(dd), val, mask);
++
++      return 0;
++}
++
++static void omap_des_dma_trigger_omap4(struct omap_des_dev *dd, int length)
++{
++      u32 mask, val;
++
++      omap_des_write(dd, DES_REG_LENGTH_N(0), length);
++
++      val = dd->pdata->dma_start;
++
++      if (dd->dma_lch_out != NULL)
++              val |= dd->pdata->dma_enable_out;
++      if (dd->dma_lch_in != NULL)
++              val |= dd->pdata->dma_enable_in;
++
++      mask = dd->pdata->dma_enable_out | dd->pdata->dma_enable_in |
++             dd->pdata->dma_start;
++
++      omap_des_write_mask(dd, DES_REG_MASK(dd), val, mask);
++}
++
++static void omap_des_dma_stop(struct omap_des_dev *dd)
++{
++      u32 mask;
++
++      mask = dd->pdata->dma_enable_out | dd->pdata->dma_enable_in |
++             dd->pdata->dma_start;
++
++      omap_des_write_mask(dd, DES_REG_MASK(dd), 0, mask);
++}
++
++static struct omap_des_dev *omap_des_find_dev(struct omap_des_ctx *ctx)
++{
++      struct omap_des_dev *dd = NULL, *tmp;
++
++      spin_lock_bh(&list_lock);
++      if (!ctx->dd) {
++              list_for_each_entry(tmp, &dev_list, list) {
++                      /* FIXME: take fist available des core */
++                      dd = tmp;
++                      break;
++              }
++              ctx->dd = dd;
++      } else {
++              /* already found before */
++              dd = ctx->dd;
++      }
++      spin_unlock_bh(&list_lock);
++
++      return dd;
++}
++
++static void omap_des_dma_out_callback(void *data)
++{
++      struct omap_des_dev *dd = data;
++
++      /* dma_lch_out - completed */
++      tasklet_schedule(&dd->done_task);
++}
++
++static int omap_des_dma_init(struct omap_des_dev *dd)
++{
++      int err = -ENOMEM;
++      dma_cap_mask_t mask;
++
++      dd->dma_lch_out = NULL;
++      dd->dma_lch_in = NULL;
++
++      dma_cap_zero(mask);
++      dma_cap_set(DMA_SLAVE, mask);
++
++      dd->dma_lch_in = dma_request_slave_channel_compat(mask,
++                                                        omap_dma_filter_fn,
++                                                        &dd->dma_in,
++                                                        dd->dev, "rx");
++      if (!dd->dma_lch_in) {
++              dev_err(dd->dev, "Unable to request in DMA channel\n");
++              goto err_dma_in;
++      }
++
++      dd->dma_lch_out = dma_request_slave_channel_compat(mask,
++                                                         omap_dma_filter_fn,
++                                                         &dd->dma_out,
++                                                         dd->dev, "tx");
++      if (!dd->dma_lch_out) {
++              dev_err(dd->dev, "Unable to request out DMA channel\n");
++              goto err_dma_out;
++      }
++
++      return 0;
++
++err_dma_out:
++      dma_release_channel(dd->dma_lch_in);
++err_dma_in:
++      if (err)
++              pr_err("error: %d\n", err);
++      return err;
++}
++
++static void omap_des_dma_cleanup(struct omap_des_dev *dd)
++{
++      dma_release_channel(dd->dma_lch_out);
++      dma_release_channel(dd->dma_lch_in);
++}
++
++static void sg_copy_buf(void *buf, struct scatterlist *sg,
++                            unsigned int start, unsigned int nbytes, int out)
++{
++      struct scatter_walk walk;
++
++      if (!nbytes)
++              return;
++
++      scatterwalk_start(&walk, sg);
++      scatterwalk_advance(&walk, start);
++      scatterwalk_copychunks(buf, &walk, nbytes, out);
++      scatterwalk_done(&walk, out, 0);
++}
++
++static int omap_des_crypt_dma(struct crypto_tfm *tfm,
++              struct scatterlist *in_sg, struct scatterlist *out_sg,
++              int in_sg_len, int out_sg_len)
++{
++      struct omap_des_ctx *ctx = crypto_tfm_ctx(tfm);
++      struct omap_des_dev *dd = ctx->dd;
++      struct dma_async_tx_descriptor *tx_in, *tx_out;
++      struct dma_slave_config cfg;
++      int ret;
++
++      if (dd->pio_only) {
++              scatterwalk_start(&dd->in_walk, dd->in_sg);
++              scatterwalk_start(&dd->out_walk, dd->out_sg);
++
++              /* Enable DATAIN interrupt and let it take
++                 care of the rest */
++              omap_des_write(dd, DES_REG_IRQ_ENABLE(dd), 0x2);
++              return 0;
++      }
++
++      dma_sync_sg_for_device(dd->dev, dd->in_sg, in_sg_len, DMA_TO_DEVICE);
++
++      memset(&cfg, 0, sizeof(cfg));
++
++      cfg.src_addr = dd->phys_base + DES_REG_DATA_N(dd, 0);
++      cfg.dst_addr = dd->phys_base + DES_REG_DATA_N(dd, 0);
++      cfg.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
++      cfg.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES;
++      cfg.src_maxburst = DST_MAXBURST;
++      cfg.dst_maxburst = DST_MAXBURST;
++
++      /* IN */
++      ret = dmaengine_slave_config(dd->dma_lch_in, &cfg);
++      if (ret) {
++              dev_err(dd->dev, "can't configure IN dmaengine slave: %d\n",
++                      ret);
++              return ret;
++      }
++
++      tx_in = dmaengine_prep_slave_sg(dd->dma_lch_in, in_sg, in_sg_len,
++                                      DMA_MEM_TO_DEV,
++                                      DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
++      if (!tx_in) {
++              dev_err(dd->dev, "IN prep_slave_sg() failed\n");
++              return -EINVAL;
++      }
++
++      /* No callback necessary */
++      tx_in->callback_param = dd;
++
++      /* OUT */
++      ret = dmaengine_slave_config(dd->dma_lch_out, &cfg);
++      if (ret) {
++              dev_err(dd->dev, "can't configure OUT dmaengine slave: %d\n",
++                      ret);
++              return ret;
++      }
++
++      tx_out = dmaengine_prep_slave_sg(dd->dma_lch_out, out_sg, out_sg_len,
++                                      DMA_DEV_TO_MEM,
++                                      DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
++      if (!tx_out) {
++              dev_err(dd->dev, "OUT prep_slave_sg() failed\n");
++              return -EINVAL;
++      }
++
++      tx_out->callback = omap_des_dma_out_callback;
++      tx_out->callback_param = dd;
++
++      dmaengine_submit(tx_in);
++      dmaengine_submit(tx_out);
++
++      dma_async_issue_pending(dd->dma_lch_in);
++      dma_async_issue_pending(dd->dma_lch_out);
++
++      /* start DMA */
++      dd->pdata->trigger(dd, dd->total);
++
++      return 0;
++}
++
++static int omap_des_crypt_dma_start(struct omap_des_dev *dd)
++{
++      struct crypto_tfm *tfm = crypto_ablkcipher_tfm(
++                                      crypto_ablkcipher_reqtfm(dd->req));
++      int err;
++
++      pr_debug("total: %d\n", dd->total);
++
++      if (!dd->pio_only) {
++              err = dma_map_sg(dd->dev, dd->in_sg, dd->in_sg_len,
++                               DMA_TO_DEVICE);
++              if (!err) {
++                      dev_err(dd->dev, "dma_map_sg() error\n");
++                      return -EINVAL;
++              }
++
++              err = dma_map_sg(dd->dev, dd->out_sg, dd->out_sg_len,
++                               DMA_FROM_DEVICE);
++              if (!err) {
++                      dev_err(dd->dev, "dma_map_sg() error\n");
++                      return -EINVAL;
++              }
++      }
++
++      err = omap_des_crypt_dma(tfm, dd->in_sg, dd->out_sg, dd->in_sg_len,
++                               dd->out_sg_len);
++      if (err && !dd->pio_only) {
++              dma_unmap_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
++              dma_unmap_sg(dd->dev, dd->out_sg, dd->out_sg_len,
++                           DMA_FROM_DEVICE);
++      }
++
++      return err;
++}
++
++static void omap_des_finish_req(struct omap_des_dev *dd, int err)
++{
++      struct ablkcipher_request *req = dd->req;
++
++      pr_debug("err: %d\n", err);
++
++      pm_runtime_put(dd->dev);
++      dd->flags &= ~FLAGS_BUSY;
++
++      req->base.complete(&req->base, err);
++}
++
++static int omap_des_crypt_dma_stop(struct omap_des_dev *dd)
++{
++      int err = 0;
++
++      pr_debug("total: %d\n", dd->total);
++
++      omap_des_dma_stop(dd);
++
++      dmaengine_terminate_all(dd->dma_lch_in);
++      dmaengine_terminate_all(dd->dma_lch_out);
++
++      dma_unmap_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
++      dma_unmap_sg(dd->dev, dd->out_sg, dd->out_sg_len, DMA_FROM_DEVICE);
++
++      return err;
++}
++
++int omap_des_copy_needed(struct scatterlist *sg)
++{
++      while (sg) {
++              if (!IS_ALIGNED(sg->offset, 4))
++                      return -1;
++              if (!IS_ALIGNED(sg->length, DES_BLOCK_SIZE))
++                      return -1;
++              sg = sg_next(sg);
++      }
++      return 0;
++}
++
++int omap_des_copy_sgs(struct omap_des_dev *dd)
++{
++      void *buf_in, *buf_out;
++      int pages;
++
++      pages = dd->total >> PAGE_SHIFT;
++
++      if (dd->total & (PAGE_SIZE-1))
++              pages++;
++
++      BUG_ON(!pages);
++
++      buf_in = (void *)__get_free_pages(GFP_ATOMIC, pages);
++      buf_out = (void *)__get_free_pages(GFP_ATOMIC, pages);
++
++      if (!buf_in || !buf_out) {
++              pr_err("Couldn't allocated pages for unaligned cases.\n");
++              return -1;
++      }
++
++      dd->orig_out = dd->out_sg;
++
++      sg_copy_buf(buf_in, dd->in_sg, 0, dd->total, 0);
++
++      sg_init_table(&dd->in_sgl, 1);
++      sg_set_buf(&dd->in_sgl, buf_in, dd->total);
++      dd->in_sg = &dd->in_sgl;
++
++      sg_init_table(&dd->out_sgl, 1);
++      sg_set_buf(&dd->out_sgl, buf_out, dd->total);
++      dd->out_sg = &dd->out_sgl;
++
++      return 0;
++}
++
++static int omap_des_handle_queue(struct omap_des_dev *dd,
++                             struct ablkcipher_request *req)
++{
++      struct crypto_async_request *async_req, *backlog;
++      struct omap_des_ctx *ctx;
++      struct omap_des_reqctx *rctx;
++      unsigned long flags;
++      int err, ret = 0;
++
++      spin_lock_irqsave(&dd->lock, flags);
++      if (req)
++              ret = ablkcipher_enqueue_request(&dd->queue, req);
++      if (dd->flags & FLAGS_BUSY) {
++              spin_unlock_irqrestore(&dd->lock, flags);
++              return ret;
++      }
++      backlog = crypto_get_backlog(&dd->queue);
++      async_req = crypto_dequeue_request(&dd->queue);
++      if (async_req)
++              dd->flags |= FLAGS_BUSY;
++      spin_unlock_irqrestore(&dd->lock, flags);
++
++      if (!async_req)
++              return ret;
++
++      if (backlog)
++              backlog->complete(backlog, -EINPROGRESS);
++
++      req = ablkcipher_request_cast(async_req);
++
++      /* assign new request to device */
++      dd->req = req;
++      dd->total = req->nbytes;
++      dd->total_save = req->nbytes;
++      dd->in_sg = req->src;
++      dd->out_sg = req->dst;
++
++      if (omap_des_copy_needed(dd->in_sg) ||
++          omap_des_copy_needed(dd->out_sg)) {
++              if (omap_des_copy_sgs(dd))
++                      pr_err("Failed to copy SGs for unaligned cases\n");
++              dd->sgs_copied = 1;
++      } else {
++              dd->sgs_copied = 0;
++      }
++
++      dd->in_sg_len = scatterwalk_bytes_sglen(dd->in_sg, dd->total);
++      dd->out_sg_len = scatterwalk_bytes_sglen(dd->out_sg, dd->total);
++      BUG_ON(dd->in_sg_len < 0 || dd->out_sg_len < 0);
++
++      rctx = ablkcipher_request_ctx(req);
++      ctx = crypto_ablkcipher_ctx(crypto_ablkcipher_reqtfm(req));
++      rctx->mode &= FLAGS_MODE_MASK;
++      dd->flags = (dd->flags & ~FLAGS_MODE_MASK) | rctx->mode;
++
++      dd->ctx = ctx;
++      ctx->dd = dd;
++
++      err = omap_des_write_ctrl(dd);
++      if (!err)
++              err = omap_des_crypt_dma_start(dd);
++      if (err) {
++              /* des_task will not finish it, so do it here */
++              omap_des_finish_req(dd, err);
++              tasklet_schedule(&dd->queue_task);
++      }
++
++      return ret; /* return ret, which is enqueue return value */
++}
++
++static void omap_des_done_task(unsigned long data)
++{
++      struct omap_des_dev *dd = (struct omap_des_dev *)data;
++      void *buf_in, *buf_out;
++      int pages;
++
++      pr_debug("enter done_task\n");
++
++      if (!dd->pio_only) {
++              dma_sync_sg_for_device(dd->dev, dd->out_sg, dd->out_sg_len,
++                                     DMA_FROM_DEVICE);
++              dma_unmap_sg(dd->dev, dd->in_sg, dd->in_sg_len, DMA_TO_DEVICE);
++              dma_unmap_sg(dd->dev, dd->out_sg, dd->out_sg_len,
++                           DMA_FROM_DEVICE);
++              omap_des_crypt_dma_stop(dd);
++      }
++
++      if (dd->sgs_copied) {
++              buf_in = sg_virt(&dd->in_sgl);
++              buf_out = sg_virt(&dd->out_sgl);
++
++              sg_copy_buf(buf_out, dd->orig_out, 0, dd->total_save, 1);
++
++              pages = get_order(dd->total_save);
++              free_pages((unsigned long)buf_in, pages);
++              free_pages((unsigned long)buf_out, pages);
++      }
++
++      omap_des_finish_req(dd, 0);
++      omap_des_handle_queue(dd, NULL);
++
++      pr_debug("exit\n");
++}
++
++static void omap_des_queue_task(unsigned long data)
++{
++      struct omap_des_dev *dd = (struct omap_des_dev *)data;
++
++      omap_des_handle_queue(dd, NULL);
++}
++
++static int omap_des_crypt(struct ablkcipher_request *req, unsigned long mode)
++{
++      struct omap_des_ctx *ctx = crypto_ablkcipher_ctx(
++                      crypto_ablkcipher_reqtfm(req));
++      struct omap_des_reqctx *rctx = ablkcipher_request_ctx(req);
++      struct omap_des_dev *dd;
++
++      pr_debug("nbytes: %d, enc: %d, cbc: %d\n", req->nbytes,
++               !!(mode & FLAGS_ENCRYPT),
++               !!(mode & FLAGS_CBC));
++
++      if (!IS_ALIGNED(req->nbytes, DES_BLOCK_SIZE)) {
++              pr_err("request size is not exact amount of DES blocks\n");
++              return -EINVAL;
++      }
++
++      dd = omap_des_find_dev(ctx);
++      if (!dd)
++              return -ENODEV;
++
++      rctx->mode = mode;
++
++      return omap_des_handle_queue(dd, req);
++}
++
++/* ********************** ALG API ************************************ */
++
++static int omap_des_setkey(struct crypto_ablkcipher *tfm, const u8 *key,
++                         unsigned int keylen)
++{
++      struct omap_des_ctx *ctx = crypto_ablkcipher_ctx(tfm);
++
++      if (keylen != DES_KEY_SIZE && keylen != (3*DES_KEY_SIZE))
++              return -EINVAL;
++
++      pr_debug("enter, keylen: %d\n", keylen);
++
++      memcpy(ctx->key, key, keylen);
++      ctx->keylen = keylen;
++
++      return 0;
++}
++
++static int omap_des_ecb_encrypt(struct ablkcipher_request *req)
++{
++      return omap_des_crypt(req, FLAGS_ENCRYPT);
++}
++
++static int omap_des_ecb_decrypt(struct ablkcipher_request *req)
++{
++      return omap_des_crypt(req, 0);
++}
++
++static int omap_des_cbc_encrypt(struct ablkcipher_request *req)
++{
++      return omap_des_crypt(req, FLAGS_ENCRYPT | FLAGS_CBC);
++}
++
++static int omap_des_cbc_decrypt(struct ablkcipher_request *req)
++{
++      return omap_des_crypt(req, FLAGS_CBC);
++}
++
++static int omap_des_cra_init(struct crypto_tfm *tfm)
++{
++      pr_debug("enter\n");
++
++      tfm->crt_ablkcipher.reqsize = sizeof(struct omap_des_reqctx);
++
++      return 0;
++}
++
++static void omap_des_cra_exit(struct crypto_tfm *tfm)
++{
++      pr_debug("enter\n");
++}
++
++/* ********************** ALGS ************************************ */
++
++static struct crypto_alg algs_ecb_cbc[] = {
++{
++      .cra_name               = "ecb(des)",
++      .cra_driver_name        = "ecb-des-omap",
++      .cra_priority           = 100,
++      .cra_flags              = CRYPTO_ALG_TYPE_ABLKCIPHER |
++                                CRYPTO_ALG_KERN_DRIVER_ONLY |
++                                CRYPTO_ALG_ASYNC,
++      .cra_blocksize          = DES_BLOCK_SIZE,
++      .cra_ctxsize            = sizeof(struct omap_des_ctx),
++      .cra_alignmask          = 0,
++      .cra_type               = &crypto_ablkcipher_type,
++      .cra_module             = THIS_MODULE,
++      .cra_init               = omap_des_cra_init,
++      .cra_exit               = omap_des_cra_exit,
++      .cra_u.ablkcipher = {
++              .min_keysize    = DES_KEY_SIZE,
++              .max_keysize    = DES_KEY_SIZE,
++              .setkey         = omap_des_setkey,
++              .encrypt        = omap_des_ecb_encrypt,
++              .decrypt        = omap_des_ecb_decrypt,
++      }
++},
++{
++      .cra_name               = "cbc(des)",
++      .cra_driver_name        = "cbc-des-omap",
++      .cra_priority           = 100,
++      .cra_flags              = CRYPTO_ALG_TYPE_ABLKCIPHER |
++                                CRYPTO_ALG_KERN_DRIVER_ONLY |
++                                CRYPTO_ALG_ASYNC,
++      .cra_blocksize          = DES_BLOCK_SIZE,
++      .cra_ctxsize            = sizeof(struct omap_des_ctx),
++      .cra_alignmask          = 0,
++      .cra_type               = &crypto_ablkcipher_type,
++      .cra_module             = THIS_MODULE,
++      .cra_init               = omap_des_cra_init,
++      .cra_exit               = omap_des_cra_exit,
++      .cra_u.ablkcipher = {
++              .min_keysize    = DES_KEY_SIZE,
++              .max_keysize    = DES_KEY_SIZE,
++              .ivsize         = DES_BLOCK_SIZE,
++              .setkey         = omap_des_setkey,
++              .encrypt        = omap_des_cbc_encrypt,
++              .decrypt        = omap_des_cbc_decrypt,
++      }
++},
++{
++      .cra_name               = "ecb(des3_ede)",
++      .cra_driver_name        = "ecb-des3-omap",
++      .cra_priority           = 100,
++      .cra_flags              = CRYPTO_ALG_TYPE_ABLKCIPHER |
++                                CRYPTO_ALG_KERN_DRIVER_ONLY |
++                                CRYPTO_ALG_ASYNC,
++      .cra_blocksize          = DES_BLOCK_SIZE,
++      .cra_ctxsize            = sizeof(struct omap_des_ctx),
++      .cra_alignmask          = 0,
++      .cra_type               = &crypto_ablkcipher_type,
++      .cra_module             = THIS_MODULE,
++      .cra_init               = omap_des_cra_init,
++      .cra_exit               = omap_des_cra_exit,
++      .cra_u.ablkcipher = {
++              .min_keysize    = 3*DES_KEY_SIZE,
++              .max_keysize    = 3*DES_KEY_SIZE,
++              .setkey         = omap_des_setkey,
++              .encrypt        = omap_des_ecb_encrypt,
++              .decrypt        = omap_des_ecb_decrypt,
++      }
++},
++{
++      .cra_name               = "cbc(des3_ede)",
++      .cra_driver_name        = "cbc-des3-omap",
++      .cra_priority           = 100,
++      .cra_flags              = CRYPTO_ALG_TYPE_ABLKCIPHER |
++                                CRYPTO_ALG_KERN_DRIVER_ONLY |
++                                CRYPTO_ALG_ASYNC,
++      .cra_blocksize          = DES_BLOCK_SIZE,
++      .cra_ctxsize            = sizeof(struct omap_des_ctx),
++      .cra_alignmask          = 0,
++      .cra_type               = &crypto_ablkcipher_type,
++      .cra_module             = THIS_MODULE,
++      .cra_init               = omap_des_cra_init,
++      .cra_exit               = omap_des_cra_exit,
++      .cra_u.ablkcipher = {
++              .min_keysize    = 3*DES_KEY_SIZE,
++              .max_keysize    = 3*DES_KEY_SIZE,
++              .ivsize         = DES_BLOCK_SIZE,
++              .setkey         = omap_des_setkey,
++              .encrypt        = omap_des_cbc_encrypt,
++              .decrypt        = omap_des_cbc_decrypt,
++      }
++}
++};
++
++static struct omap_des_algs_info omap_des_algs_info_ecb_cbc[] = {
++      {
++              .algs_list      = algs_ecb_cbc,
++              .size           = ARRAY_SIZE(algs_ecb_cbc),
++      },
++};
++
++#ifdef CONFIG_OF
++static const struct omap_des_pdata omap_des_pdata_omap4 = {
++      .algs_info      = omap_des_algs_info_ecb_cbc,
++      .algs_info_size = ARRAY_SIZE(omap_des_algs_info_ecb_cbc),
++      .trigger        = omap_des_dma_trigger_omap4,
++      .key_ofs        = 0x14,
++      .iv_ofs         = 0x18,
++      .ctrl_ofs       = 0x20,
++      .data_ofs       = 0x28,
++      .rev_ofs        = 0x30,
++      .mask_ofs       = 0x34,
++      .irq_status_ofs = 0x3c,
++      .irq_enable_ofs = 0x40,
++      .dma_enable_in  = BIT(5),
++      .dma_enable_out = BIT(6),
++      .major_mask     = 0x0700,
++      .major_shift    = 8,
++      .minor_mask     = 0x003f,
++      .minor_shift    = 0,
++};
++
++static irqreturn_t omap_des_irq(int irq, void *dev_id)
++{
++      struct omap_des_dev *dd = dev_id;
++      u32 status, i;
++      u32 *src, *dst;
++
++      status = omap_des_read(dd, DES_REG_IRQ_STATUS(dd));
++      if (status & DES_REG_IRQ_DATA_IN) {
++              omap_des_write(dd, DES_REG_IRQ_ENABLE(dd), 0x0);
++
++              BUG_ON(!dd->in_sg);
++
++              BUG_ON(_calc_walked(in) > dd->in_sg->length);
++
++              src = sg_virt(dd->in_sg) + _calc_walked(in);
++
++              for (i = 0; i < DES_BLOCK_WORDS; i++) {
++                      omap_des_write(dd, DES_REG_DATA_N(dd, i), *src);
++
++                      scatterwalk_advance(&dd->in_walk, 4);
++                      if (dd->in_sg->length == _calc_walked(in)) {
++                              dd->in_sg = scatterwalk_sg_next(dd->in_sg);
++                              if (dd->in_sg) {
++                                      scatterwalk_start(&dd->in_walk,
++                                                        dd->in_sg);
++                                      src = sg_virt(dd->in_sg) +
++                                            _calc_walked(in);
++                              }
++                      } else {
++                              src++;
++                      }
++              }
++
++              /* Clear IRQ status */
++              status &= ~DES_REG_IRQ_DATA_IN;
++              omap_des_write(dd, DES_REG_IRQ_STATUS(dd), status);
++
++              /* Enable DATA_OUT interrupt */
++              omap_des_write(dd, DES_REG_IRQ_ENABLE(dd), 0x4);
++
++      } else if (status & DES_REG_IRQ_DATA_OUT) {
++              omap_des_write(dd, DES_REG_IRQ_ENABLE(dd), 0x0);
++
++              BUG_ON(!dd->out_sg);
++
++              BUG_ON(_calc_walked(out) > dd->out_sg->length);
++
++              dst = sg_virt(dd->out_sg) + _calc_walked(out);
++
++              for (i = 0; i < DES_BLOCK_WORDS; i++) {
++                      *dst = omap_des_read(dd, DES_REG_DATA_N(dd, i));
++                      scatterwalk_advance(&dd->out_walk, 4);
++                      if (dd->out_sg->length == _calc_walked(out)) {
++                              dd->out_sg = scatterwalk_sg_next(dd->out_sg);
++                              if (dd->out_sg) {
++                                      scatterwalk_start(&dd->out_walk,
++                                                        dd->out_sg);
++                                      dst = sg_virt(dd->out_sg) +
++                                            _calc_walked(out);
++                              }
++                      } else {
++                              dst++;
++                      }
++              }
++
++              dd->total -= DES_BLOCK_SIZE;
++
++              BUG_ON(dd->total < 0);
++
++              /* Clear IRQ status */
++              status &= ~DES_REG_IRQ_DATA_OUT;
++              omap_des_write(dd, DES_REG_IRQ_STATUS(dd), status);
++
++              if (!dd->total)
++                      /* All bytes read! */
++                      tasklet_schedule(&dd->done_task);
++              else
++                      /* Enable DATA_IN interrupt for next block */
++                      omap_des_write(dd, DES_REG_IRQ_ENABLE(dd), 0x2);
++      }
++
++      return IRQ_HANDLED;
++}
++
++static const struct of_device_id omap_des_of_match[] = {
++      {
++              .compatible     = "ti,omap4-des",
++              .data           = &omap_des_pdata_omap4,
++      },
++      {},
++};
++MODULE_DEVICE_TABLE(of, omap_des_of_match);
++
++static int omap_des_get_res_of(struct omap_des_dev *dd,
++              struct device *dev, struct resource *res)
++{
++      struct device_node *node = dev->of_node;
++      const struct of_device_id *match;
++      int err = 0;
++
++      match = of_match_device(of_match_ptr(omap_des_of_match), dev);
++      if (!match) {
++              dev_err(dev, "no compatible OF match\n");
++              err = -EINVAL;
++              goto err;
++      }
++
++      err = of_address_to_resource(node, 0, res);
++      if (err < 0) {
++              dev_err(dev, "can't translate OF node address\n");
++              err = -EINVAL;
++              goto err;
++      }
++
++      dd->dma_out = -1; /* Dummy value that's unused */
++      dd->dma_in = -1; /* Dummy value that's unused */
++
++      dd->pdata = match->data;
++
++err:
++      return err;
++}
++#else
++static const struct of_device_id omap_des_of_match[] = {
++      {},
++};
++
++static int omap_des_get_res_of(struct omap_des_dev *dd,
++              struct device *dev, struct resource *res)
++{
++      return -EINVAL;
++}
++#endif
++
++static int omap_des_get_res_pdev(struct omap_des_dev *dd,
++              struct platform_device *pdev, struct resource *res)
++{
++      struct device *dev = &pdev->dev;
++      struct resource *r;
++      int err = 0;
++
++      /* Get the base address */
++      r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      if (!r) {
++              dev_err(dev, "no MEM resource info\n");
++              err = -ENODEV;
++              goto err;
++      }
++      memcpy(res, r, sizeof(*res));
++
++      /* Get the DMA out channel */
++      r = platform_get_resource(pdev, IORESOURCE_DMA, 0);
++      if (!r) {
++              dev_err(dev, "no DMA out resource info\n");
++              err = -ENODEV;
++              goto err;
++      }
++      dd->dma_out = r->start;
++
++      /* Get the DMA in channel */
++      r = platform_get_resource(pdev, IORESOURCE_DMA, 1);
++      if (!r) {
++              dev_err(dev, "no DMA in resource info\n");
++              err = -ENODEV;
++              goto err;
++      }
++      dd->dma_in = r->start;
++
++      /* non-DT devices get pdata from pdev */
++      dd->pdata = pdev->dev.platform_data;
++
++err:
++      return err;
++}
++
++static int omap_des_probe(struct platform_device *pdev)
++{
++      struct device *dev = &pdev->dev;
++      struct omap_des_dev *dd;
++      struct crypto_alg *algp;
++      struct resource res;
++      int err = -ENOMEM, i, j, irq = -1;
++      u32 reg;
++
++      dd = devm_kzalloc(dev, sizeof(struct omap_des_dev), GFP_KERNEL);
++      if (dd == NULL) {
++              dev_err(dev, "unable to alloc data struct.\n");
++              goto err_data;
++      }
++      dd->dev = dev;
++      platform_set_drvdata(pdev, dd);
++
++      spin_lock_init(&dd->lock);
++      crypto_init_queue(&dd->queue, OMAP_DES_QUEUE_LENGTH);
++
++      err = (dev->of_node) ? omap_des_get_res_of(dd, dev, &res) :
++                             omap_des_get_res_pdev(dd, pdev, &res);
++      if (err)
++              goto err_res;
++
++      dd->io_base = devm_request_and_ioremap(dev, &res);
++      if (!dd->io_base) {
++              dev_err(dev, "can't ioremap\n");
++              err = -ENOMEM;
++              goto err_res;
++      }
++      dd->phys_base = res.start;
++
++      pm_runtime_enable(dev);
++      pm_runtime_get_sync(dev);
++
++      omap_des_dma_stop(dd);
++
++      reg = omap_des_read(dd, DES_REG_REV(dd));
++
++      pm_runtime_put_sync(dev);
++
++      dev_info(dev, "OMAP DES hw accel rev: %u.%u\n",
++               (reg & dd->pdata->major_mask) >> dd->pdata->major_shift,
++               (reg & dd->pdata->minor_mask) >> dd->pdata->minor_shift);
++
++      tasklet_init(&dd->done_task, omap_des_done_task, (unsigned long)dd);
++      tasklet_init(&dd->queue_task, omap_des_queue_task, (unsigned long)dd);
++
++      err = omap_des_dma_init(dd);
++      if (err && DES_REG_IRQ_STATUS(dd) && DES_REG_IRQ_ENABLE(dd)) {
++              dd->pio_only = 1;
++
++              irq = platform_get_irq(pdev, 0);
++              if (irq < 0) {
++                      dev_err(dev, "can't get IRQ resource\n");
++                      goto err_irq;
++              }
++
++              err = devm_request_irq(dev, irq, omap_des_irq, 0,
++                              dev_name(dev), dd);
++              if (err) {
++                      dev_err(dev, "Unable to grab omap-des IRQ\n");
++                      goto err_irq;
++              }
++      }
++
++
++      INIT_LIST_HEAD(&dd->list);
++      spin_lock(&list_lock);
++      list_add_tail(&dd->list, &dev_list);
++      spin_unlock(&list_lock);
++
++      for (i = 0; i < dd->pdata->algs_info_size; i++) {
++              for (j = 0; j < dd->pdata->algs_info[i].size; j++) {
++                      algp = &dd->pdata->algs_info[i].algs_list[j];
++
++                      pr_debug("reg alg: %s\n", algp->cra_name);
++                      INIT_LIST_HEAD(&algp->cra_list);
++
++                      err = crypto_register_alg(algp);
++                      if (err)
++                              goto err_algs;
++
++                      dd->pdata->algs_info[i].registered++;
++              }
++      }
++
++      return 0;
++err_algs:
++      for (i = dd->pdata->algs_info_size - 1; i >= 0; i--)
++              for (j = dd->pdata->algs_info[i].registered - 1; j >= 0; j--)
++                      crypto_unregister_alg(
++                                      &dd->pdata->algs_info[i].algs_list[j]);
++      if (!dd->pio_only)
++              omap_des_dma_cleanup(dd);
++err_irq:
++      tasklet_kill(&dd->done_task);
++      tasklet_kill(&dd->queue_task);
++      pm_runtime_disable(dev);
++err_res:
++      dd = NULL;
++err_data:
++      dev_err(dev, "initialization failed.\n");
++      return err;
++}
++
++static int omap_des_remove(struct platform_device *pdev)
++{
++      struct omap_des_dev *dd = platform_get_drvdata(pdev);
++      int i, j;
++
++      if (!dd)
++              return -ENODEV;
++
++      spin_lock(&list_lock);
++      list_del(&dd->list);
++      spin_unlock(&list_lock);
++
++      for (i = dd->pdata->algs_info_size - 1; i >= 0; i--)
++              for (j = dd->pdata->algs_info[i].registered - 1; j >= 0; j--)
++                      crypto_unregister_alg(
++                                      &dd->pdata->algs_info[i].algs_list[j]);
++
++      tasklet_kill(&dd->done_task);
++      tasklet_kill(&dd->queue_task);
++      omap_des_dma_cleanup(dd);
++      pm_runtime_disable(dd->dev);
++      dd = NULL;
++
++      return 0;
++}
++
++#ifdef CONFIG_PM_SLEEP
++static int omap_des_suspend(struct device *dev)
++{
++      pm_runtime_put_sync(dev);
++      return 0;
++}
++
++static int omap_des_resume(struct device *dev)
++{
++      pm_runtime_get_sync(dev);
++      return 0;
++}
++#endif
++
++static const struct dev_pm_ops omap_des_pm_ops = {
++      SET_SYSTEM_SLEEP_PM_OPS(omap_des_suspend, omap_des_resume)
++};
++
++static struct platform_driver omap_des_driver = {
++      .probe  = omap_des_probe,
++      .remove = omap_des_remove,
++      .driver = {
++              .name   = "omap-des",
++              .owner  = THIS_MODULE,
++              .pm     = &omap_des_pm_ops,
++              .of_match_table = omap_des_of_match,
++      },
++};
++
++module_platform_driver(omap_des_driver);
++
++MODULE_DESCRIPTION("OMAP DES hw acceleration support.");
++MODULE_LICENSE("GPL v2");
++MODULE_AUTHOR("Joel Fernandes <joelf@ti.com>");
+--- a/drivers/dma/amba-pl08x.c
++++ b/drivers/dma/amba-pl08x.c
+@@ -2133,8 +2133,7 @@ static int pl08x_probe(struct amba_devic
+       writel(0x000000FF, pl08x->base + PL080_ERR_CLEAR);
+       writel(0x000000FF, pl08x->base + PL080_TC_CLEAR);
+-      ret = request_irq(adev->irq[0], pl08x_irq, IRQF_DISABLED,
+-                        DRIVER_NAME, pl08x);
++      ret = request_irq(adev->irq[0], pl08x_irq, 0, DRIVER_NAME, pl08x);
+       if (ret) {
+               dev_err(&adev->dev, "%s failed to request interrupt %d\n",
+                       __func__, adev->irq[0]);
+--- a/drivers/dma/coh901318.c
++++ b/drivers/dma/coh901318.c
+@@ -2694,7 +2694,7 @@ static int __init coh901318_probe(struct
+       if (irq < 0)
+               return irq;
+-      err = devm_request_irq(&pdev->dev, irq, dma_irq_handler, IRQF_DISABLED,
++      err = devm_request_irq(&pdev->dev, irq, dma_irq_handler, 0,
+                              "coh901318", base);
+       if (err)
+               return err;
+--- a/drivers/dma/cppi41.c
++++ b/drivers/dma/cppi41.c
+@@ -141,6 +141,9 @@ struct cppi41_dd {
+       const struct chan_queues *queues_rx;
+       const struct chan_queues *queues_tx;
+       struct chan_queues td_queue;
++
++      /* context for suspend/resume */
++      unsigned int dma_tdfdq;
+ };
+ #define FIST_COMPLETION_QUEUE 93
+@@ -263,6 +266,15 @@ static u32 pd_trans_len(u32 val)
+       return val & ((1 << (DESC_LENGTH_BITS_NUM + 1)) - 1);
+ }
++static u32 cppi41_pop_desc(struct cppi41_dd *cdd, unsigned queue_num)
++{
++      u32 desc;
++
++      desc = cppi_readl(cdd->qmgr_mem + QMGR_QUEUE_D(queue_num));
++      desc &= ~0x1f;
++      return desc;
++}
++
+ static irqreturn_t cppi41_irq(int irq, void *data)
+ {
+       struct cppi41_dd *cdd = data;
+@@ -300,8 +312,7 @@ static irqreturn_t cppi41_irq(int irq, v
+                       q_num = __fls(val);
+                       val &= ~(1 << q_num);
+                       q_num += 32 * i;
+-                      desc = cppi_readl(cdd->qmgr_mem + QMGR_QUEUE_D(q_num));
+-                      desc &= ~0x1f;
++                      desc = cppi41_pop_desc(cdd, q_num);
+                       c = desc_to_chan(cdd, desc);
+                       if (WARN_ON(!c)) {
+                               pr_err("%s() q %d desc %08x\n", __func__,
+@@ -517,15 +528,6 @@ static void cppi41_compute_td_desc(struc
+       d->pd0 = DESC_TYPE_TEARD << DESC_TYPE;
+ }
+-static u32 cppi41_pop_desc(struct cppi41_dd *cdd, unsigned queue_num)
+-{
+-      u32 desc;
+-
+-      desc = cppi_readl(cdd->qmgr_mem + QMGR_QUEUE_D(queue_num));
+-      desc &= ~0x1f;
+-      return desc;
+-}
+-
+ static int cppi41_tear_down_chan(struct cppi41_channel *c)
+ {
+       struct cppi41_dd *cdd = c->cdd;
+@@ -561,36 +563,26 @@ static int cppi41_tear_down_chan(struct
+               c->td_retry = 100;
+       }
+-      if (!c->td_seen) {
+-              unsigned td_comp_queue;
++      if (!c->td_seen || !c->td_desc_seen) {
+-              if (c->is_tx)
+-                      td_comp_queue =  cdd->td_queue.complete;
+-              else
+-                      td_comp_queue =  c->q_comp_num;
++              desc_phys = cppi41_pop_desc(cdd, cdd->td_queue.complete);
++              if (!desc_phys)
++                      desc_phys = cppi41_pop_desc(cdd, c->q_comp_num);
+-              desc_phys = cppi41_pop_desc(cdd, td_comp_queue);
+-              if (desc_phys) {
+-                      __iormb();
++              if (desc_phys == c->desc_phys) {
++                      c->td_desc_seen = 1;
++
++              } else if (desc_phys == td_desc_phys) {
++                      u32 pd0;
+-                      if (desc_phys == td_desc_phys) {
+-                              u32 pd0;
+-                              pd0 = td->pd0;
+-                              WARN_ON((pd0 >> DESC_TYPE) != DESC_TYPE_TEARD);
+-                              WARN_ON(!c->is_tx && !(pd0 & TD_DESC_IS_RX));
+-                              WARN_ON((pd0 & 0x1f) != c->port_num);
+-                      } else {
+-                              WARN_ON_ONCE(1);
+-                      }
+-                      c->td_seen = 1;
+-              }
+-      }
+-      if (!c->td_desc_seen) {
+-              desc_phys = cppi41_pop_desc(cdd, c->q_comp_num);
+-              if (desc_phys) {
+                       __iormb();
+-                      WARN_ON(c->desc_phys != desc_phys);
+-                      c->td_desc_seen = 1;
++                      pd0 = td->pd0;
++                      WARN_ON((pd0 >> DESC_TYPE) != DESC_TYPE_TEARD);
++                      WARN_ON(!c->is_tx && !(pd0 & TD_DESC_IS_RX));
++                      WARN_ON((pd0 & 0x1f) != c->port_num);
++                      c->td_seen = 1;
++              } else if (desc_phys) {
++                      WARN_ON_ONCE(1);
+               }
+       }
+       c->td_retry--;
+@@ -609,7 +601,7 @@ static int cppi41_tear_down_chan(struct
+       WARN_ON(!c->td_retry);
+       if (!c->td_desc_seen) {
+-              desc_phys = cppi_readl(cdd->qmgr_mem + QMGR_QUEUE_D(c->q_num));
++              desc_phys = cppi41_pop_desc(cdd, c->q_num);
+               WARN_ON(!desc_phys);
+       }
+@@ -674,14 +666,14 @@ static void cleanup_chans(struct cppi41_
+       }
+ }
+-static int cppi41_add_chans(struct platform_device *pdev, struct cppi41_dd *cdd)
++static int cppi41_add_chans(struct device *dev, struct cppi41_dd *cdd)
+ {
+       struct cppi41_channel *cchan;
+       int i;
+       int ret;
+       u32 n_chans;
+-      ret = of_property_read_u32(pdev->dev.of_node, "#dma-channels",
++      ret = of_property_read_u32(dev->of_node, "#dma-channels",
+                       &n_chans);
+       if (ret)
+               return ret;
+@@ -719,7 +711,7 @@ err:
+       return -ENOMEM;
+ }
+-static void purge_descs(struct platform_device *pdev, struct cppi41_dd *cdd)
++static void purge_descs(struct device *dev, struct cppi41_dd *cdd)
+ {
+       unsigned int mem_decs;
+       int i;
+@@ -731,7 +723,7 @@ static void purge_descs(struct platform_
+               cppi_writel(0, cdd->qmgr_mem + QMGR_MEMBASE(i));
+               cppi_writel(0, cdd->qmgr_mem + QMGR_MEMCTRL(i));
+-              dma_free_coherent(&pdev->dev, mem_decs, cdd->cd,
++              dma_free_coherent(dev, mem_decs, cdd->cd,
+                               cdd->descs_phys);
+       }
+ }
+@@ -741,19 +733,19 @@ static void disable_sched(struct cppi41_
+       cppi_writel(0, cdd->sched_mem + DMA_SCHED_CTRL);
+ }
+-static void deinit_cpii41(struct platform_device *pdev, struct cppi41_dd *cdd)
++static void deinit_cppi41(struct device *dev, struct cppi41_dd *cdd)
+ {
+       disable_sched(cdd);
+-      purge_descs(pdev, cdd);
++      purge_descs(dev, cdd);
+       cppi_writel(0, cdd->qmgr_mem + QMGR_LRAM0_BASE);
+       cppi_writel(0, cdd->qmgr_mem + QMGR_LRAM0_BASE);
+-      dma_free_coherent(&pdev->dev, QMGR_SCRATCH_SIZE, cdd->qmgr_scratch,
++      dma_free_coherent(dev, QMGR_SCRATCH_SIZE, cdd->qmgr_scratch,
+                       cdd->scratch_phys);
+ }
+-static int init_descs(struct platform_device *pdev, struct cppi41_dd *cdd)
++static int init_descs(struct device *dev, struct cppi41_dd *cdd)
+ {
+       unsigned int desc_size;
+       unsigned int mem_decs;
+@@ -777,7 +769,7 @@ static int init_descs(struct platform_de
+               reg |= ilog2(ALLOC_DECS_NUM) - 5;
+               BUILD_BUG_ON(DESCS_AREAS != 1);
+-              cdd->cd = dma_alloc_coherent(&pdev->dev, mem_decs,
++              cdd->cd = dma_alloc_coherent(dev, mem_decs,
+                               &cdd->descs_phys, GFP_KERNEL);
+               if (!cdd->cd)
+                       return -ENOMEM;
+@@ -813,12 +805,12 @@ static void init_sched(struct cppi41_dd
+       cppi_writel(reg, cdd->sched_mem + DMA_SCHED_CTRL);
+ }
+-static int init_cppi41(struct platform_device *pdev, struct cppi41_dd *cdd)
++static int init_cppi41(struct device *dev, struct cppi41_dd *cdd)
+ {
+       int ret;
+       BUILD_BUG_ON(QMGR_SCRATCH_SIZE > ((1 << 14) - 1));
+-      cdd->qmgr_scratch = dma_alloc_coherent(&pdev->dev, QMGR_SCRATCH_SIZE,
++      cdd->qmgr_scratch = dma_alloc_coherent(dev, QMGR_SCRATCH_SIZE,
+                       &cdd->scratch_phys, GFP_KERNEL);
+       if (!cdd->qmgr_scratch)
+               return -ENOMEM;
+@@ -827,7 +819,7 @@ static int init_cppi41(struct platform_d
+       cppi_writel(QMGR_SCRATCH_SIZE, cdd->qmgr_mem + QMGR_LRAM_SIZE);
+       cppi_writel(0, cdd->qmgr_mem + QMGR_LRAM1_BASE);
+-      ret = init_descs(pdev, cdd);
++      ret = init_descs(dev, cdd);
+       if (ret)
+               goto err_td;
+@@ -835,7 +827,7 @@ static int init_cppi41(struct platform_d
+       init_sched(cdd);
+       return 0;
+ err_td:
+-      deinit_cpii41(pdev, cdd);
++      deinit_cppi41(dev, cdd);
+       return ret;
+ }
+@@ -914,11 +906,11 @@ static const struct of_device_id cppi41_
+ };
+ MODULE_DEVICE_TABLE(of, cppi41_dma_ids);
+-static const struct cppi_glue_infos *get_glue_info(struct platform_device *pdev)
++static const struct cppi_glue_infos *get_glue_info(struct device *dev)
+ {
+       const struct of_device_id *of_id;
+-      of_id = of_match_node(cppi41_dma_ids, pdev->dev.of_node);
++      of_id = of_match_node(cppi41_dma_ids, dev->of_node);
+       if (!of_id)
+               return NULL;
+       return of_id->data;
+@@ -927,11 +919,12 @@ static const struct cppi_glue_infos *get
+ static int cppi41_dma_probe(struct platform_device *pdev)
+ {
+       struct cppi41_dd *cdd;
++      struct device *dev = &pdev->dev;
+       const struct cppi_glue_infos *glue_info;
+       int irq;
+       int ret;
+-      glue_info = get_glue_info(pdev);
++      glue_info = get_glue_info(dev);
+       if (!glue_info)
+               return -EINVAL;
+@@ -946,14 +939,14 @@ static int cppi41_dma_probe(struct platf
+       cdd->ddev.device_issue_pending = cppi41_dma_issue_pending;
+       cdd->ddev.device_prep_slave_sg = cppi41_dma_prep_slave_sg;
+       cdd->ddev.device_control = cppi41_dma_control;
+-      cdd->ddev.dev = &pdev->dev;
++      cdd->ddev.dev = dev;
+       INIT_LIST_HEAD(&cdd->ddev.channels);
+       cpp41_dma_info.dma_cap = cdd->ddev.cap_mask;
+-      cdd->usbss_mem = of_iomap(pdev->dev.of_node, 0);
+-      cdd->ctrl_mem = of_iomap(pdev->dev.of_node, 1);
+-      cdd->sched_mem = of_iomap(pdev->dev.of_node, 2);
+-      cdd->qmgr_mem = of_iomap(pdev->dev.of_node, 3);
++      cdd->usbss_mem = of_iomap(dev->of_node, 0);
++      cdd->ctrl_mem = of_iomap(dev->of_node, 1);
++      cdd->sched_mem = of_iomap(dev->of_node, 2);
++      cdd->qmgr_mem = of_iomap(dev->of_node, 3);
+       if (!cdd->usbss_mem || !cdd->ctrl_mem || !cdd->sched_mem ||
+                       !cdd->qmgr_mem) {
+@@ -961,31 +954,31 @@ static int cppi41_dma_probe(struct platf
+               goto err_remap;
+       }
+-      pm_runtime_enable(&pdev->dev);
+-      ret = pm_runtime_get_sync(&pdev->dev);
+-      if (ret)
++      pm_runtime_enable(dev);
++      ret = pm_runtime_get_sync(dev);
++      if (ret < 0)
+               goto err_get_sync;
+       cdd->queues_rx = glue_info->queues_rx;
+       cdd->queues_tx = glue_info->queues_tx;
+       cdd->td_queue = glue_info->td_queue;
+-      ret = init_cppi41(pdev, cdd);
++      ret = init_cppi41(dev, cdd);
+       if (ret)
+               goto err_init_cppi;
+-      ret = cppi41_add_chans(pdev, cdd);
++      ret = cppi41_add_chans(dev, cdd);
+       if (ret)
+               goto err_chans;
+-      irq = irq_of_parse_and_map(pdev->dev.of_node, 0);
++      irq = irq_of_parse_and_map(dev->of_node, 0);
+       if (!irq)
+               goto err_irq;
+       cppi_writel(USBSS_IRQ_PD_COMP, cdd->usbss_mem + USBSS_IRQ_ENABLER);
+       ret = request_irq(irq, glue_info->isr, IRQF_SHARED,
+-                      dev_name(&pdev->dev), cdd);
++                      dev_name(dev), cdd);
+       if (ret)
+               goto err_irq;
+       cdd->irq = irq;
+@@ -994,7 +987,7 @@ static int cppi41_dma_probe(struct platf
+       if (ret)
+               goto err_dma_reg;
+-      ret = of_dma_controller_register(pdev->dev.of_node,
++      ret = of_dma_controller_register(dev->of_node,
+                       cppi41_dma_xlate, &cpp41_dma_info);
+       if (ret)
+               goto err_of;
+@@ -1009,11 +1002,11 @@ err_irq:
+       cppi_writel(0, cdd->usbss_mem + USBSS_IRQ_CLEARR);
+       cleanup_chans(cdd);
+ err_chans:
+-      deinit_cpii41(pdev, cdd);
++      deinit_cppi41(dev, cdd);
+ err_init_cppi:
+-      pm_runtime_put(&pdev->dev);
++      pm_runtime_put(dev);
+ err_get_sync:
+-      pm_runtime_disable(&pdev->dev);
++      pm_runtime_disable(dev);
+       iounmap(cdd->usbss_mem);
+       iounmap(cdd->ctrl_mem);
+       iounmap(cdd->sched_mem);
+@@ -1033,7 +1026,7 @@ static int cppi41_dma_remove(struct plat
+       cppi_writel(0, cdd->usbss_mem + USBSS_IRQ_CLEARR);
+       free_irq(cdd->irq, cdd);
+       cleanup_chans(cdd);
+-      deinit_cpii41(pdev, cdd);
++      deinit_cppi41(&pdev->dev, cdd);
+       iounmap(cdd->usbss_mem);
+       iounmap(cdd->ctrl_mem);
+       iounmap(cdd->sched_mem);
+@@ -1044,12 +1037,53 @@ static int cppi41_dma_remove(struct plat
+       return 0;
+ }
++#ifdef CONFIG_PM_SLEEP
++static int cppi41_suspend(struct device *dev)
++{
++      struct cppi41_dd *cdd = dev_get_drvdata(dev);
++
++      cdd->dma_tdfdq = cppi_readl(cdd->ctrl_mem + DMA_TDFDQ);
++      cppi_writel(0, cdd->usbss_mem + USBSS_IRQ_CLEARR);
++      disable_sched(cdd);
++
++      return 0;
++}
++
++static int cppi41_resume(struct device *dev)
++{
++      struct cppi41_dd *cdd = dev_get_drvdata(dev);
++      struct cppi41_channel *c;
++      int i;
++
++      for (i = 0; i < DESCS_AREAS; i++)
++              cppi_writel(cdd->descs_phys, cdd->qmgr_mem + QMGR_MEMBASE(i));
++
++      list_for_each_entry(c, &cdd->ddev.channels, chan.device_node)
++              if (!c->is_tx)
++                      cppi_writel(c->q_num, c->gcr_reg + RXHPCRA0);
++
++      init_sched(cdd);
++
++      cppi_writel(cdd->dma_tdfdq, cdd->ctrl_mem + DMA_TDFDQ);
++      cppi_writel(cdd->scratch_phys, cdd->qmgr_mem + QMGR_LRAM0_BASE);
++      cppi_writel(QMGR_SCRATCH_SIZE, cdd->qmgr_mem + QMGR_LRAM_SIZE);
++      cppi_writel(0, cdd->qmgr_mem + QMGR_LRAM1_BASE);
++
++      cppi_writel(USBSS_IRQ_PD_COMP, cdd->usbss_mem + USBSS_IRQ_ENABLER);
++
++      return 0;
++}
++#endif
++
++static SIMPLE_DEV_PM_OPS(cppi41_pm_ops, cppi41_suspend, cppi41_resume);
++
+ static struct platform_driver cpp41_dma_driver = {
+       .probe  = cppi41_dma_probe,
+       .remove = cppi41_dma_remove,
+       .driver = {
+               .name = "cppi41-dma-engine",
+               .owner = THIS_MODULE,
++              .pm = &cppi41_pm_ops,
+               .of_match_table = of_match_ptr(cppi41_dma_ids),
+       },
+ };
+--- a/drivers/dma/edma.c
++++ b/drivers/dma/edma.c
+@@ -46,8 +46,14 @@
+ #define EDMA_CHANS    64
+ #endif /* CONFIG_ARCH_DAVINCI_DA8XX */
+-/* Max of 16 segments per channel to conserve PaRAM slots */
+-#define MAX_NR_SG             16
++/*
++ * Max of 20 segments per channel to conserve PaRAM slots
++ * Also note that MAX_NR_SG should be atleast the no.of periods
++ * that are required for ASoC, otherwise DMA prep calls will
++ * fail. Today davinci-pcm is the only user of this driver and
++ * requires atleast 17 slots, so we setup the default to 20.
++ */
++#define MAX_NR_SG             20
+ #define EDMA_MAX_SLOTS                MAX_NR_SG
+ #define EDMA_DESCRIPTORS      16
+@@ -250,6 +256,117 @@ static int edma_control(struct dma_chan
+       return ret;
+ }
++/*
++ * A PaRAM set configuration abstraction used by other modes
++ * @chan: Channel who's PaRAM set we're configuring
++ * @pset: PaRAM set to initialize and setup.
++ * @src_addr: Source address of the DMA
++ * @dst_addr: Destination address of the DMA
++ * @burst: In units of dev_width, how much to send
++ * @dev_width: How much is the dev_width
++ * @dma_length: Total length of the DMA transfer
++ * @direction: Direction of the transfer
++ */
++static int edma_config_pset(struct dma_chan *chan, struct edmacc_param *pset,
++      dma_addr_t src_addr, dma_addr_t dst_addr, u32 burst,
++      enum dma_slave_buswidth dev_width, unsigned int dma_length,
++      enum dma_transfer_direction direction)
++{
++      struct edma_chan *echan = to_edma_chan(chan);
++      struct device *dev = chan->device->dev;
++      int acnt, bcnt, ccnt, cidx;
++      int src_bidx, dst_bidx, src_cidx, dst_cidx;
++      int absync;
++
++      acnt = dev_width;
++      /*
++       * If the maxburst is equal to the fifo width, use
++       * A-synced transfers. This allows for large contiguous
++       * buffer transfers using only one PaRAM set.
++       */
++      if (burst == 1) {
++              /*
++               * For the A-sync case, bcnt and ccnt are the remainder
++               * and quotient respectively of the division of:
++               * (dma_length / acnt) by (SZ_64K -1). This is so
++               * that in case bcnt over flows, we have ccnt to use.
++               * Note: In A-sync tranfer only, bcntrld is used, but it
++               * only applies for sg_dma_len(sg) >= SZ_64K.
++               * In this case, the best way adopted is- bccnt for the
++               * first frame will be the remainder below. Then for
++               * every successive frame, bcnt will be SZ_64K-1. This
++               * is assured as bcntrld = 0xffff in end of function.
++               */
++              absync = false;
++              ccnt = dma_length / acnt / (SZ_64K - 1);
++              bcnt = dma_length / acnt - ccnt * (SZ_64K - 1);
++              /*
++               * If bcnt is non-zero, we have a remainder and hence an
++               * extra frame to transfer, so increment ccnt.
++               */
++              if (bcnt)
++                      ccnt++;
++              else
++                      bcnt = SZ_64K - 1;
++              cidx = acnt;
++      } else {
++              /*
++               * If maxburst is greater than the fifo address_width,
++               * use AB-synced transfers where A count is the fifo
++               * address_width and B count is the maxburst. In this
++               * case, we are limited to transfers of C count frames
++               * of (address_width * maxburst) where C count is limited
++               * to SZ_64K-1. This places an upper bound on the length
++               * of an SG segment that can be handled.
++               */
++              absync = true;
++              bcnt = burst;
++              ccnt = dma_length / (acnt * bcnt);
++              if (ccnt > (SZ_64K - 1)) {
++                      dev_err(dev, "Exceeded max SG segment size\n");
++                      return -EINVAL;
++              }
++              cidx = acnt * bcnt;
++      }
++
++      if (direction == DMA_MEM_TO_DEV) {
++              src_bidx = acnt;
++              src_cidx = cidx;
++              dst_bidx = 0;
++              dst_cidx = 0;
++      } else if (direction == DMA_DEV_TO_MEM)  {
++              src_bidx = 0;
++              src_cidx = 0;
++              dst_bidx = acnt;
++              dst_cidx = cidx;
++      } else {
++              dev_err(dev, "%s: direction not implemented yet\n", __func__);
++              return -EINVAL;
++      }
++
++      pset->opt = EDMA_TCC(EDMA_CHAN_SLOT(echan->ch_num));
++      /* Configure A or AB synchronized transfers */
++      if (absync)
++              pset->opt |= SYNCDIM;
++
++      pset->src = src_addr;
++      pset->dst = dst_addr;
++
++      pset->src_dst_bidx = (dst_bidx << 16) | src_bidx;
++      pset->src_dst_cidx = (dst_cidx << 16) | src_cidx;
++
++      pset->a_b_cnt = bcnt << 16 | acnt;
++      pset->ccnt = ccnt;
++      /*
++       * Only time when (bcntrld) auto reload is required is for
++       * A-sync case, and in this case, a requirement of reload value
++       * of SZ_64K-1 only is assured. 'link' is initially set to NULL
++       * and then later will be populated by edma_execute.
++       */
++      pset->link_bcntrld = 0xffffffff;
++      return absync;
++}
++
+ static struct dma_async_tx_descriptor *edma_prep_slave_sg(
+       struct dma_chan *chan, struct scatterlist *sgl,
+       unsigned int sg_len, enum dma_transfer_direction direction,
+@@ -258,23 +375,21 @@ static struct dma_async_tx_descriptor *e
+       struct edma_chan *echan = to_edma_chan(chan);
+       struct device *dev = chan->device->dev;
+       struct edma_desc *edesc;
+-      dma_addr_t dev_addr;
++      dma_addr_t src_addr = 0, dst_addr = 0;
+       enum dma_slave_buswidth dev_width;
+       u32 burst;
+       struct scatterlist *sg;
+-      int acnt, bcnt, ccnt, src, dst, cidx;
+-      int src_bidx, dst_bidx, src_cidx, dst_cidx;
+-      int i, nslots;
++      int i, nslots, ret;
+       if (unlikely(!echan || !sgl || !sg_len))
+               return NULL;
+       if (direction == DMA_DEV_TO_MEM) {
+-              dev_addr = echan->cfg.src_addr;
++              src_addr = echan->cfg.src_addr;
+               dev_width = echan->cfg.src_addr_width;
+               burst = echan->cfg.src_maxburst;
+       } else if (direction == DMA_MEM_TO_DEV) {
+-              dev_addr = echan->cfg.dst_addr;
++              dst_addr = echan->cfg.dst_addr;
+               dev_width = echan->cfg.dst_addr_width;
+               burst = echan->cfg.dst_maxburst;
+       } else {
+@@ -315,64 +430,19 @@ static struct dma_async_tx_descriptor *e
+       /* Configure PaRAM sets for each SG */
+       for_each_sg(sgl, sg, sg_len, i) {
++              /* Get address for each SG */
++              if (direction == DMA_DEV_TO_MEM)
++                      dst_addr = sg_dma_address(sg);
++              else
++                      src_addr = sg_dma_address(sg);
++
++              ret = edma_config_pset(chan, &edesc->pset[i], src_addr,
++                                     dst_addr, burst, dev_width,
++                                     sg_dma_len(sg), direction);
++              if (ret < 0)
++                      return NULL;
+-              acnt = dev_width;
+-
+-              /*
+-               * If the maxburst is equal to the fifo width, use
+-               * A-synced transfers. This allows for large contiguous
+-               * buffer transfers using only one PaRAM set.
+-               */
+-              if (burst == 1) {
+-                      edesc->absync = false;
+-                      ccnt = sg_dma_len(sg) / acnt / (SZ_64K - 1);
+-                      bcnt = sg_dma_len(sg) / acnt - ccnt * (SZ_64K - 1);
+-                      if (bcnt)
+-                              ccnt++;
+-                      else
+-                              bcnt = SZ_64K - 1;
+-                      cidx = acnt;
+-              /*
+-               * If maxburst is greater than the fifo address_width,
+-               * use AB-synced transfers where A count is the fifo
+-               * address_width and B count is the maxburst. In this
+-               * case, we are limited to transfers of C count frames
+-               * of (address_width * maxburst) where C count is limited
+-               * to SZ_64K-1. This places an upper bound on the length
+-               * of an SG segment that can be handled.
+-               */
+-              } else {
+-                      edesc->absync = true;
+-                      bcnt = burst;
+-                      ccnt = sg_dma_len(sg) / (acnt * bcnt);
+-                      if (ccnt > (SZ_64K - 1)) {
+-                              dev_err(dev, "Exceeded max SG segment size\n");
+-                              kfree(edesc);
+-                              return NULL;
+-                      }
+-                      cidx = acnt * bcnt;
+-              }
+-
+-              if (direction == DMA_MEM_TO_DEV) {
+-                      src = sg_dma_address(sg);
+-                      dst = dev_addr;
+-                      src_bidx = acnt;
+-                      src_cidx = cidx;
+-                      dst_bidx = 0;
+-                      dst_cidx = 0;
+-              } else {
+-                      src = dev_addr;
+-                      dst = sg_dma_address(sg);
+-                      src_bidx = 0;
+-                      src_cidx = 0;
+-                      dst_bidx = acnt;
+-                      dst_cidx = cidx;
+-              }
+-
+-              edesc->pset[i].opt = EDMA_TCC(EDMA_CHAN_SLOT(echan->ch_num));
+-              /* Configure A or AB synchronized transfers */
+-              if (edesc->absync)
+-                      edesc->pset[i].opt |= SYNCDIM;
++              edesc->absync = ret;
+               /* If this is the last in a current SG set of transactions,
+                  enable interrupts so that next set is processed */
+@@ -382,17 +452,6 @@ static struct dma_async_tx_descriptor *e
+               /* If this is the last set, enable completion interrupt flag */
+               if (i == sg_len - 1)
+                       edesc->pset[i].opt |= TCINTEN;
+-
+-              edesc->pset[i].src = src;
+-              edesc->pset[i].dst = dst;
+-
+-              edesc->pset[i].src_dst_bidx = (dst_bidx << 16) | src_bidx;
+-              edesc->pset[i].src_dst_cidx = (dst_cidx << 16) | src_cidx;
+-
+-              edesc->pset[i].a_b_cnt = bcnt << 16 | acnt;
+-              edesc->pset[i].ccnt = ccnt;
+-              edesc->pset[i].link_bcntrld = 0xffffffff;
+-
+       }
+       return vchan_tx_prep(&echan->vchan, &edesc->vdesc, tx_flags);
+--- a/drivers/dma/k3dma.c
++++ b/drivers/dma/k3dma.c
+@@ -693,7 +693,7 @@ static int k3_dma_probe(struct platform_
+       irq = platform_get_irq(op, 0);
+       ret = devm_request_irq(&op->dev, irq,
+-                      k3_dma_int_handler, IRQF_DISABLED, DRIVER_NAME, d);
++                      k3_dma_int_handler, 0, DRIVER_NAME, d);
+       if (ret)
+               return ret;
+--- a/drivers/dma/mmp_pdma.c
++++ b/drivers/dma/mmp_pdma.c
+@@ -798,8 +798,7 @@ static void dma_do_tasklet(unsigned long
+                * move the descriptors to a temporary list so we can drop
+                * the lock during the entire cleanup operation
+                */
+-              list_del(&desc->node);
+-              list_add(&desc->node, &chain_cleanup);
++              list_move(&desc->node, &chain_cleanup);
+               /*
+                * Look for the first list entry which has the ENDIRQEN flag
+@@ -863,7 +862,7 @@ static int mmp_pdma_chan_init(struct mmp
+       if (irq) {
+               ret = devm_request_irq(pdev->dev, irq,
+-                      mmp_pdma_chan_handler, IRQF_DISABLED, "pdma", phy);
++                      mmp_pdma_chan_handler, 0, "pdma", phy);
+               if (ret) {
+                       dev_err(pdev->dev, "channel request irq fail!\n");
+                       return ret;
+@@ -970,7 +969,7 @@ static int mmp_pdma_probe(struct platfor
+               /* all chan share one irq, demux inside */
+               irq = platform_get_irq(op, 0);
+               ret = devm_request_irq(pdev->dev, irq,
+-                      mmp_pdma_int_handler, IRQF_DISABLED, "pdma", pdev);
++                      mmp_pdma_int_handler, 0, "pdma", pdev);
+               if (ret)
+                       return ret;
+       }
+--- a/drivers/dma/mmp_tdma.c
++++ b/drivers/dma/mmp_tdma.c
+@@ -62,6 +62,11 @@
+ #define TDCR_BURSTSZ_16B      (0x3 << 6)
+ #define TDCR_BURSTSZ_32B      (0x6 << 6)
+ #define TDCR_BURSTSZ_64B      (0x7 << 6)
++#define TDCR_BURSTSZ_SQU_1B           (0x5 << 6)
++#define TDCR_BURSTSZ_SQU_2B           (0x6 << 6)
++#define TDCR_BURSTSZ_SQU_4B           (0x0 << 6)
++#define TDCR_BURSTSZ_SQU_8B           (0x1 << 6)
++#define TDCR_BURSTSZ_SQU_16B  (0x3 << 6)
+ #define TDCR_BURSTSZ_SQU_32B  (0x7 << 6)
+ #define TDCR_BURSTSZ_128B     (0x5 << 6)
+ #define TDCR_DSTDIR_MSK               (0x3 << 4)      /* Dst Direction */
+@@ -228,8 +233,31 @@ static int mmp_tdma_config_chan(struct m
+                       return -EINVAL;
+               }
+       } else if (tdmac->type == PXA910_SQU) {
+-              tdcr |= TDCR_BURSTSZ_SQU_32B;
+               tdcr |= TDCR_SSPMOD;
++
++              switch (tdmac->burst_sz) {
++              case 1:
++                      tdcr |= TDCR_BURSTSZ_SQU_1B;
++                      break;
++              case 2:
++                      tdcr |= TDCR_BURSTSZ_SQU_2B;
++                      break;
++              case 4:
++                      tdcr |= TDCR_BURSTSZ_SQU_4B;
++                      break;
++              case 8:
++                      tdcr |= TDCR_BURSTSZ_SQU_8B;
++                      break;
++              case 16:
++                      tdcr |= TDCR_BURSTSZ_SQU_16B;
++                      break;
++              case 32:
++                      tdcr |= TDCR_BURSTSZ_SQU_32B;
++                      break;
++              default:
++                      dev_err(tdmac->dev, "mmp_tdma: unknown burst size.\n");
++                      return -EINVAL;
++              }
+       }
+       writel(tdcr, tdmac->reg_base + TDCR);
+@@ -324,7 +352,7 @@ static int mmp_tdma_alloc_chan_resources
+       if (tdmac->irq) {
+               ret = devm_request_irq(tdmac->dev, tdmac->irq,
+-                      mmp_tdma_chan_handler, IRQF_DISABLED, "tdma", tdmac);
++                      mmp_tdma_chan_handler, 0, "tdma", tdmac);
+               if (ret)
+                       return ret;
+       }
+@@ -559,7 +587,7 @@ static int mmp_tdma_probe(struct platfor
+       if (irq_num != chan_num) {
+               irq = platform_get_irq(pdev, 0);
+               ret = devm_request_irq(&pdev->dev, irq,
+-                      mmp_tdma_int_handler, IRQF_DISABLED, "tdma", tdev);
++                      mmp_tdma_int_handler, 0, "tdma", tdev);
+               if (ret)
+                       return ret;
+       }
+--- a/drivers/dma/pl330.c
++++ b/drivers/dma/pl330.c
+@@ -2922,16 +2922,23 @@ pl330_probe(struct amba_device *adev, co
+       amba_set_drvdata(adev, pdmac);
+-      irq = adev->irq[0];
+-      ret = request_irq(irq, pl330_irq_handler, 0,
+-                      dev_name(&adev->dev), pi);
+-      if (ret)
+-              return ret;
++      for (i = 0; i <= AMBA_NR_IRQS; i++) {
++              irq = adev->irq[i];
++              if (irq) {
++                      ret = devm_request_irq(&adev->dev, irq,
++                                             pl330_irq_handler, 0,
++                                             dev_name(&adev->dev), pi);
++                      if (ret)
++                              return ret;
++              } else {
++                      break;
++              }
++      }
+       pi->pcfg.periph_id = adev->periphid;
+       ret = pl330_add(pi);
+       if (ret)
+-              goto probe_err1;
++              return ret;
+       INIT_LIST_HEAD(&pdmac->desc_pool);
+       spin_lock_init(&pdmac->pool_lock);
+@@ -3044,8 +3051,6 @@ probe_err3:
+       }
+ probe_err2:
+       pl330_del(pi);
+-probe_err1:
+-      free_irq(irq, pi);
+       return ret;
+ }
+@@ -3055,7 +3060,6 @@ static int pl330_remove(struct amba_devi
+       struct dma_pl330_dmac *pdmac = amba_get_drvdata(adev);
+       struct dma_pl330_chan *pch, *_p;
+       struct pl330_info *pi;
+-      int irq;
+       if (!pdmac)
+               return 0;
+@@ -3082,9 +3086,6 @@ static int pl330_remove(struct amba_devi
+       pl330_del(pi);
+-      irq = adev->irq[0];
+-      free_irq(irq, pi);
+-
+       return 0;
+ }
+--- a/drivers/dma/ste_dma40.c
++++ b/drivers/dma/ste_dma40.c
+@@ -14,6 +14,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/clk.h>
+ #include <linux/delay.h>
++#include <linux/log2.h>
+ #include <linux/pm.h>
+ #include <linux/pm_runtime.h>
+ #include <linux/err.h>
+@@ -2796,8 +2797,8 @@ static int d40_set_runtime_config(struct
+           src_addr_width >  DMA_SLAVE_BUSWIDTH_8_BYTES   ||
+           dst_addr_width <= DMA_SLAVE_BUSWIDTH_UNDEFINED ||
+           dst_addr_width >  DMA_SLAVE_BUSWIDTH_8_BYTES   ||
+-          ((src_addr_width > 1) && (src_addr_width & 1)) ||
+-          ((dst_addr_width > 1) && (dst_addr_width & 1)))
++          !is_power_of_2(src_addr_width) ||
++          !is_power_of_2(dst_addr_width))
+               return -EINVAL;
+       cfg->src_info.data_width = src_addr_width;
+--- /dev/null
++++ b/drivers/extcon/extcon-gpio-usbvid.c
+@@ -0,0 +1,281 @@
++/*
++ * Generic  USB VBUS-ID pin detection driver
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: George Cherian <george.cherian@ti.com>
++ *
++ * Based on extcon-palmas.c
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ */
++
++#include <linux/err.h>
++#include <linux/extcon.h>
++#include <linux/gpio.h>
++#include <linux/interrupt.h>
++#include <linux/module.h>
++#include <linux/of.h>
++#include <linux/of_gpio.h>
++#include <linux/of_platform.h>
++#include <linux/platform_device.h>
++
++struct gpio_usbvid {
++      struct device *dev;
++
++      struct extcon_dev edev;
++
++      /* GPIO pin */
++      int id_gpio;
++      int vbus_gpio;
++
++      int id_irq;
++      int vbus_irq;
++      int type;
++};
++
++static const char *dra7xx_extcon_cable[] = {
++      [0] = "USB",
++      [1] = "USB-HOST",
++      NULL,
++};
++
++static const int mutually_exclusive[] = {0x3, 0x0};
++
++/* Two types of support are provided.
++ * Systems which has
++ *    1) VBUS and ID pin connected via GPIO
++ *    2) only ID pin connected via GPIO
++ *  For Case 1 both the gpios should be provided via DT
++ *  Always the first GPIO in dt is considered ID pin GPIO
++ */
++
++enum {
++      UNKNOWN = 0,
++      ID_DETECT,
++      VBUS_ID_DETECT,
++};
++
++#define ID_GND                0
++#define ID_FLOAT      1
++#define VBUS_OFF      0
++#define VBUS_ON               1
++
++static irqreturn_t id_irq_handler(int irq, void *data)
++{
++      struct gpio_usbvid *gpio_usbvid = (struct gpio_usbvid *)data;
++      int id_current;
++
++      id_current = gpio_get_value_cansleep(gpio_usbvid->id_gpio);
++      if (id_current == ID_GND) {
++              if (gpio_usbvid->type == ID_DETECT)
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", false);
++              extcon_set_cable_state(&gpio_usbvid->edev, "USB-HOST", true);
++      } else {
++              extcon_set_cable_state(&gpio_usbvid->edev, "USB-HOST", false);
++              if (gpio_usbvid->type == ID_DETECT)
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", true);
++      }
++
++      return IRQ_HANDLED;
++}
++
++static irqreturn_t vbus_irq_handler(int irq, void *data)
++{
++      struct gpio_usbvid *gpio_usbvid = (struct gpio_usbvid *)data;
++      int vbus_current;
++
++      vbus_current = gpio_get_value_cansleep(gpio_usbvid->vbus_gpio);
++      if (vbus_current == VBUS_OFF)
++              extcon_set_cable_state(&gpio_usbvid->edev, "USB", false);
++      else
++              extcon_set_cable_state(&gpio_usbvid->edev, "USB", true);
++
++      return IRQ_HANDLED;
++}
++
++static void gpio_usbvid_set_initial_state(struct gpio_usbvid *gpio_usbvid)
++{
++      int id_current, vbus_current;
++
++      switch (gpio_usbvid->type) {
++      case ID_DETECT:
++              id_current = gpio_get_value_cansleep(gpio_usbvid->id_gpio);
++              if (!!id_current == ID_FLOAT) {
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB-HOST", false);
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", true);
++              } else {
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", false);
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB-HOST", true);
++              }
++              break;
++
++      case VBUS_ID_DETECT:
++              id_current = gpio_get_value_cansleep(gpio_usbvid->id_gpio);
++              if (!!id_current == ID_FLOAT)
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB-HOST", false);
++              else
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB-HOST", true);
++
++              vbus_current = gpio_get_value_cansleep(gpio_usbvid->vbus_gpio);
++              if (!!vbus_current == VBUS_ON)
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", true);
++              else
++                      extcon_set_cable_state(&gpio_usbvid->edev,
++                                                      "USB", false);
++              break;
++
++      default:
++              dev_err(gpio_usbvid->dev, "Unknown VBUS-ID type\n");
++      }
++}
++
++static int gpio_usbvid_request_irq(struct gpio_usbvid *gpio_usbvid)
++{
++      int ret;
++
++      ret = devm_request_threaded_irq(gpio_usbvid->dev, gpio_usbvid->id_irq,
++                                      NULL, id_irq_handler,
++                                      IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
++                                      dev_name(gpio_usbvid->dev),
++                                      (void *) gpio_usbvid);
++      if (ret) {
++              dev_err(gpio_usbvid->dev, "failed to request id irq #%d\n",
++                                      gpio_usbvid->id_irq);
++              return ret;
++      }
++      if (gpio_usbvid->type == VBUS_ID_DETECT) {
++              ret = devm_request_threaded_irq(gpio_usbvid->dev,
++                                      gpio_usbvid->vbus_irq, NULL,
++                                      vbus_irq_handler,
++                                      IRQF_ONESHOT | IRQF_TRIGGER_FALLING,
++                                      dev_name(gpio_usbvid->dev),
++                                      (void *) gpio_usbvid);
++              if (ret)
++                      dev_err(gpio_usbvid->dev, "failed to request vbus irq #%d\n",
++                                              gpio_usbvid->vbus_irq);
++      }
++
++      return ret;
++}
++
++static int gpio_usbvid_probe(struct platform_device *pdev)
++{
++      struct device_node *node = pdev->dev.of_node;
++      struct gpio_usbvid *gpio_usbvid;
++      int ret, gpio;
++
++      gpio_usbvid = devm_kzalloc(&pdev->dev, sizeof(*gpio_usbvid),
++                              GFP_KERNEL);
++      if (!gpio_usbvid)
++              return -ENOMEM;
++
++      gpio_usbvid->dev = &pdev->dev;
++
++      platform_set_drvdata(pdev, gpio_usbvid);
++
++      //gpio_usbvid->edev.name = dev_name(&pdev->dev);
++      gpio_usbvid->edev.supported_cable = dra7xx_extcon_cable;
++      gpio_usbvid->edev.mutually_exclusive = mutually_exclusive;
++
++      if (of_device_is_compatible(node, "ti,gpio-usb-id"))
++              gpio_usbvid->type = ID_DETECT;
++
++      gpio = of_get_gpio(node, 0);
++      if (gpio_is_valid(gpio)) {
++              gpio_usbvid->id_gpio = gpio;
++              ret = devm_gpio_request(&pdev->dev, gpio_usbvid->id_gpio,
++                                      "id_gpio");
++              if (ret)
++                      return ret;
++
++              gpio_usbvid->id_irq = gpio_to_irq(gpio_usbvid->id_gpio);
++      } else {
++              dev_err(&pdev->dev, "failed to get id gpio\n");
++              return -EPROBE_DEFER;
++      }
++
++      if (of_device_is_compatible(node, "ti,gpio-usb-vid")) {
++              gpio_usbvid->type = VBUS_ID_DETECT;
++              gpio = of_get_gpio(node, 1);
++              if (gpio_is_valid(gpio)) {
++                      gpio_usbvid->vbus_gpio = gpio;
++                      ret = devm_gpio_request(&pdev->dev,
++                                              gpio_usbvid->vbus_gpio,
++                                              "vbus_gpio");
++                      if (ret)
++                              return ret;
++
++                      gpio_usbvid->vbus_irq =
++                                      gpio_to_irq(gpio_usbvid->vbus_gpio);
++              } else {
++                      dev_err(&pdev->dev, "failed to get vbus gpio\n");
++                      return -ENODEV;
++              }
++      }
++
++      ret = gpio_usbvid_request_irq(gpio_usbvid);
++      if (ret)
++              return ret;
++
++      ret = extcon_dev_register(&gpio_usbvid->edev, gpio_usbvid->dev);
++      if (ret) {
++              dev_err(&pdev->dev, "failed to register extcon device\n");
++              return ret;
++      }
++
++      gpio_usbvid_set_initial_state(gpio_usbvid);
++
++      return 0;
++
++}
++
++static int gpio_usbvid_remove(struct platform_device *pdev)
++{
++      struct gpio_usbvid *gpio_usbvid = platform_get_drvdata(pdev);
++
++      extcon_dev_unregister(&gpio_usbvid->edev);
++      return 0;
++}
++
++static struct of_device_id of_gpio_usbvid_match_tbl[] = {
++      { .compatible = "ti,gpio-usb-vid", },
++      { .compatible = "ti,gpio-usb-id", },
++      { /* end */ }
++};
++
++static struct platform_driver gpio_usbvid_driver = {
++      .probe = gpio_usbvid_probe,
++      .remove = gpio_usbvid_remove,
++      .driver = {
++              .name = "gpio-usbvid",
++              .of_match_table = of_gpio_usbvid_match_tbl,
++              .owner = THIS_MODULE,
++      },
++};
++
++module_platform_driver(gpio_usbvid_driver);
++
++MODULE_ALIAS("platform:gpio-usbvid");
++MODULE_AUTHOR("George Cherian <george.cherian@ti.com>");
++MODULE_DESCRIPTION("GPIO based USB Connector driver");
++MODULE_LICENSE("GPL");
++MODULE_DEVICE_TABLE(of, of_gpio_usbvid_match_tbl);
+--- a/drivers/extcon/extcon-palmas.c
++++ b/drivers/extcon/extcon-palmas.c
+@@ -78,20 +78,24 @@ static irqreturn_t palmas_vbus_irq_handl
+ static irqreturn_t palmas_id_irq_handler(int irq, void *_palmas_usb)
+ {
+-      unsigned int set;
++      unsigned int set, id_src;
+       struct palmas_usb *palmas_usb = _palmas_usb;
+       palmas_read(palmas_usb->palmas, PALMAS_USB_OTG_BASE,
+               PALMAS_USB_ID_INT_LATCH_SET, &set);
++      palmas_read(palmas_usb->palmas, PALMAS_USB_OTG_BASE,
++              PALMAS_USB_ID_INT_SRC, &id_src);
+-      if (set & PALMAS_USB_ID_INT_SRC_ID_GND) {
++      if ((set & PALMAS_USB_ID_INT_SRC_ID_GND) &&
++                              (id_src & PALMAS_USB_ID_INT_SRC_ID_GND)) {
+               palmas_write(palmas_usb->palmas, PALMAS_USB_OTG_BASE,
+                       PALMAS_USB_ID_INT_LATCH_CLR,
+                       PALMAS_USB_ID_INT_EN_HI_CLR_ID_GND);
+               palmas_usb->linkstat = PALMAS_USB_STATE_ID;
+               extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", true);
+               dev_info(palmas_usb->dev, "USB-HOST cable is attached\n");
+-      } else if (set & PALMAS_USB_ID_INT_SRC_ID_FLOAT) {
++      } else if ((set & PALMAS_USB_ID_INT_SRC_ID_FLOAT) &&
++                              (id_src & PALMAS_USB_ID_INT_SRC_ID_FLOAT)) {
+               palmas_write(palmas_usb->palmas, PALMAS_USB_OTG_BASE,
+                       PALMAS_USB_ID_INT_LATCH_CLR,
+                       PALMAS_USB_ID_INT_EN_HI_CLR_ID_FLOAT);
+@@ -103,6 +107,11 @@ static irqreturn_t palmas_id_irq_handler
+               palmas_usb->linkstat = PALMAS_USB_STATE_DISCONNECT;
+               extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", false);
+               dev_info(palmas_usb->dev, "USB-HOST cable is detached\n");
++      } else if ((palmas_usb->linkstat == PALMAS_USB_STATE_DISCONNECT) &&
++                              (id_src & PALMAS_USB_ID_INT_SRC_ID_GND)) {
++              palmas_usb->linkstat = PALMAS_USB_STATE_ID;
++              extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", true);
++              dev_info(palmas_usb->dev, " USB-HOST cable is attached\n");
+       }
+       return IRQ_HANDLED;
+@@ -268,6 +277,7 @@ static const struct dev_pm_ops palmas_pm
+ static struct of_device_id of_palmas_match_tbl[] = {
+       { .compatible = "ti,palmas-usb", },
++      { .compatible = "ti,palmas-usb-vid", },
+       { .compatible = "ti,twl6035-usb", },
+       { /* end */ }
+ };
+--- a/drivers/extcon/Kconfig
++++ b/drivers/extcon/Kconfig
+@@ -64,4 +64,9 @@ config EXTCON_PALMAS
+         Say Y here to enable support for USB peripheral and USB host
+         detection by palmas usb.
++config EXTCON_GPIO_USBVID
++      tristate "Generic USB VBUS/ID detection using GPIO EXTCON support"
++      help
++        Say Y here to enable support for USB VBUS/ID deetction by GPIO.
++
+ endif # MULTISTATE_SWITCH
+--- a/drivers/extcon/Makefile
++++ b/drivers/extcon/Makefile
+@@ -11,3 +11,4 @@ obj-$(CONFIG_EXTCON_MAX77693)        += extcon-
+ obj-$(CONFIG_EXTCON_MAX8997)  += extcon-max8997.o
+ obj-$(CONFIG_EXTCON_ARIZONA)  += extcon-arizona.o
+ obj-$(CONFIG_EXTCON_PALMAS)   += extcon-palmas.o
++obj-$(CONFIG_EXTCON_GPIO_USBVID)      += extcon-gpio-usbvid.o
+--- a/drivers/gpio/gpio-pcf857x.c
++++ b/drivers/gpio/gpio-pcf857x.c
+@@ -26,9 +26,10 @@
+ #include <linux/irqdomain.h>
+ #include <linux/kernel.h>
+ #include <linux/module.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
+ #include <linux/slab.h>
+ #include <linux/spinlock.h>
+-#include <linux/workqueue.h>
+ static const struct i2c_device_id pcf857x_id[] = {
+@@ -50,6 +51,27 @@ static const struct i2c_device_id pcf857
+ };
+ MODULE_DEVICE_TABLE(i2c, pcf857x_id);
++#ifdef CONFIG_OF
++static const struct of_device_id pcf857x_of_table[] = {
++      { .compatible = "nxp,pcf8574" },
++      { .compatible = "nxp,pcf8574a" },
++      { .compatible = "nxp,pca8574" },
++      { .compatible = "nxp,pca9670" },
++      { .compatible = "nxp,pca9672" },
++      { .compatible = "nxp,pca9674" },
++      { .compatible = "nxp,pcf8575" },
++      { .compatible = "nxp,pca8575" },
++      { .compatible = "nxp,pca9671" },
++      { .compatible = "nxp,pca9673" },
++      { .compatible = "nxp,pca9675" },
++      { .compatible = "maxim,max7328" },
++      { .compatible = "maxim,max7329" },
++      { .compatible = "ti,tca9554" },
++      { }
++};
++MODULE_DEVICE_TABLE(of, pcf857x_of_table);
++#endif
++
+ /*
+  * The pcf857x, pca857x, and pca967x chips only expose one read and one
+  * write register.  Writing a "one" bit (to match the reset state) lets
+@@ -66,12 +88,11 @@ struct pcf857x {
+       struct gpio_chip        chip;
+       struct i2c_client       *client;
+       struct mutex            lock;           /* protect 'out' */
+-      struct work_struct      work;           /* irq demux work */
+       struct irq_domain       *irq_domain;    /* for irq demux  */
+       spinlock_t              slock;          /* protect irq demux */
+       unsigned                out;            /* software latch */
+       unsigned                status;         /* current status */
+-      int                     irq;            /* real irq number */
++      unsigned                irq_mapped;     /* mapped gpio irqs */
+       int (*write)(struct i2c_client *client, unsigned data);
+       int (*read)(struct i2c_client *client);
+@@ -164,48 +185,54 @@ static void pcf857x_set(struct gpio_chip
+ static int pcf857x_to_irq(struct gpio_chip *chip, unsigned offset)
+ {
+       struct pcf857x *gpio = container_of(chip, struct pcf857x, chip);
++      int ret;
+-      return irq_create_mapping(gpio->irq_domain, offset);
++      ret = irq_create_mapping(gpio->irq_domain, offset);
++      if (ret > 0)
++              gpio->irq_mapped |= (1 << offset);
++
++      return ret;
+ }
+-static void pcf857x_irq_demux_work(struct work_struct *work)
++static irqreturn_t pcf857x_irq(int irq, void *data)
+ {
+-      struct pcf857x *gpio = container_of(work,
+-                                             struct pcf857x,
+-                                             work);
++      struct pcf857x  *gpio = data;
+       unsigned long change, i, status, flags;
+       status = gpio->read(gpio->client);
+       spin_lock_irqsave(&gpio->slock, flags);
+-      change = gpio->status ^ status;
++      /*
++       * call the interrupt handler iff gpio is used as
++       * interrupt source, just to avoid bad irqs
++       */
++
++      change = ((gpio->status ^ status) & gpio->irq_mapped);
+       for_each_set_bit(i, &change, gpio->chip.ngpio)
+               generic_handle_irq(irq_find_mapping(gpio->irq_domain, i));
+       gpio->status = status;
+       spin_unlock_irqrestore(&gpio->slock, flags);
+-}
+-
+-static irqreturn_t pcf857x_irq_demux(int irq, void *data)
+-{
+-      struct pcf857x  *gpio = data;
+-
+-      /*
+-       * pcf857x can't read/write data here,
+-       * since i2c data access might go to sleep.
+-       */
+-      schedule_work(&gpio->work);
+       return IRQ_HANDLED;
+ }
+-static int pcf857x_irq_domain_map(struct irq_domain *domain, unsigned int virq,
++static int pcf857x_irq_domain_map(struct irq_domain *domain, unsigned int irq,
+                                irq_hw_number_t hw)
+ {
+-      irq_set_chip_and_handler(virq,
++      struct pcf857x *gpio = domain->host_data;
++
++      irq_set_chip_and_handler(irq,
+                                &dummy_irq_chip,
+                                handle_level_irq);
++#ifdef CONFIG_ARM
++      set_irq_flags(irq, IRQF_VALID);
++#else
++      irq_set_noprobe(irq);
++#endif
++      gpio->irq_mapped |= (1 << hw);
++
+       return 0;
+ }
+@@ -218,8 +245,6 @@ static void pcf857x_irq_domain_cleanup(s
+       if (gpio->irq_domain)
+               irq_domain_remove(gpio->irq_domain);
+-      if (gpio->irq)
+-              free_irq(gpio->irq, gpio);
+ }
+ static int pcf857x_irq_domain_init(struct pcf857x *gpio,
+@@ -230,20 +255,21 @@ static int pcf857x_irq_domain_init(struc
+       gpio->irq_domain = irq_domain_add_linear(client->dev.of_node,
+                                                gpio->chip.ngpio,
+                                                &pcf857x_irq_domain_ops,
+-                                               NULL);
++                                               gpio);
+       if (!gpio->irq_domain)
+               goto fail;
+       /* enable real irq */
+-      status = request_irq(client->irq, pcf857x_irq_demux, 0,
+-                           dev_name(&client->dev), gpio);
++      status = devm_request_threaded_irq(&client->dev, client->irq,
++                              NULL, pcf857x_irq, IRQF_ONESHOT |
++                              IRQF_TRIGGER_FALLING,
++                              dev_name(&client->dev), gpio);
++
+       if (status)
+               goto fail;
+       /* enable gpio_to_irq() */
+-      INIT_WORK(&gpio->work, pcf857x_irq_demux_work);
+       gpio->chip.to_irq       = pcf857x_to_irq;
+-      gpio->irq               = client->irq;
+       return 0;
+@@ -257,14 +283,18 @@ fail:
+ static int pcf857x_probe(struct i2c_client *client,
+                        const struct i2c_device_id *id)
+ {
+-      struct pcf857x_platform_data    *pdata;
++      struct pcf857x_platform_data    *pdata = dev_get_platdata(&client->dev);
++      struct device_node              *np = client->dev.of_node;
+       struct pcf857x                  *gpio;
++      unsigned int                    n_latch = 0;
+       int                             status;
+-      pdata = dev_get_platdata(&client->dev);
+-      if (!pdata) {
++      if (IS_ENABLED(CONFIG_OF) && np)
++              of_property_read_u32(np, "lines-initial-states", &n_latch);
++      else if (pdata)
++              n_latch = pdata->n_latch;
++      else
+               dev_dbg(&client->dev, "no platform data\n");
+-      }
+       /* Allocate, initialize, and register this gpio_chip. */
+       gpio = devm_kzalloc(&client->dev, sizeof(*gpio), GFP_KERNEL);
+@@ -357,11 +387,11 @@ static int pcf857x_probe(struct i2c_clie
+        * may cause transient glitching since it can't know the last value
+        * written (some pins may need to be driven low).
+        *
+-       * Using pdata->n_latch avoids that trouble.  When left initialized
+-       * to zero, our software copy of the "latch" then matches the chip's
+-       * all-ones reset state.  Otherwise it flags pins to be driven low.
++       * Using n_latch avoids that trouble.  When left initialized to zero,
++       * our software copy of the "latch" then matches the chip's all-ones
++       * reset state.  Otherwise it flags pins to be driven low.
+        */
+-      gpio->out = pdata ? ~pdata->n_latch : ~0;
++      gpio->out = ~n_latch;
+       gpio->status = gpio->out;
+       status = gpiochip_add(&gpio->chip);
+@@ -423,6 +453,7 @@ static struct i2c_driver pcf857x_driver
+       .driver = {
+               .name   = "pcf857x",
+               .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(pcf857x_of_table),
+       },
+       .probe  = pcf857x_probe,
+       .remove = pcf857x_remove,
+--- a/drivers/gpu/drm/omapdrm/omap_crtc.c
++++ b/drivers/gpu/drm/omapdrm/omap_crtc.c
+@@ -411,7 +411,7 @@ static void omap_crtc_error_irq(struct o
+       struct drm_crtc *crtc = &omap_crtc->base;
+       DRM_ERROR("%s: errors: %08x\n", omap_crtc->name, irqstatus);
+       /* avoid getting in a flood, unregister the irq until next vblank */
+-      omap_irq_unregister(crtc->dev, &omap_crtc->error_irq);
++      __omap_irq_unregister(crtc->dev, &omap_crtc->error_irq);
+ }
+ static void omap_crtc_apply_irq(struct omap_drm_irq *irq, uint32_t irqstatus)
+@@ -421,13 +421,13 @@ static void omap_crtc_apply_irq(struct o
+       struct drm_crtc *crtc = &omap_crtc->base;
+       if (!omap_crtc->error_irq.registered)
+-              omap_irq_register(crtc->dev, &omap_crtc->error_irq);
++              __omap_irq_register(crtc->dev, &omap_crtc->error_irq);
+       if (!dispc_mgr_go_busy(omap_crtc->channel)) {
+               struct omap_drm_private *priv =
+                               crtc->dev->dev_private;
+               DBG("%s: apply done", omap_crtc->name);
+-              omap_irq_unregister(crtc->dev, &omap_crtc->apply_irq);
++              __omap_irq_unregister(crtc->dev, &omap_crtc->apply_irq);
+               queue_work(priv->wq, &omap_crtc->apply_work);
+       }
+ }
+@@ -623,6 +623,11 @@ void omap_crtc_pre_init(void)
+       dss_install_mgr_ops(&mgr_ops);
+ }
++void omap_crtc_pre_uninit(void)
++{
++      dss_uninstall_mgr_ops();
++}
++
+ /* initialize crtc */
+ struct drm_crtc *omap_crtc_init(struct drm_device *dev,
+               struct drm_plane *plane, enum omap_channel channel, int id)
+--- a/drivers/gpu/drm/omapdrm/omap_dmm_tiler.c
++++ b/drivers/gpu/drm/omapdrm/omap_dmm_tiler.c
+@@ -968,12 +968,23 @@ static const struct dev_pm_ops omap_dmm_
+ };
+ #endif
++#if defined(CONFIG_OF)
++static const struct of_device_id dmm_of_match[] = {
++      { .compatible = "ti,omap4-dmm", },
++      { .compatible = "ti,omap5-dmm", },
++      {},
++};
++#else
++#define dmm_of_match NULL
++#endif
++
+ struct platform_driver omap_dmm_driver = {
+       .probe = omap_dmm_probe,
+       .remove = omap_dmm_remove,
+       .driver = {
+               .owner = THIS_MODULE,
+               .name = DMM_DRIVER_NAME,
++              .of_match_table = dmm_of_match,
+ #ifdef CONFIG_PM
+               .pm = &omap_dmm_pm_ops,
+ #endif
+--- a/drivers/gpu/drm/omapdrm/omap_drv.c
++++ b/drivers/gpu/drm/omapdrm/omap_drv.c
+@@ -86,6 +86,47 @@ static bool channel_used(struct drm_devi
+       return false;
+ }
++static void omap_disconnect_dssdevs(void)
++{
++      struct omap_dss_device *dssdev = NULL;
++
++      for_each_dss_dev(dssdev)
++              dssdev->driver->disconnect(dssdev);
++}
++
++static int omap_connect_dssdevs(void)
++{
++      int r;
++      struct omap_dss_device *dssdev = NULL;
++      bool no_displays = true;
++
++      for_each_dss_dev(dssdev) {
++              r = dssdev->driver->connect(dssdev);
++              if (r == -EPROBE_DEFER) {
++                      omap_dss_put_device(dssdev);
++                      goto cleanup;
++              } else if (r) {
++                      dev_warn(dssdev->dev, "could not connect display: %s\n",
++                              dssdev->name);
++              } else {
++                      no_displays = false;
++              }
++      }
++
++      if (no_displays)
++              return -EPROBE_DEFER;
++
++      return 0;
++
++cleanup:
++      /*
++       * if we are deferring probe, we disconnect the devices we previously
++       * connected
++       */
++      omap_disconnect_dssdevs();
++
++      return r;
++}
+ static int omap_modeset_init(struct drm_device *dev)
+ {
+@@ -95,9 +136,6 @@ static int omap_modeset_init(struct drm_
+       int num_mgrs = dss_feat_get_num_mgrs();
+       int num_crtcs;
+       int i, id = 0;
+-      int r;
+-
+-      omap_crtc_pre_init();
+       drm_mode_config_init(dev);
+@@ -119,26 +157,8 @@ static int omap_modeset_init(struct drm_
+               enum omap_channel channel;
+               struct omap_overlay_manager *mgr;
+-              if (!dssdev->driver) {
+-                      dev_warn(dev->dev, "%s has no driver.. skipping it\n",
+-                                      dssdev->name);
+-                      continue;
+-              }
+-
+-              if (!(dssdev->driver->get_timings ||
+-                                      dssdev->driver->read_edid)) {
+-                      dev_warn(dev->dev, "%s driver does not support "
+-                              "get_timings or read_edid.. skipping it!\n",
+-                              dssdev->name);
+-                      continue;
+-              }
+-
+-              r = dssdev->driver->connect(dssdev);
+-              if (r) {
+-                      dev_err(dev->dev, "could not connect display: %s\n",
+-                                      dssdev->name);
++              if (!omapdss_device_is_connected(dssdev))
+                       continue;
+-              }
+               encoder = omap_encoder_init(dev, dssdev);
+@@ -656,9 +676,19 @@ static void pdev_shutdown(struct platfor
+ static int pdev_probe(struct platform_device *device)
+ {
++      int r;
++
+       if (omapdss_is_initialized() == false)
+               return -EPROBE_DEFER;
++      omap_crtc_pre_init();
++
++      r = omap_connect_dssdevs();
++      if (r) {
++              omap_crtc_pre_uninit();
++              return r;
++      }
++
+       DBG("%s", device->name);
+       return drm_platform_init(&omap_drm_driver, device);
+ }
+@@ -668,6 +698,8 @@ static int pdev_remove(struct platform_d
+       DBG("");
+       drm_platform_exit(&omap_drm_driver, device);
++      omap_disconnect_dssdevs();
++
+       platform_driver_unregister(&omap_dmm_driver);
+       return 0;
+ }
+--- a/drivers/gpu/drm/omapdrm/omap_drv.h
++++ b/drivers/gpu/drm/omapdrm/omap_drv.h
+@@ -145,6 +145,8 @@ irqreturn_t omap_irq_handler(DRM_IRQ_ARG
+ void omap_irq_preinstall(struct drm_device *dev);
+ int omap_irq_postinstall(struct drm_device *dev);
+ void omap_irq_uninstall(struct drm_device *dev);
++void __omap_irq_register(struct drm_device *dev, struct omap_drm_irq *irq);
++void __omap_irq_unregister(struct drm_device *dev, struct omap_drm_irq *irq);
+ void omap_irq_register(struct drm_device *dev, struct omap_drm_irq *irq);
+ void omap_irq_unregister(struct drm_device *dev, struct omap_drm_irq *irq);
+ int omap_drm_irq_uninstall(struct drm_device *dev);
+@@ -158,6 +160,7 @@ enum omap_channel omap_crtc_channel(stru
+ int omap_crtc_apply(struct drm_crtc *crtc,
+               struct omap_drm_apply *apply);
+ void omap_crtc_pre_init(void);
++void omap_crtc_pre_uninit(void);
+ struct drm_crtc *omap_crtc_init(struct drm_device *dev,
+               struct drm_plane *plane, enum omap_channel channel, int id);
+--- a/drivers/gpu/drm/omapdrm/omap_encoder.c
++++ b/drivers/gpu/drm/omapdrm/omap_encoder.c
+@@ -51,6 +51,10 @@ struct omap_dss_device *omap_encoder_get
+ static void omap_encoder_destroy(struct drm_encoder *encoder)
+ {
+       struct omap_encoder *omap_encoder = to_omap_encoder(encoder);
++      struct omap_dss_device *dssdev = omap_encoder->dssdev;
++
++      dssdev->driver->disable(dssdev);
++
+       drm_encoder_cleanup(encoder);
+       kfree(omap_encoder);
+ }
+--- a/drivers/gpu/drm/omapdrm/omap_irq.c
++++ b/drivers/gpu/drm/omapdrm/omap_irq.c
+@@ -45,12 +45,11 @@ static void omap_irq_update(struct drm_d
+       dispc_read_irqenable();        /* flush posted write */
+ }
+-void omap_irq_register(struct drm_device *dev, struct omap_drm_irq *irq)
++void __omap_irq_register(struct drm_device *dev, struct omap_drm_irq *irq)
+ {
+       struct omap_drm_private *priv = dev->dev_private;
+       unsigned long flags;
+-      dispc_runtime_get();
+       spin_lock_irqsave(&list_lock, flags);
+       if (!WARN_ON(irq->registered)) {
+@@ -60,14 +59,21 @@ void omap_irq_register(struct drm_device
+       }
+       spin_unlock_irqrestore(&list_lock, flags);
++}
++
++void omap_irq_register(struct drm_device *dev, struct omap_drm_irq *irq)
++{
++      dispc_runtime_get();
++
++      __omap_irq_register(dev, irq);
++
+       dispc_runtime_put();
+ }
+-void omap_irq_unregister(struct drm_device *dev, struct omap_drm_irq *irq)
++void __omap_irq_unregister(struct drm_device *dev, struct omap_drm_irq *irq)
+ {
+       unsigned long flags;
+-      dispc_runtime_get();
+       spin_lock_irqsave(&list_lock, flags);
+       if (!WARN_ON(!irq->registered)) {
+@@ -77,6 +83,14 @@ void omap_irq_unregister(struct drm_devi
+       }
+       spin_unlock_irqrestore(&list_lock, flags);
++}
++
++void omap_irq_unregister(struct drm_device *dev, struct omap_drm_irq *irq)
++{
++      dispc_runtime_get();
++
++      __omap_irq_unregister(dev, irq);
++
+       dispc_runtime_put();
+ }
+--- a/drivers/gpu/drm/omapdrm/omap_plane.c
++++ b/drivers/gpu/drm/omapdrm/omap_plane.c
+@@ -122,6 +122,7 @@ static void omap_plane_pre_apply(struct
+       enum omap_channel channel;
+       bool enabled = omap_plane->enabled && crtc;
+       bool ilace, replication;
++      u32 low, high;
+       int ret;
+       DBG("%s, enabled=%d", omap_plane->name, enabled);
+@@ -149,6 +150,10 @@ static void omap_plane_pre_apply(struct
+       ilace = false;
+       replication = false;
++      dispc_ovl_compute_fifo_thresholds(omap_plane->id, &low, &high,
++              false, false);
++      dispc_ovl_set_fifo_threshold(omap_plane->id, low, high);
++
+       /* and finally, update omapdss: */
+       ret = dispc_ovl_setup(omap_plane->id, info,
+                       replication, omap_crtc_timings(crtc), false);
+--- a/drivers/gpu/drm/tilcdc/tilcdc_drv.h
++++ b/drivers/gpu/drm/tilcdc/tilcdc_drv.h
+@@ -43,7 +43,7 @@
+  * with optimized DDR & EMIF settings tweaked 1920x1080@24 appears to
+  * be supportable
+  */
+-#define TILCDC_DEFAULT_MAX_BANDWIDTH  (1280*1024*60)
++#define TILCDC_DEFAULT_MAX_BANDWIDTH  (1680*1050*60)
+ struct tilcdc_drm_private {
+--- a/drivers/iio/adc/ti_am335x_adc.c
++++ b/drivers/iio/adc/ti_am335x_adc.c
+@@ -154,7 +154,7 @@ static int tiadc_read_raw(struct iio_dev
+       while (tiadc_readl(adc_dev, REG_ADCFSM) & SEQ_STATUS) {
+               if (time_after(jiffies, timeout))
+                       return -EAGAIN;
+-              }
++      }
+       map_val = chan->channel + TOTAL_CHANNELS;
+       /*
+--- a/drivers/input/touchscreen/atmel_mxt_ts.c
++++ b/drivers/input/touchscreen/atmel_mxt_ts.c
+@@ -20,6 +20,8 @@
+ #include <linux/input/mt.h>
+ #include <linux/interrupt.h>
+ #include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
+ /* Version */
+ #define MXT_VER_20            20
+@@ -335,6 +337,105 @@ static void mxt_dump_message(struct devi
+               message->reportid, 7, message->message);
+ }
++static int mxt_of_get_platform_info(struct i2c_client *client,
++                           struct mxt_platform_data *pdata)
++
++{
++      int size, index = 0;
++      u32 val;
++      const __be32 *config_be;
++      u8 *config;
++      const char *pname;
++      struct device_node *node = client->dev.of_node;
++
++      config_be = of_get_property(node, "atmel,config", &size);
++      if (config_be && size) {
++              size /= sizeof(*config_be);
++              config = devm_kzalloc(&client->dev, size, GFP_KERNEL);
++              if (!config) {
++                      dev_err(&client->dev, "Failed to allocate memory\n");
++                      return -ENOMEM;
++              }
++
++              pdata->config = config;
++              pdata->config_length = size;
++
++              while (index < size) {
++                      config[index] = be32_to_cpup(config_be + index) & 0xFF;
++                      index++;
++              }
++      } else {
++              dev_dbg(&client->dev, "%s:no config data specified\n",
++                      __func__);
++      }
++
++      pname = "atmel,x_line";
++      if (of_property_read_u32(node, pname, &pdata->x_line)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,y_line";
++      if (of_property_read_u32(node, pname, &pdata->y_line)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,x_size";
++      if (of_property_read_u32(node, pname, &pdata->x_size)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,y_size";
++      if (of_property_read_u32(node, pname, &pdata->y_size)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,blen";
++      if (of_property_read_u32(node, pname, &pdata->blen)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,threshold";
++      if (of_property_read_u32(node, pname, &pdata->threshold)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,voltage";
++      if (of_property_read_u32(node, pname, &pdata->voltage)) {
++              dev_err(&client->dev,
++                      "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      pname = "atmel,orient";
++      if (of_property_read_u32(node, pname, &val)) {
++              dev_err(&client->dev, "%s: Failed to read %s property\n",
++                      __func__, pname);
++              return -EINVAL;
++      }
++
++      if (val > 0xFF) {
++              dev_err(&client->dev, "%s: Bad %s property value %d\n",
++                      __func__, pname, val);
++              return -EINVAL;
++      }
++      pdata->orient = val & 0xFF;
++
++      return 0;
++}
++
+ static int mxt_check_bootloader(struct i2c_client *client,
+                                    unsigned int state)
+ {
+@@ -1127,19 +1228,43 @@ static void mxt_input_close(struct input
+       mxt_stop(data);
+ }
++static const struct of_device_id mxt_dt_ids[] = {
++      { .compatible = "atmel,qt602240_ts", },
++      { .compatible = "atmel,atmel_mxt_ts", },
++      { .compatible = "atmel,mXT244", },
++      { /* sentinel */ }
++};
++MODULE_DEVICE_TABLE(of, mxt_dt_ids);
++
+ static int mxt_probe(struct i2c_client *client,
+               const struct i2c_device_id *id)
+ {
+-      const struct mxt_platform_data *pdata = client->dev.platform_data;
++      struct mxt_platform_data *pdata;
+       struct mxt_data *data;
+       struct input_dev *input_dev;
+       int error;
+       unsigned int num_mt_slots;
++      const struct of_device_id *match;
+-      if (!pdata)
+-              return -EINVAL;
++      match = of_match_device(of_match_ptr(mxt_dt_ids), &client->dev);
++      if (match) {
++              pdata = devm_kzalloc(&client->dev,
++                                      sizeof(struct mxt_platform_data),
++                                      GFP_KERNEL);
++              if (!pdata)
++                      return -ENOMEM;
++              error = mxt_of_get_platform_info(client, pdata);
++              if (error)
++                      return error;
++      } else {
++              pdata = client->dev.platform_data;
++              if (!pdata) {
++                      dev_err(&client->dev, "Platform data not populated\n");
++                      return -EINVAL;
++              }
++      }
+-      data = kzalloc(sizeof(struct mxt_data), GFP_KERNEL);
++      data = devm_kzalloc(&client->dev, sizeof(struct mxt_data), GFP_KERNEL);
+       input_dev = input_allocate_device();
+       if (!data || !input_dev) {
+               dev_err(&client->dev, "Failed to allocate memory\n");
+@@ -1224,9 +1349,10 @@ static int mxt_probe(struct i2c_client *
+       input_set_drvdata(input_dev, data);
+       i2c_set_clientdata(client, data);
+-      error = request_threaded_irq(client->irq, NULL, mxt_interrupt,
+-                                   pdata->irqflags | IRQF_ONESHOT,
+-                                   client->name, data);
++      error = devm_request_threaded_irq(&client->dev, client->irq,
++                                        NULL, mxt_interrupt,
++                                        IRQF_ONESHOT,
++                                        dev_name(&client->dev), data);
+       if (error) {
+               dev_err(&client->dev, "Failed to register interrupt\n");
+               goto err_free_object;
+@@ -1234,11 +1360,11 @@ static int mxt_probe(struct i2c_client *
+       error = mxt_make_highchg(data);
+       if (error)
+-              goto err_free_irq;
++              goto err_free_object;
+       error = input_register_device(input_dev);
+       if (error)
+-              goto err_free_irq;
++              goto err_free_object;
+       error = sysfs_create_group(&client->dev.kobj, &mxt_attr_group);
+       if (error)
+@@ -1249,13 +1375,10 @@ static int mxt_probe(struct i2c_client *
+ err_unregister_device:
+       input_unregister_device(input_dev);
+       input_dev = NULL;
+-err_free_irq:
+-      free_irq(client->irq, data);
+ err_free_object:
+       kfree(data->object_table);
+ err_free_mem:
+       input_free_device(input_dev);
+-      kfree(data);
+       return error;
+ }
+@@ -1264,10 +1387,8 @@ static int mxt_remove(struct i2c_client
+       struct mxt_data *data = i2c_get_clientdata(client);
+       sysfs_remove_group(&client->dev.kobj, &mxt_attr_group);
+-      free_irq(data->irq, data);
+       input_unregister_device(data->input_dev);
+       kfree(data->object_table);
+-      kfree(data);
+       return 0;
+ }
+@@ -1328,6 +1449,7 @@ static struct i2c_driver mxt_driver = {
+               .name   = "atmel_mxt_ts",
+               .owner  = THIS_MODULE,
+               .pm     = &mxt_pm_ops,
++              .of_match_table = mxt_dt_ids,
+       },
+       .probe          = mxt_probe,
+       .remove         = mxt_remove,
+--- a/drivers/input/touchscreen/pixcir_i2c_ts.c
++++ b/drivers/input/touchscreen/pixcir_i2c_ts.c
+@@ -23,170 +23,490 @@
+ #include <linux/slab.h>
+ #include <linux/i2c.h>
+ #include <linux/input.h>
++#include <linux/input/mt.h>
+ #include <linux/input/pixcir_ts.h>
++#include <linux/gpio.h>
++#include <linux/of.h>
++#include <linux/of_gpio.h>
++#include <linux/of_device.h>
++
++#define MAX_FINGERS   5       /* Maximum supported by the driver */
+ struct pixcir_i2c_ts_data {
+       struct i2c_client *client;
+       struct input_dev *input;
+-      const struct pixcir_ts_platform_data *chip;
++      const struct pixcir_ts_platform_data *pdata;
+       bool exiting;
++      u8 max_fingers;         /* Maximum supported by the chip */
+ };
+-static void pixcir_ts_poscheck(struct pixcir_i2c_ts_data *data)
++static void pixcir_ts_typea_report(struct pixcir_i2c_ts_data *tsdata)
+ {
+-      struct pixcir_i2c_ts_data *tsdata = data;
++      const struct pixcir_ts_platform_data *pdata = tsdata->pdata;
+       u8 rdbuf[10], wrbuf[1] = { 0 };
+       u8 touch;
+       int ret;
+-      ret = i2c_master_send(tsdata->client, wrbuf, sizeof(wrbuf));
+-      if (ret != sizeof(wrbuf)) {
+-              dev_err(&tsdata->client->dev,
+-                      "%s: i2c_master_send failed(), ret=%d\n",
+-                      __func__, ret);
+-              return;
+-      }
+-
+-      ret = i2c_master_recv(tsdata->client, rdbuf, sizeof(rdbuf));
+-      if (ret != sizeof(rdbuf)) {
+-              dev_err(&tsdata->client->dev,
+-                      "%s: i2c_master_recv failed(), ret=%d\n",
+-                      __func__, ret);
+-              return;
+-      }
+-
+-      touch = rdbuf[0];
+-      if (touch) {
+-              u16 posx1 = (rdbuf[3] << 8) | rdbuf[2];
+-              u16 posy1 = (rdbuf[5] << 8) | rdbuf[4];
+-              u16 posx2 = (rdbuf[7] << 8) | rdbuf[6];
+-              u16 posy2 = (rdbuf[9] << 8) | rdbuf[8];
+-
+-              input_report_key(tsdata->input, BTN_TOUCH, 1);
+-              input_report_abs(tsdata->input, ABS_X, posx1);
+-              input_report_abs(tsdata->input, ABS_Y, posy1);
+-
+-              input_report_abs(tsdata->input, ABS_MT_POSITION_X, posx1);
+-              input_report_abs(tsdata->input, ABS_MT_POSITION_Y, posy1);
+-              input_mt_sync(tsdata->input);
+-
+-              if (touch == 2) {
+-                      input_report_abs(tsdata->input,
+-                                       ABS_MT_POSITION_X, posx2);
+-                      input_report_abs(tsdata->input,
+-                                       ABS_MT_POSITION_Y, posy2);
++      while (!tsdata->exiting) {
++
++              ret = i2c_master_send(tsdata->client, wrbuf, sizeof(wrbuf));
++              if (ret != sizeof(wrbuf)) {
++                      dev_err(&tsdata->client->dev,
++                               "%s: i2c_master_send failed(), ret=%d\n",
++                               __func__, ret);
++                      return;
++              }
++
++              ret = i2c_master_recv(tsdata->client, rdbuf, sizeof(rdbuf));
++              if (ret != sizeof(rdbuf)) {
++                      dev_err(&tsdata->client->dev,
++                               "%s: i2c_master_recv failed(), ret=%d\n",
++                               __func__, ret);
++                      return;
++              }
++
++              touch = rdbuf[0];
++              if (touch) {
++                      u16 posx1 = (rdbuf[3] << 8) | rdbuf[2];
++                      u16 posy1 = (rdbuf[5] << 8) | rdbuf[4];
++                      u16 posx2 = (rdbuf[7] << 8) | rdbuf[6];
++                      u16 posy2 = (rdbuf[9] << 8) | rdbuf[8];
++
++                      input_report_key(tsdata->input, BTN_TOUCH, 1);
++                      input_report_abs(tsdata->input, ABS_X, posx1);
++                      input_report_abs(tsdata->input, ABS_Y, posy1);
++
++                      input_report_abs(tsdata->input, ABS_MT_POSITION_X,
++                                                                      posx1);
++                      input_report_abs(tsdata->input, ABS_MT_POSITION_Y,
++                                                                      posy1);
+                       input_mt_sync(tsdata->input);
++
++                      if (touch == 2) {
++                              input_report_abs(tsdata->input,
++                                              ABS_MT_POSITION_X, posx2);
++                              input_report_abs(tsdata->input,
++                                              ABS_MT_POSITION_Y, posy2);
++                              input_mt_sync(tsdata->input);
++                      }
++              } else {
++                      input_report_key(tsdata->input, BTN_TOUCH, 0);
+               }
+-      } else {
+-              input_report_key(tsdata->input, BTN_TOUCH, 0);
++
++              input_sync(tsdata->input);
++
++              if (gpio_get_value(pdata->gpio_attb))
++                      break;
++
++              msleep(20);
+       }
++}
++
++static void pixcir_ts_typeb_report(struct pixcir_i2c_ts_data *ts)
++{
++      const struct pixcir_ts_platform_data *pdata = ts->pdata;
++      struct device *dev = &ts->client->dev;
++      u8 rdbuf[32], wrbuf[1] = { 0 };
++      u8 *bufptr;
++      u8 num_fingers;
++      u8 unreliable;
++      int ret, i;
++
++      while (!ts->exiting) {
++
++              ret = i2c_master_send(ts->client, wrbuf, sizeof(wrbuf));
++              if (ret != sizeof(wrbuf)) {
++                      dev_err(dev, "%s: i2c_master_send failed(), ret=%d\n",
++                               __func__, ret);
++                      return;
++              }
++
++              ret = i2c_master_recv(ts->client, rdbuf, sizeof(rdbuf));
++              if (ret != sizeof(rdbuf)) {
++                      dev_err(dev, "%s: i2c_master_recv failed(), ret=%d\n",
++                               __func__, ret);
++                      return;
++              }
+-      input_sync(tsdata->input);
++              unreliable = rdbuf[0] & 0xe0;
++
++              if (unreliable)
++                      goto next;      /* ignore unreliable data */
++
++              num_fingers = rdbuf[0] & 0x7;
++              bufptr = &rdbuf[2];
++
++              if (num_fingers > ts->max_fingers) {
++                      num_fingers = ts->max_fingers;
++                      dev_dbg(dev, "limiting num_fingers to %d\n",
++                                                              num_fingers);
++              }
++
++              for (i = 0; i < num_fingers; i++) {
++                      u8 id;
++                      unsigned int x, y;
++                      int slot;
++
++                      id = bufptr[4];
++                      slot = input_mt_get_slot_by_key(ts->input, id);
++                      if (slot < 0) {
++                              dev_dbg(dev, "no free slot for id 0x%x\n", id);
++                              continue;
++                      }
++
++
++                      x = bufptr[1] << 8 | bufptr[0];
++                      y = bufptr[3] << 8 | bufptr[2];
++
++                      input_mt_slot(ts->input, slot);
++                      input_mt_report_slot_state(ts->input,
++                                                      MT_TOOL_FINGER, true);
++
++                      input_event(ts->input, EV_ABS, ABS_MT_POSITION_X, x);
++                      input_event(ts->input, EV_ABS, ABS_MT_POSITION_Y, y);
++
++                      bufptr = &bufptr[5];
++                      dev_dbg(dev, "%d: id 0x%x slot %d, x %d, y %d\n",
++                                                      i, id, slot, x, y);
++              }
++
++              /* One frame is complete so sync it */
++              input_mt_sync_frame(ts->input);
++              input_sync(ts->input);
++
++next:
++              if (gpio_get_value(pdata->gpio_attb))
++                      break;
++
++              usleep_range(2000, 5000);
++      }
+ }
+ static irqreturn_t pixcir_ts_isr(int irq, void *dev_id)
+ {
+       struct pixcir_i2c_ts_data *tsdata = dev_id;
+-      while (!tsdata->exiting) {
+-              pixcir_ts_poscheck(tsdata);
++      if (tsdata->input->mt)
++              pixcir_ts_typeb_report(tsdata);
++      else
++              pixcir_ts_typea_report(tsdata);
+-              if (tsdata->chip->attb_read_val())
+-                      break;
++      return IRQ_HANDLED;
++}
+-              msleep(20);
++static int pixcir_set_power_mode(struct pixcir_i2c_ts_data *ts,
++                                              enum pixcir_power_mode mode)
++{
++      struct device *dev = &ts->client->dev;
++      int ret;
++
++      ret = i2c_smbus_read_byte_data(ts->client, PIXCIR_REG_POWER_MODE);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't read reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_POWER_MODE, ret);
++              return ret;
+       }
+-      return IRQ_HANDLED;
++      ret &= ~PIXCIR_POWER_MODE_MASK;
++      ret |= mode;
++
++      /* Always AUTO_IDLE */
++      ret |= PIXCIR_POWER_ALLOW_IDLE;
++
++      ret = i2c_smbus_write_byte_data(ts->client, PIXCIR_REG_POWER_MODE, ret);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't write reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_POWER_MODE, ret);
++              return ret;
++      }
++
++      return 0;
+ }
+-#ifdef CONFIG_PM_SLEEP
+-static int pixcir_i2c_ts_suspend(struct device *dev)
++/*
++ * Set the interrupt mode for the device i.e. ATTB line behaviour
++ *
++ * @polarity : 1 for active high, 0 for active low.
++ */
++static int pixcir_set_int_mode(struct pixcir_i2c_ts_data *ts,
++                                              enum pixcir_int_mode mode,
++                                      bool polarity)
+ {
+-      struct i2c_client *client = to_i2c_client(dev);
++      struct device *dev = &ts->client->dev;
++      int ret;
+-      if (device_may_wakeup(&client->dev))
+-              enable_irq_wake(client->irq);
++      ret = i2c_smbus_read_byte_data(ts->client, PIXCIR_REG_INT_MODE);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't read reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_INT_MODE, ret);
++              return ret;
++      }
++
++      ret &= ~PIXCIR_INT_MODE_MASK;
++      ret |= mode;
++
++      if (polarity)
++              ret |= PIXCIR_INT_POL_HIGH;
++      else
++              ret &= ~PIXCIR_INT_POL_HIGH;
++
++      ret = i2c_smbus_write_byte_data(ts->client, PIXCIR_REG_INT_MODE, ret);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't write reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_INT_MODE, ret);
++              return ret;
++      }
+       return 0;
+ }
+-static int pixcir_i2c_ts_resume(struct device *dev)
++/*
++ * Enable/disable interrupt generation
++ */
++static int pixcir_int_enable(struct pixcir_i2c_ts_data *ts, bool enable)
+ {
+-      struct i2c_client *client = to_i2c_client(dev);
++      struct device *dev = &ts->client->dev;
++      int ret;
+-      if (device_may_wakeup(&client->dev))
+-              disable_irq_wake(client->irq);
++      ret = i2c_smbus_read_byte_data(ts->client, PIXCIR_REG_INT_MODE);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't read reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_INT_MODE, ret);
++              return ret;
++      }
++
++      if (enable)
++              ret |= PIXCIR_INT_ENABLE;
++      else
++              ret &= ~PIXCIR_INT_ENABLE;
++
++      ret = i2c_smbus_write_byte_data(ts->client, PIXCIR_REG_INT_MODE, ret);
++      if (ret < 0) {
++              dev_err(dev, "%s: can't write reg 0x%x : %d\n",
++                                      __func__, PIXCIR_REG_INT_MODE, ret);
++              return ret;
++      }
+       return 0;
+ }
+-#endif
+-static SIMPLE_DEV_PM_OPS(pixcir_dev_pm_ops,
+-                       pixcir_i2c_ts_suspend, pixcir_i2c_ts_resume);
++static int pixcir_start(struct pixcir_i2c_ts_data *ts)
++{
++      struct device *dev = &ts->client->dev;
++      int ret;
++
++      /* LEVEL_TOUCH interrupt with active low polarity */
++      ret = pixcir_set_int_mode(ts, PIXCIR_INT_LEVEL_TOUCH, 0);
++      if (ret) {
++              dev_err(dev, "Failed to set interrupt mode\n");
++              return ret;
++      }
++
++      enable_irq(ts->client->irq);
++
++      /* enable interrupt generation */
++      ret = pixcir_int_enable(ts, 1);
++      if (ret) {
++              dev_err(dev, "Failed to enable interrupt generation\n");
++              return ret;
++      }
++
++      return 0;
++}
++
++static int pixcir_stop(struct pixcir_i2c_ts_data *ts)
++{
++      struct device *dev = &ts->client->dev;
++      int ret;
++
++      /* disable interrupt generation */
++      ret = pixcir_int_enable(ts, 0);
++      if (ret) {
++              dev_err(dev, "Failed to disable interrupt generation\n");
++              return ret;
++      }
++
++      disable_irq(ts->client->irq);
++
++      return 0;
++}
++
++static int pixcir_input_open(struct input_dev *dev)
++{
++      struct pixcir_i2c_ts_data *ts = input_get_drvdata(dev);
++
++      return pixcir_start(ts);
++}
++
++static void pixcir_input_close(struct input_dev *dev)
++{
++      struct pixcir_i2c_ts_data *ts = input_get_drvdata(dev);
++
++      pixcir_stop(ts);
++
++      return;
++}
++
++#if defined(CONFIG_OF)
++static const struct of_device_id pixcir_of_match[];
++
++static struct pixcir_ts_platform_data *pixcir_parse_dt(struct device *dev)
++{
++      struct pixcir_ts_platform_data *pdata;
++      struct device_node *np = dev->of_node;
++      const struct of_device_id *match;
++
++      match = of_match_device(of_match_ptr(pixcir_of_match), dev);
++      if (!match)
++              return ERR_PTR(-EINVAL);
++
++      pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
++      if (!pdata)
++              return ERR_PTR(-ENOMEM);
++
++      pdata->chip = *(const struct pixcir_i2c_chip_data *)match->data;
++
++      pdata->gpio_attb = of_get_named_gpio(np, "attb-gpio", 0);
++      if (!gpio_is_valid(pdata->gpio_attb)) {
++              dev_err(dev, "Failed to get ATTB GPIO\n");
++              return ERR_PTR(-EINVAL);
++      }
++
++      if (of_property_read_u32(np, "x-size", &pdata->x_size)) {
++              dev_err(dev, "Failed to get x-size property\n");
++              return ERR_PTR(-EINVAL);
++      }
++
++      if (of_property_read_u32(np, "y-size", &pdata->y_size)) {
++              dev_err(dev, "Failed to get y-size property\n");
++              return ERR_PTR(-EINVAL);
++      }
++
++      dev_dbg(dev, "%s: x %d, y %d, gpio %d\n", __func__,
++                              pdata->x_size, pdata->y_size, pdata->gpio_attb);
++
++      return pdata;
++}
++#else
++static struct pixcir_ts_platform_data *pixcir_parse_dt(struct device *dev)
++{
++      return NULL;
++}
++#endif
+ static int pixcir_i2c_ts_probe(struct i2c_client *client,
+                                        const struct i2c_device_id *id)
+ {
+       const struct pixcir_ts_platform_data *pdata = client->dev.platform_data;
++      struct device *dev = &client->dev;
++      struct device_node *np = dev->of_node;
+       struct pixcir_i2c_ts_data *tsdata;
+       struct input_dev *input;
+       int error;
+-      if (!pdata) {
++      if (np) {
++              pdata = pixcir_parse_dt(dev);
++              if (IS_ERR(pdata))
++                      return PTR_ERR(pdata);
++
++      } else if (!pdata) {
+               dev_err(&client->dev, "platform data not defined\n");
+               return -EINVAL;
++      } else {
++              if (!gpio_is_valid(pdata->gpio_attb)) {
++                      dev_err(dev, "Invalid gpio_attb in pdata\n");
++                      return -EINVAL;
++              }
+       }
+-      tsdata = kzalloc(sizeof(*tsdata), GFP_KERNEL);
+-      input = input_allocate_device();
+-      if (!tsdata || !input) {
+-              dev_err(&client->dev, "Failed to allocate driver data!\n");
+-              error = -ENOMEM;
+-              goto err_free_mem;
++      tsdata = devm_kzalloc(dev, sizeof(*tsdata), GFP_KERNEL);
++      if (!tsdata)
++              return -ENOMEM;
++
++      input = devm_input_allocate_device(dev);
++      if (!input) {
++              dev_err(&client->dev, "Failed to allocate input device\n");
++              return -ENOMEM;
+       }
+       tsdata->client = client;
+       tsdata->input = input;
+-      tsdata->chip = pdata;
++      tsdata->pdata = pdata;
+       input->name = client->name;
+       input->id.bustype = BUS_I2C;
+       input->dev.parent = &client->dev;
++      input->open = pixcir_input_open;
++      input->close = pixcir_input_close;
+-      __set_bit(EV_KEY, input->evbit);
+       __set_bit(EV_ABS, input->evbit);
+       __set_bit(BTN_TOUCH, input->keybit);
+-      input_set_abs_params(input, ABS_X, 0, pdata->x_max, 0, 0);
+-      input_set_abs_params(input, ABS_Y, 0, pdata->y_max, 0, 0);
+-      input_set_abs_params(input, ABS_MT_POSITION_X, 0, pdata->x_max, 0, 0);
+-      input_set_abs_params(input, ABS_MT_POSITION_Y, 0, pdata->y_max, 0, 0);
++
++      input_set_abs_params(input, ABS_X,
++                                      0, pdata->x_size - 1, 0, 0);
++      input_set_abs_params(input, ABS_Y,
++                                      0, pdata->y_size - 1, 0, 0);
++      input_set_abs_params(input, ABS_MT_POSITION_X,
++                                      0, pdata->x_size - 1, 0, 0);
++      input_set_abs_params(input, ABS_MT_POSITION_Y,
++                                      0, pdata->y_size - 1, 0, 0);
++
++      /* Type-B Multi-Touch support */
++      if (pdata->chip.num_report_ids) {
++              const struct pixcir_i2c_chip_data *chip = &pdata->chip;
++
++              tsdata->max_fingers = chip->num_report_ids;
++              if (tsdata->max_fingers > MAX_FINGERS) {
++                      dev_info(dev, "Limiting maximum fingers to %d\n",
++                                                              MAX_FINGERS);
++                      tsdata->max_fingers = MAX_FINGERS;
++              }
++
++              error = input_mt_init_slots(input, tsdata->max_fingers,
++                                      INPUT_MT_DIRECT | INPUT_MT_DROP_UNUSED);
++              if (error) {
++                      dev_err(dev, "Error initializing Multi-Touch slots\n");
++                      return error;
++              }
++      }
+       input_set_drvdata(input, tsdata);
+-      error = request_threaded_irq(client->irq, NULL, pixcir_ts_isr,
++      error = devm_gpio_request_one(dev, pdata->gpio_attb,
++                      GPIOF_DIR_IN, "pixcir_i2c_attb");
++      if (error) {
++              dev_err(dev, "Failed to request ATTB gpio\n");
++              return error;
++      }
++
++      error = devm_request_threaded_irq(dev, client->irq, NULL, pixcir_ts_isr,
+                                    IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
+                                    client->name, tsdata);
+       if (error) {
+-              dev_err(&client->dev, "Unable to request touchscreen IRQ.\n");
+-              goto err_free_mem;
++              dev_err(dev, "failed to request irq %d\n", client->irq);
++              return error;
+       }
++      /* Always be in IDLE mode to save power, device supports auto wake */
++      error = pixcir_set_power_mode(tsdata, PIXCIR_POWER_IDLE);
++      if (error) {
++              dev_err(dev, "Failed to set IDLE mode\n");
++              return error;
++      }
++
++      /* Stop device till opened */
++      error = pixcir_stop(tsdata);
++      if (error)
++              return error;
++
+       error = input_register_device(input);
+       if (error)
+-              goto err_free_irq;
++              return error;
+       i2c_set_clientdata(client, tsdata);
+       device_init_wakeup(&client->dev, 1);
+       return 0;
+-
+-err_free_irq:
+-      free_irq(client->irq, tsdata);
+-err_free_mem:
+-      input_free_device(input);
+-      kfree(tsdata);
+-      return error;
+ }
+ static int pixcir_i2c_ts_remove(struct i2c_client *client)
+@@ -197,25 +517,99 @@ static int pixcir_i2c_ts_remove(struct i
+       tsdata->exiting = true;
+       mb();
+-      free_irq(client->irq, tsdata);
+-
+-      input_unregister_device(tsdata->input);
+-      kfree(tsdata);
+       return 0;
+ }
++#ifdef CONFIG_PM_SLEEP
++static int pixcir_i2c_ts_suspend(struct device *dev)
++{
++      struct i2c_client *client = to_i2c_client(dev);
++      struct pixcir_i2c_ts_data *ts = i2c_get_clientdata(client);
++      struct input_dev *input = ts->input;
++      int ret = 0;
++
++      mutex_lock(&input->mutex);
++
++      if (device_may_wakeup(&client->dev)) {
++              /* need to start device if not open, to be wakeup source */
++              if (!input->users) {
++                      ret = pixcir_start(ts);
++                      if (ret)
++                              goto unlock;
++              }
++
++              enable_irq_wake(client->irq);
++
++      } else if (input->users) {
++              ret = pixcir_stop(ts);
++      }
++
++unlock:
++      mutex_unlock(&input->mutex);
++
++      return ret;
++}
++
++static int pixcir_i2c_ts_resume(struct device *dev)
++{
++      struct i2c_client *client = to_i2c_client(dev);
++      struct pixcir_i2c_ts_data *ts = i2c_get_clientdata(client);
++      struct input_dev *input = ts->input;
++      int ret = 0;
++
++      mutex_lock(&input->mutex);
++
++      if (device_may_wakeup(&client->dev)) {
++              disable_irq_wake(client->irq);
++
++              /* need to stop device if it was not open on suspend */
++              if (!input->users) {
++                      ret = pixcir_stop(ts);
++                      if (ret)
++                              goto unlock;
++              }
++
++      } else if (input->users) {
++              ret = pixcir_start(ts);
++      }
++
++unlock:
++      mutex_unlock(&input->mutex);
++
++      return ret;
++}
++#endif
++
++static SIMPLE_DEV_PM_OPS(pixcir_dev_pm_ops,
++                              pixcir_i2c_ts_suspend, pixcir_i2c_ts_resume);
++
+ static const struct i2c_device_id pixcir_i2c_ts_id[] = {
+       { "pixcir_ts", 0 },
++      { "pixcir_tangoc", 0},
+       { }
+ };
+ MODULE_DEVICE_TABLE(i2c, pixcir_i2c_ts_id);
++#if defined(CONFIG_OF)
++static const struct pixcir_i2c_chip_data tangoc_data = {
++      .num_report_ids = 5,
++};
++
++static const struct of_device_id pixcir_of_match[] = {
++      { .compatible = "pixcir,pixcir_ts", },
++      { .compatible = "pixcir,pixcir_tangoc", .data = &tangoc_data, },
++      { }
++};
++MODULE_DEVICE_TABLE(of, pixcir_of_match);
++#endif
++
+ static struct i2c_driver pixcir_i2c_ts_driver = {
+       .driver = {
+               .owner  = THIS_MODULE,
+               .name   = "pixcir_ts",
+               .pm     = &pixcir_dev_pm_ops,
++              .of_match_table = of_match_ptr(pixcir_of_match),
+       },
+       .probe          = pixcir_i2c_ts_probe,
+       .remove         = pixcir_i2c_ts_remove,
+--- a/drivers/input/touchscreen/ti_am335x_tsc.c
++++ b/drivers/input/touchscreen/ti_am335x_tsc.c
+@@ -348,9 +348,16 @@ static int titsc_parse_dt(struct platfor
+       if (err < 0)
+               return err;
+-      err = of_property_read_u32(node, "ti,coordiante-readouts",
++      /*
++       * try with new binding first. If it fails, still try with
++       * bogus, miss-spelled version.
++       */
++      err = of_property_read_u32(node, "ti,coordinate-readouts",
+                       &ts_dev->coordinate_readouts);
+       if (err < 0)
++              err = of_property_read_u32(node, "ti,coordiante-readouts",
++                              &ts_dev->coordinate_readouts);
++      if (err < 0)
+               return err;
+       return of_property_read_u32_array(node, "ti,wire-config",
+--- a/drivers/Kconfig
++++ b/drivers/Kconfig
+@@ -166,4 +166,6 @@ source "drivers/reset/Kconfig"
+ source "drivers/fmc/Kconfig"
++source "drivers/phy/Kconfig"
++
+ endmenu
+--- a/drivers/mailbox/mailbox-omap1.c
++++ b/drivers/mailbox/mailbox-omap1.c
+@@ -13,6 +13,7 @@
+ #include <linux/interrupt.h>
+ #include <linux/platform_device.h>
+ #include <linux/io.h>
++#include <linux/delay.h>
+ #include "omap-mbox.h"
+@@ -26,7 +27,7 @@
+ #define MAILBOX_DSP2ARM1_Flag         0x1c
+ #define MAILBOX_DSP2ARM2_Flag         0x20
+-static void __iomem *mbox_base;
++static struct omap_mbox_device omap1_mbox_device;
+ struct omap_mbox1_fifo {
+       unsigned long cmd;
+@@ -37,16 +38,17 @@ struct omap_mbox1_fifo {
+ struct omap_mbox1_priv {
+       struct omap_mbox1_fifo tx_fifo;
+       struct omap_mbox1_fifo rx_fifo;
++      bool empty_flag;
+ };
+ static inline int mbox_read_reg(size_t ofs)
+ {
+-      return __raw_readw(mbox_base + ofs);
++      return __raw_readw(omap1_mbox_device.mbox_base + ofs);
+ }
+ static inline void mbox_write_reg(u32 val, size_t ofs)
+ {
+-      __raw_writew(val, mbox_base + ofs);
++      __raw_writew(val, omap1_mbox_device.mbox_base + ofs);
+ }
+ /* msg */
+@@ -59,6 +61,7 @@ static mbox_msg_t omap1_mbox_fifo_read(s
+       msg = mbox_read_reg(fifo->data);
+       msg |= ((mbox_msg_t) mbox_read_reg(fifo->cmd)) << 16;
++      (struct omap_mbox1_priv *)(mbox->priv)->empty_flag = false;
+       return msg;
+ }
+@@ -74,7 +77,9 @@ omap1_mbox_fifo_write(struct omap_mbox *
+ static int omap1_mbox_fifo_empty(struct omap_mbox *mbox)
+ {
+-      return 0;
++      struct omap_mbox1_priv *priv = (struct omap_mbox1_priv *)mbox->priv;
++
++      return priv->empty_flag ? 0 : 1;
+ }
+ static int omap1_mbox_fifo_full(struct omap_mbox *mbox)
+@@ -85,6 +90,18 @@ static int omap1_mbox_fifo_full(struct o
+       return mbox_read_reg(fifo->flag);
+ }
++static int omap1_mbox_poll_for_space(struct omap_mbox *mbox)
++{
++      int i = 1000;
++
++      while (omap1_mbox_fifo_full(mbox)) {
++              if (--i == 0)
++                      return -1;
++              udelay(1);
++      }
++      return 0;
++}
++
+ /* irq */
+ static void
+ omap1_mbox_enable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+@@ -103,17 +120,21 @@ omap1_mbox_disable_irq(struct omap_mbox
+ static int
+ omap1_mbox_is_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+ {
++      struct omap_mbox1_priv *priv = (struct omap_mbox1_priv *)mbox->priv;
++
+       if (irq == IRQ_TX)
+               return 0;
++      if (irq == IRQ_RX)
++              priv->empty_flag = true;
++
+       return 1;
+ }
+ static struct omap_mbox_ops omap1_mbox_ops = {
+-      .type           = OMAP_MBOX_TYPE1,
+       .fifo_read      = omap1_mbox_fifo_read,
+       .fifo_write     = omap1_mbox_fifo_write,
+       .fifo_empty     = omap1_mbox_fifo_empty,
+-      .fifo_full      = omap1_mbox_fifo_full,
++      .poll_for_space = omap1_mbox_poll_for_space,
+       .enable_irq     = omap1_mbox_enable_irq,
+       .disable_irq    = omap1_mbox_disable_irq,
+       .is_irq         = omap1_mbox_is_irq,
+@@ -139,6 +160,7 @@ static struct omap_mbox mbox_dsp_info =
+       .name   = "dsp",
+       .ops    = &omap1_mbox_ops,
+       .priv   = &omap1_mbox_dsp_priv,
++      .parent = &omap1_mbox_device,
+ };
+ static struct omap_mbox *omap1_mboxes[] = { &mbox_dsp_info, NULL };
+@@ -148,6 +170,7 @@ static int omap1_mbox_probe(struct platf
+       struct resource *mem;
+       int ret;
+       struct omap_mbox **list;
++      struct omap_mbox_device *mdev = &omap1_mbox_device;
+       list = omap1_mboxes;
+       list[0]->irq = platform_get_irq_byname(pdev, "dsp");
+@@ -156,13 +179,18 @@ static int omap1_mbox_probe(struct platf
+       if (!mem)
+               return -ENOENT;
+-      mbox_base = ioremap(mem->start, resource_size(mem));
+-      if (!mbox_base)
++      mdev->mbox_base = ioremap(mem->start, resource_size(mem));
++      if (!mdev->mbox_base)
+               return -ENOMEM;
++      mutex_init(&mdev->cfg_lock);
++      mdev->dev = &pdev->dev;
++      mdev->mboxes = omap1_mboxes;
++      mdev->num_users = 2;
++      mdev->num_fifos = 4;
+-      ret = omap_mbox_register(&pdev->dev, list);
++      ret = omap_mbox_register(mdev);
+       if (ret) {
+-              iounmap(mbox_base);
++              iounmap(mdev->mbox_base);
+               return ret;
+       }
+@@ -171,8 +199,14 @@ static int omap1_mbox_probe(struct platf
+ static int omap1_mbox_remove(struct platform_device *pdev)
+ {
+-      omap_mbox_unregister();
+-      iounmap(mbox_base);
++      struct omap_mbox_device *mdev = &omap1_mbox_device;
++
++      omap_mbox_unregister(mdev);
++      iounmap(mdev->mbox_base);
++      mdev->mbox_base = NULL;
++      mdev->mboxes = NULL;
++      mdev->dev = NULL;
++
+       return 0;
+ }
+--- a/drivers/mailbox/mailbox-omap2.c
++++ b/drivers/mailbox/mailbox-omap2.c
+@@ -14,6 +14,7 @@
+ #include <linux/slab.h>
+ #include <linux/clk.h>
+ #include <linux/err.h>
++#include <linux/of_device.h>
+ #include <linux/platform_device.h>
+ #include <linux/io.h>
+ #include <linux/pm_runtime.h>
+@@ -35,6 +36,8 @@
+ #define MAILBOX_IRQ_NEWMSG(m)         (1 << (2 * (m)))
+ #define MAILBOX_IRQ_NOTFULL(m)                (1 << (2 * (m) + 1))
++#define AM33X_MBOX_WKUPM3_USR         3
++
+ #define MBOX_REG_SIZE                 0x120
+ #define OMAP4_MBOX_REG_SIZE           0x130
+@@ -42,8 +45,6 @@
+ #define MBOX_NR_REGS                  (MBOX_REG_SIZE / sizeof(u32))
+ #define OMAP4_MBOX_NR_REGS            (OMAP4_MBOX_REG_SIZE / sizeof(u32))
+-static void __iomem *mbox_base;
+-
+ struct omap_mbox2_fifo {
+       unsigned long msg;
+       unsigned long fifo_stat;
+@@ -62,34 +63,38 @@ struct omap_mbox2_priv {
+       u32 intr_type;
+ };
+-static inline unsigned int mbox_read_reg(size_t ofs)
++static inline
++unsigned int mbox_read_reg(struct omap_mbox_device *mdev, size_t ofs)
+ {
+-      return __raw_readl(mbox_base + ofs);
++      return __raw_readl(mdev->mbox_base + ofs);
+ }
+-static inline void mbox_write_reg(u32 val, size_t ofs)
++static inline
++void mbox_write_reg(struct omap_mbox_device *mdev, u32 val, size_t ofs)
+ {
+-      __raw_writel(val, mbox_base + ofs);
++      __raw_writel(val, mdev->mbox_base + ofs);
+ }
+ /* Mailbox H/W preparations */
+ static int omap2_mbox_startup(struct omap_mbox *mbox)
+ {
+-      u32 l;
+-
+-      pm_runtime_enable(mbox->dev->parent);
+-      pm_runtime_get_sync(mbox->dev->parent);
++      pm_runtime_get_sync(mbox->parent->dev);
+-      l = mbox_read_reg(MAILBOX_REVISION);
+-      pr_debug("omap mailbox rev %d.%d\n", (l & 0xf0) >> 4, (l & 0x0f));
++      /*
++       * just print the raw revision register, the format is not
++       * uniform across all SoCs
++       */
++      if (!mbox->use_count) {
++              u32 l = mbox_read_reg(mbox->parent, MAILBOX_REVISION);
++              pr_debug("omap mailbox rev 0x%x\n", l);
++      }
+       return 0;
+ }
+ static void omap2_mbox_shutdown(struct omap_mbox *mbox)
+ {
+-      pm_runtime_put_sync(mbox->dev->parent);
+-      pm_runtime_disable(mbox->dev->parent);
++      pm_runtime_put_sync(mbox->parent->dev);
+ }
+ /* Mailbox FIFO handle functions */
+@@ -97,28 +102,36 @@ static mbox_msg_t omap2_mbox_fifo_read(s
+ {
+       struct omap_mbox2_fifo *fifo =
+               &((struct omap_mbox2_priv *)mbox->priv)->rx_fifo;
+-      return (mbox_msg_t) mbox_read_reg(fifo->msg);
++      return (mbox_msg_t) mbox_read_reg(mbox->parent, fifo->msg);
+ }
+ static void omap2_mbox_fifo_write(struct omap_mbox *mbox, mbox_msg_t msg)
+ {
+       struct omap_mbox2_fifo *fifo =
+               &((struct omap_mbox2_priv *)mbox->priv)->tx_fifo;
+-      mbox_write_reg(msg, fifo->msg);
++      mbox_write_reg(mbox->parent, msg, fifo->msg);
+ }
+ static int omap2_mbox_fifo_empty(struct omap_mbox *mbox)
+ {
+       struct omap_mbox2_fifo *fifo =
+               &((struct omap_mbox2_priv *)mbox->priv)->rx_fifo;
+-      return (mbox_read_reg(fifo->msg_stat) == 0);
++      return (mbox_read_reg(mbox->parent, fifo->msg_stat) == 0);
+ }
+ static int omap2_mbox_fifo_full(struct omap_mbox *mbox)
+ {
+       struct omap_mbox2_fifo *fifo =
+               &((struct omap_mbox2_priv *)mbox->priv)->tx_fifo;
+-      return mbox_read_reg(fifo->fifo_stat);
++      return mbox_read_reg(mbox->parent, fifo->fifo_stat);
++}
++
++static int omap2_mbox_poll_for_space(struct omap_mbox *mbox)
++{
++      if (omap2_mbox_fifo_full(mbox))
++              return -1;
++
++      return 0;
+ }
+ /* Mailbox IRQ handle functions */
+@@ -127,9 +140,9 @@ static void omap2_mbox_enable_irq(struct
+       struct omap_mbox2_priv *p = mbox->priv;
+       u32 l, bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
+-      l = mbox_read_reg(p->irqenable);
++      l = mbox_read_reg(mbox->parent, p->irqenable);
+       l |= bit;
+-      mbox_write_reg(l, p->irqenable);
++      mbox_write_reg(mbox->parent, l, p->irqenable);
+ }
+ static void omap2_mbox_disable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+@@ -142,9 +155,9 @@ static void omap2_mbox_disable_irq(struc
+        * OMAP4 and later SoCs have a dedicated interrupt disabling register.
+        */
+       if (!p->intr_type)
+-              bit = mbox_read_reg(p->irqdisable) & ~bit;
++              bit = mbox_read_reg(mbox->parent, p->irqdisable) & ~bit;
+-      mbox_write_reg(bit, p->irqdisable);
++      mbox_write_reg(mbox->parent, bit, p->irqdisable);
+ }
+ static void omap2_mbox_ack_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+@@ -152,18 +165,69 @@ static void omap2_mbox_ack_irq(struct om
+       struct omap_mbox2_priv *p = mbox->priv;
+       u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
+-      mbox_write_reg(bit, p->irqstatus);
++      mbox_write_reg(mbox->parent, bit, p->irqstatus);
+       /* Flush posted write for irq status to avoid spurious interrupts */
+-      mbox_read_reg(p->irqstatus);
++      mbox_read_reg(mbox->parent, p->irqstatus);
+ }
+ static int omap2_mbox_is_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+ {
+       struct omap_mbox2_priv *p = mbox->priv;
+       u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
+-      u32 enable = mbox_read_reg(p->irqenable);
+-      u32 status = mbox_read_reg(p->irqstatus);
++      u32 enable = mbox_read_reg(mbox->parent, p->irqenable);
++      u32 status = mbox_read_reg(mbox->parent, p->irqstatus);
++
++      return (int)(enable & status & bit);
++}
++
++static void wkupm3_mbox_enable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
++{
++      struct omap_mbox2_priv *p = mbox->priv;
++      u32 l, bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
++      unsigned long irqenable = ((irq == IRQ_RX) ?
++              OMAP4_MAILBOX_IRQENABLE(AM33X_MBOX_WKUPM3_USR) : p->irqenable);
++
++      l = mbox_read_reg(mbox->parent, irqenable);
++      l |= bit;
++      mbox_write_reg(mbox->parent, l, irqenable);
++}
++
++static void wkupm3_mbox_disable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
++{
++      struct omap_mbox2_priv *p = mbox->priv;
++      u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
++      unsigned long irqdisable = ((irq == IRQ_RX) ?
++          OMAP4_MAILBOX_IRQENABLE_CLR(AM33X_MBOX_WKUPM3_USR) : p->irqdisable);
++
++      mbox_write_reg(mbox->parent, bit, irqdisable);
++}
++
++static void wkupm3_mbox_ack_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
++{
++      struct omap_mbox2_priv *p = mbox->priv;
++      u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
++      unsigned long irqstatus = ((irq == IRQ_RX) ?
++              OMAP4_MAILBOX_IRQSTATUS(AM33X_MBOX_WKUPM3_USR) : p->irqstatus);
++
++      mbox_write_reg(mbox->parent, bit, irqstatus);
++
++      /* Flush posted write for irq status to avoid spurious interrupts */
++      mbox_read_reg(mbox->parent, irqstatus);
++}
++
++static int wkupm3_mbox_is_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
++{
++      struct omap_mbox2_priv *p = mbox->priv;
++      u32 bit = (irq == IRQ_TX) ? p->notfull_bit : p->newmsg_bit;
++      u32 enable, status;
++
++      /* WkupM3 mailbox does not use a receive queue */
++      if (irq == IRQ_RX)
++              return 0;
++
++      enable = mbox_read_reg(mbox->parent, p->irqenable);
++      status = mbox_read_reg(mbox->parent, p->irqstatus);
+       return (int)(enable & status & bit);
+ }
+@@ -179,7 +243,7 @@ static void omap2_mbox_save_ctx(struct o
+       else
+               nr_regs = MBOX_NR_REGS;
+       for (i = 0; i < nr_regs; i++) {
+-              p->ctx[i] = mbox_read_reg(i * sizeof(u32));
++              p->ctx[i] = mbox_read_reg(mbox->parent, i * sizeof(u32));
+               dev_dbg(mbox->dev, "%s: [%02x] %08x\n", __func__,
+                       i, p->ctx[i]);
+@@ -197,21 +261,34 @@ static void omap2_mbox_restore_ctx(struc
+       else
+               nr_regs = MBOX_NR_REGS;
+       for (i = 0; i < nr_regs; i++) {
+-              mbox_write_reg(p->ctx[i], i * sizeof(u32));
++              mbox_write_reg(mbox->parent, p->ctx[i], i * sizeof(u32));
+               dev_dbg(mbox->dev, "%s: [%02x] %08x\n", __func__,
+                       i, p->ctx[i]);
+       }
+ }
++static void wkupm3_mbox_send_data(struct omap_mbox *mbox, mbox_msg_t msg)
++{
++      mbox_msg_t rmsg;
++
++      /* enable the mbox Rx interrupt for WkupM3 only briefly */
++      wkupm3_mbox_enable_irq(mbox, IRQ_RX);
++      omap2_mbox_fifo_write(mbox, msg);
++      wkupm3_mbox_disable_irq(mbox, IRQ_RX);
++
++      /* read back the message and ack the interrupt on behalf of WkupM3 */
++      rmsg = omap2_mbox_fifo_read(mbox);
++      wkupm3_mbox_ack_irq(mbox, IRQ_RX);
++}
++
+ static struct omap_mbox_ops omap2_mbox_ops = {
+-      .type           = OMAP_MBOX_TYPE2,
+       .startup        = omap2_mbox_startup,
+       .shutdown       = omap2_mbox_shutdown,
+       .fifo_read      = omap2_mbox_fifo_read,
+       .fifo_write     = omap2_mbox_fifo_write,
+       .fifo_empty     = omap2_mbox_fifo_empty,
+-      .fifo_full      = omap2_mbox_fifo_full,
++      .poll_for_space = omap2_mbox_poll_for_space,
+       .enable_irq     = omap2_mbox_enable_irq,
+       .disable_irq    = omap2_mbox_disable_irq,
+       .ack_irq        = omap2_mbox_ack_irq,
+@@ -220,6 +297,36 @@ static struct omap_mbox_ops omap2_mbox_o
+       .restore_ctx    = omap2_mbox_restore_ctx,
+ };
++static struct omap_mbox_ops wkupm3_mbox_ops = {
++      .startup        = omap2_mbox_startup,
++      .shutdown       = omap2_mbox_shutdown,
++      .fifo_read      = omap2_mbox_fifo_read,
++      .fifo_write     = wkupm3_mbox_send_data,
++      .fifo_empty     = omap2_mbox_fifo_empty,
++      .poll_for_space = omap2_mbox_poll_for_space,
++      .enable_irq     = wkupm3_mbox_enable_irq,
++      .disable_irq    = wkupm3_mbox_disable_irq,
++      .ack_irq        = wkupm3_mbox_ack_irq,
++      .is_irq         = wkupm3_mbox_is_irq,
++      .save_ctx       = omap2_mbox_save_ctx,
++      .restore_ctx    = omap2_mbox_restore_ctx,
++};
++
++static const struct of_device_id omap_mailbox_of_match[] = {
++      {
++              .compatible     = "ti,omap2-mailbox",
++              .data           = (void *) MBOX_INTR_CFG_TYPE1,
++      },
++      {
++              .compatible     = "ti,omap4-mailbox",
++              .data           = (void *) MBOX_INTR_CFG_TYPE2,
++      },
++      {
++              /* end */
++      },
++};
++MODULE_DEVICE_TABLE(of, omap_mailbox_of_match);
++
+ static int omap2_mbox_probe(struct platform_device *pdev)
+ {
+       struct resource *mem;
+@@ -227,40 +334,127 @@ static int omap2_mbox_probe(struct platf
+       struct omap_mbox **list, *mbox, *mboxblk;
+       struct omap_mbox2_priv *priv, *privblk;
+       struct omap_mbox_pdata *pdata = pdev->dev.platform_data;
+-      struct omap_mbox_dev_info *info;
+-      int i;
++      struct omap_mbox_device *mdev;
++      struct omap_mbox_dev_info *info, *of_info = NULL;
++      struct device_node *node = pdev->dev.of_node;
++      int i, j;
++      u32 info_count = 0, intr_type = 0;
++      u32 num_users = 0, num_fifos = 0;
++      u32 dlen, dsize = 4;
++      u32 *tmp;
++      const __be32 *mbox_data;
+-      if (!pdata || !pdata->info_cnt || !pdata->info) {
++      if (!node && (!pdata || !pdata->info_cnt || !pdata->info)) {
+               pr_err("%s: platform not supported\n", __func__);
+               return -ENODEV;
+       }
++      if (node) {
++              intr_type = (u32)of_match_device(omap_mailbox_of_match,
++                                                      &pdev->dev)->data;
++              if (intr_type != 0 && intr_type != 1) {
++                      dev_err(&pdev->dev, "invalid match data value\n");
++                      return -EINVAL;
++              }
++
++              if (of_property_read_u32(node, "ti,mbox-num-users",
++                                                              &num_users)) {
++                      dev_err(&pdev->dev,
++                              "no ti,mbox-num-users configuration found\n");
++                      return -ENODEV;
++              }
++
++              if (of_property_read_u32(node, "ti,mbox-num-fifos",
++                                                              &num_fifos)) {
++                      dev_err(&pdev->dev,
++                              "no ti,mbox-num-fifos configuration found\n");
++                      return -ENODEV;
++              }
++
++              info_count = of_property_count_strings(node, "ti,mbox-names");
++              if (!info_count) {
++                      dev_err(&pdev->dev, "no mbox devices found\n");
++                      return -ENODEV;
++              }
++
++              mbox_data = of_get_property(node, "ti,mbox-data", &dlen);
++              if (!mbox_data) {
++                      dev_err(&pdev->dev, "no mbox device data found\n");
++                      return -ENODEV;
++              }
++              dlen /= sizeof(dsize);
++              if (dlen != dsize * info_count) {
++                      dev_err(&pdev->dev, "mbox device data is truncated\n");
++                      return -ENODEV;
++              }
++
++              of_info = kzalloc(info_count * sizeof(*of_info), GFP_KERNEL);
++              if (!of_info)
++                      return -ENOMEM;
++
++              i = 0;
++              while (i < info_count) {
++                      info = of_info + i;
++                      if (of_property_read_string_index(node,
++                                      "ti,mbox-names", i,  &info->name)) {
++                              dev_err(&pdev->dev,
++                                      "mbox_name [%d] read failed\n", i);
++                              ret = -ENODEV;
++                              goto free_of;
++                      }
++
++                      tmp = &info->tx_id;
++                      for (j = 0; j < dsize; j++) {
++                              tmp[j] = of_read_number(
++                                              mbox_data + j + (i * dsize), 1);
++                      }
++                      i++;
++              }
++      }
++
++      if (!node) { /* non-DT device creation */
++              info_count = pdata->info_cnt;
++              info = pdata->info;
++              intr_type = pdata->intr_type;
++              num_users = pdata->num_users;
++              num_fifos = pdata->num_fifos;
++      } else {
++              info = of_info;
++      }
++
++      mdev = kzalloc(sizeof(*mdev), GFP_KERNEL);
++      if (!mdev) {
++              ret = -ENOMEM;
++              goto free_of;
++      }
++
+       /* allocate one extra for marking end of list */
+-      list = kzalloc((pdata->info_cnt + 1) * sizeof(*list), GFP_KERNEL);
+-      if (!list)
+-              return -ENOMEM;
++      list = kzalloc((info_count + 1) * sizeof(*list), GFP_KERNEL);
++      if (!list) {
++              ret = -ENOMEM;
++              goto free_mdev;
++      }
+-      mboxblk = mbox = kzalloc(pdata->info_cnt * sizeof(*mbox), GFP_KERNEL);
++      mboxblk = mbox = kzalloc(info_count * sizeof(*mbox), GFP_KERNEL);
+       if (!mboxblk) {
+               ret = -ENOMEM;
+               goto free_list;
+       }
+-      privblk = priv = kzalloc(pdata->info_cnt * sizeof(*priv), GFP_KERNEL);
++      privblk = priv = kzalloc(info_count * sizeof(*priv), GFP_KERNEL);
+       if (!privblk) {
+               ret = -ENOMEM;
+               goto free_mboxblk;
+       }
+-      info = pdata->info;
+-      for (i = 0; i < pdata->info_cnt; i++, info++, priv++) {
++      for (i = 0; i < info_count; i++, info++, priv++) {
+               priv->tx_fifo.msg = MAILBOX_MESSAGE(info->tx_id);
+               priv->tx_fifo.fifo_stat = MAILBOX_FIFOSTATUS(info->tx_id);
+               priv->rx_fifo.msg =  MAILBOX_MESSAGE(info->rx_id);
+               priv->rx_fifo.msg_stat =  MAILBOX_MSGSTATUS(info->rx_id);
+               priv->notfull_bit = MAILBOX_IRQ_NOTFULL(info->tx_id);
+               priv->newmsg_bit = MAILBOX_IRQ_NEWMSG(info->rx_id);
+-              if (pdata->intr_type) {
++              if (intr_type) {
+                       priv->irqenable = OMAP4_MAILBOX_IRQENABLE(info->usr_id);
+                       priv->irqstatus = OMAP4_MAILBOX_IRQSTATUS(info->usr_id);
+                       priv->irqdisable =
+@@ -270,11 +464,15 @@ static int omap2_mbox_probe(struct platf
+                       priv->irqstatus = MAILBOX_IRQSTATUS(info->usr_id);
+                       priv->irqdisable = MAILBOX_IRQENABLE(info->usr_id);
+               }
+-              priv->intr_type = pdata->intr_type;
++              priv->intr_type = intr_type;
+               mbox->priv = priv;
++              mbox->parent = mdev;
+               mbox->name = info->name;
+-              mbox->ops = &omap2_mbox_ops;
++              if (!strcmp(mbox->name, "wkup_m3"))
++                      mbox->ops = &wkupm3_mbox_ops;
++              else
++                      mbox->ops = &omap2_mbox_ops;
+               mbox->irq = platform_get_irq(pdev, info->irq_id);
+               if (mbox->irq < 0) {
+                       ret = mbox->irq;
+@@ -289,42 +487,58 @@ static int omap2_mbox_probe(struct platf
+               goto free_privblk;
+       }
+-      mbox_base = ioremap(mem->start, resource_size(mem));
+-      if (!mbox_base) {
++      mdev->mbox_base = ioremap(mem->start, resource_size(mem));
++      if (!mdev->mbox_base) {
+               ret = -ENOMEM;
+               goto free_privblk;
+       }
+-      ret = omap_mbox_register(&pdev->dev, list);
++      mutex_init(&mdev->cfg_lock);
++      mdev->dev = &pdev->dev;
++      mdev->num_users = num_users;
++      mdev->num_fifos = num_fifos;
++      mdev->mboxes = list;
++      ret = omap_mbox_register(mdev);
+       if (ret)
+               goto unmap_mbox;
+-      platform_set_drvdata(pdev, list);
++      platform_set_drvdata(pdev, mdev);
++      pm_runtime_enable(mdev->dev);
++
++      kfree(of_info);
+       return 0;
+ unmap_mbox:
+-      iounmap(mbox_base);
++      iounmap(mdev->mbox_base);
+ free_privblk:
+       kfree(privblk);
+ free_mboxblk:
+       kfree(mboxblk);
+ free_list:
+       kfree(list);
++free_mdev:
++      kfree(mdev);
++free_of:
++      kfree(of_info);
+       return ret;
+ }
+ static int omap2_mbox_remove(struct platform_device *pdev)
+ {
+       struct omap_mbox2_priv *privblk;
+-      struct omap_mbox **list = platform_get_drvdata(pdev);
++      struct omap_mbox_device *mdev = platform_get_drvdata(pdev);
++      struct omap_mbox **list = mdev->mboxes;
+       struct omap_mbox *mboxblk = list[0];
++      pm_runtime_disable(mdev->dev);
++
+       privblk = mboxblk->priv;
+-      omap_mbox_unregister();
+-      iounmap(mbox_base);
++      omap_mbox_unregister(mdev);
++      iounmap(mdev->mbox_base);
+       kfree(privblk);
+       kfree(mboxblk);
+       kfree(list);
++      kfree(mdev);
+       return 0;
+ }
+@@ -334,6 +548,7 @@ static struct platform_driver omap2_mbox
+       .remove = omap2_mbox_remove,
+       .driver = {
+               .name = "omap-mailbox",
++              .of_match_table = omap_mailbox_of_match,
+       },
+ };
+--- a/drivers/mailbox/omap-mailbox.c
++++ b/drivers/mailbox/omap-mailbox.c
+@@ -24,7 +24,6 @@
+ #include <linux/interrupt.h>
+ #include <linux/spinlock.h>
+ #include <linux/mutex.h>
+-#include <linux/delay.h>
+ #include <linux/slab.h>
+ #include <linux/kfifo.h>
+ #include <linux/err.h>
+@@ -33,16 +32,16 @@
+ #include "omap-mbox.h"
+-static struct omap_mbox **mboxes;
+-
+-static int mbox_configured;
+-static DEFINE_MUTEX(mbox_configured_lock);
++/* global variables for the mailbox devices */
++static DEFINE_MUTEX(omap_mbox_devices_lock);
++static LIST_HEAD(omap_mbox_devices);
++/* default size for the fifos, configured through kernel menuconfig */
+ static unsigned int mbox_kfifo_size = CONFIG_OMAP_MBOX_KFIFO_SIZE;
+ module_param(mbox_kfifo_size, uint, S_IRUGO);
+ MODULE_PARM_DESC(mbox_kfifo_size, "Size of omap's mailbox kfifo (bytes)");
+-/* Mailbox FIFO handle functions */
++/* mailbox h/w transport communication handler helper functions */
+ static inline mbox_msg_t mbox_fifo_read(struct omap_mbox *mbox)
+ {
+       return mbox->ops->fifo_read(mbox);
+@@ -55,12 +54,16 @@ static inline int mbox_fifo_empty(struct
+ {
+       return mbox->ops->fifo_empty(mbox);
+ }
+-static inline int mbox_fifo_full(struct omap_mbox *mbox)
++/*
++ * local helper to check if the h/w transport is busy or free.
++ * Returns 0 if free, and non-zero otherwise
++ */
++static inline int mbox_poll_for_space(struct omap_mbox *mbox)
+ {
+-      return mbox->ops->fifo_full(mbox);
++      return mbox->ops->poll_for_space(mbox);
+ }
+-/* Mailbox IRQ handle functions */
++/* mailbox h/w irq handler helper functions */
+ static inline void ack_mbox_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+ {
+       if (mbox->ops->ack_irq)
+@@ -71,23 +74,21 @@ static inline int is_mbox_irq(struct oma
+       return mbox->ops->is_irq(mbox, irq);
+ }
+-/*
+- * message sender
++/**
++ * omap_mbox_msg_send() - send a mailbox message
++ * @mbox: handle to the acquired mailbox on which to send the message
++ * @msg: the mailbox message to be sent
++ *
++ * This API is called by a client user to send a mailbox message on an
++ * acquired mailbox. The API transmits the message immediately on the h/w
++ * communication transport if it is available, otherwise buffers the
++ * message for transmission as soon as the h/w transport is ready.
++ *
++ * The only failure from this function is when neither the h/w transport
++ * is available nor the s/w buffer fifo is empty.
++ *
++ * Returns 0 on success, or an error otherwise
+  */
+-static int __mbox_poll_for_space(struct omap_mbox *mbox)
+-{
+-      int ret = 0, i = 1000;
+-
+-      while (mbox_fifo_full(mbox)) {
+-              if (mbox->ops->type == OMAP_MBOX_TYPE2)
+-                      return -1;
+-              if (--i == 0)
+-                      return -1;
+-              udelay(1);
+-      }
+-      return ret;
+-}
+-
+ int omap_mbox_msg_send(struct omap_mbox *mbox, mbox_msg_t msg)
+ {
+       struct omap_mbox_queue *mq = mbox->txq;
+@@ -100,7 +101,7 @@ int omap_mbox_msg_send(struct omap_mbox
+               goto out;
+       }
+-      if (kfifo_is_empty(&mq->fifo) && !__mbox_poll_for_space(mbox)) {
++      if (kfifo_is_empty(&mq->fifo) && !mbox_poll_for_space(mbox)) {
+               mbox_fifo_write(mbox, msg);
+               goto out;
+       }
+@@ -116,6 +117,17 @@ out:
+ }
+ EXPORT_SYMBOL(omap_mbox_msg_send);
++/**
++ * omap_mbox_save_ctx: save the context of a mailbox
++ * @mbox: handle to the acquired mailbox
++ *
++ * This allows a client (controlling a remote) to request a mailbox to
++ * save its context when it is powering down the remote.
++ *
++ * NOTE: This will be eventually deprecated, new clients should not use this.
++ *     The same feature can be enabled through runtime_pm enablement of
++ *     mailbox.
++ */
+ void omap_mbox_save_ctx(struct omap_mbox *mbox)
+ {
+       if (!mbox->ops->save_ctx) {
+@@ -127,6 +139,18 @@ void omap_mbox_save_ctx(struct omap_mbox
+ }
+ EXPORT_SYMBOL(omap_mbox_save_ctx);
++/**
++ * omap_mbox_restore_ctx: restore the context of a mailbox
++ * @mbox: handle to the acquired mailbox
++ *
++ * This allows a client (controlling a remote) to request a mailbox to
++ * restore its context after restoring the remote, so that it can
++ * communicate with the remote as it would normally.
++ *
++ * NOTE: This will be deprecated, new clients should not use this.
++ *     The same feature can be enabled through runtime_pm enablement
++ *     of mailbox.
++ */
+ void omap_mbox_restore_ctx(struct omap_mbox *mbox)
+ {
+       if (!mbox->ops->restore_ctx) {
+@@ -138,18 +162,48 @@ void omap_mbox_restore_ctx(struct omap_m
+ }
+ EXPORT_SYMBOL(omap_mbox_restore_ctx);
++/**
++ * omap_mbox_enable_irq: enable a specific mailbox Rx or Tx interrupt source
++ * @mbox: handle to the acquired mailbox
++ * @irq: interrupt type associated with either the Rx or Tx
++ *
++ * This allows a client (having its own shared memory communication protocol
++ * with the remote) to request a mailbox to enable a particular interrupt
++ * signal source of the mailbox, as part of its communication state machine.
++ *
++ * NOTE: This will be deprecated, new clients should not use this. It is
++ *     being exported for TI DSP/Bridge driver.
++ */
+ void omap_mbox_enable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+ {
+       mbox->ops->enable_irq(mbox, irq);
+ }
+ EXPORT_SYMBOL(omap_mbox_enable_irq);
++/**
++ * omap_mbox_disable_irq: disable a specific mailbox Rx or Tx interrupt source
++ * @mbox: handle to the acquired mailbox
++ * @irq: interrupt type associated with either the Rx or Tx
++ *
++ * This allows a client (having its own shared memory communication protocal
++ * with the remote) to request a mailbox to disable a particular interrupt
++ * signal source of the mailbox, as part of its communication state machine.
++ *
++ * NOTE: This will be deprecated, new clients should not use this. It is
++ *     being exported for TI DSP/Bridge driver.
++ */
+ void omap_mbox_disable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq)
+ {
+       mbox->ops->disable_irq(mbox, irq);
+ }
+ EXPORT_SYMBOL(omap_mbox_disable_irq);
++/*
++ * This is the tasklet function in which all the buffered messages are
++ * sent until the h/w transport is busy again. The tasklet is scheduled
++ * upon receiving an interrupt indicating the availability of the h/w
++ * transport.
++ */
+ static void mbox_tx_tasklet(unsigned long tx_data)
+ {
+       struct omap_mbox *mbox = (struct omap_mbox *)tx_data;
+@@ -158,7 +212,7 @@ static void mbox_tx_tasklet(unsigned lon
+       int ret;
+       while (kfifo_len(&mq->fifo)) {
+-              if (__mbox_poll_for_space(mbox)) {
++              if (mbox_poll_for_space(mbox)) {
+                       omap_mbox_enable_irq(mbox, IRQ_TX);
+                       break;
+               }
+@@ -172,7 +226,12 @@ static void mbox_tx_tasklet(unsigned lon
+ }
+ /*
+- * Message receiver(workqueue)
++ * This is the message receiver workqueue function, which is responsible
++ * for delivering all the received messages stored in the receive kfifo
++ * to the clients. Each message is delivered to all the registered mailbox
++ * clients. It also re-enables the receive interrupt on the mailbox (disabled
++ * when the s/w kfifo is full) after emptying atleast a message from the
++ * fifo.
+  */
+ static void mbox_rx_work(struct work_struct *work)
+ {
+@@ -197,7 +256,9 @@ static void mbox_rx_work(struct work_str
+ }
+ /*
+- * Mailbox interrupt handler
++ * Interrupt handler for Tx interrupt source for each of the mailboxes.
++ * This schedules the tasklet to transmit the messages buffered in the
++ * Tx fifo.
+  */
+ static void __mbox_tx_interrupt(struct omap_mbox *mbox)
+ {
+@@ -206,6 +267,12 @@ static void __mbox_tx_interrupt(struct o
+       tasklet_schedule(&mbox->txq->tasklet);
+ }
++/*
++ * Interrupt handler for Rx interrupt source for each of the mailboxes.
++ * This performs the read from the h/w mailbox until the transport is
++ * free of any incoming messages, and buffers the read message. The
++ * buffers are delivered to clients by scheduling a work-queue.
++ */
+ static void __mbox_rx_interrupt(struct omap_mbox *mbox)
+ {
+       struct omap_mbox_queue *mq = mbox->rxq;
+@@ -223,9 +290,6 @@ static void __mbox_rx_interrupt(struct o
+               len = kfifo_in(&mq->fifo, (unsigned char *)&msg, sizeof(msg));
+               WARN_ON(len != sizeof(msg));
+-
+-              if (mbox->ops->type == OMAP_MBOX_TYPE1)
+-                      break;
+       }
+       /* no more messages in the fifo. clear IRQ source. */
+@@ -234,6 +298,10 @@ nomem:
+       schedule_work(&mbox->rxq->work);
+ }
++/*
++ * The core mailbox interrupt handler function. The interrupt core would
++ * call this for each of the mailboxes the interrupt is configured.
++ */
+ static irqreturn_t mbox_interrupt(int irq, void *p)
+ {
+       struct omap_mbox *mbox = p;
+@@ -247,6 +315,12 @@ static irqreturn_t mbox_interrupt(int ir
+       return IRQ_HANDLED;
+ }
++/*
++ * Helper function to allocate a mailbox queue object. This function
++ * also creates either or both of the work-queue or tasklet to
++ * deal with processing of messages on the kfifo associated with
++ * the mailbox queue object.
++ */
+ static struct omap_mbox_queue *mbox_queue_alloc(struct omap_mbox *mbox,
+                                       void (*work) (struct work_struct *),
+                                       void (*tasklet)(unsigned long))
+@@ -273,24 +347,31 @@ error:
+       return NULL;
+ }
++/*
++ * Helper function to free a mailbox queue object.
++ */
+ static void mbox_queue_free(struct omap_mbox_queue *q)
+ {
+       kfifo_free(&q->fifo);
+       kfree(q);
+ }
++/*
++ * Helper function to initialize a mailbox. This function creates
++ * the mailbox queue objects associated with the mailbox h/w channel
++ * and plugs-in the interrupt associated with the mailbox, when the
++ * mailbox h/w channel is requested for the first time.
++ */
+ static int omap_mbox_startup(struct omap_mbox *mbox)
+ {
+       int ret = 0;
+       struct omap_mbox_queue *mq;
++      struct omap_mbox_device *mdev = mbox->parent;
+-      mutex_lock(&mbox_configured_lock);
+-      if (!mbox_configured++) {
+-              if (likely(mbox->ops->startup)) {
+-                      ret = mbox->ops->startup(mbox);
+-                      if (unlikely(ret))
+-                              goto fail_startup;
+-              } else
++      mutex_lock(&mdev->cfg_lock);
++      if (mbox->ops->startup) {
++              ret = mbox->ops->startup(mbox);
++              if (ret)
+                       goto fail_startup;
+       }
+@@ -319,7 +400,7 @@ static int omap_mbox_startup(struct omap
+               omap_mbox_enable_irq(mbox, IRQ_RX);
+       }
+-      mutex_unlock(&mbox_configured_lock);
++      mutex_unlock(&mdev->cfg_lock);
+       return 0;
+ fail_request_irq:
+@@ -331,14 +412,18 @@ fail_alloc_txq:
+               mbox->ops->shutdown(mbox);
+       mbox->use_count--;
+ fail_startup:
+-      mbox_configured--;
+-      mutex_unlock(&mbox_configured_lock);
++      mutex_unlock(&mdev->cfg_lock);
+       return ret;
+ }
++/*
++ * Helper function to de-initialize a mailbox
++ */
+ static void omap_mbox_fini(struct omap_mbox *mbox)
+ {
+-      mutex_lock(&mbox_configured_lock);
++      struct omap_mbox_device *mdev = mbox->parent;
++
++      mutex_lock(&mdev->cfg_lock);
+       if (!--mbox->use_count) {
+               omap_mbox_disable_irq(mbox, IRQ_RX);
+@@ -349,28 +434,66 @@ static void omap_mbox_fini(struct omap_m
+               mbox_queue_free(mbox->rxq);
+       }
+-      if (likely(mbox->ops->shutdown)) {
+-              if (!--mbox_configured)
+-                      mbox->ops->shutdown(mbox);
+-      }
++      if (mbox->ops->shutdown)
++              mbox->ops->shutdown(mbox);
+-      mutex_unlock(&mbox_configured_lock);
++      mutex_unlock(&mdev->cfg_lock);
+ }
+-struct omap_mbox *omap_mbox_get(const char *name, struct notifier_block *nb)
++/*
++ * Helper function to find a mailbox. It is currently assumed that all the
++ * mailbox names are unique among all the mailbox devices. This can be
++ * easily extended if only a particular mailbox device is to searched.
++ */
++static struct omap_mbox *omap_mbox_device_find(struct omap_mbox_device *mdev,
++                                              const char *mbox_name)
+ {
+       struct omap_mbox *_mbox, *mbox = NULL;
+-      int i, ret;
++      struct omap_mbox **mboxes = mdev->mboxes;
++      int i;
+       if (!mboxes)
+-              return ERR_PTR(-EINVAL);
++              return NULL;
+       for (i = 0; (_mbox = mboxes[i]); i++) {
+-              if (!strcmp(_mbox->name, name)) {
++              if (!strcmp(_mbox->name, mbox_name)) {
+                       mbox = _mbox;
+                       break;
+               }
+       }
++      return mbox;
++}
++
++/**
++ * omap_mbox_get() - acquire a mailbox
++ * @name: name of the mailbox to acquire
++ * @nb: notifier block to be invoked on received messages
++ *
++ * This API is called by a client user to use a mailbox. The returned handle
++ * needs to be used by the client for invoking any other mailbox API. Any
++ * message received on the mailbox is delivered to the client through the
++ * 'nb' notifier. There are currently no restrictions on multiple clients
++ * acquiring the same mailbox - the same message is delivered to each of the
++ * clients through their respective notifiers.
++ *
++ * The function ensures that the mailbox is put into an operational state
++ * before the function returns.
++ *
++ * Returns a usable mailbox handle on success, or NULL otherwise
++ */
++struct omap_mbox *omap_mbox_get(const char *name, struct notifier_block *nb)
++{
++      struct omap_mbox *mbox = NULL;
++      struct omap_mbox_device *mdev;
++      int ret;
++
++      mutex_lock(&omap_mbox_devices_lock);
++      list_for_each_entry(mdev, &omap_mbox_devices, elem) {
++              mbox = omap_mbox_device_find(mdev, name);
++              if (mbox)
++                      break;
++      }
++      mutex_unlock(&omap_mbox_devices_lock);
+       if (!mbox)
+               return ERR_PTR(-ENOENT);
+@@ -388,6 +511,18 @@ struct omap_mbox *omap_mbox_get(const ch
+ }
+ EXPORT_SYMBOL(omap_mbox_get);
++/**
++ * omap_mbox_put() - release a mailbox
++ * @mbox: handle to the acquired mailbox
++ * @nb: notifier block used while acquiring the mailbox
++ *
++ * This API is to be called by a client user once it is done using the
++ * mailbox. The particular user's notifier function is removed from the
++ * notifier list of received messages on this mailbox. It also undoes
++ * any h/w configuration done during the acquisition of the mailbox.
++ *
++ * No return value
++ */
+ void omap_mbox_put(struct omap_mbox *mbox, struct notifier_block *nb)
+ {
+       blocking_notifier_chain_unregister(&mbox->notifier, nb);
+@@ -397,19 +532,35 @@ EXPORT_SYMBOL(omap_mbox_put);
+ static struct class omap_mbox_class = { .name = "mbox", };
+-int omap_mbox_register(struct device *parent, struct omap_mbox **list)
++/**
++ * omap_mbox_register() - register the list of mailboxes
++ * @mdev: mailbox device handle containing the mailboxes that need to be
++ *      with the mailbox core
++ *
++ * This API is to be called by individual mailbox driver implementations
++ * for registering the set of mailboxes contained in a h/w communication
++ * block with the mailbox core. Each of the mailbox represents a h/w
++ * communication channel, contained within the h/w communication block or ip.
++ *
++ * An associated device is also created for each of the mailboxes, and the
++ * mailbox device is added to a global list of registered mailbox devices.
++ *
++ * Return 0 on success, or a failure code otherwise
++ */
++int omap_mbox_register(struct omap_mbox_device *mdev)
+ {
+       int ret;
+       int i;
++      struct omap_mbox **mboxes;
+-      mboxes = list;
+-      if (!mboxes)
++      if (!mdev || !mdev->mboxes)
+               return -EINVAL;
++      mboxes = mdev->mboxes;
+       for (i = 0; mboxes[i]; i++) {
+               struct omap_mbox *mbox = mboxes[i];
+               mbox->dev = device_create(&omap_mbox_class,
+-                              parent, 0, mbox, "%s", mbox->name);
++                              mdev->dev, 0, mbox, "%s", mbox->name);
+               if (IS_ERR(mbox->dev)) {
+                       ret = PTR_ERR(mbox->dev);
+                       goto err_out;
+@@ -417,6 +568,11 @@ int omap_mbox_register(struct device *pa
+               BLOCKING_INIT_NOTIFIER_HEAD(&mbox->notifier);
+       }
++
++      mutex_lock(&omap_mbox_devices_lock);
++      list_add(&mdev->elem, &omap_mbox_devices);
++      mutex_unlock(&omap_mbox_devices_lock);
++
+       return 0;
+ err_out:
+@@ -426,16 +582,33 @@ err_out:
+ }
+ EXPORT_SYMBOL(omap_mbox_register);
+-int omap_mbox_unregister(void)
++/**
++ * omap_mbox_unregister() - unregister the list of mailboxes
++ * @mdev: parent mailbox device handle containing the mailboxes that need
++ *      to be unregistered
++ *
++ * This API is to be called by individual mailbox driver implementations
++ * for unregistering the set of mailboxes contained in a h/w communication
++ * block. Once unregistered, these mailboxes are not available for any
++ * client users/drivers.
++ *
++ * Return 0 on success, or a failure code otherwise
++ */
++int omap_mbox_unregister(struct omap_mbox_device *mdev)
+ {
+       int i;
++      struct omap_mbox **mboxes;
+-      if (!mboxes)
++      if (!mdev || !mdev->mboxes)
+               return -EINVAL;
++      mutex_lock(&omap_mbox_devices_lock);
++      list_del(&mdev->elem);
++      mutex_unlock(&omap_mbox_devices_lock);
++
++      mboxes = mdev->mboxes;
+       for (i = 0; mboxes[i]; i++)
+               device_unregister(mboxes[i]->dev);
+-      mboxes = NULL;
+       return 0;
+ }
+ EXPORT_SYMBOL(omap_mbox_unregister);
+--- a/drivers/mailbox/omap-mbox.h
++++ b/drivers/mailbox/omap-mbox.h
+@@ -16,19 +16,58 @@
+ #include <linux/workqueue.h>
+ #include <linux/omap-mailbox.h>
+-typedef int __bitwise omap_mbox_type_t;
+-#define OMAP_MBOX_TYPE1 ((__force omap_mbox_type_t) 1)
+-#define OMAP_MBOX_TYPE2 ((__force omap_mbox_type_t) 2)
+-
++/**
++ * struct omap_mbox_ops - function ops specific to a mailbox implementation
++ * @startup: the startup function, essential for making the mailbox active.
++ *         This will be called when a client acquires the mailbox. The driver
++ *         implementation needs to take care of any refcounting if the same
++ *         mailbox is requested by multiple clients.
++ * @shutdown: the shutdown function, essential for making the mailbox inactive
++ *          after usage. This will be called when a client releases the
++ *          mailbox. The driver implementation needs to take care of any
++ *          refcounting if the same mailbox is requested by multiple clients.
++ * @fifo_read: read and return the h/w transport payload message. This hook
++ *           provides the omap mailbox core to read all the available messages
++ *           upon a Rx interrupt and buffer them. The messages are delivered
++ *           to the clients in a workqueue.
++ * @fifo_write: send a mailbox message packet on the h/w transport channel. The
++ *            individual drivers are responsible for configuring the h/w
++ *            accordingly.
++ * @fifo_empty: check if the h/w Rx transport has more messages. The function
++ *            should return 0 if there are no more messages to be read from
++ *            the transport, and non-zero if there are available messages.
++ * @poll_for_space: check if the h/w Tx transport is busy. This hook should
++ *                return non-zero if the h/w Tx transport is busy, and 0 when
++ *                the h/w communication channel is free.
++ * @enable_irq: This hook allows the mailbox core to allow a specific Rx or Tx
++ *            interrupt signal to interrupt the processor, based on its state
++ *            machine.
++ * @disable_irq: This hooks allows the mailbox core to disable a specific Rx or
++ *             Tx interrupt signal from interrupting the processor, based on
++ *             its state machine.
++ * @ack_irq: acknowledge the Tx or Rx interrupt signal internal to the mailbox.
++ *         This allows the h/w communication block to clear any internal
++ *         interrupt source status registers.
++ * @is_irq: check if a particular Tx or Rx interrupt signal on the corresponding
++ *        mailbox is set. This hook is used by the mailbox core to process the
++ *        interrupt accordingly.
++ * @save_ctx: Called by a client or the mailbox core to allow the individual
++ *          driver implementation to save the context of the mailbox registers
++ *          before the domain containing the h/w communication block can be
++ *          put into a low-power state.
++ * @restore_ctx: Called by a client or the mailbox core to allow the individual
++ *          driver implementation to restore the context of the mailbox
++ *          registers after the domain containing the h/w communication block
++ *          is powered back to active state.
++ */
+ struct omap_mbox_ops {
+-      omap_mbox_type_t        type;
+       int             (*startup)(struct omap_mbox *mbox);
+       void            (*shutdown)(struct omap_mbox *mbox);
+-      /* fifo */
++      /* mailbox access */
+       mbox_msg_t      (*fifo_read)(struct omap_mbox *mbox);
+       void            (*fifo_write)(struct omap_mbox *mbox, mbox_msg_t msg);
+       int             (*fifo_empty)(struct omap_mbox *mbox);
+-      int             (*fifo_full)(struct omap_mbox *mbox);
++      int             (*poll_for_space)(struct omap_mbox *mbox);
+       /* irq */
+       void            (*enable_irq)(struct omap_mbox *mbox,
+                                               omap_mbox_irq_t irq);
+@@ -36,11 +75,28 @@ struct omap_mbox_ops {
+                                               omap_mbox_irq_t irq);
+       void            (*ack_irq)(struct omap_mbox *mbox, omap_mbox_irq_t irq);
+       int             (*is_irq)(struct omap_mbox *mbox, omap_mbox_irq_t irq);
+-      /* ctx */
++      /* context */
+       void            (*save_ctx)(struct omap_mbox *mbox);
+       void            (*restore_ctx)(struct omap_mbox *mbox);
+ };
++/**
++ * struct omap_mbox_queue - A queue object used for buffering messages
++ * @lock: a spinlock providing synchronization in atomic context
++ * @fifo: a kfifo object for buffering the messages. The size of the kfifo is
++ *      is currently configured either at build time using kernel menu
++ *      configuration or at runtime through a module parameter. The usage of
++ *      the kfifo depends on whether the queue object is for Rx or Tx. For Tx,
++ *      a message is buffered into the kfifo if the h/w transport is busy, and
++ *      is taken out when the h/w signals Tx readiness. For Rx, the messages
++ *      are buffered into the kfifo in the bottom-half processing of a Rx
++ *      interrupt, and taken out during the top-half processing.
++ * @work: a workqueue object for scheduling top-half processing of rx messages
++ * @tasklet: a tasklet object for processing tx messages in an atomic context
++ * @mbox: reference to the containing parent mailbox
++ * full: indicates the status of the fifo, and is set to true when there is no
++ *     room in the fifo.
++ */
+ struct omap_mbox_queue {
+       spinlock_t              lock;
+       struct kfifo            fifo;
+@@ -50,18 +106,65 @@ struct omap_mbox_queue {
+       bool full;
+ };
++/**
++ * struct omap_mbox_device - device structure for storing h/w mailbox block
++ * @dev:      reference device pointer of the h/w mailbox block
++ * @cfg_lock: a configuration mutex lock used for protecting the mailbox
++ *            device configuration operations
++ * @mbox_base:        ioremapped base address of the h/w mailbox block
++ * @num_users:        number of output interrupts from the h/w mailbox block, multiple
++ *            interrupts can be routed to a particular processor sub-system
++ * @num_fifos:        number of individual h/w fifo queues supported within a h/w
++ *            mailbox block
++ * @mboxes:   array of containing mailboxes within the h/w mailbox block
++ * @elem:     list node
++ */
++struct omap_mbox_device {
++      struct device *dev;
++      struct mutex cfg_lock;
++      void __iomem *mbox_base;
++      u32 num_users;
++      u32 num_fifos;
++      struct omap_mbox **mboxes;
++      struct list_head elem;
++};
++
++/**
++ * struct omap_mbox - the base object describing a h/w communication channel.
++ *      there can be more than one object in a h/w communication block
++ * @name: a unique name for the mailbox object. Client users acquire a
++ *      mailbox object using this name
++ * @irq: IRQ number that the mailbox uses to interrupt the host processor.
++ *     the same IRQ number may be shared between different mailboxes
++ * @txq: the mailbox queue object pertaining to Tx
++ * @rxq: the mailbox queue object pertaining to Rx
++ * @ops: function ops specific to the mailbox
++ * @dev: the device pointer representing the mailbox object
++ * @parent: back reference to the containing parent mailbox device object
++ * @priv: a private structure specific to the driver implementation, this will
++ *      not be touched by the mailbox core
++ * @use_count: number of current references to the mailbox, useful in
++ *           controlling the mailbox state
++ * @notifier: notifier chain of clients, to which a received message is
++ *          communicated
++ */
+ struct omap_mbox {
+       const char              *name;
+       unsigned int            irq;
+       struct omap_mbox_queue  *txq, *rxq;
+       struct omap_mbox_ops    *ops;
+       struct device           *dev;
++      struct omap_mbox_device *parent;
+       void                    *priv;
+       int                     use_count;
+       struct blocking_notifier_head   notifier;
+ };
+-int omap_mbox_register(struct device *parent, struct omap_mbox **);
+-int omap_mbox_unregister(void);
++/*
++ * mailbox objects registration and de-registration functions with the
++ * mailbox core.
++ */
++int omap_mbox_register(struct omap_mbox_device *device);
++int omap_mbox_unregister(struct omap_mbox_device *device);
+ #endif /* OMAP_MBOX_H */
+--- a/drivers/Makefile
++++ b/drivers/Makefile
+@@ -8,6 +8,8 @@
+ obj-y                         += irqchip/
+ obj-y                         += bus/
++obj-$(CONFIG_GENERIC_PHY)     += phy/
++
+ # GPIO must come after pinctrl as gpios may need to mux pins etc
+ obj-y                         += pinctrl/
+ obj-y                         += gpio/
+--- a/drivers/media/platform/Kconfig
++++ b/drivers/media/platform/Kconfig
+@@ -220,6 +220,22 @@ config VIDEO_RENESAS_VSP1
+         To compile this driver as a module, choose M here: the module
+         will be called vsp1.
++config VIDEO_TI_VPE
++      tristate "TI VPE (Video Processing Engine) driver"
++      depends on VIDEO_DEV && VIDEO_V4L2 && SOC_DRA7XX
++      select VIDEOBUF2_DMA_CONTIG
++      select V4L2_MEM2MEM_DEV
++      default n
++      ---help---
++        Support for the TI VPE(Video Processing Engine) block
++        found on DRA7XX SoC.
++
++config VIDEO_TI_VPE_DEBUG
++      bool "VPE debug messages"
++      depends on VIDEO_TI_VPE
++      ---help---
++        Enable debug messages on VPE driver.
++
+ endif # V4L_MEM2MEM_DRIVERS
+ menuconfig V4L_TEST_DRIVERS
+--- a/drivers/media/platform/Makefile
++++ b/drivers/media/platform/Makefile
+@@ -22,6 +22,8 @@ obj-$(CONFIG_VIDEO_VIVI) += vivi.o
+ obj-$(CONFIG_VIDEO_MEM2MEM_TESTDEV) += mem2mem_testdev.o
++obj-$(CONFIG_VIDEO_TI_VPE)            += ti-vpe/
++
+ obj-$(CONFIG_VIDEO_MX2_EMMAPRP)               += mx2_emmaprp.o
+ obj-$(CONFIG_VIDEO_CODA)              += coda.o
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/Makefile
+@@ -0,0 +1,5 @@
++obj-$(CONFIG_VIDEO_TI_VPE) += ti-vpe.o
++
++ti-vpe-y := vpe.o vpdma.o
++
++ccflags-$(CONFIG_VIDEO_TI_VPE_DEBUG) += -DDEBUG
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/vpdma.c
+@@ -0,0 +1,846 @@
++/*
++ * VPDMA helper library
++ *
++ * Copyright (c) 2013 Texas Instruments Inc.
++ *
++ * David Griego, <dagriego@biglakesoftware.com>
++ * Dale Farnsworth, <dale@farnsworth.org>
++ * Archit Taneja, <archit@ti.com>
++ *
++ * 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.
++ */
++
++#include <linux/delay.h>
++#include <linux/dma-mapping.h>
++#include <linux/err.h>
++#include <linux/firmware.h>
++#include <linux/io.h>
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/sched.h>
++#include <linux/slab.h>
++#include <linux/videodev2.h>
++
++#include "vpdma.h"
++#include "vpdma_priv.h"
++
++#define VPDMA_FIRMWARE        "vpdma-1b8.bin"
++
++const struct vpdma_data_format vpdma_yuv_fmts[] = {
++      [VPDMA_DATA_FMT_Y444] = {
++              .data_type      = DATA_TYPE_Y444,
++              .depth          = 8,
++      },
++      [VPDMA_DATA_FMT_Y422] = {
++              .data_type      = DATA_TYPE_Y422,
++              .depth          = 8,
++      },
++      [VPDMA_DATA_FMT_Y420] = {
++              .data_type      = DATA_TYPE_Y420,
++              .depth          = 8,
++      },
++      [VPDMA_DATA_FMT_C444] = {
++              .data_type      = DATA_TYPE_C444,
++              .depth          = 8,
++      },
++      [VPDMA_DATA_FMT_C422] = {
++              .data_type      = DATA_TYPE_C422,
++              .depth          = 8,
++      },
++      [VPDMA_DATA_FMT_C420] = {
++              .data_type      = DATA_TYPE_C420,
++              .depth          = 4,
++      },
++      [VPDMA_DATA_FMT_YC422] = {
++              .data_type      = DATA_TYPE_YC422,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_YC444] = {
++              .data_type      = DATA_TYPE_YC444,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_CY422] = {
++              .data_type      = DATA_TYPE_CY422,
++              .depth          = 16,
++      },
++};
++
++const struct vpdma_data_format vpdma_rgb_fmts[] = {
++      [VPDMA_DATA_FMT_RGB565] = {
++              .data_type      = DATA_TYPE_RGB16_565,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ARGB16_1555] = {
++              .data_type      = DATA_TYPE_ARGB_1555,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ARGB16] = {
++              .data_type      = DATA_TYPE_ARGB_4444,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_RGBA16_5551] = {
++              .data_type      = DATA_TYPE_RGBA_5551,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_RGBA16] = {
++              .data_type      = DATA_TYPE_RGBA_4444,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ARGB24] = {
++              .data_type      = DATA_TYPE_ARGB24_6666,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_RGB24] = {
++              .data_type      = DATA_TYPE_RGB24_888,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_ARGB32] = {
++              .data_type      = DATA_TYPE_ARGB32_8888,
++              .depth          = 32,
++      },
++      [VPDMA_DATA_FMT_RGBA24] = {
++              .data_type      = DATA_TYPE_RGBA24_6666,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_RGBA32] = {
++              .data_type      = DATA_TYPE_RGBA32_8888,
++              .depth          = 32,
++      },
++      [VPDMA_DATA_FMT_BGR565] = {
++              .data_type      = DATA_TYPE_BGR16_565,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ABGR16_1555] = {
++              .data_type      = DATA_TYPE_ABGR_1555,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ABGR16] = {
++              .data_type      = DATA_TYPE_ABGR_4444,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_BGRA16_5551] = {
++              .data_type      = DATA_TYPE_BGRA_5551,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_BGRA16] = {
++              .data_type      = DATA_TYPE_BGRA_4444,
++              .depth          = 16,
++      },
++      [VPDMA_DATA_FMT_ABGR24] = {
++              .data_type      = DATA_TYPE_ABGR24_6666,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_BGR24] = {
++              .data_type      = DATA_TYPE_BGR24_888,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_ABGR32] = {
++              .data_type      = DATA_TYPE_ABGR32_8888,
++              .depth          = 32,
++      },
++      [VPDMA_DATA_FMT_BGRA24] = {
++              .data_type      = DATA_TYPE_BGRA24_6666,
++              .depth          = 24,
++      },
++      [VPDMA_DATA_FMT_BGRA32] = {
++              .data_type      = DATA_TYPE_BGRA32_8888,
++              .depth          = 32,
++      },
++};
++
++const struct vpdma_data_format vpdma_misc_fmts[] = {
++      [VPDMA_DATA_FMT_MV] = {
++              .data_type      = DATA_TYPE_MV,
++              .depth          = 4,
++      },
++};
++
++struct vpdma_channel_info {
++      int num;                /* VPDMA channel number */
++      int cstat_offset;       /* client CSTAT register offset */
++};
++
++static const struct vpdma_channel_info chan_info[] = {
++      [VPE_CHAN_LUMA1_IN] = {
++              .num            = VPE_CHAN_NUM_LUMA1_IN,
++              .cstat_offset   = VPDMA_DEI_LUMA1_CSTAT,
++      },
++      [VPE_CHAN_CHROMA1_IN] = {
++              .num            = VPE_CHAN_NUM_CHROMA1_IN,
++              .cstat_offset   = VPDMA_DEI_CHROMA1_CSTAT,
++      },
++      [VPE_CHAN_LUMA2_IN] = {
++              .num            = VPE_CHAN_NUM_LUMA2_IN,
++              .cstat_offset   = VPDMA_DEI_LUMA2_CSTAT,
++      },
++      [VPE_CHAN_CHROMA2_IN] = {
++              .num            = VPE_CHAN_NUM_CHROMA2_IN,
++              .cstat_offset   = VPDMA_DEI_CHROMA2_CSTAT,
++      },
++      [VPE_CHAN_LUMA3_IN] = {
++              .num            = VPE_CHAN_NUM_LUMA3_IN,
++              .cstat_offset   = VPDMA_DEI_LUMA3_CSTAT,
++      },
++      [VPE_CHAN_CHROMA3_IN] = {
++              .num            = VPE_CHAN_NUM_CHROMA3_IN,
++              .cstat_offset   = VPDMA_DEI_CHROMA3_CSTAT,
++      },
++      [VPE_CHAN_MV_IN] = {
++              .num            = VPE_CHAN_NUM_MV_IN,
++              .cstat_offset   = VPDMA_DEI_MV_IN_CSTAT,
++      },
++      [VPE_CHAN_MV_OUT] = {
++              .num            = VPE_CHAN_NUM_MV_OUT,
++              .cstat_offset   = VPDMA_DEI_MV_OUT_CSTAT,
++      },
++      [VPE_CHAN_LUMA_OUT] = {
++              .num            = VPE_CHAN_NUM_LUMA_OUT,
++              .cstat_offset   = VPDMA_VIP_UP_Y_CSTAT,
++      },
++      [VPE_CHAN_CHROMA_OUT] = {
++              .num            = VPE_CHAN_NUM_CHROMA_OUT,
++              .cstat_offset   = VPDMA_VIP_UP_UV_CSTAT,
++      },
++      [VPE_CHAN_RGB_OUT] = {
++              .num            = VPE_CHAN_NUM_RGB_OUT,
++              .cstat_offset   = VPDMA_VIP_UP_Y_CSTAT,
++      },
++};
++
++static u32 read_reg(struct vpdma_data *vpdma, int offset)
++{
++      return ioread32(vpdma->base + offset);
++}
++
++static void write_reg(struct vpdma_data *vpdma, int offset, u32 value)
++{
++      iowrite32(value, vpdma->base + offset);
++}
++
++static int read_field_reg(struct vpdma_data *vpdma, int offset,
++              u32 mask, int shift)
++{
++      return (read_reg(vpdma, offset) & (mask << shift)) >> shift;
++}
++
++static void write_field_reg(struct vpdma_data *vpdma, int offset, u32 field,
++              u32 mask, int shift)
++{
++      u32 val = read_reg(vpdma, offset);
++
++      val &= ~(mask << shift);
++      val |= (field & mask) << shift;
++
++      write_reg(vpdma, offset, val);
++}
++
++void vpdma_dump_regs(struct vpdma_data *vpdma)
++{
++      struct device *dev = &vpdma->pdev->dev;
++
++#define DUMPREG(r) dev_dbg(dev, "%-35s %08x\n", #r, read_reg(vpdma, VPDMA_##r))
++
++      dev_dbg(dev, "VPDMA Registers:\n");
++
++      DUMPREG(PID);
++      DUMPREG(LIST_ADDR);
++      DUMPREG(LIST_ATTR);
++      DUMPREG(LIST_STAT_SYNC);
++      DUMPREG(BG_RGB);
++      DUMPREG(BG_YUV);
++      DUMPREG(SETUP);
++      DUMPREG(MAX_SIZE1);
++      DUMPREG(MAX_SIZE2);
++      DUMPREG(MAX_SIZE3);
++
++      /*
++       * dumping registers of only group0 and group3, because VPE channels
++       * lie within group0 and group3 registers
++       */
++      DUMPREG(INT_CHAN_STAT(0));
++      DUMPREG(INT_CHAN_MASK(0));
++      DUMPREG(INT_CHAN_STAT(3));
++      DUMPREG(INT_CHAN_MASK(3));
++      DUMPREG(INT_CLIENT0_STAT);
++      DUMPREG(INT_CLIENT0_MASK);
++      DUMPREG(INT_CLIENT1_STAT);
++      DUMPREG(INT_CLIENT1_MASK);
++      DUMPREG(INT_LIST0_STAT);
++      DUMPREG(INT_LIST0_MASK);
++
++      /*
++       * these are registers specific to VPE clients, we can make this
++       * function dump client registers specific to VPE or VIP based on
++       * who is using it
++       */
++      DUMPREG(DEI_CHROMA1_CSTAT);
++      DUMPREG(DEI_LUMA1_CSTAT);
++      DUMPREG(DEI_CHROMA2_CSTAT);
++      DUMPREG(DEI_LUMA2_CSTAT);
++      DUMPREG(DEI_CHROMA3_CSTAT);
++      DUMPREG(DEI_LUMA3_CSTAT);
++      DUMPREG(DEI_MV_IN_CSTAT);
++      DUMPREG(DEI_MV_OUT_CSTAT);
++      DUMPREG(VIP_UP_Y_CSTAT);
++      DUMPREG(VIP_UP_UV_CSTAT);
++      DUMPREG(VPI_CTL_CSTAT);
++}
++
++/*
++ * Allocate a DMA buffer
++ */
++int vpdma_alloc_desc_buf(struct vpdma_buf *buf, size_t size)
++{
++      buf->size = size;
++      buf->mapped = false;
++      buf->addr = kzalloc(size, GFP_KERNEL);
++      if (!buf->addr)
++              return -ENOMEM;
++
++      WARN_ON((u32) buf->addr & VPDMA_DESC_ALIGN);
++
++      return 0;
++}
++
++void vpdma_free_desc_buf(struct vpdma_buf *buf)
++{
++      WARN_ON(buf->mapped);
++      kfree(buf->addr);
++      buf->addr = NULL;
++      buf->size = 0;
++}
++
++/*
++ * map descriptor/payload DMA buffer, enabling DMA access
++ */
++int vpdma_map_desc_buf(struct vpdma_data *vpdma, struct vpdma_buf *buf)
++{
++      struct device *dev = &vpdma->pdev->dev;
++
++      WARN_ON(buf->mapped);
++      buf->dma_addr = dma_map_single(dev, buf->addr, buf->size,
++                              DMA_TO_DEVICE);
++      if (dma_mapping_error(dev, buf->dma_addr)) {
++              dev_err(dev, "failed to map buffer\n");
++              return -EINVAL;
++      }
++
++      buf->mapped = true;
++
++      return 0;
++}
++
++/*
++ * unmap descriptor/payload DMA buffer, disabling DMA access and
++ * allowing the main processor to acces the data
++ */
++void vpdma_unmap_desc_buf(struct vpdma_data *vpdma, struct vpdma_buf *buf)
++{
++      struct device *dev = &vpdma->pdev->dev;
++
++      if (buf->mapped)
++              dma_unmap_single(dev, buf->dma_addr, buf->size, DMA_TO_DEVICE);
++
++      buf->mapped = false;
++}
++
++/*
++ * create a descriptor list, the user of this list will append configuration,
++ * control and data descriptors to this list, this list will be submitted to
++ * VPDMA. VPDMA's list parser will go through each descriptor and perform the
++ * required DMA operations
++ */
++int vpdma_create_desc_list(struct vpdma_desc_list *list, size_t size, int type)
++{
++      int r;
++
++      r = vpdma_alloc_desc_buf(&list->buf, size);
++      if (r)
++              return r;
++
++      list->next = list->buf.addr;
++
++      list->type = type;
++
++      return 0;
++}
++
++/*
++ * once a descriptor list is parsed by VPDMA, we reset the list by emptying it,
++ * to allow new descriptors to be added to the list.
++ */
++void vpdma_reset_desc_list(struct vpdma_desc_list *list)
++{
++      list->next = list->buf.addr;
++}
++
++/*
++ * free the buffer allocated fot the VPDMA descriptor list, this should be
++ * called when the user doesn't want to use VPDMA any more.
++ */
++void vpdma_free_desc_list(struct vpdma_desc_list *list)
++{
++      vpdma_free_desc_buf(&list->buf);
++
++      list->next = NULL;
++}
++
++static bool vpdma_list_busy(struct vpdma_data *vpdma, int list_num)
++{
++      return read_reg(vpdma, VPDMA_LIST_STAT_SYNC) & BIT(list_num + 16);
++}
++
++/*
++ * submit a list of DMA descriptors to the VPE VPDMA, do not wait for completion
++ */
++int vpdma_submit_descs(struct vpdma_data *vpdma, struct vpdma_desc_list *list)
++{
++      /* we always use the first list */
++      int list_num = 0;
++      int list_size;
++
++      if (vpdma_list_busy(vpdma, list_num))
++              return -EBUSY;
++
++      /* 16-byte granularity */
++      list_size = (list->next - list->buf.addr) >> 4;
++
++      write_reg(vpdma, VPDMA_LIST_ADDR, (u32) list->buf.dma_addr);
++
++      write_reg(vpdma, VPDMA_LIST_ATTR,
++                      (list_num << VPDMA_LIST_NUM_SHFT) |
++                      (list->type << VPDMA_LIST_TYPE_SHFT) |
++                      list_size);
++
++      return 0;
++}
++
++static void dump_cfd(struct vpdma_cfd *cfd)
++{
++      int class;
++
++      class = cfd_get_class(cfd);
++
++      pr_debug("config descriptor of payload class: %s\n",
++              class == CFD_CLS_BLOCK ? "simple block" :
++              "address data block");
++
++      if (class == CFD_CLS_BLOCK)
++              pr_debug("word0: dst_addr_offset = 0x%08x\n",
++                      cfd->dest_addr_offset);
++
++      if (class == CFD_CLS_BLOCK)
++              pr_debug("word1: num_data_wrds = %d\n", cfd->block_len);
++
++      pr_debug("word2: payload_addr = 0x%08x\n", cfd->payload_addr);
++
++      pr_debug("word3: pkt_type = %d, direct = %d, class = %d, dest = %d, "
++              "payload_len = %d\n", cfd_get_pkt_type(cfd),
++              cfd_get_direct(cfd), class, cfd_get_dest(cfd),
++              cfd_get_payload_len(cfd));
++}
++
++/*
++ * append a configuration descriptor to the given descriptor list, where the
++ * payload is in the form of a simple data block specified in the descriptor
++ * header, this is used to upload scaler coefficients to the scaler module
++ */
++void vpdma_add_cfd_block(struct vpdma_desc_list *list, int client,
++              struct vpdma_buf *blk, u32 dest_offset)
++{
++      struct vpdma_cfd *cfd;
++      int len = blk->size;
++
++      WARN_ON(blk->dma_addr & VPDMA_DESC_ALIGN);
++
++      cfd = list->next;
++      WARN_ON((void *)(cfd + 1) > (list->buf.addr + list->buf.size));
++
++      cfd->dest_addr_offset = dest_offset;
++      cfd->block_len = len;
++      cfd->payload_addr = (u32) blk->dma_addr;
++      cfd->ctl_payload_len = cfd_pkt_payload_len(CFD_INDIRECT, CFD_CLS_BLOCK,
++                              client, len >> 4);
++
++      list->next = cfd + 1;
++
++      dump_cfd(cfd);
++}
++
++/*
++ * append a configuration descriptor to the given descriptor list, where the
++ * payload is in the address data block format, this is used to a configure a
++ * discontiguous set of MMRs
++ */
++void vpdma_add_cfd_adb(struct vpdma_desc_list *list, int client,
++              struct vpdma_buf *adb)
++{
++      struct vpdma_cfd *cfd;
++      unsigned int len = adb->size;
++
++      WARN_ON(len & VPDMA_ADB_SIZE_ALIGN);
++      WARN_ON(adb->dma_addr & VPDMA_DESC_ALIGN);
++
++      cfd = list->next;
++      BUG_ON((void *)(cfd + 1) > (list->buf.addr + list->buf.size));
++
++      cfd->w0 = 0;
++      cfd->w1 = 0;
++      cfd->payload_addr = (u32) adb->dma_addr;
++      cfd->ctl_payload_len = cfd_pkt_payload_len(CFD_INDIRECT, CFD_CLS_ADB,
++                              client, len >> 4);
++
++      list->next = cfd + 1;
++
++      dump_cfd(cfd);
++};
++
++/*
++ * control descriptor format change based on what type of control descriptor it
++ * is, we only use 'sync on channel' control descriptors for now, so assume it's
++ * that
++ */
++static void dump_ctd(struct vpdma_ctd *ctd)
++{
++      pr_debug("control descriptor\n");
++
++      pr_debug("word3: pkt_type = %d, source = %d, ctl_type = %d\n",
++              ctd_get_pkt_type(ctd), ctd_get_source(ctd), ctd_get_ctl(ctd));
++}
++
++/*
++ * append a 'sync on channel' type control descriptor to the given descriptor
++ * list, this descriptor stalls the VPDMA list till the time DMA is completed
++ * on the specified channel
++ */
++void vpdma_add_sync_on_channel_ctd(struct vpdma_desc_list *list,
++              enum vpdma_channel chan)
++{
++      struct vpdma_ctd *ctd;
++
++      ctd = list->next;
++      WARN_ON((void *)(ctd + 1) > (list->buf.addr + list->buf.size));
++
++      ctd->w0 = 0;
++      ctd->w1 = 0;
++      ctd->w2 = 0;
++      ctd->type_source_ctl = ctd_type_source_ctl(chan_info[chan].num,
++                              CTD_TYPE_SYNC_ON_CHANNEL);
++
++      list->next = ctd + 1;
++
++      dump_ctd(ctd);
++}
++
++static void dump_dtd(struct vpdma_dtd *dtd)
++{
++      int dir, chan;
++
++      dir = dtd_get_dir(dtd);
++      chan = dtd_get_chan(dtd);
++
++      pr_debug("%s data transfer descriptor for channel %d\n",
++              dir == DTD_DIR_OUT ? "outbound" : "inbound", chan);
++
++      pr_debug("word0: data_type = %d, notify = %d, field = %d, 1D = %d, "
++              "even_ln_skp = %d, odd_ln_skp = %d, line_stride = %d\n",
++              dtd_get_data_type(dtd), dtd_get_notify(dtd), dtd_get_field(dtd),
++              dtd_get_1d(dtd), dtd_get_even_line_skip(dtd),
++              dtd_get_odd_line_skip(dtd), dtd_get_line_stride(dtd));
++
++      if (dir == DTD_DIR_IN)
++              pr_debug("word1: line_length = %d, xfer_height = %d\n",
++                      dtd_get_line_length(dtd), dtd_get_xfer_height(dtd));
++
++      pr_debug("word2: start_addr = 0x%08x\n", dtd->start_addr);
++
++      pr_debug("word3: pkt_type = %d, mode = %d, dir = %d, chan = %d, "
++              "pri = %d, next_chan = %d\n", dtd_get_pkt_type(dtd),
++              dtd_get_mode(dtd), dir, chan, dtd_get_priority(dtd),
++              dtd_get_next_chan(dtd));
++
++      if (dir == DTD_DIR_IN)
++              pr_debug("word4: frame_width = %d, frame_height = %d\n",
++                      dtd_get_frame_width(dtd), dtd_get_frame_height(dtd));
++      else
++              pr_debug("word4: desc_write_addr = 0x%08x, write_desc = %d, "
++                      "drp_data = %d, use_desc_reg = %d\n",
++                      dtd_get_desc_write_addr(dtd), dtd_get_write_desc(dtd),
++                      dtd_get_drop_data(dtd), dtd_get_use_desc(dtd));
++
++      if (dir == DTD_DIR_IN)
++              pr_debug("word5: hor_start = %d, ver_start = %d\n",
++                      dtd_get_h_start(dtd), dtd_get_v_start(dtd));
++      else
++              pr_debug("word5: max_width %d, max_height %d\n",
++                      dtd_get_max_width(dtd), dtd_get_max_height(dtd));
++
++      pr_debug("word6: client specfic attr0 = 0x%08x\n", dtd->client_attr0);
++      pr_debug("word7: client specfic attr1 = 0x%08x\n", dtd->client_attr1);
++}
++
++/*
++ * append an outbound data transfer descriptor to the given descriptor list,
++ * this sets up a 'client to memory' VPDMA transfer for the given VPDMA channel
++ */
++void vpdma_add_out_dtd(struct vpdma_desc_list *list, struct v4l2_rect *c_rect,
++              const struct vpdma_data_format *fmt, dma_addr_t dma_addr,
++              enum vpdma_channel chan, u32 flags)
++{
++      int priority = 0;
++      int field = 0;
++      int notify = 1;
++      int channel, next_chan;
++      int depth = fmt->depth;
++      int stride;
++      struct vpdma_dtd *dtd;
++
++      channel = next_chan = chan_info[chan].num;
++
++      if (fmt->data_type == DATA_TYPE_C420)
++              depth = 8;
++
++      stride = (depth * c_rect->width) >> 3;
++      dma_addr += (c_rect->left * depth) >> 3;
++
++      dtd = list->next;
++      WARN_ON((void *)(dtd + 1) > (list->buf.addr + list->buf.size));
++
++      dtd->type_ctl_stride = dtd_type_ctl_stride(fmt->data_type,
++                                      notify,
++                                      field,
++                                      !!(flags & VPDMA_DATA_FRAME_1D),
++                                      !!(flags & VPDMA_DATA_EVEN_LINE_SKIP),
++                                      !!(flags & VPDMA_DATA_ODD_LINE_SKIP),
++                                      stride);
++      dtd->w1 = 0;
++      dtd->start_addr = (u32) dma_addr;
++      dtd->pkt_ctl = dtd_pkt_ctl(!!(flags & VPDMA_DATA_MODE_TILED),
++                              DTD_DIR_OUT, channel, priority, next_chan);
++      dtd->desc_write_addr = dtd_desc_write_addr(0, 0, 0, 0);
++      dtd->max_width_height = dtd_max_width_height(MAX_OUT_WIDTH_1920,
++                                      MAX_OUT_HEIGHT_1080);
++      dtd->client_attr0 = 0;
++      dtd->client_attr1 = 0;
++
++      list->next = dtd + 1;
++
++      dump_dtd(dtd);
++}
++
++/*
++ * append an inbound data transfer descriptor to the given descriptor list,
++ * this sets up a 'memory to client' VPDMA transfer for the given VPDMA channel
++ */
++void vpdma_add_in_dtd(struct vpdma_desc_list *list, int frame_width,
++              int frame_height, struct v4l2_rect *c_rect,
++              const struct vpdma_data_format *fmt, dma_addr_t dma_addr,
++              enum vpdma_channel chan, int field, u32 flags)
++{
++      int priority = 0;
++      int notify = 1;
++      int depth = fmt->depth;
++      int channel, next_chan;
++      int stride;
++      int height = c_rect->height;
++      struct vpdma_dtd *dtd;
++
++      channel = next_chan = chan_info[chan].num;
++
++      if (fmt->data_type == DATA_TYPE_C420) {
++              height >>= 1;
++              frame_height >>= 1;
++              depth = 8;
++      }
++
++      stride = (depth * c_rect->width) >> 3;
++      dma_addr += (c_rect->left * depth) >> 3;
++
++      dtd = list->next;
++      WARN_ON((void *)(dtd + 1) > (list->buf.addr + list->buf.size));
++
++      dtd->type_ctl_stride = dtd_type_ctl_stride(fmt->data_type,
++                                      notify,
++                                      field,
++                                      !!(flags & VPDMA_DATA_FRAME_1D),
++                                      !!(flags & VPDMA_DATA_EVEN_LINE_SKIP),
++                                      !!(flags & VPDMA_DATA_ODD_LINE_SKIP),
++                                      stride);
++
++      dtd->xfer_length_height = dtd_xfer_length_height(c_rect->width, height);
++      dtd->start_addr = (u32) dma_addr;
++      dtd->pkt_ctl = dtd_pkt_ctl(!!(flags & VPDMA_DATA_MODE_TILED),
++                              DTD_DIR_IN, channel, priority, next_chan);
++      dtd->frame_width_height = dtd_frame_width_height(frame_width,
++                                      frame_height);
++      dtd->start_h_v = dtd_start_h_v(c_rect->left, c_rect->top);
++      dtd->client_attr0 = 0;
++      dtd->client_attr1 = 0;
++
++      list->next = dtd + 1;
++
++      dump_dtd(dtd);
++}
++
++/* set or clear the mask for list complete interrupt */
++void vpdma_enable_list_complete_irq(struct vpdma_data *vpdma, int list_num,
++              bool enable)
++{
++      u32 val;
++
++      val = read_reg(vpdma, VPDMA_INT_LIST0_MASK);
++      if (enable)
++              val |= (1 << (list_num * 2));
++      else
++              val &= ~(1 << (list_num * 2));
++      write_reg(vpdma, VPDMA_INT_LIST0_MASK, val);
++}
++
++/* clear previosuly occured list intterupts in the LIST_STAT register */
++void vpdma_clear_list_stat(struct vpdma_data *vpdma)
++{
++      write_reg(vpdma, VPDMA_INT_LIST0_STAT,
++              read_reg(vpdma, VPDMA_INT_LIST0_STAT));
++}
++
++/*
++ * configures the output mode of the line buffer for the given client, the
++ * line buffer content can either be mirrored(each line repeated twice) or
++ * passed to the client as is
++ */
++void vpdma_set_line_mode(struct vpdma_data *vpdma, int line_mode,
++              enum vpdma_channel chan)
++{
++      int client_cstat = chan_info[chan].cstat_offset;
++
++      write_field_reg(vpdma, client_cstat, line_mode,
++              VPDMA_CSTAT_LINE_MODE_MASK, VPDMA_CSTAT_LINE_MODE_SHIFT);
++}
++
++/*
++ * configures the event which should trigger VPDMA transfer for the given
++ * client
++ */
++void vpdma_set_frame_start_event(struct vpdma_data *vpdma,
++              enum vpdma_frame_start_event fs_event,
++              enum vpdma_channel chan)
++{
++      int client_cstat = chan_info[chan].cstat_offset;
++
++      write_field_reg(vpdma, client_cstat, fs_event,
++              VPDMA_CSTAT_FRAME_START_MASK, VPDMA_CSTAT_FRAME_START_SHIFT);
++}
++
++static void vpdma_firmware_cb(const struct firmware *f, void *context)
++{
++      struct vpdma_data *vpdma = context;
++      struct vpdma_buf fw_dma_buf;
++      int i, r;
++
++      dev_dbg(&vpdma->pdev->dev, "firmware callback\n");
++
++      if (!f || !f->data) {
++              dev_err(&vpdma->pdev->dev, "couldn't get firmware\n");
++              return;
++      }
++
++      /* already initialized */
++      if (read_field_reg(vpdma, VPDMA_LIST_ATTR, VPDMA_LIST_RDY_MASK,
++                      VPDMA_LIST_RDY_SHFT)) {
++              vpdma->ready = true;
++              return;
++      }
++
++      r = vpdma_alloc_desc_buf(&fw_dma_buf, f->size);
++      if (r) {
++              dev_err(&vpdma->pdev->dev,
++                      "failed to allocate dma buffer for firmware\n");
++              goto rel_fw;
++      }
++
++      memcpy(fw_dma_buf.addr, f->data, f->size);
++
++      vpdma_map_desc_buf(vpdma, &fw_dma_buf);
++
++      write_reg(vpdma, VPDMA_LIST_ADDR, (u32) fw_dma_buf.dma_addr);
++
++      for (i = 0; i < 100; i++) {             /* max 1 second */
++              msleep_interruptible(10);
++
++              if (read_field_reg(vpdma, VPDMA_LIST_ATTR, VPDMA_LIST_RDY_MASK,
++                              VPDMA_LIST_RDY_SHFT))
++                      break;
++      }
++
++      if (i == 100) {
++              dev_err(&vpdma->pdev->dev, "firmware upload failed\n");
++              goto free_buf;
++      }
++
++      vpdma->ready = true;
++
++free_buf:
++      vpdma_unmap_desc_buf(vpdma, &fw_dma_buf);
++
++      vpdma_free_desc_buf(&fw_dma_buf);
++rel_fw:
++      release_firmware(f);
++}
++
++static int vpdma_load_firmware(struct vpdma_data *vpdma)
++{
++      int r;
++      struct device *dev = &vpdma->pdev->dev;
++
++      r = request_firmware_nowait(THIS_MODULE, 1,
++              (const char *) VPDMA_FIRMWARE, dev, GFP_KERNEL, vpdma,
++              vpdma_firmware_cb);
++      if (r) {
++              dev_err(dev, "firmware not available %s\n", VPDMA_FIRMWARE);
++              return r;
++      } else {
++              dev_info(dev, "loading firmware %s\n", VPDMA_FIRMWARE);
++      }
++
++      return 0;
++}
++
++struct vpdma_data *vpdma_create(struct platform_device *pdev)
++{
++      struct resource *res;
++      struct vpdma_data *vpdma;
++      int r;
++
++      dev_dbg(&pdev->dev, "vpdma_create\n");
++
++      vpdma = devm_kzalloc(&pdev->dev, sizeof(*vpdma), GFP_KERNEL);
++      if (!vpdma) {
++              dev_err(&pdev->dev, "couldn't alloc vpdma_dev\n");
++              return ERR_PTR(-ENOMEM);
++      }
++
++      vpdma->pdev = pdev;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vpdma");
++      if (res == NULL) {
++              dev_err(&pdev->dev, "missing platform resources data\n");
++              return ERR_PTR(-ENODEV);
++      }
++
++      vpdma->base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
++      if (!vpdma->base) {
++              dev_err(&pdev->dev, "failed to ioremap\n");
++              return ERR_PTR(-ENOMEM);
++      }
++
++      r = vpdma_load_firmware(vpdma);
++      if (r) {
++              pr_err("failed to load firmware %s\n", VPDMA_FIRMWARE);
++              return ERR_PTR(r);
++      }
++
++      return vpdma;
++}
++MODULE_FIRMWARE(VPDMA_FIRMWARE);
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/vpdma.h
+@@ -0,0 +1,203 @@
++/*
++ * Copyright (c) 2013 Texas Instruments Inc.
++ *
++ * David Griego, <dagriego@biglakesoftware.com>
++ * Dale Farnsworth, <dale@farnsworth.org>
++ * Archit Taneja, <archit@ti.com>
++ *
++ * 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.
++ */
++
++#ifndef __TI_VPDMA_H_
++#define __TI_VPDMA_H_
++
++/*
++ * A vpdma_buf tracks the size, DMA address and mapping status of each
++ * driver DMA area.
++ */
++struct vpdma_buf {
++      void                    *addr;
++      dma_addr_t              dma_addr;
++      size_t                  size;
++      bool                    mapped;
++};
++
++struct vpdma_desc_list {
++      struct vpdma_buf buf;
++      void *next;
++      int type;
++};
++
++struct vpdma_data {
++      void __iomem            *base;
++
++      struct platform_device  *pdev;
++
++      /* tells whether vpdma firmware is loaded or not */
++      bool ready;
++};
++
++struct vpdma_data_format {
++      int data_type;
++      u8 depth;
++};
++
++#define VPDMA_DESC_ALIGN              16      /* 16-byte descriptor alignment */
++
++#define VPDMA_DTD_DESC_SIZE           32      /* 8 words */
++#define VPDMA_CFD_CTD_DESC_SIZE               16      /* 4 words */
++
++#define VPDMA_LIST_TYPE_NORMAL                0
++#define VPDMA_LIST_TYPE_SELF_MODIFYING        1
++#define VPDMA_LIST_TYPE_DOORBELL      2
++
++enum vpdma_yuv_formats {
++      VPDMA_DATA_FMT_Y444 = 0,
++      VPDMA_DATA_FMT_Y422,
++      VPDMA_DATA_FMT_Y420,
++      VPDMA_DATA_FMT_C444,
++      VPDMA_DATA_FMT_C422,
++      VPDMA_DATA_FMT_C420,
++      VPDMA_DATA_FMT_YC422,
++      VPDMA_DATA_FMT_YC444,
++      VPDMA_DATA_FMT_CY422,
++};
++
++enum vpdma_rgb_formats {
++      VPDMA_DATA_FMT_RGB565 = 0,
++      VPDMA_DATA_FMT_ARGB16_1555,
++      VPDMA_DATA_FMT_ARGB16,
++      VPDMA_DATA_FMT_RGBA16_5551,
++      VPDMA_DATA_FMT_RGBA16,
++      VPDMA_DATA_FMT_ARGB24,
++      VPDMA_DATA_FMT_RGB24,
++      VPDMA_DATA_FMT_ARGB32,
++      VPDMA_DATA_FMT_RGBA24,
++      VPDMA_DATA_FMT_RGBA32,
++      VPDMA_DATA_FMT_BGR565,
++      VPDMA_DATA_FMT_ABGR16_1555,
++      VPDMA_DATA_FMT_ABGR16,
++      VPDMA_DATA_FMT_BGRA16_5551,
++      VPDMA_DATA_FMT_BGRA16,
++      VPDMA_DATA_FMT_ABGR24,
++      VPDMA_DATA_FMT_BGR24,
++      VPDMA_DATA_FMT_ABGR32,
++      VPDMA_DATA_FMT_BGRA24,
++      VPDMA_DATA_FMT_BGRA32,
++};
++
++enum vpdma_misc_formats {
++      VPDMA_DATA_FMT_MV = 0,
++};
++
++extern const struct vpdma_data_format vpdma_yuv_fmts[];
++extern const struct vpdma_data_format vpdma_rgb_fmts[];
++extern const struct vpdma_data_format vpdma_misc_fmts[];
++
++enum vpdma_frame_start_event {
++      VPDMA_FSEVENT_HDMI_FID = 0,
++      VPDMA_FSEVENT_DVO2_FID,
++      VPDMA_FSEVENT_HDCOMP_FID,
++      VPDMA_FSEVENT_SD_FID,
++      VPDMA_FSEVENT_LM_FID0,
++      VPDMA_FSEVENT_LM_FID1,
++      VPDMA_FSEVENT_LM_FID2,
++      VPDMA_FSEVENT_CHANNEL_ACTIVE,
++};
++
++/*
++ * VPDMA channel numbers
++ */
++enum vpdma_channel {
++      VPE_CHAN_LUMA1_IN,
++      VPE_CHAN_CHROMA1_IN,
++      VPE_CHAN_LUMA2_IN,
++      VPE_CHAN_CHROMA2_IN,
++      VPE_CHAN_LUMA3_IN,
++      VPE_CHAN_CHROMA3_IN,
++      VPE_CHAN_MV_IN,
++      VPE_CHAN_MV_OUT,
++      VPE_CHAN_LUMA_OUT,
++      VPE_CHAN_CHROMA_OUT,
++      VPE_CHAN_RGB_OUT,
++};
++
++/* flags for VPDMA data descriptors */
++#define VPDMA_DATA_ODD_LINE_SKIP      (1 << 0)
++#define VPDMA_DATA_EVEN_LINE_SKIP     (1 << 1)
++#define VPDMA_DATA_FRAME_1D           (1 << 2)
++#define VPDMA_DATA_MODE_TILED         (1 << 3)
++
++/*
++ * client identifiers used for configuration descriptors
++ */
++#define CFD_MMR_CLIENT                0
++#define CFD_SC_CLIENT         4
++
++/* Address data block header format */
++struct vpdma_adb_hdr {
++      u32                     offset;
++      u32                     nwords;
++      u32                     reserved0;
++      u32                     reserved1;
++};
++
++/* helpers for creating ADB headers for config descriptors MMRs as client */
++#define ADB_ADDR(dma_buf, str, fld)   ((dma_buf)->addr + offsetof(str, fld))
++#define MMR_ADB_ADDR(buf, str, fld)   ADB_ADDR(&(buf), struct str, fld)
++
++#define VPDMA_SET_MMR_ADB_HDR(buf, str, hdr, regs, offset_a)  \
++      do {                                                    \
++              struct vpdma_adb_hdr *h;                        \
++              struct str *adb = NULL;                         \
++              h = MMR_ADB_ADDR(buf, str, hdr);                \
++              h->offset = (offset_a);                         \
++              h->nwords = sizeof(adb->regs) >> 2;             \
++      } while (0)
++
++/* vpdma descriptor buffer allocation and management */
++int vpdma_alloc_desc_buf(struct vpdma_buf *buf, size_t size);
++void vpdma_free_desc_buf(struct vpdma_buf *buf);
++int vpdma_map_desc_buf(struct vpdma_data *vpdma, struct vpdma_buf *buf);
++void vpdma_unmap_desc_buf(struct vpdma_data *vpdma, struct vpdma_buf *buf);
++
++/* vpdma descriptor list funcs */
++int vpdma_create_desc_list(struct vpdma_desc_list *list, size_t size, int type);
++void vpdma_reset_desc_list(struct vpdma_desc_list *list);
++void vpdma_free_desc_list(struct vpdma_desc_list *list);
++int vpdma_submit_descs(struct vpdma_data *vpdma, struct vpdma_desc_list *list);
++
++/* helpers for creating vpdma descriptors */
++void vpdma_add_cfd_block(struct vpdma_desc_list *list, int client,
++              struct vpdma_buf *blk, u32 dest_offset);
++void vpdma_add_cfd_adb(struct vpdma_desc_list *list, int client,
++              struct vpdma_buf *adb);
++void vpdma_add_sync_on_channel_ctd(struct vpdma_desc_list *list,
++              enum vpdma_channel chan);
++void vpdma_add_out_dtd(struct vpdma_desc_list *list, struct v4l2_rect *c_rect,
++              const struct vpdma_data_format *fmt, dma_addr_t dma_addr,
++              enum vpdma_channel chan, u32 flags);
++void vpdma_add_in_dtd(struct vpdma_desc_list *list, int frame_width,
++              int frame_height, struct v4l2_rect *c_rect,
++              const struct vpdma_data_format *fmt, dma_addr_t dma_addr,
++              enum vpdma_channel chan, int field, u32 flags);
++
++/* vpdma list interrupt management */
++void vpdma_enable_list_complete_irq(struct vpdma_data *vpdma, int list_num,
++              bool enable);
++void vpdma_clear_list_stat(struct vpdma_data *vpdma);
++
++/* vpdma client configuration */
++void vpdma_set_line_mode(struct vpdma_data *vpdma, int line_mode,
++              enum vpdma_channel chan);
++void vpdma_set_frame_start_event(struct vpdma_data *vpdma,
++              enum vpdma_frame_start_event fs_event, enum vpdma_channel chan);
++
++void vpdma_dump_regs(struct vpdma_data *vpdma);
++
++/* initialize vpdma, passed with VPE's platform device pointer */
++struct vpdma_data *vpdma_create(struct platform_device *pdev);
++
++#endif
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/vpdma_priv.h
+@@ -0,0 +1,641 @@
++/*
++ * Copyright (c) 2013 Texas Instruments Inc.
++ *
++ * David Griego, <dagriego@biglakesoftware.com>
++ * Dale Farnsworth, <dale@farnsworth.org>
++ * Archit Taneja, <archit@ti.com>
++ *
++ * 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.
++ */
++
++#ifndef _TI_VPDMA_PRIV_H_
++#define _TI_VPDMA_PRIV_H_
++
++/*
++ * VPDMA Register offsets
++ */
++
++/* Top level */
++#define VPDMA_PID             0x00
++#define VPDMA_LIST_ADDR               0x04
++#define VPDMA_LIST_ATTR               0x08
++#define VPDMA_LIST_STAT_SYNC  0x0c
++#define VPDMA_BG_RGB          0x18
++#define VPDMA_BG_YUV          0x1c
++#define VPDMA_SETUP           0x30
++#define VPDMA_MAX_SIZE1               0x34
++#define VPDMA_MAX_SIZE2               0x38
++#define VPDMA_MAX_SIZE3               0x3c
++
++/* Interrupts */
++#define VPDMA_INT_CHAN_STAT(grp)      (0x40 + grp * 8)
++#define VPDMA_INT_CHAN_MASK(grp)      (VPDMA_INT_CHAN_STAT(grp) + 4)
++#define VPDMA_INT_CLIENT0_STAT                0x78
++#define VPDMA_INT_CLIENT0_MASK                0x7c
++#define VPDMA_INT_CLIENT1_STAT                0x80
++#define VPDMA_INT_CLIENT1_MASK                0x84
++#define VPDMA_INT_LIST0_STAT          0x88
++#define VPDMA_INT_LIST0_MASK          0x8c
++
++#define VPDMA_PERFMON(i)              (0x200 + i * 4)
++
++/* VPE specific client registers */
++#define VPDMA_DEI_CHROMA1_CSTAT               0x0300
++#define VPDMA_DEI_LUMA1_CSTAT         0x0304
++#define VPDMA_DEI_LUMA2_CSTAT         0x0308
++#define VPDMA_DEI_CHROMA2_CSTAT               0x030c
++#define VPDMA_DEI_LUMA3_CSTAT         0x0310
++#define VPDMA_DEI_CHROMA3_CSTAT               0x0314
++#define VPDMA_DEI_MV_IN_CSTAT         0x0330
++#define VPDMA_DEI_MV_OUT_CSTAT                0x033c
++#define VPDMA_VIP_UP_Y_CSTAT          0x0390
++#define VPDMA_VIP_UP_UV_CSTAT         0x0394
++#define VPDMA_VPI_CTL_CSTAT           0x03d0
++
++/* Reg field info for VPDMA_CLIENT_CSTAT registers */
++#define VPDMA_CSTAT_LINE_MODE_MASK    0x03
++#define VPDMA_CSTAT_LINE_MODE_SHIFT   8
++#define VPDMA_CSTAT_FRAME_START_MASK  0xf
++#define VPDMA_CSTAT_FRAME_START_SHIFT 10
++
++#define VPDMA_LIST_NUM_MASK           0x07
++#define VPDMA_LIST_NUM_SHFT           24
++#define VPDMA_LIST_STOP_SHFT          20
++#define VPDMA_LIST_RDY_MASK           0x01
++#define VPDMA_LIST_RDY_SHFT           19
++#define VPDMA_LIST_TYPE_MASK          0x03
++#define VPDMA_LIST_TYPE_SHFT          16
++#define VPDMA_LIST_SIZE_MASK          0xffff
++
++/* VPDMA data type values for data formats */
++#define DATA_TYPE_Y444                                0x0
++#define DATA_TYPE_Y422                                0x1
++#define DATA_TYPE_Y420                                0x2
++#define DATA_TYPE_C444                                0x4
++#define DATA_TYPE_C422                                0x5
++#define DATA_TYPE_C420                                0x6
++#define DATA_TYPE_YC422                               0x7
++#define DATA_TYPE_YC444                               0x8
++#define DATA_TYPE_CY422                               0x23
++
++#define DATA_TYPE_RGB16_565                   0x0
++#define DATA_TYPE_ARGB_1555                   0x1
++#define DATA_TYPE_ARGB_4444                   0x2
++#define DATA_TYPE_RGBA_5551                   0x3
++#define DATA_TYPE_RGBA_4444                   0x4
++#define DATA_TYPE_ARGB24_6666                 0x5
++#define DATA_TYPE_RGB24_888                   0x6
++#define DATA_TYPE_ARGB32_8888                 0x7
++#define DATA_TYPE_RGBA24_6666                 0x8
++#define DATA_TYPE_RGBA32_8888                 0x9
++#define DATA_TYPE_BGR16_565                   0x10
++#define DATA_TYPE_ABGR_1555                   0x11
++#define DATA_TYPE_ABGR_4444                   0x12
++#define DATA_TYPE_BGRA_5551                   0x13
++#define DATA_TYPE_BGRA_4444                   0x14
++#define DATA_TYPE_ABGR24_6666                 0x15
++#define DATA_TYPE_BGR24_888                   0x16
++#define DATA_TYPE_ABGR32_8888                 0x17
++#define DATA_TYPE_BGRA24_6666                 0x18
++#define DATA_TYPE_BGRA32_8888                 0x19
++
++#define DATA_TYPE_MV                          0x3
++
++/* VPDMA channel numbers(only VPE channels for now) */
++#define       VPE_CHAN_NUM_LUMA1_IN           0
++#define       VPE_CHAN_NUM_CHROMA1_IN         1
++#define       VPE_CHAN_NUM_LUMA2_IN           2
++#define       VPE_CHAN_NUM_CHROMA2_IN         3
++#define       VPE_CHAN_NUM_LUMA3_IN           4
++#define       VPE_CHAN_NUM_CHROMA3_IN         5
++#define       VPE_CHAN_NUM_MV_IN              12
++#define       VPE_CHAN_NUM_MV_OUT             15
++#define       VPE_CHAN_NUM_LUMA_OUT           102
++#define       VPE_CHAN_NUM_CHROMA_OUT         103
++#define       VPE_CHAN_NUM_RGB_OUT            106
++
++/*
++ * a VPDMA address data block payload for a configuration descriptor needs to
++ * have each sub block length as a multiple of 16 bytes. Therefore, the overall
++ * size of the payload also needs to be a multiple of 16 bytes. The sub block
++ * lengths should be ensured to be aligned by the VPDMA user.
++ */
++#define VPDMA_ADB_SIZE_ALIGN          0x0f
++
++/*
++ * data transfer descriptor
++ */
++struct vpdma_dtd {
++      u32                     type_ctl_stride;
++      union {
++              u32             xfer_length_height;
++              u32             w1;
++      };
++      dma_addr_t              start_addr;
++      u32                     pkt_ctl;
++      union {
++              u32             frame_width_height;     /* inbound */
++              dma_addr_t      desc_write_addr;        /* outbound */
++      };
++      union {
++              u32             start_h_v;              /* inbound */
++              u32             max_width_height;       /* outbound */
++      };
++      u32                     client_attr0;
++      u32                     client_attr1;
++};
++
++/* Data Transfer Descriptor specifics */
++#define DTD_NO_NOTIFY         0
++#define DTD_NOTIFY            1
++
++#define DTD_PKT_TYPE          0xa
++#define DTD_DIR_IN            0
++#define DTD_DIR_OUT           1
++
++/* type_ctl_stride */
++#define DTD_DATA_TYPE_MASK    0x3f
++#define DTD_DATA_TYPE_SHFT    26
++#define DTD_NOTIFY_MASK               0x01
++#define DTD_NOTIFY_SHFT               25
++#define DTD_FIELD_MASK                0x01
++#define DTD_FIELD_SHFT                24
++#define DTD_1D_MASK           0x01
++#define DTD_1D_SHFT           23
++#define DTD_EVEN_LINE_SKIP_MASK       0x01
++#define DTD_EVEN_LINE_SKIP_SHFT       20
++#define DTD_ODD_LINE_SKIP_MASK        0x01
++#define DTD_ODD_LINE_SKIP_SHFT        16
++#define DTD_LINE_STRIDE_MASK  0xffff
++#define DTD_LINE_STRIDE_SHFT  0
++
++/* xfer_length_height */
++#define DTD_LINE_LENGTH_MASK  0xffff
++#define DTD_LINE_LENGTH_SHFT  16
++#define DTD_XFER_HEIGHT_MASK  0xffff
++#define DTD_XFER_HEIGHT_SHFT  0
++
++/* pkt_ctl */
++#define DTD_PKT_TYPE_MASK     0x1f
++#define DTD_PKT_TYPE_SHFT     27
++#define DTD_MODE_MASK         0x01
++#define DTD_MODE_SHFT         26
++#define DTD_DIR_MASK          0x01
++#define DTD_DIR_SHFT          25
++#define DTD_CHAN_MASK         0x01ff
++#define DTD_CHAN_SHFT         16
++#define DTD_PRI_MASK          0x0f
++#define DTD_PRI_SHFT          9
++#define DTD_NEXT_CHAN_MASK    0x01ff
++#define DTD_NEXT_CHAN_SHFT    0
++
++/* frame_width_height */
++#define DTD_FRAME_WIDTH_MASK  0xffff
++#define DTD_FRAME_WIDTH_SHFT  16
++#define DTD_FRAME_HEIGHT_MASK 0xffff
++#define DTD_FRAME_HEIGHT_SHFT 0
++
++/* start_h_v */
++#define DTD_H_START_MASK      0xffff
++#define DTD_H_START_SHFT      16
++#define DTD_V_START_MASK      0xffff
++#define DTD_V_START_SHFT      0
++
++#define DTD_DESC_START_SHIFT  5
++#define DTD_WRITE_DESC_MASK   0x01
++#define DTD_WRITE_DESC_SHIFT  2
++#define DTD_DROP_DATA_MASK    0x01
++#define DTD_DROP_DATA_SHIFT   1
++#define DTD_USE_DESC_MASK     0x01
++#define DTD_USE_DESC_SHIFT    0
++
++/* max_width_height */
++#define DTD_MAX_WIDTH_MASK    0x07
++#define DTD_MAX_WIDTH_SHFT    4
++#define DTD_MAX_HEIGHT_MASK   0x07
++#define DTD_MAX_HEIGHT_SHFT   0
++
++/* max width configurations */
++ /* unlimited width */
++#define       MAX_OUT_WIDTH_UNLIMITED         0
++/* as specified in max_size1 reg */
++#define MAX_OUT_WIDTH_REG1            1
++/* as specified in max_size2 reg */
++#define MAX_OUT_WIDTH_REG2            2
++/* as specified in max_size3 reg */
++#define       MAX_OUT_WIDTH_REG3              3
++/* maximum of 352 pixels as width */
++#define MAX_OUT_WIDTH_352             4
++/* maximum of 768 pixels as width */
++#define       MAX_OUT_WIDTH_768               5
++/* maximum of 1280 pixels width */
++#define       MAX_OUT_WIDTH_1280              6
++/* maximum of 1920 pixels as width */
++#define       MAX_OUT_WIDTH_1920              7
++
++/* max height configurations */
++ /* unlimited height */
++#define       MAX_OUT_HEIGHT_UNLIMITED        0
++/* as specified in max_size1 reg */
++#define MAX_OUT_HEIGHT_REG1           1
++/* as specified in max_size2 reg */
++#define MAX_OUT_HEIGHT_REG2           2
++/* as specified in max_size3 reg */
++#define       MAX_OUT_HEIGHT_REG3             3
++/* maximum of 288 lines as height */
++#define MAX_OUT_HEIGHT_288            4
++/* maximum of 576 lines as height */
++#define       MAX_OUT_HEIGHT_576              5
++/* maximum of 720 lines as height */
++#define       MAX_OUT_HEIGHT_720              6
++/* maximum of 1080 lines as height */
++#define       MAX_OUT_HEIGHT_1080             7
++
++static inline u32 dtd_type_ctl_stride(int type, bool notify, int field,
++                      bool one_d, bool even_line_skip, bool odd_line_skip,
++                      int line_stride)
++{
++      return (type << DTD_DATA_TYPE_SHFT) | (notify << DTD_NOTIFY_SHFT) |
++              (field << DTD_FIELD_SHFT) | (one_d << DTD_1D_SHFT) |
++              (even_line_skip << DTD_EVEN_LINE_SKIP_SHFT) |
++              (odd_line_skip << DTD_ODD_LINE_SKIP_SHFT) |
++              line_stride;
++}
++
++static inline u32 dtd_xfer_length_height(int line_length, int xfer_height)
++{
++      return (line_length << DTD_LINE_LENGTH_SHFT) | xfer_height;
++}
++
++static inline u32 dtd_pkt_ctl(bool mode, bool dir, int chan, int pri,
++                      int next_chan)
++{
++      return (DTD_PKT_TYPE << DTD_PKT_TYPE_SHFT) | (mode << DTD_MODE_SHFT) |
++              (dir << DTD_DIR_SHFT) | (chan << DTD_CHAN_SHFT) |
++              (pri << DTD_PRI_SHFT) | next_chan;
++}
++
++static inline u32 dtd_frame_width_height(int width, int height)
++{
++      return (width << DTD_FRAME_WIDTH_SHFT) | height;
++}
++
++static inline u32 dtd_desc_write_addr(unsigned int addr, bool write_desc,
++                      bool drop_data, bool use_desc)
++{
++      return (addr << DTD_DESC_START_SHIFT) |
++              (write_desc << DTD_WRITE_DESC_SHIFT) |
++              (drop_data << DTD_DROP_DATA_SHIFT) |
++              use_desc;
++}
++
++static inline u32 dtd_start_h_v(int h_start, int v_start)
++{
++      return (h_start << DTD_H_START_SHFT) | v_start;
++}
++
++static inline u32 dtd_max_width_height(int max_width, int max_height)
++{
++      return (max_width << DTD_MAX_WIDTH_SHFT) | max_height;
++}
++
++static inline int dtd_get_data_type(struct vpdma_dtd *dtd)
++{
++      return dtd->type_ctl_stride >> DTD_DATA_TYPE_SHFT;
++}
++
++static inline bool dtd_get_notify(struct vpdma_dtd *dtd)
++{
++      return (dtd->type_ctl_stride >> DTD_NOTIFY_SHFT) & DTD_NOTIFY_MASK;
++}
++
++static inline int dtd_get_field(struct vpdma_dtd *dtd)
++{
++      return (dtd->type_ctl_stride >> DTD_FIELD_SHFT) & DTD_FIELD_MASK;
++}
++
++static inline bool dtd_get_1d(struct vpdma_dtd *dtd)
++{
++      return (dtd->type_ctl_stride >> DTD_1D_SHFT) & DTD_1D_MASK;
++}
++
++static inline bool dtd_get_even_line_skip(struct vpdma_dtd *dtd)
++{
++      return (dtd->type_ctl_stride >> DTD_EVEN_LINE_SKIP_SHFT)
++              & DTD_EVEN_LINE_SKIP_MASK;
++}
++
++static inline bool dtd_get_odd_line_skip(struct vpdma_dtd *dtd)
++{
++      return (dtd->type_ctl_stride >> DTD_ODD_LINE_SKIP_SHFT)
++              & DTD_ODD_LINE_SKIP_MASK;
++}
++
++static inline int dtd_get_line_stride(struct vpdma_dtd *dtd)
++{
++      return dtd->type_ctl_stride & DTD_LINE_STRIDE_MASK;
++}
++
++static inline int dtd_get_line_length(struct vpdma_dtd *dtd)
++{
++      return dtd->xfer_length_height >> DTD_LINE_LENGTH_SHFT;
++}
++
++static inline int dtd_get_xfer_height(struct vpdma_dtd *dtd)
++{
++      return dtd->xfer_length_height & DTD_XFER_HEIGHT_MASK;
++}
++
++static inline int dtd_get_pkt_type(struct vpdma_dtd *dtd)
++{
++      return dtd->pkt_ctl >> DTD_PKT_TYPE_SHFT;
++}
++
++static inline bool dtd_get_mode(struct vpdma_dtd *dtd)
++{
++      return (dtd->pkt_ctl >> DTD_MODE_SHFT) & DTD_MODE_MASK;
++}
++
++static inline bool dtd_get_dir(struct vpdma_dtd *dtd)
++{
++      return (dtd->pkt_ctl >> DTD_DIR_SHFT) & DTD_DIR_MASK;
++}
++
++static inline int dtd_get_chan(struct vpdma_dtd *dtd)
++{
++      return (dtd->pkt_ctl >> DTD_CHAN_SHFT) & DTD_CHAN_MASK;
++}
++
++static inline int dtd_get_priority(struct vpdma_dtd *dtd)
++{
++      return (dtd->pkt_ctl >> DTD_PRI_SHFT) & DTD_PRI_MASK;
++}
++
++static inline int dtd_get_next_chan(struct vpdma_dtd *dtd)
++{
++      return (dtd->pkt_ctl >> DTD_NEXT_CHAN_SHFT) & DTD_NEXT_CHAN_MASK;
++}
++
++static inline int dtd_get_frame_width(struct vpdma_dtd *dtd)
++{
++      return dtd->frame_width_height >> DTD_FRAME_WIDTH_SHFT;
++}
++
++static inline int dtd_get_frame_height(struct vpdma_dtd *dtd)
++{
++      return dtd->frame_width_height & DTD_FRAME_HEIGHT_MASK;
++}
++
++static inline int dtd_get_desc_write_addr(struct vpdma_dtd *dtd)
++{
++      return dtd->desc_write_addr >> DTD_DESC_START_SHIFT;
++}
++
++static inline bool dtd_get_write_desc(struct vpdma_dtd *dtd)
++{
++      return (dtd->desc_write_addr >> DTD_WRITE_DESC_SHIFT) &
++                                                      DTD_WRITE_DESC_MASK;
++}
++
++static inline bool dtd_get_drop_data(struct vpdma_dtd *dtd)
++{
++      return (dtd->desc_write_addr >> DTD_DROP_DATA_SHIFT) &
++                                                      DTD_DROP_DATA_MASK;
++}
++
++static inline bool dtd_get_use_desc(struct vpdma_dtd *dtd)
++{
++      return dtd->desc_write_addr & DTD_USE_DESC_MASK;
++}
++
++static inline int dtd_get_h_start(struct vpdma_dtd *dtd)
++{
++      return dtd->start_h_v >> DTD_H_START_SHFT;
++}
++
++static inline int dtd_get_v_start(struct vpdma_dtd *dtd)
++{
++      return dtd->start_h_v & DTD_V_START_MASK;
++}
++
++static inline int dtd_get_max_width(struct vpdma_dtd *dtd)
++{
++      return (dtd->max_width_height >> DTD_MAX_WIDTH_SHFT) &
++                                                      DTD_MAX_WIDTH_MASK;
++}
++
++static inline int dtd_get_max_height(struct vpdma_dtd *dtd)
++{
++      return (dtd->max_width_height >> DTD_MAX_HEIGHT_SHFT) &
++                                                      DTD_MAX_HEIGHT_MASK;
++}
++
++/*
++ * configuration descriptor
++ */
++struct vpdma_cfd {
++      union {
++              u32     dest_addr_offset;
++              u32     w0;
++      };
++      union {
++              u32     block_len;              /* in words */
++              u32     w1;
++      };
++      u32             payload_addr;
++      u32             ctl_payload_len;        /* in words */
++};
++
++/* Configuration descriptor specifics */
++
++#define CFD_PKT_TYPE          0xb
++
++#define CFD_DIRECT            1
++#define CFD_INDIRECT          0
++#define CFD_CLS_ADB           0
++#define CFD_CLS_BLOCK         1
++
++/* block_len */
++#define CFD__BLOCK_LEN_MASK   0xffff
++#define CFD__BLOCK_LEN_SHFT   0
++
++/* ctl_payload_len */
++#define CFD_PKT_TYPE_MASK     0x1f
++#define CFD_PKT_TYPE_SHFT     27
++#define CFD_DIRECT_MASK               0x01
++#define CFD_DIRECT_SHFT               26
++#define CFD_CLASS_MASK                0x03
++#define CFD_CLASS_SHFT                24
++#define CFD_DEST_MASK         0xff
++#define CFD_DEST_SHFT         16
++#define CFD_PAYLOAD_LEN_MASK  0xffff
++#define CFD_PAYLOAD_LEN_SHFT  0
++
++static inline u32 cfd_pkt_payload_len(bool direct, int cls, int dest,
++              int payload_len)
++{
++      return (CFD_PKT_TYPE << CFD_PKT_TYPE_SHFT) |
++              (direct << CFD_DIRECT_SHFT) |
++              (cls << CFD_CLASS_SHFT) |
++              (dest << CFD_DEST_SHFT) |
++              payload_len;
++}
++
++static inline int cfd_get_pkt_type(struct vpdma_cfd *cfd)
++{
++      return cfd->ctl_payload_len >> CFD_PKT_TYPE_SHFT;
++}
++
++static inline bool cfd_get_direct(struct vpdma_cfd *cfd)
++{
++      return (cfd->ctl_payload_len >> CFD_DIRECT_SHFT) & CFD_DIRECT_MASK;
++}
++
++static inline bool cfd_get_class(struct vpdma_cfd *cfd)
++{
++      return (cfd->ctl_payload_len >> CFD_CLASS_SHFT) & CFD_CLASS_MASK;
++}
++
++static inline int cfd_get_dest(struct vpdma_cfd *cfd)
++{
++      return (cfd->ctl_payload_len >> CFD_DEST_SHFT) & CFD_DEST_MASK;
++}
++
++static inline int cfd_get_payload_len(struct vpdma_cfd *cfd)
++{
++      return cfd->ctl_payload_len & CFD_PAYLOAD_LEN_MASK;
++}
++
++/*
++ * control descriptor
++ */
++struct vpdma_ctd {
++      union {
++              u32     timer_value;
++              u32     list_addr;
++              u32     w0;
++      };
++      union {
++              u32     pixel_line_count;
++              u32     list_size;
++              u32     w1;
++      };
++      union {
++              u32     event;
++              u32     fid_ctl;
++              u32     w2;
++      };
++      u32             type_source_ctl;
++};
++
++/* control descriptor types */
++#define CTD_TYPE_SYNC_ON_CLIENT               0
++#define CTD_TYPE_SYNC_ON_LIST         1
++#define CTD_TYPE_SYNC_ON_EXT          2
++#define CTD_TYPE_SYNC_ON_LM_TIMER     3
++#define CTD_TYPE_SYNC_ON_CHANNEL      4
++#define CTD_TYPE_CHNG_CLIENT_IRQ      5
++#define CTD_TYPE_SEND_IRQ             6
++#define CTD_TYPE_RELOAD_LIST          7
++#define CTD_TYPE_ABORT_CHANNEL                8
++
++#define CTD_PKT_TYPE          0xc
++
++/* timer_value */
++#define CTD_TIMER_VALUE_MASK  0xffff
++#define CTD_TIMER_VALUE_SHFT  0
++
++/* pixel_line_count */
++#define CTD_PIXEL_COUNT_MASK  0xffff
++#define CTD_PIXEL_COUNT_SHFT  16
++#define CTD_LINE_COUNT_MASK   0xffff
++#define CTD_LINE_COUNT_SHFT   0
++
++/* list_size */
++#define CTD_LIST_SIZE_MASK    0xffff
++#define CTD_LIST_SIZE_SHFT    0
++
++/* event */
++#define CTD_EVENT_MASK                0x0f
++#define CTD_EVENT_SHFT                0
++
++/* fid_ctl */
++#define CTD_FID2_MASK         0x03
++#define CTD_FID2_SHFT         4
++#define CTD_FID1_MASK         0x03
++#define CTD_FID1_SHFT         2
++#define CTD_FID0_MASK         0x03
++#define CTD_FID0_SHFT         0
++
++/* type_source_ctl */
++#define CTD_PKT_TYPE_MASK     0x1f
++#define CTD_PKT_TYPE_SHFT     27
++#define CTD_SOURCE_MASK               0xff
++#define CTD_SOURCE_SHFT               16
++#define CTD_CONTROL_MASK      0x0f
++#define CTD_CONTROL_SHFT      0
++
++static inline u32 ctd_pixel_line_count(int pixel_count, int line_count)
++{
++      return (pixel_count << CTD_PIXEL_COUNT_SHFT) | line_count;
++}
++
++static inline u32 ctd_set_fid_ctl(int fid0, int fid1, int fid2)
++{
++      return (fid2 << CTD_FID2_SHFT) | (fid1 << CTD_FID1_SHFT) | fid0;
++}
++
++static inline u32 ctd_type_source_ctl(int source, int control)
++{
++      return (CTD_PKT_TYPE << CTD_PKT_TYPE_SHFT) |
++              (source << CTD_SOURCE_SHFT) | control;
++}
++
++static inline u32 ctd_get_pixel_count(struct vpdma_ctd *ctd)
++{
++      return ctd->pixel_line_count >> CTD_PIXEL_COUNT_SHFT;
++}
++
++static inline int ctd_get_line_count(struct vpdma_ctd *ctd)
++{
++      return ctd->pixel_line_count & CTD_LINE_COUNT_MASK;
++}
++
++static inline int ctd_get_event(struct vpdma_ctd *ctd)
++{
++      return ctd->event & CTD_EVENT_MASK;
++}
++
++static inline int ctd_get_fid2_ctl(struct vpdma_ctd *ctd)
++{
++      return (ctd->fid_ctl >> CTD_FID2_SHFT) & CTD_FID2_MASK;
++}
++
++static inline int ctd_get_fid1_ctl(struct vpdma_ctd *ctd)
++{
++      return (ctd->fid_ctl >> CTD_FID1_SHFT) & CTD_FID1_MASK;
++}
++
++static inline int ctd_get_fid0_ctl(struct vpdma_ctd *ctd)
++{
++      return ctd->fid_ctl & CTD_FID2_MASK;
++}
++
++static inline int ctd_get_pkt_type(struct vpdma_ctd *ctd)
++{
++      return ctd->type_source_ctl >> CTD_PKT_TYPE_SHFT;
++}
++
++static inline int ctd_get_source(struct vpdma_ctd *ctd)
++{
++      return (ctd->type_source_ctl >> CTD_SOURCE_SHFT) & CTD_SOURCE_MASK;
++}
++
++static inline int ctd_get_ctl(struct vpdma_ctd *ctd)
++{
++      return ctd->type_source_ctl & CTD_CONTROL_MASK;
++}
++
++#endif
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/vpe.c
+@@ -0,0 +1,2074 @@
++/*
++ * TI VPE mem2mem driver, based on the virtual v4l2-mem2mem example driver
++ *
++ * Copyright (c) 2013 Texas Instruments Inc.
++ * David Griego, <dagriego@biglakesoftware.com>
++ * Dale Farnsworth, <dale@farnsworth.org>
++ * Archit Taneja, <archit@ti.com>
++ *
++ * Copyright (c) 2009-2010 Samsung Electronics Co., Ltd.
++ * Pawel Osciak, <pawel@osciak.com>
++ * Marek Szyprowski, <m.szyprowski@samsung.com>
++ *
++ * Based on the virtual v4l2-mem2mem example device
++ *
++ * 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
++ */
++
++#include <linux/delay.h>
++#include <linux/dma-mapping.h>
++#include <linux/err.h>
++#include <linux/fs.h>
++#include <linux/interrupt.h>
++#include <linux/io.h>
++#include <linux/ioctl.h>
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/pm_runtime.h>
++#include <linux/sched.h>
++#include <linux/slab.h>
++#include <linux/videodev2.h>
++
++#include <media/v4l2-common.h>
++#include <media/v4l2-ctrls.h>
++#include <media/v4l2-device.h>
++#include <media/v4l2-event.h>
++#include <media/v4l2-ioctl.h>
++#include <media/v4l2-mem2mem.h>
++#include <media/videobuf2-core.h>
++#include <media/videobuf2-dma-contig.h>
++
++#include "vpdma.h"
++#include "vpe_regs.h"
++
++#define VPE_MODULE_NAME "vpe"
++
++/* minimum and maximum frame sizes */
++#define MIN_W         128
++#define MIN_H         128
++#define MAX_W         1920
++#define MAX_H         1080
++
++/* required alignments */
++#define S_ALIGN               0       /* multiple of 1 */
++#define H_ALIGN               1       /* multiple of 2 */
++#define W_ALIGN               1       /* multiple of 2 */
++
++/* multiple of 128 bits, line stride, 16 bytes */
++#define L_ALIGN               4
++
++/* flags that indicate a format can be used for capture/output */
++#define VPE_FMT_TYPE_CAPTURE  (1 << 0)
++#define VPE_FMT_TYPE_OUTPUT   (1 << 1)
++
++/* used as plane indices */
++#define VPE_MAX_PLANES        2
++#define VPE_LUMA      0
++#define VPE_CHROMA    1
++
++/* per m2m context info */
++#define VPE_MAX_SRC_BUFS      3       /* need 3 src fields to de-interlace */
++
++#define VPE_DEF_BUFS_PER_JOB  1       /* default one buffer per batch job */
++
++/*
++ * each VPE context can need up to 3 config desciptors, 7 input descriptors,
++ * 3 output descriptors, and 10 control descriptors
++ */
++#define VPE_DESC_LIST_SIZE    (10 * VPDMA_DTD_DESC_SIZE +     \
++                                      13 * VPDMA_CFD_CTD_DESC_SIZE)
++
++#define vpe_dbg(vpedev, fmt, arg...)  \
++              dev_dbg((vpedev)->v4l2_dev.dev, fmt, ##arg)
++#define vpe_err(vpedev, fmt, arg...)  \
++              dev_err((vpedev)->v4l2_dev.dev, fmt, ##arg)
++
++struct vpe_us_coeffs {
++      unsigned short  anchor_fid0_c0;
++      unsigned short  anchor_fid0_c1;
++      unsigned short  anchor_fid0_c2;
++      unsigned short  anchor_fid0_c3;
++      unsigned short  interp_fid0_c0;
++      unsigned short  interp_fid0_c1;
++      unsigned short  interp_fid0_c2;
++      unsigned short  interp_fid0_c3;
++      unsigned short  anchor_fid1_c0;
++      unsigned short  anchor_fid1_c1;
++      unsigned short  anchor_fid1_c2;
++      unsigned short  anchor_fid1_c3;
++      unsigned short  interp_fid1_c0;
++      unsigned short  interp_fid1_c1;
++      unsigned short  interp_fid1_c2;
++      unsigned short  interp_fid1_c3;
++};
++
++/*
++ * Default upsampler coefficients
++ */
++static const struct vpe_us_coeffs us_coeffs[] = {
++      {
++              /* Coefficients for progressive input */
++              0x00C8, 0x0348, 0x0018, 0x3FD8, 0x3FB8, 0x0378, 0x00E8, 0x3FE8,
++              0x00C8, 0x0348, 0x0018, 0x3FD8, 0x3FB8, 0x0378, 0x00E8, 0x3FE8,
++      },
++      {
++              /* Coefficients for Top Field Interlaced input */
++              0x0051, 0x03D5, 0x3FE3, 0x3FF7, 0x3FB5, 0x02E9, 0x018F, 0x3FD3,
++              /* Coefficients for Bottom Field Interlaced input */
++              0x016B, 0x0247, 0x00B1, 0x3F9D, 0x3FCF, 0x03DB, 0x005D, 0x3FF9,
++      },
++};
++
++/*
++ * the following registers are for configuring some of the parameters of the
++ * motion and edge detection blocks inside DEI, these generally remain the same,
++ * these could be passed later via userspace if some one needs to tweak these.
++ */
++struct vpe_dei_regs {
++      unsigned long mdt_spacial_freq_thr_reg;         /* VPE_DEI_REG2 */
++      unsigned long edi_config_reg;                   /* VPE_DEI_REG3 */
++      unsigned long edi_lut_reg0;                     /* VPE_DEI_REG4 */
++      unsigned long edi_lut_reg1;                     /* VPE_DEI_REG5 */
++      unsigned long edi_lut_reg2;                     /* VPE_DEI_REG6 */
++      unsigned long edi_lut_reg3;                     /* VPE_DEI_REG7 */
++};
++
++/*
++ * default expert DEI register values, unlikely to be modified.
++ */
++static const struct vpe_dei_regs dei_regs = {
++      0x020C0804u,
++      0x0118100Fu,
++      0x08040200u,
++      0x1010100Cu,
++      0x10101010u,
++      0x10101010u,
++};
++
++/*
++ * The port_data structure contains per-port data.
++ */
++struct vpe_port_data {
++      enum vpdma_channel channel;     /* VPDMA channel */
++      u8      vb_index;               /* input frame f, f-1, f-2 index */
++      u8      vb_part;                /* plane index for co-panar formats */
++};
++
++/*
++ * Define indices into the port_data tables
++ */
++#define VPE_PORT_LUMA1_IN     0
++#define VPE_PORT_CHROMA1_IN   1
++#define VPE_PORT_LUMA2_IN     2
++#define VPE_PORT_CHROMA2_IN   3
++#define VPE_PORT_LUMA3_IN     4
++#define VPE_PORT_CHROMA3_IN   5
++#define VPE_PORT_MV_IN                6
++#define VPE_PORT_MV_OUT               7
++#define VPE_PORT_LUMA_OUT     8
++#define VPE_PORT_CHROMA_OUT   9
++#define VPE_PORT_RGB_OUT      10
++
++static const struct vpe_port_data port_data[11] = {
++      [VPE_PORT_LUMA1_IN] = {
++              .channel        = VPE_CHAN_LUMA1_IN,
++              .vb_index       = 0,
++              .vb_part        = VPE_LUMA,
++      },
++      [VPE_PORT_CHROMA1_IN] = {
++              .channel        = VPE_CHAN_CHROMA1_IN,
++              .vb_index       = 0,
++              .vb_part        = VPE_CHROMA,
++      },
++      [VPE_PORT_LUMA2_IN] = {
++              .channel        = VPE_CHAN_LUMA2_IN,
++              .vb_index       = 1,
++              .vb_part        = VPE_LUMA,
++      },
++      [VPE_PORT_CHROMA2_IN] = {
++              .channel        = VPE_CHAN_CHROMA2_IN,
++              .vb_index       = 1,
++              .vb_part        = VPE_CHROMA,
++      },
++      [VPE_PORT_LUMA3_IN] = {
++              .channel        = VPE_CHAN_LUMA3_IN,
++              .vb_index       = 2,
++              .vb_part        = VPE_LUMA,
++      },
++      [VPE_PORT_CHROMA3_IN] = {
++              .channel        = VPE_CHAN_CHROMA3_IN,
++              .vb_index       = 2,
++              .vb_part        = VPE_CHROMA,
++      },
++      [VPE_PORT_MV_IN] = {
++              .channel        = VPE_CHAN_MV_IN,
++      },
++      [VPE_PORT_MV_OUT] = {
++              .channel        = VPE_CHAN_MV_OUT,
++      },
++      [VPE_PORT_LUMA_OUT] = {
++              .channel        = VPE_CHAN_LUMA_OUT,
++              .vb_part        = VPE_LUMA,
++      },
++      [VPE_PORT_CHROMA_OUT] = {
++              .channel        = VPE_CHAN_CHROMA_OUT,
++              .vb_part        = VPE_CHROMA,
++      },
++      [VPE_PORT_RGB_OUT] = {
++              .channel        = VPE_CHAN_RGB_OUT,
++              .vb_part        = VPE_LUMA,
++      },
++};
++
++
++/* driver info for each of the supported video formats */
++struct vpe_fmt {
++      char    *name;                  /* human-readable name */
++      u32     fourcc;                 /* standard format identifier */
++      u8      types;                  /* CAPTURE and/or OUTPUT */
++      u8      coplanar;               /* set for unpacked Luma and Chroma */
++      /* vpdma format info for each plane */
++      struct vpdma_data_format const *vpdma_fmt[VPE_MAX_PLANES];
++};
++
++static struct vpe_fmt vpe_formats[] = {
++      {
++              .name           = "YUV 422 co-planar",
++              .fourcc         = V4L2_PIX_FMT_NV16,
++              .types          = VPE_FMT_TYPE_CAPTURE | VPE_FMT_TYPE_OUTPUT,
++              .coplanar       = 1,
++              .vpdma_fmt      = { &vpdma_yuv_fmts[VPDMA_DATA_FMT_Y444],
++                                  &vpdma_yuv_fmts[VPDMA_DATA_FMT_C444],
++                                },
++      },
++      {
++              .name           = "YUV 420 co-planar",
++              .fourcc         = V4L2_PIX_FMT_NV12,
++              .types          = VPE_FMT_TYPE_CAPTURE | VPE_FMT_TYPE_OUTPUT,
++              .coplanar       = 1,
++              .vpdma_fmt      = { &vpdma_yuv_fmts[VPDMA_DATA_FMT_Y420],
++                                  &vpdma_yuv_fmts[VPDMA_DATA_FMT_C420],
++                                },
++      },
++      {
++              .name           = "YUYV 422 packed",
++              .fourcc         = V4L2_PIX_FMT_YUYV,
++              .types          = VPE_FMT_TYPE_CAPTURE | VPE_FMT_TYPE_OUTPUT,
++              .coplanar       = 0,
++              .vpdma_fmt      = { &vpdma_yuv_fmts[VPDMA_DATA_FMT_YC422],
++                                },
++      },
++      {
++              .name           = "UYVY 422 packed",
++              .fourcc         = V4L2_PIX_FMT_UYVY,
++              .types          = VPE_FMT_TYPE_CAPTURE | VPE_FMT_TYPE_OUTPUT,
++              .coplanar       = 0,
++              .vpdma_fmt      = { &vpdma_yuv_fmts[VPDMA_DATA_FMT_CY422],
++                                },
++      },
++};
++
++/*
++ * per-queue, driver-specific private data.
++ * there is one source queue and one destination queue for each m2m context.
++ */
++struct vpe_q_data {
++      unsigned int            width;                          /* frame width */
++      unsigned int            height;                         /* frame height */
++      unsigned int            bytesperline[VPE_MAX_PLANES];   /* bytes per line in memory */
++      enum v4l2_colorspace    colorspace;
++      enum v4l2_field         field;                          /* supported field value */
++      unsigned int            flags;
++      unsigned int            sizeimage[VPE_MAX_PLANES];      /* image size in memory */
++      struct v4l2_rect        c_rect;                         /* crop/compose rectangle */
++      struct vpe_fmt          *fmt;                           /* format info */
++};
++
++/* vpe_q_data flag bits */
++#define       Q_DATA_FRAME_1D         (1 << 0)
++#define       Q_DATA_MODE_TILED       (1 << 1)
++#define       Q_DATA_INTERLACED       (1 << 2)
++
++enum {
++      Q_DATA_SRC = 0,
++      Q_DATA_DST = 1,
++};
++
++/* find our format description corresponding to the passed v4l2_format */
++static struct vpe_fmt *find_format(struct v4l2_format *f)
++{
++      struct vpe_fmt *fmt;
++      unsigned int k;
++
++      for (k = 0; k < ARRAY_SIZE(vpe_formats); k++) {
++              fmt = &vpe_formats[k];
++              if (fmt->fourcc == f->fmt.pix.pixelformat)
++                      return fmt;
++      }
++
++      return NULL;
++}
++
++/*
++ * there is one vpe_dev structure in the driver, it is shared by
++ * all instances.
++ */
++struct vpe_dev {
++      struct v4l2_device      v4l2_dev;
++      struct video_device     vfd;
++      struct v4l2_m2m_dev     *m2m_dev;
++
++      atomic_t                num_instances;  /* count of driver instances */
++      dma_addr_t              loaded_mmrs;    /* shadow mmrs in device */
++      struct mutex            dev_mutex;
++      spinlock_t              lock;
++
++      int                     irq;
++      void __iomem            *base;
++
++      struct vb2_alloc_ctx    *alloc_ctx;
++      struct vpdma_data       *vpdma;         /* vpdma data handle */
++};
++
++/*
++ * There is one vpe_ctx structure for each m2m context.
++ */
++struct vpe_ctx {
++      struct v4l2_fh          fh;
++      struct vpe_dev          *dev;
++      struct v4l2_m2m_ctx     *m2m_ctx;
++      struct v4l2_ctrl_handler hdl;
++
++      unsigned int            field;                  /* current field */
++      unsigned int            sequence;               /* current frame/field seq */
++      unsigned int            aborting;               /* abort after next irq */
++
++      unsigned int            bufs_per_job;           /* input buffers per batch */
++      unsigned int            bufs_completed;         /* bufs done in this batch */
++
++      struct vpe_q_data       q_data[2];              /* src & dst queue data */
++      struct vb2_buffer       *src_vbs[VPE_MAX_SRC_BUFS];
++      struct vb2_buffer       *dst_vb;
++
++      dma_addr_t              mv_buf_dma[2];          /* dma addrs of motion vector in/out bufs */
++      void                    *mv_buf[2];             /* virtual addrs of motion vector bufs */
++      size_t                  mv_buf_size;            /* current motion vector buffer size */
++      struct vpdma_buf        mmr_adb;                /* shadow reg addr/data block */
++      struct vpdma_desc_list  desc_list;              /* DMA descriptor list */
++
++      bool                    deinterlacing;          /* using de-interlacer */
++      bool                    load_mmrs;              /* have new shadow reg values */
++
++      unsigned int            src_mv_buf_selector;
++};
++
++
++/*
++ * M2M devices get 2 queues.
++ * Return the queue given the type.
++ */
++static struct vpe_q_data *get_q_data(struct vpe_ctx *ctx,
++                                   enum v4l2_buf_type type)
++{
++      switch (type) {
++      case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
++              return &ctx->q_data[Q_DATA_SRC];
++      case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
++              return &ctx->q_data[Q_DATA_DST];
++      default:
++              BUG();
++      }
++      return NULL;
++}
++
++static u32 read_reg(struct vpe_dev *dev, int offset)
++{
++      return ioread32(dev->base + offset);
++}
++
++static void write_reg(struct vpe_dev *dev, int offset, u32 value)
++{
++      iowrite32(value, dev->base + offset);
++}
++
++/* register field read/write helpers */
++static int get_field(u32 value, u32 mask, int shift)
++{
++      return (value & (mask << shift)) >> shift;
++}
++
++static int read_field_reg(struct vpe_dev *dev, int offset, u32 mask, int shift)
++{
++      return get_field(read_reg(dev, offset), mask, shift);
++}
++
++static void write_field(u32 *valp, u32 field, u32 mask, int shift)
++{
++      u32 val = *valp;
++
++      val &= ~(mask << shift);
++      val |= (field & mask) << shift;
++      *valp = val;
++}
++
++static void write_field_reg(struct vpe_dev *dev, int offset, u32 field,
++              u32 mask, int shift)
++{
++      u32 val = read_reg(dev, offset);
++
++      write_field(&val, field, mask, shift);
++
++      write_reg(dev, offset, val);
++}
++
++/*
++ * DMA address/data block for the shadow registers
++ */
++struct vpe_mmr_adb {
++      struct vpdma_adb_hdr    out_fmt_hdr;
++      u32                     out_fmt_reg[1];
++      u32                     out_fmt_pad[3];
++      struct vpdma_adb_hdr    us1_hdr;
++      u32                     us1_regs[8];
++      struct vpdma_adb_hdr    us2_hdr;
++      u32                     us2_regs[8];
++      struct vpdma_adb_hdr    us3_hdr;
++      u32                     us3_regs[8];
++      struct vpdma_adb_hdr    dei_hdr;
++      u32                     dei_regs[8];
++      struct vpdma_adb_hdr    sc_hdr;
++      u32                     sc_regs[1];
++      u32                     sc_pad[3];
++      struct vpdma_adb_hdr    csc_hdr;
++      u32                     csc_regs[6];
++      u32                     csc_pad[2];
++};
++
++#define VPE_SET_MMR_ADB_HDR(ctx, hdr, regs, offset_a) \
++      VPDMA_SET_MMR_ADB_HDR(ctx->mmr_adb, vpe_mmr_adb, hdr, regs, offset_a)
++/*
++ * Set the headers for all of the address/data block structures.
++ */
++static void init_adb_hdrs(struct vpe_ctx *ctx)
++{
++      VPE_SET_MMR_ADB_HDR(ctx, out_fmt_hdr, out_fmt_reg, VPE_CLK_FORMAT_SELECT);
++      VPE_SET_MMR_ADB_HDR(ctx, us1_hdr, us1_regs, VPE_US1_R0);
++      VPE_SET_MMR_ADB_HDR(ctx, us2_hdr, us2_regs, VPE_US2_R0);
++      VPE_SET_MMR_ADB_HDR(ctx, us3_hdr, us3_regs, VPE_US3_R0);
++      VPE_SET_MMR_ADB_HDR(ctx, dei_hdr, dei_regs, VPE_DEI_FRAME_SIZE);
++      VPE_SET_MMR_ADB_HDR(ctx, sc_hdr, sc_regs, VPE_SC_MP_SC0);
++      VPE_SET_MMR_ADB_HDR(ctx, csc_hdr, csc_regs, VPE_CSC_CSC00);
++};
++
++/*
++ * Allocate or re-allocate the motion vector DMA buffers
++ * There are two buffers, one for input and one for output.
++ * However, the roles are reversed after each field is processed.
++ * In other words, after each field is processed, the previous
++ * output (dst) MV buffer becomes the new input (src) MV buffer.
++ */
++static int realloc_mv_buffers(struct vpe_ctx *ctx, size_t size)
++{
++      struct device *dev = ctx->dev->v4l2_dev.dev;
++
++      if (ctx->mv_buf_size == size)
++              return 0;
++
++      if (ctx->mv_buf[0])
++              dma_free_coherent(dev, ctx->mv_buf_size, ctx->mv_buf[0],
++                      ctx->mv_buf_dma[0]);
++
++      if (ctx->mv_buf[1])
++              dma_free_coherent(dev, ctx->mv_buf_size, ctx->mv_buf[1],
++                      ctx->mv_buf_dma[1]);
++
++      if (size == 0)
++              return 0;
++
++      ctx->mv_buf[0] = dma_alloc_coherent(dev, size, &ctx->mv_buf_dma[0],
++                              GFP_KERNEL);
++      if (!ctx->mv_buf[0]) {
++              vpe_err(ctx->dev, "failed to allocate motion vector buffer\n");
++              return -ENOMEM;
++      }
++
++      ctx->mv_buf[1] = dma_alloc_coherent(dev, size, &ctx->mv_buf_dma[1],
++                              GFP_KERNEL);
++      if (!ctx->mv_buf[1]) {
++              vpe_err(ctx->dev, "failed to allocate motion vector buffer\n");
++              dma_free_coherent(dev, size, ctx->mv_buf[0],
++                      ctx->mv_buf_dma[0]);
++
++              return -ENOMEM;
++      }
++
++      ctx->mv_buf_size = size;
++      ctx->src_mv_buf_selector = 0;
++
++      return 0;
++}
++
++static void free_mv_buffers(struct vpe_ctx *ctx)
++{
++      realloc_mv_buffers(ctx, 0);
++}
++
++/*
++ * While de-interlacing, we keep the two most recent input buffers
++ * around.  This function frees those two buffers when we have
++ * finished processing the current stream.
++ */
++static void free_vbs(struct vpe_ctx *ctx)
++{
++      struct vpe_dev *dev = ctx->dev;
++      unsigned long flags;
++
++      if (ctx->src_vbs[2] == NULL)
++              return;
++
++      spin_lock_irqsave(&dev->lock, flags);
++      if (ctx->src_vbs[2]) {
++              v4l2_m2m_buf_done(ctx->src_vbs[2], VB2_BUF_STATE_DONE);
++              v4l2_m2m_buf_done(ctx->src_vbs[1], VB2_BUF_STATE_DONE);
++      }
++      spin_unlock_irqrestore(&dev->lock, flags);
++}
++
++/*
++ * Enable or disable the VPE clocks
++ */
++static void vpe_set_clock_enable(struct vpe_dev *dev, bool on)
++{
++      u32 val = 0;
++
++      if (on)
++              val = VPE_DATA_PATH_CLK_ENABLE | VPE_VPEDMA_CLK_ENABLE;
++      write_reg(dev, VPE_CLK_ENABLE, val);
++}
++
++static void vpe_top_reset(struct vpe_dev *dev)
++{
++
++      write_field_reg(dev, VPE_CLK_RESET, 1, VPE_DATA_PATH_CLK_RESET_MASK,
++              VPE_DATA_PATH_CLK_RESET_SHIFT);
++
++      usleep_range(100, 150);
++
++      write_field_reg(dev, VPE_CLK_RESET, 0, VPE_DATA_PATH_CLK_RESET_MASK,
++              VPE_DATA_PATH_CLK_RESET_SHIFT);
++}
++
++static void vpe_top_vpdma_reset(struct vpe_dev *dev)
++{
++      write_field_reg(dev, VPE_CLK_RESET, 1, VPE_VPDMA_CLK_RESET_MASK,
++              VPE_VPDMA_CLK_RESET_SHIFT);
++
++      usleep_range(100, 150);
++
++      write_field_reg(dev, VPE_CLK_RESET, 0, VPE_VPDMA_CLK_RESET_MASK,
++              VPE_VPDMA_CLK_RESET_SHIFT);
++}
++
++/*
++ * Load the correct of upsampler coefficients into the shadow MMRs
++ */
++static void set_us_coefficients(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      struct vpe_q_data *s_q_data = &ctx->q_data[Q_DATA_SRC];
++      u32 *us1_reg = &mmr_adb->us1_regs[0];
++      u32 *us2_reg = &mmr_adb->us2_regs[0];
++      u32 *us3_reg = &mmr_adb->us3_regs[0];
++      const unsigned short *cp, *end_cp;
++
++      cp = &us_coeffs[0].anchor_fid0_c0;
++
++      if (s_q_data->flags & Q_DATA_INTERLACED)        /* interlaced */
++              cp += sizeof(us_coeffs[0]) / sizeof(*cp);
++
++      end_cp = cp + sizeof(us_coeffs[0]) / sizeof(*cp);
++
++      while (cp < end_cp) {
++              write_field(us1_reg, *cp++, VPE_US_C0_MASK, VPE_US_C0_SHIFT);
++              write_field(us1_reg, *cp++, VPE_US_C1_MASK, VPE_US_C1_SHIFT);
++              *us2_reg++ = *us1_reg;
++              *us3_reg++ = *us1_reg++;
++      }
++      ctx->load_mmrs = true;
++}
++
++/*
++ * Set the upsampler config mode and the VPDMA line mode in the shadow MMRs.
++ */
++static void set_cfg_and_line_modes(struct vpe_ctx *ctx)
++{
++      struct vpe_fmt *fmt = ctx->q_data[Q_DATA_SRC].fmt;
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      u32 *us1_reg0 = &mmr_adb->us1_regs[0];
++      u32 *us2_reg0 = &mmr_adb->us2_regs[0];
++      u32 *us3_reg0 = &mmr_adb->us3_regs[0];
++      int line_mode = 1;
++      int cfg_mode = 1;
++
++      /*
++       * Cfg Mode 0: YUV420 source, enable upsampler, DEI is de-interlacing.
++       * Cfg Mode 1: YUV422 source, disable upsampler, DEI is de-interlacing.
++       */
++
++      if (fmt->fourcc == V4L2_PIX_FMT_NV12) {
++              cfg_mode = 0;
++              line_mode = 0;          /* double lines to line buffer */
++      }
++
++      write_field(us1_reg0, cfg_mode, VPE_US_MODE_MASK, VPE_US_MODE_SHIFT);
++      write_field(us2_reg0, cfg_mode, VPE_US_MODE_MASK, VPE_US_MODE_SHIFT);
++      write_field(us3_reg0, cfg_mode, VPE_US_MODE_MASK, VPE_US_MODE_SHIFT);
++
++      /* regs for now */
++      vpdma_set_line_mode(ctx->dev->vpdma, line_mode, VPE_CHAN_CHROMA1_IN);
++      vpdma_set_line_mode(ctx->dev->vpdma, line_mode, VPE_CHAN_CHROMA2_IN);
++      vpdma_set_line_mode(ctx->dev->vpdma, line_mode, VPE_CHAN_CHROMA3_IN);
++
++      /* frame start for input luma */
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_LUMA1_IN);
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_LUMA2_IN);
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_LUMA3_IN);
++
++      /* frame start for input chroma */
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_CHROMA1_IN);
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_CHROMA2_IN);
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_CHROMA3_IN);
++
++      /* frame start for MV in client */
++      vpdma_set_frame_start_event(ctx->dev->vpdma, VPDMA_FSEVENT_CHANNEL_ACTIVE,
++              VPE_CHAN_MV_IN);
++
++      ctx->load_mmrs = true;
++}
++
++/*
++ * Set the shadow registers that are modified when the source
++ * format changes.
++ */
++static void set_src_registers(struct vpe_ctx *ctx)
++{
++      set_us_coefficients(ctx);
++}
++
++/*
++ * Set the shadow registers that are modified when the destination
++ * format changes.
++ */
++static void set_dst_registers(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      struct vpe_fmt *fmt = ctx->q_data[Q_DATA_DST].fmt;
++      u32 val = 0;
++
++      /* select RGB path when color space conversion is supported in future */
++      if (fmt->fourcc == V4L2_PIX_FMT_RGB24)
++              val |= VPE_RGB_OUT_SELECT | VPE_CSC_SRC_DEI_SCALER;
++      else if (fmt->fourcc == V4L2_PIX_FMT_NV16)
++              val |= VPE_COLOR_SEPARATE_422;
++
++      /* The source of CHR_DS is always the scaler, whether it's used or not */
++      val |= VPE_DS_SRC_DEI_SCALER;
++
++      if (fmt->fourcc != V4L2_PIX_FMT_NV12)
++              val |= VPE_DS_BYPASS;
++
++      mmr_adb->out_fmt_reg[0] = val;
++
++      ctx->load_mmrs = true;
++}
++
++/*
++ * Set the de-interlacer shadow register values
++ */
++static void set_dei_regs(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      struct vpe_q_data *s_q_data = &ctx->q_data[Q_DATA_SRC];
++      unsigned int src_h = s_q_data->c_rect.height;
++      unsigned int src_w = s_q_data->c_rect.width;
++      u32 *dei_mmr0 = &mmr_adb->dei_regs[0];
++      bool deinterlace = true;
++      u32 val = 0;
++
++      /*
++       * according to TRM, we should set DEI in progressive bypass mode when
++       * the input content is progressive, however, DEI is bypassed correctly
++       * for both progressive and interlace content in interlace bypass mode.
++       * It has been recommended not to use progressive bypass mode.
++       */
++      if ((!ctx->deinterlacing && (s_q_data->flags & Q_DATA_INTERLACED)) ||
++                      !(s_q_data->flags & Q_DATA_INTERLACED)) {
++              deinterlace = false;
++              val = VPE_DEI_INTERLACE_BYPASS;
++      }
++
++      src_h = deinterlace ? src_h * 2 : src_h;
++
++      val |= (src_h << VPE_DEI_HEIGHT_SHIFT) |
++              (src_w << VPE_DEI_WIDTH_SHIFT) |
++              VPE_DEI_FIELD_FLUSH;
++
++      *dei_mmr0 = val;
++
++      ctx->load_mmrs = true;
++}
++
++static void set_dei_shadow_registers(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      u32 *dei_mmr = &mmr_adb->dei_regs[0];
++      const struct vpe_dei_regs *cur = &dei_regs;
++
++      dei_mmr[2]  = cur->mdt_spacial_freq_thr_reg;
++      dei_mmr[3]  = cur->edi_config_reg;
++      dei_mmr[4]  = cur->edi_lut_reg0;
++      dei_mmr[5]  = cur->edi_lut_reg1;
++      dei_mmr[6]  = cur->edi_lut_reg2;
++      dei_mmr[7]  = cur->edi_lut_reg3;
++
++      ctx->load_mmrs = true;
++}
++
++static void set_csc_coeff_bypass(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      u32 *shadow_csc_reg5 = &mmr_adb->csc_regs[5];
++
++      *shadow_csc_reg5 |= VPE_CSC_BYPASS;
++
++      ctx->load_mmrs = true;
++}
++
++static void set_sc_regs_bypass(struct vpe_ctx *ctx)
++{
++      struct vpe_mmr_adb *mmr_adb = ctx->mmr_adb.addr;
++      u32 *sc_reg0 = &mmr_adb->sc_regs[0];
++      u32 val = 0;
++
++      val |= VPE_SC_BYPASS;
++      *sc_reg0 = val;
++
++      ctx->load_mmrs = true;
++}
++
++/*
++ * Set the shadow registers whose values are modified when either the
++ * source or destination format is changed.
++ */
++static int set_srcdst_params(struct vpe_ctx *ctx)
++{
++      struct vpe_q_data *s_q_data =  &ctx->q_data[Q_DATA_SRC];
++      struct vpe_q_data *d_q_data =  &ctx->q_data[Q_DATA_DST];
++      size_t mv_buf_size;
++      int ret;
++
++      ctx->sequence = 0;
++      ctx->field = V4L2_FIELD_TOP;
++
++      if ((s_q_data->flags & Q_DATA_INTERLACED) &&
++                      !(d_q_data->flags & Q_DATA_INTERLACED)) {
++              const struct vpdma_data_format *mv =
++                      &vpdma_misc_fmts[VPDMA_DATA_FMT_MV];
++
++              ctx->deinterlacing = 1;
++              mv_buf_size =
++                      (s_q_data->width * s_q_data->height * mv->depth) >> 3;
++      } else {
++              ctx->deinterlacing = 0;
++              mv_buf_size = 0;
++      }
++
++      free_vbs(ctx);
++
++      ret = realloc_mv_buffers(ctx, mv_buf_size);
++      if (ret)
++              return ret;
++
++      set_cfg_and_line_modes(ctx);
++      set_dei_regs(ctx);
++      set_csc_coeff_bypass(ctx);
++      set_sc_regs_bypass(ctx);
++
++      return 0;
++}
++
++/*
++ * Return the vpe_ctx structure for a given struct file
++ */
++static struct vpe_ctx *file2ctx(struct file *file)
++{
++      return container_of(file->private_data, struct vpe_ctx, fh);
++}
++
++/*
++ * mem2mem callbacks
++ */
++
++/**
++ * job_ready() - check whether an instance is ready to be scheduled to run
++ */
++static int job_ready(void *priv)
++{
++      struct vpe_ctx *ctx = priv;
++      int needed = ctx->bufs_per_job;
++
++      if (ctx->deinterlacing && ctx->src_vbs[2] == NULL)
++              needed += 2;    /* need additional two most recent fields */
++
++      if (v4l2_m2m_num_src_bufs_ready(ctx->m2m_ctx) < needed)
++              return 0;
++
++      return 1;
++}
++
++static void job_abort(void *priv)
++{
++      struct vpe_ctx *ctx = priv;
++
++      /* Will cancel the transaction in the next interrupt handler */
++      ctx->aborting = 1;
++}
++
++/*
++ * Lock access to the device
++ */
++static void vpe_lock(void *priv)
++{
++      struct vpe_ctx *ctx = priv;
++      struct vpe_dev *dev = ctx->dev;
++      mutex_lock(&dev->dev_mutex);
++}
++
++static void vpe_unlock(void *priv)
++{
++      struct vpe_ctx *ctx = priv;
++      struct vpe_dev *dev = ctx->dev;
++      mutex_unlock(&dev->dev_mutex);
++}
++
++static void vpe_dump_regs(struct vpe_dev *dev)
++{
++#define DUMPREG(r) vpe_dbg(dev, "%-35s %08x\n", #r, read_reg(dev, VPE_##r))
++
++      vpe_dbg(dev, "VPE Registers:\n");
++
++      DUMPREG(PID);
++      DUMPREG(SYSCONFIG);
++      DUMPREG(INT0_STATUS0_RAW);
++      DUMPREG(INT0_STATUS0);
++      DUMPREG(INT0_ENABLE0);
++      DUMPREG(INT0_STATUS1_RAW);
++      DUMPREG(INT0_STATUS1);
++      DUMPREG(INT0_ENABLE1);
++      DUMPREG(CLK_ENABLE);
++      DUMPREG(CLK_RESET);
++      DUMPREG(CLK_FORMAT_SELECT);
++      DUMPREG(CLK_RANGE_MAP);
++      DUMPREG(US1_R0);
++      DUMPREG(US1_R1);
++      DUMPREG(US1_R2);
++      DUMPREG(US1_R3);
++      DUMPREG(US1_R4);
++      DUMPREG(US1_R5);
++      DUMPREG(US1_R6);
++      DUMPREG(US1_R7);
++      DUMPREG(US2_R0);
++      DUMPREG(US2_R1);
++      DUMPREG(US2_R2);
++      DUMPREG(US2_R3);
++      DUMPREG(US2_R4);
++      DUMPREG(US2_R5);
++      DUMPREG(US2_R6);
++      DUMPREG(US2_R7);
++      DUMPREG(US3_R0);
++      DUMPREG(US3_R1);
++      DUMPREG(US3_R2);
++      DUMPREG(US3_R3);
++      DUMPREG(US3_R4);
++      DUMPREG(US3_R5);
++      DUMPREG(US3_R6);
++      DUMPREG(US3_R7);
++      DUMPREG(DEI_FRAME_SIZE);
++      DUMPREG(MDT_BYPASS);
++      DUMPREG(MDT_SF_THRESHOLD);
++      DUMPREG(EDI_CONFIG);
++      DUMPREG(DEI_EDI_LUT_R0);
++      DUMPREG(DEI_EDI_LUT_R1);
++      DUMPREG(DEI_EDI_LUT_R2);
++      DUMPREG(DEI_EDI_LUT_R3);
++      DUMPREG(DEI_FMD_WINDOW_R0);
++      DUMPREG(DEI_FMD_WINDOW_R1);
++      DUMPREG(DEI_FMD_CONTROL_R0);
++      DUMPREG(DEI_FMD_CONTROL_R1);
++      DUMPREG(DEI_FMD_STATUS_R0);
++      DUMPREG(DEI_FMD_STATUS_R1);
++      DUMPREG(DEI_FMD_STATUS_R2);
++      DUMPREG(SC_MP_SC0);
++      DUMPREG(SC_MP_SC1);
++      DUMPREG(SC_MP_SC2);
++      DUMPREG(SC_MP_SC3);
++      DUMPREG(SC_MP_SC4);
++      DUMPREG(SC_MP_SC5);
++      DUMPREG(SC_MP_SC6);
++      DUMPREG(SC_MP_SC8);
++      DUMPREG(SC_MP_SC9);
++      DUMPREG(SC_MP_SC10);
++      DUMPREG(SC_MP_SC11);
++      DUMPREG(SC_MP_SC12);
++      DUMPREG(SC_MP_SC13);
++      DUMPREG(SC_MP_SC17);
++      DUMPREG(SC_MP_SC18);
++      DUMPREG(SC_MP_SC19);
++      DUMPREG(SC_MP_SC20);
++      DUMPREG(SC_MP_SC21);
++      DUMPREG(SC_MP_SC22);
++      DUMPREG(SC_MP_SC23);
++      DUMPREG(SC_MP_SC24);
++      DUMPREG(SC_MP_SC25);
++      DUMPREG(CSC_CSC00);
++      DUMPREG(CSC_CSC01);
++      DUMPREG(CSC_CSC02);
++      DUMPREG(CSC_CSC03);
++      DUMPREG(CSC_CSC04);
++      DUMPREG(CSC_CSC05);
++#undef DUMPREG
++}
++
++static void add_out_dtd(struct vpe_ctx *ctx, int port)
++{
++      struct vpe_q_data *q_data = &ctx->q_data[Q_DATA_DST];
++      const struct vpe_port_data *p_data = &port_data[port];
++      struct vb2_buffer *vb = ctx->dst_vb;
++      struct v4l2_rect *c_rect = &q_data->c_rect;
++      struct vpe_fmt *fmt = q_data->fmt;
++      const struct vpdma_data_format *vpdma_fmt;
++      int mv_buf_selector = !ctx->src_mv_buf_selector;
++      dma_addr_t dma_addr;
++      u32 flags = 0;
++
++      if (port == VPE_PORT_MV_OUT) {
++              vpdma_fmt = &vpdma_misc_fmts[VPDMA_DATA_FMT_MV];
++              dma_addr = ctx->mv_buf_dma[mv_buf_selector];
++      } else {
++              /* to incorporate interleaved formats */
++              int plane = fmt->coplanar ? p_data->vb_part : 0;
++
++              vpdma_fmt = fmt->vpdma_fmt[plane];
++              dma_addr = vb2_dma_contig_plane_dma_addr(vb, plane);
++              if (!dma_addr) {
++                      vpe_err(ctx->dev,
++                              "acquiring output buffer(%d) dma_addr failed\n",
++                              port);
++                      return;
++              }
++      }
++
++      if (q_data->flags & Q_DATA_FRAME_1D)
++              flags |= VPDMA_DATA_FRAME_1D;
++      if (q_data->flags & Q_DATA_MODE_TILED)
++              flags |= VPDMA_DATA_MODE_TILED;
++
++      vpdma_add_out_dtd(&ctx->desc_list, c_rect, vpdma_fmt, dma_addr,
++              p_data->channel, flags);
++}
++
++static void add_in_dtd(struct vpe_ctx *ctx, int port)
++{
++      struct vpe_q_data *q_data = &ctx->q_data[Q_DATA_SRC];
++      const struct vpe_port_data *p_data = &port_data[port];
++      struct vb2_buffer *vb = ctx->src_vbs[p_data->vb_index];
++      struct v4l2_rect *c_rect = &q_data->c_rect;
++      struct vpe_fmt *fmt = q_data->fmt;
++      const struct vpdma_data_format *vpdma_fmt;
++      int mv_buf_selector = ctx->src_mv_buf_selector;
++      int field = vb->v4l2_buf.field == V4L2_FIELD_BOTTOM;
++      dma_addr_t dma_addr;
++      u32 flags = 0;
++
++      if (port == VPE_PORT_MV_IN) {
++              vpdma_fmt = &vpdma_misc_fmts[VPDMA_DATA_FMT_MV];
++              dma_addr = ctx->mv_buf_dma[mv_buf_selector];
++      } else {
++              /* to incorporate interleaved formats */
++              int plane = fmt->coplanar ? p_data->vb_part : 0;
++
++              vpdma_fmt = fmt->vpdma_fmt[plane];
++
++              dma_addr = vb2_dma_contig_plane_dma_addr(vb, plane);
++              if (!dma_addr) {
++                      vpe_err(ctx->dev,
++                              "acquiring input buffer(%d) dma_addr failed\n",
++                              port);
++                      return;
++              }
++      }
++
++      if (q_data->flags & Q_DATA_FRAME_1D)
++              flags |= VPDMA_DATA_FRAME_1D;
++      if (q_data->flags & Q_DATA_MODE_TILED)
++              flags |= VPDMA_DATA_MODE_TILED;
++
++      vpdma_add_in_dtd(&ctx->desc_list, q_data->width, q_data->height,
++              c_rect, vpdma_fmt, dma_addr, p_data->channel, field, flags);
++}
++
++/*
++ * Enable the expected IRQ sources
++ */
++static void enable_irqs(struct vpe_ctx *ctx)
++{
++      write_reg(ctx->dev, VPE_INT0_ENABLE0_SET, VPE_INT0_LIST0_COMPLETE);
++      write_reg(ctx->dev, VPE_INT0_ENABLE1_SET, VPE_DEI_ERROR_INT |
++                              VPE_DS1_UV_ERROR_INT);
++
++      vpdma_enable_list_complete_irq(ctx->dev->vpdma, 0, true);
++}
++
++static void disable_irqs(struct vpe_ctx *ctx)
++{
++      write_reg(ctx->dev, VPE_INT0_ENABLE0_CLR, 0xffffffff);
++      write_reg(ctx->dev, VPE_INT0_ENABLE1_CLR, 0xffffffff);
++
++      vpdma_enable_list_complete_irq(ctx->dev->vpdma, 0, false);
++}
++
++/* device_run() - prepares and starts the device
++ *
++ * This function is only called when both the source and destination
++ * buffers are in place.
++ */
++static void device_run(void *priv)
++{
++      struct vpe_ctx *ctx = priv;
++      struct vpe_q_data *d_q_data = &ctx->q_data[Q_DATA_DST];
++
++      if (ctx->deinterlacing && ctx->src_vbs[2] == NULL) {
++              ctx->src_vbs[2] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
++              WARN_ON(ctx->src_vbs[2] == NULL);
++              ctx->src_vbs[1] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
++              WARN_ON(ctx->src_vbs[1] == NULL);
++      }
++
++      ctx->src_vbs[0] = v4l2_m2m_src_buf_remove(ctx->m2m_ctx);
++      WARN_ON(ctx->src_vbs[0] == NULL);
++      ctx->dst_vb = v4l2_m2m_dst_buf_remove(ctx->m2m_ctx);
++      WARN_ON(ctx->dst_vb == NULL);
++
++      /* config descriptors */
++      if (ctx->dev->loaded_mmrs != ctx->mmr_adb.dma_addr || ctx->load_mmrs) {
++              vpdma_map_desc_buf(ctx->dev->vpdma, &ctx->mmr_adb);
++              vpdma_add_cfd_adb(&ctx->desc_list, CFD_MMR_CLIENT, &ctx->mmr_adb);
++              ctx->dev->loaded_mmrs = ctx->mmr_adb.dma_addr;
++              ctx->load_mmrs = false;
++      }
++
++      /* output data descriptors */
++      if (ctx->deinterlacing)
++              add_out_dtd(ctx, VPE_PORT_MV_OUT);
++
++      add_out_dtd(ctx, VPE_PORT_LUMA_OUT);
++      if (d_q_data->fmt->coplanar)
++              add_out_dtd(ctx, VPE_PORT_CHROMA_OUT);
++
++      /* input data descriptors */
++      if (ctx->deinterlacing) {
++              add_in_dtd(ctx, VPE_PORT_LUMA3_IN);
++              add_in_dtd(ctx, VPE_PORT_CHROMA3_IN);
++
++              add_in_dtd(ctx, VPE_PORT_LUMA2_IN);
++              add_in_dtd(ctx, VPE_PORT_CHROMA2_IN);
++      }
++
++      add_in_dtd(ctx, VPE_PORT_LUMA1_IN);
++      add_in_dtd(ctx, VPE_PORT_CHROMA1_IN);
++
++      if (ctx->deinterlacing)
++              add_in_dtd(ctx, VPE_PORT_MV_IN);
++
++      /* sync on channel control descriptors for input ports */
++      vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_LUMA1_IN);
++      vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_CHROMA1_IN);
++
++      if (ctx->deinterlacing) {
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list,
++                      VPE_CHAN_LUMA2_IN);
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list,
++                      VPE_CHAN_CHROMA2_IN);
++
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list,
++                      VPE_CHAN_LUMA3_IN);
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list,
++                      VPE_CHAN_CHROMA3_IN);
++
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_MV_IN);
++      }
++
++      /* sync on channel control descriptors for output ports */
++      vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_LUMA_OUT);
++      if (d_q_data->fmt->coplanar)
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_CHROMA_OUT);
++
++      if (ctx->deinterlacing)
++              vpdma_add_sync_on_channel_ctd(&ctx->desc_list, VPE_CHAN_MV_OUT);
++
++      enable_irqs(ctx);
++
++      vpdma_map_desc_buf(ctx->dev->vpdma, &ctx->desc_list.buf);
++      vpdma_submit_descs(ctx->dev->vpdma, &ctx->desc_list);
++}
++
++static void dei_error(struct vpe_ctx *ctx)
++{
++      dev_warn(ctx->dev->v4l2_dev.dev,
++              "received DEI error interrupt\n");
++}
++
++static void ds1_uv_error(struct vpe_ctx *ctx)
++{
++      dev_warn(ctx->dev->v4l2_dev.dev,
++              "received downsampler error interrupt\n");
++}
++
++static irqreturn_t vpe_irq(int irq_vpe, void *data)
++{
++      struct vpe_dev *dev = (struct vpe_dev *)data;
++      struct vpe_ctx *ctx;
++      struct vpe_q_data *d_q_data;
++      struct vb2_buffer *s_vb, *d_vb;
++      struct v4l2_buffer *s_buf, *d_buf;
++      unsigned long flags;
++      u32 irqst0, irqst1;
++
++      irqst0 = read_reg(dev, VPE_INT0_STATUS0);
++      if (irqst0) {
++              write_reg(dev, VPE_INT0_STATUS0_CLR, irqst0);
++              vpe_dbg(dev, "INT0_STATUS0 = 0x%08x\n", irqst0);
++      }
++
++      irqst1 = read_reg(dev, VPE_INT0_STATUS1);
++      if (irqst1) {
++              write_reg(dev, VPE_INT0_STATUS1_CLR, irqst1);
++              vpe_dbg(dev, "INT0_STATUS1 = 0x%08x\n", irqst1);
++      }
++
++      ctx = v4l2_m2m_get_curr_priv(dev->m2m_dev);
++      if (!ctx) {
++              vpe_err(dev, "instance released before end of transaction\n");
++              goto handled;
++      }
++
++      if (irqst1) {
++              if (irqst1 & VPE_DEI_ERROR_INT) {
++                      irqst1 &= ~VPE_DEI_ERROR_INT;
++                      dei_error(ctx);
++              }
++              if (irqst1 & VPE_DS1_UV_ERROR_INT) {
++                      irqst1 &= ~VPE_DS1_UV_ERROR_INT;
++                      ds1_uv_error(ctx);
++              }
++      }
++
++      if (irqst0) {
++              if (irqst0 & VPE_INT0_LIST0_COMPLETE)
++                      vpdma_clear_list_stat(ctx->dev->vpdma);
++
++              irqst0 &= ~(VPE_INT0_LIST0_COMPLETE);
++      }
++
++      if (irqst0 | irqst1) {
++              dev_warn(dev->v4l2_dev.dev, "Unexpected interrupt: "
++                      "INT0_STATUS0 = 0x%08x, INT0_STATUS1 = 0x%08x\n",
++                      irqst0, irqst1);
++      }
++
++      disable_irqs(ctx);
++
++      vpdma_unmap_desc_buf(dev->vpdma, &ctx->desc_list.buf);
++      vpdma_unmap_desc_buf(dev->vpdma, &ctx->mmr_adb);
++
++      vpdma_reset_desc_list(&ctx->desc_list);
++
++       /* the previous dst mv buffer becomes the next src mv buffer */
++      ctx->src_mv_buf_selector = !ctx->src_mv_buf_selector;
++
++      if (ctx->aborting)
++              goto finished;
++
++      s_vb = ctx->src_vbs[0];
++      d_vb = ctx->dst_vb;
++      s_buf = &s_vb->v4l2_buf;
++      d_buf = &d_vb->v4l2_buf;
++
++      d_buf->timestamp = s_buf->timestamp;
++      if (s_buf->flags & V4L2_BUF_FLAG_TIMECODE) {
++              d_buf->flags |= V4L2_BUF_FLAG_TIMECODE;
++              d_buf->timecode = s_buf->timecode;
++      }
++      d_buf->sequence = ctx->sequence;
++      d_buf->field = ctx->field;
++
++      d_q_data = &ctx->q_data[Q_DATA_DST];
++      if (d_q_data->flags & Q_DATA_INTERLACED) {
++              if (ctx->field == V4L2_FIELD_BOTTOM) {
++                      ctx->sequence++;
++                      ctx->field = V4L2_FIELD_TOP;
++              } else {
++                      WARN_ON(ctx->field != V4L2_FIELD_TOP);
++                      ctx->field = V4L2_FIELD_BOTTOM;
++              }
++      } else {
++              ctx->sequence++;
++      }
++
++      if (ctx->deinterlacing)
++              s_vb = ctx->src_vbs[2];
++
++      spin_lock_irqsave(&dev->lock, flags);
++      v4l2_m2m_buf_done(s_vb, VB2_BUF_STATE_DONE);
++      v4l2_m2m_buf_done(d_vb, VB2_BUF_STATE_DONE);
++      spin_unlock_irqrestore(&dev->lock, flags);
++
++      if (ctx->deinterlacing) {
++              ctx->src_vbs[2] = ctx->src_vbs[1];
++              ctx->src_vbs[1] = ctx->src_vbs[0];
++      }
++
++      ctx->bufs_completed++;
++      if (ctx->bufs_completed < ctx->bufs_per_job) {
++              device_run(ctx);
++              goto handled;
++      }
++
++finished:
++      vpe_dbg(ctx->dev, "finishing transaction\n");
++      ctx->bufs_completed = 0;
++      v4l2_m2m_job_finish(dev->m2m_dev, ctx->m2m_ctx);
++handled:
++      return IRQ_HANDLED;
++}
++
++/*
++ * video ioctls
++ */
++static int vpe_querycap(struct file *file, void *priv,
++                      struct v4l2_capability *cap)
++{
++      strncpy(cap->driver, VPE_MODULE_NAME, sizeof(cap->driver) - 1);
++      strncpy(cap->card, VPE_MODULE_NAME, sizeof(cap->card) - 1);
++      strlcpy(cap->bus_info, VPE_MODULE_NAME, sizeof(cap->bus_info));
++      cap->device_caps  = V4L2_CAP_VIDEO_M2M | V4L2_CAP_STREAMING;
++      cap->capabilities = cap->device_caps | V4L2_CAP_DEVICE_CAPS;
++      return 0;
++}
++
++static int __enum_fmt(struct v4l2_fmtdesc *f, u32 type)
++{
++      int i, index;
++      struct vpe_fmt *fmt = NULL;
++
++      index = 0;
++      for (i = 0; i < ARRAY_SIZE(vpe_formats); ++i) {
++              if (vpe_formats[i].types & type) {
++                      if (index == f->index) {
++                              fmt = &vpe_formats[i];
++                              break;
++                      }
++                      index++;
++              }
++      }
++
++      if (!fmt)
++              return -EINVAL;
++
++      strncpy(f->description, fmt->name, sizeof(f->description) - 1);
++      f->pixelformat = fmt->fourcc;
++      return 0;
++}
++
++static int vpe_enum_fmt(struct file *file, void *priv,
++                              struct v4l2_fmtdesc *f)
++{
++      if (V4L2_TYPE_IS_OUTPUT(f->type))
++              return __enum_fmt(f, VPE_FMT_TYPE_OUTPUT);
++
++      return __enum_fmt(f, VPE_FMT_TYPE_CAPTURE);
++}
++
++static int vpe_g_fmt(struct file *file, void *priv, struct v4l2_format *f)
++{
++      struct v4l2_pix_format_mplane *pix = &f->fmt.pix_mp;
++      struct vpe_ctx *ctx = file2ctx(file);
++      struct vb2_queue *vq;
++      struct vpe_q_data *q_data;
++      int i;
++
++      vq = v4l2_m2m_get_vq(ctx->m2m_ctx, f->type);
++      if (!vq)
++              return -EINVAL;
++
++      q_data = get_q_data(ctx, f->type);
++
++      pix->width = q_data->width;
++      pix->height = q_data->height;
++      pix->pixelformat = q_data->fmt->fourcc;
++      pix->field = q_data->field;
++      pix->colorspace = q_data->colorspace;
++      pix->num_planes = q_data->fmt->coplanar ? 2 : 1;
++
++      for (i = 0; i < pix->num_planes; i++) {
++              pix->plane_fmt[i].bytesperline = q_data->bytesperline[i];
++              pix->plane_fmt[i].sizeimage = q_data->sizeimage[i];
++      }
++
++      return 0;
++}
++
++static int __vpe_try_fmt(struct vpe_ctx *ctx, struct v4l2_format *f,
++                     struct vpe_fmt *fmt, int type)
++{
++      struct v4l2_pix_format_mplane *pix = &f->fmt.pix_mp;
++      struct v4l2_plane_pix_format *plane_fmt;
++      int i;
++
++      if (!fmt || !(fmt->types & type)) {
++              vpe_err(ctx->dev, "Fourcc format (0x%08x) invalid.\n",
++                      pix->pixelformat);
++              return -EINVAL;
++      }
++
++      if (pix->field != V4L2_FIELD_NONE && pix->field != V4L2_FIELD_ALTERNATE)
++              pix->field = V4L2_FIELD_NONE;
++
++      v4l_bound_align_image(&pix->width, MIN_W, MAX_W, W_ALIGN,
++                            &pix->height, MIN_H, MAX_H, H_ALIGN,
++                            S_ALIGN);
++
++      pix->num_planes = fmt->coplanar ? 2 : 1;
++      pix->pixelformat = fmt->fourcc;
++      pix->colorspace = fmt->fourcc == V4L2_PIX_FMT_RGB24 ?
++                      V4L2_COLORSPACE_SRGB : V4L2_COLORSPACE_SMPTE170M;
++
++      for (i = 0; i < pix->num_planes; i++) {
++              int depth;
++
++              plane_fmt = &pix->plane_fmt[i];
++              depth = fmt->vpdma_fmt[i]->depth;
++
++              if (i == VPE_LUMA)
++                      plane_fmt->bytesperline =
++                                      round_up((pix->width * depth) >> 3,
++                                              1 << L_ALIGN);
++              else
++                      plane_fmt->bytesperline = pix->width;
++
++              plane_fmt->sizeimage =
++                              (pix->height * pix->width * depth) >> 3;
++      }
++
++      return 0;
++}
++
++static int vpe_try_fmt(struct file *file, void *priv, struct v4l2_format *f)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++      struct vpe_fmt *fmt = find_format(f);
++
++      if (V4L2_TYPE_IS_OUTPUT(f->type))
++              return __vpe_try_fmt(ctx, f, fmt, VPE_FMT_TYPE_OUTPUT);
++      else
++              return __vpe_try_fmt(ctx, f, fmt, VPE_FMT_TYPE_CAPTURE);
++}
++
++static int __vpe_s_fmt(struct vpe_ctx *ctx, struct v4l2_format *f)
++{
++      struct v4l2_pix_format_mplane *pix = &f->fmt.pix_mp;
++      struct v4l2_plane_pix_format *plane_fmt;
++      struct vpe_q_data *q_data;
++      struct vb2_queue *vq;
++      int i;
++
++      vq = v4l2_m2m_get_vq(ctx->m2m_ctx, f->type);
++      if (!vq)
++              return -EINVAL;
++
++      if (vb2_is_busy(vq)) {
++              vpe_err(ctx->dev, "queue busy\n");
++              return -EBUSY;
++      }
++
++      q_data = get_q_data(ctx, f->type);
++      if (!q_data)
++              return -EINVAL;
++
++      q_data->fmt             = find_format(f);
++      q_data->width           = pix->width;
++      q_data->height          = pix->height;
++      q_data->colorspace      = pix->colorspace;
++      q_data->field           = pix->field;
++
++      for (i = 0; i < pix->num_planes; i++) {
++              plane_fmt = &pix->plane_fmt[i];
++
++              q_data->bytesperline[i] = plane_fmt->bytesperline;
++              q_data->sizeimage[i]    = plane_fmt->sizeimage;
++      }
++
++      q_data->c_rect.left     = 0;
++      q_data->c_rect.top      = 0;
++      q_data->c_rect.width    = q_data->width;
++      q_data->c_rect.height   = q_data->height;
++
++      if (q_data->field == V4L2_FIELD_ALTERNATE)
++              q_data->flags |= Q_DATA_INTERLACED;
++      else
++              q_data->flags &= ~Q_DATA_INTERLACED;
++
++      vpe_dbg(ctx->dev, "Setting format for type %d, wxh: %dx%d, fmt: %d bpl_y %d",
++              f->type, q_data->width, q_data->height, q_data->fmt->fourcc,
++              q_data->bytesperline[VPE_LUMA]);
++      if (q_data->fmt->coplanar)
++              vpe_dbg(ctx->dev, " bpl_uv %d\n",
++                      q_data->bytesperline[VPE_CHROMA]);
++
++      return 0;
++}
++
++static int vpe_s_fmt(struct file *file, void *priv, struct v4l2_format *f)
++{
++      int ret;
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      ret = vpe_try_fmt(file, priv, f);
++      if (ret)
++              return ret;
++
++      ret = __vpe_s_fmt(ctx, f);
++      if (ret)
++              return ret;
++
++      if (V4L2_TYPE_IS_OUTPUT(f->type))
++              set_src_registers(ctx);
++      else
++              set_dst_registers(ctx);
++
++      return set_srcdst_params(ctx);
++}
++
++static int vpe_reqbufs(struct file *file, void *priv,
++                     struct v4l2_requestbuffers *reqbufs)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      return v4l2_m2m_reqbufs(file, ctx->m2m_ctx, reqbufs);
++}
++
++static int vpe_querybuf(struct file *file, void *priv, struct v4l2_buffer *buf)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      return v4l2_m2m_querybuf(file, ctx->m2m_ctx, buf);
++}
++
++static int vpe_qbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      return v4l2_m2m_qbuf(file, ctx->m2m_ctx, buf);
++}
++
++static int vpe_dqbuf(struct file *file, void *priv, struct v4l2_buffer *buf)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      return v4l2_m2m_dqbuf(file, ctx->m2m_ctx, buf);
++}
++
++static int vpe_streamon(struct file *file, void *priv, enum v4l2_buf_type type)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      return v4l2_m2m_streamon(file, ctx->m2m_ctx, type);
++}
++
++static int vpe_streamoff(struct file *file, void *priv, enum v4l2_buf_type type)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      vpe_dump_regs(ctx->dev);
++      vpdma_dump_regs(ctx->dev->vpdma);
++
++      return v4l2_m2m_streamoff(file, ctx->m2m_ctx, type);
++}
++
++#define V4L2_CID_VPE_BUFS_PER_JOB             (V4L2_CID_USER_TI_VPE_BASE + 0)
++
++static int vpe_s_ctrl(struct v4l2_ctrl *ctrl)
++{
++      struct vpe_ctx *ctx =
++              container_of(ctrl->handler, struct vpe_ctx, hdl);
++
++      switch (ctrl->id) {
++      case V4L2_CID_VPE_BUFS_PER_JOB:
++              ctx->bufs_per_job = ctrl->val;
++              break;
++
++      default:
++              vpe_err(ctx->dev, "Invalid control\n");
++              return -EINVAL;
++      }
++
++      return 0;
++}
++
++static const struct v4l2_ctrl_ops vpe_ctrl_ops = {
++      .s_ctrl = vpe_s_ctrl,
++};
++
++static const struct v4l2_ioctl_ops vpe_ioctl_ops = {
++      .vidioc_querycap        = vpe_querycap,
++
++      .vidioc_enum_fmt_vid_cap_mplane = vpe_enum_fmt,
++      .vidioc_g_fmt_vid_cap_mplane    = vpe_g_fmt,
++      .vidioc_try_fmt_vid_cap_mplane  = vpe_try_fmt,
++      .vidioc_s_fmt_vid_cap_mplane    = vpe_s_fmt,
++
++      .vidioc_enum_fmt_vid_out_mplane = vpe_enum_fmt,
++      .vidioc_g_fmt_vid_out_mplane    = vpe_g_fmt,
++      .vidioc_try_fmt_vid_out_mplane  = vpe_try_fmt,
++      .vidioc_s_fmt_vid_out_mplane    = vpe_s_fmt,
++
++      .vidioc_reqbufs         = vpe_reqbufs,
++      .vidioc_querybuf        = vpe_querybuf,
++
++      .vidioc_qbuf            = vpe_qbuf,
++      .vidioc_dqbuf           = vpe_dqbuf,
++
++      .vidioc_streamon        = vpe_streamon,
++      .vidioc_streamoff       = vpe_streamoff,
++      .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
++      .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
++};
++
++/*
++ * Queue operations
++ */
++static int vpe_queue_setup(struct vb2_queue *vq,
++                         const struct v4l2_format *fmt,
++                         unsigned int *nbuffers, unsigned int *nplanes,
++                         unsigned int sizes[], void *alloc_ctxs[])
++{
++      int i;
++      struct vpe_ctx *ctx = vb2_get_drv_priv(vq);
++      struct vpe_q_data *q_data;
++
++      q_data = get_q_data(ctx, vq->type);
++
++      *nplanes = q_data->fmt->coplanar ? 2 : 1;
++
++      for (i = 0; i < *nplanes; i++) {
++              sizes[i] = q_data->sizeimage[i];
++              alloc_ctxs[i] = ctx->dev->alloc_ctx;
++      }
++
++      vpe_dbg(ctx->dev, "get %d buffer(s) of size %d", *nbuffers,
++              sizes[VPE_LUMA]);
++      if (q_data->fmt->coplanar)
++              vpe_dbg(ctx->dev, " and %d\n", sizes[VPE_CHROMA]);
++
++      return 0;
++}
++
++static int vpe_buf_prepare(struct vb2_buffer *vb)
++{
++      struct vpe_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
++      struct vpe_q_data *q_data;
++      int i, num_planes;
++
++      vpe_dbg(ctx->dev, "type: %d\n", vb->vb2_queue->type);
++
++      q_data = get_q_data(ctx, vb->vb2_queue->type);
++      num_planes = q_data->fmt->coplanar ? 2 : 1;
++
++      for (i = 0; i < num_planes; i++) {
++              if (vb2_plane_size(vb, i) < q_data->sizeimage[i]) {
++                      vpe_err(ctx->dev,
++                              "data will not fit into plane (%lu < %lu)\n",
++                              vb2_plane_size(vb, i),
++                              (long) q_data->sizeimage[i]);
++                      return -EINVAL;
++              }
++      }
++
++      for (i = 0; i < num_planes; i++)
++              vb2_set_plane_payload(vb, i, q_data->sizeimage[i]);
++
++      return 0;
++}
++
++static void vpe_buf_queue(struct vb2_buffer *vb)
++{
++      struct vpe_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
++      v4l2_m2m_buf_queue(ctx->m2m_ctx, vb);
++}
++
++static void vpe_wait_prepare(struct vb2_queue *q)
++{
++      struct vpe_ctx *ctx = vb2_get_drv_priv(q);
++      vpe_unlock(ctx);
++}
++
++static void vpe_wait_finish(struct vb2_queue *q)
++{
++      struct vpe_ctx *ctx = vb2_get_drv_priv(q);
++      vpe_lock(ctx);
++}
++
++static struct vb2_ops vpe_qops = {
++      .queue_setup     = vpe_queue_setup,
++      .buf_prepare     = vpe_buf_prepare,
++      .buf_queue       = vpe_buf_queue,
++      .wait_prepare    = vpe_wait_prepare,
++      .wait_finish     = vpe_wait_finish,
++};
++
++static int queue_init(void *priv, struct vb2_queue *src_vq,
++                    struct vb2_queue *dst_vq)
++{
++      struct vpe_ctx *ctx = priv;
++      int ret;
++
++      memset(src_vq, 0, sizeof(*src_vq));
++      src_vq->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
++      src_vq->io_modes = VB2_MMAP;
++      src_vq->drv_priv = ctx;
++      src_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
++      src_vq->ops = &vpe_qops;
++      src_vq->mem_ops = &vb2_dma_contig_memops;
++      src_vq->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_COPY;
++
++      ret = vb2_queue_init(src_vq);
++      if (ret)
++              return ret;
++
++      memset(dst_vq, 0, sizeof(*dst_vq));
++      dst_vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
++      dst_vq->io_modes = VB2_MMAP;
++      dst_vq->drv_priv = ctx;
++      dst_vq->buf_struct_size = sizeof(struct v4l2_m2m_buffer);
++      dst_vq->ops = &vpe_qops;
++      dst_vq->mem_ops = &vb2_dma_contig_memops;
++      dst_vq->timestamp_type = V4L2_BUF_FLAG_TIMESTAMP_COPY;
++
++      return vb2_queue_init(dst_vq);
++}
++
++static const struct v4l2_ctrl_config vpe_bufs_per_job = {
++      .ops = &vpe_ctrl_ops,
++      .id = V4L2_CID_VPE_BUFS_PER_JOB,
++      .name = "Buffers Per Transaction",
++      .type = V4L2_CTRL_TYPE_INTEGER,
++      .def = VPE_DEF_BUFS_PER_JOB,
++      .min = 1,
++      .max = VIDEO_MAX_FRAME,
++      .step = 1,
++};
++
++/*
++ * File operations
++ */
++static int vpe_open(struct file *file)
++{
++      struct vpe_dev *dev = video_drvdata(file);
++      struct vpe_ctx *ctx = NULL;
++      struct vpe_q_data *s_q_data;
++      struct v4l2_ctrl_handler *hdl;
++      int ret;
++
++      vpe_dbg(dev, "vpe_open\n");
++
++      if (!dev->vpdma->ready) {
++              vpe_err(dev, "vpdma firmware not loaded\n");
++              return -ENODEV;
++      }
++
++      ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
++      if (!ctx)
++              return -ENOMEM;
++
++      ctx->dev = dev;
++
++      if (mutex_lock_interruptible(&dev->dev_mutex)) {
++              ret = -ERESTARTSYS;
++              goto free_ctx;
++      }
++
++      ret = vpdma_create_desc_list(&ctx->desc_list, VPE_DESC_LIST_SIZE,
++                      VPDMA_LIST_TYPE_NORMAL);
++      if (ret != 0)
++              goto unlock;
++
++      ret = vpdma_alloc_desc_buf(&ctx->mmr_adb, sizeof(struct vpe_mmr_adb));
++      if (ret != 0)
++              goto free_desc_list;
++
++      init_adb_hdrs(ctx);
++
++      v4l2_fh_init(&ctx->fh, video_devdata(file));
++      file->private_data = &ctx->fh;
++
++      hdl = &ctx->hdl;
++      v4l2_ctrl_handler_init(hdl, 1);
++      v4l2_ctrl_new_custom(hdl, &vpe_bufs_per_job, NULL);
++      if (hdl->error) {
++              ret = hdl->error;
++              goto exit_fh;
++      }
++      ctx->fh.ctrl_handler = hdl;
++      v4l2_ctrl_handler_setup(hdl);
++
++      s_q_data = &ctx->q_data[Q_DATA_SRC];
++      s_q_data->fmt = &vpe_formats[2];
++      s_q_data->width = 1920;
++      s_q_data->height = 1080;
++      s_q_data->sizeimage[VPE_LUMA] = (s_q_data->width * s_q_data->height *
++                      s_q_data->fmt->vpdma_fmt[VPE_LUMA]->depth) >> 3;
++      s_q_data->colorspace = V4L2_COLORSPACE_SMPTE240M;
++      s_q_data->field = V4L2_FIELD_NONE;
++      s_q_data->c_rect.left = 0;
++      s_q_data->c_rect.top = 0;
++      s_q_data->c_rect.width = s_q_data->width;
++      s_q_data->c_rect.height = s_q_data->height;
++      s_q_data->flags = 0;
++
++      ctx->q_data[Q_DATA_DST] = *s_q_data;
++
++      set_dei_shadow_registers(ctx);
++      set_src_registers(ctx);
++      set_dst_registers(ctx);
++      ret = set_srcdst_params(ctx);
++      if (ret)
++              goto exit_fh;
++
++      ctx->m2m_ctx = v4l2_m2m_ctx_init(dev->m2m_dev, ctx, &queue_init);
++
++      if (IS_ERR(ctx->m2m_ctx)) {
++              ret = PTR_ERR(ctx->m2m_ctx);
++              goto exit_fh;
++      }
++
++      v4l2_fh_add(&ctx->fh);
++
++      /*
++       * for now, just report the creation of the first instance, we can later
++       * optimize the driver to enable or disable clocks when the first
++       * instance is created or the last instance released
++       */
++      if (atomic_inc_return(&dev->num_instances) == 1)
++              vpe_dbg(dev, "first instance created\n");
++
++      ctx->bufs_per_job = VPE_DEF_BUFS_PER_JOB;
++
++      ctx->load_mmrs = true;
++
++      vpe_dbg(dev, "created instance %p, m2m_ctx: %p\n",
++              ctx, ctx->m2m_ctx);
++
++      mutex_unlock(&dev->dev_mutex);
++
++      return 0;
++exit_fh:
++      v4l2_ctrl_handler_free(hdl);
++      v4l2_fh_exit(&ctx->fh);
++      vpdma_free_desc_buf(&ctx->mmr_adb);
++free_desc_list:
++      vpdma_free_desc_list(&ctx->desc_list);
++unlock:
++      mutex_unlock(&dev->dev_mutex);
++free_ctx:
++      kfree(ctx);
++      return ret;
++}
++
++static int vpe_release(struct file *file)
++{
++      struct vpe_dev *dev = video_drvdata(file);
++      struct vpe_ctx *ctx = file2ctx(file);
++
++      vpe_dbg(dev, "releasing instance %p\n", ctx);
++
++      mutex_lock(&dev->dev_mutex);
++      free_vbs(ctx);
++      free_mv_buffers(ctx);
++      vpdma_free_desc_list(&ctx->desc_list);
++      vpdma_free_desc_buf(&ctx->mmr_adb);
++
++      v4l2_fh_del(&ctx->fh);
++      v4l2_fh_exit(&ctx->fh);
++      v4l2_ctrl_handler_free(&ctx->hdl);
++      v4l2_m2m_ctx_release(ctx->m2m_ctx);
++
++      kfree(ctx);
++
++      /*
++       * for now, just report the release of the last instance, we can later
++       * optimize the driver to enable or disable clocks when the first
++       * instance is created or the last instance released
++       */
++      if (atomic_dec_return(&dev->num_instances) == 0)
++              vpe_dbg(dev, "last instance released\n");
++
++      mutex_unlock(&dev->dev_mutex);
++
++      return 0;
++}
++
++static unsigned int vpe_poll(struct file *file,
++                           struct poll_table_struct *wait)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++      struct vpe_dev *dev = ctx->dev;
++      int ret;
++
++      mutex_lock(&dev->dev_mutex);
++      ret = v4l2_m2m_poll(file, ctx->m2m_ctx, wait);
++      mutex_unlock(&dev->dev_mutex);
++      return ret;
++}
++
++static int vpe_mmap(struct file *file, struct vm_area_struct *vma)
++{
++      struct vpe_ctx *ctx = file2ctx(file);
++      struct vpe_dev *dev = ctx->dev;
++      int ret;
++
++      if (mutex_lock_interruptible(&dev->dev_mutex))
++              return -ERESTARTSYS;
++      ret = v4l2_m2m_mmap(file, ctx->m2m_ctx, vma);
++      mutex_unlock(&dev->dev_mutex);
++      return ret;
++}
++
++static const struct v4l2_file_operations vpe_fops = {
++      .owner          = THIS_MODULE,
++      .open           = vpe_open,
++      .release        = vpe_release,
++      .poll           = vpe_poll,
++      .unlocked_ioctl = video_ioctl2,
++      .mmap           = vpe_mmap,
++};
++
++static struct video_device vpe_videodev = {
++      .name           = VPE_MODULE_NAME,
++      .fops           = &vpe_fops,
++      .ioctl_ops      = &vpe_ioctl_ops,
++      .minor          = -1,
++      .release        = video_device_release,
++      .vfl_dir        = VFL_DIR_M2M,
++};
++
++static struct v4l2_m2m_ops m2m_ops = {
++      .device_run     = device_run,
++      .job_ready      = job_ready,
++      .job_abort      = job_abort,
++      .lock           = vpe_lock,
++      .unlock         = vpe_unlock,
++};
++
++static int vpe_runtime_get(struct platform_device *pdev)
++{
++      int r;
++
++      dev_dbg(&pdev->dev, "vpe_runtime_get\n");
++
++      r = pm_runtime_get_sync(&pdev->dev);
++      WARN_ON(r < 0);
++      return r < 0 ? r : 0;
++}
++
++static void vpe_runtime_put(struct platform_device *pdev)
++{
++
++      int r;
++
++      dev_dbg(&pdev->dev, "vpe_runtime_put\n");
++
++      r = pm_runtime_put_sync(&pdev->dev);
++      WARN_ON(r < 0 && r != -ENOSYS);
++}
++
++static int vpe_probe(struct platform_device *pdev)
++{
++      struct vpe_dev *dev;
++      struct video_device *vfd;
++      struct resource *res;
++      int ret, irq, func;
++
++      dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
++      if (IS_ERR(dev))
++              return PTR_ERR(dev);
++
++      spin_lock_init(&dev->lock);
++
++      ret = v4l2_device_register(&pdev->dev, &dev->v4l2_dev);
++      if (ret)
++              return ret;
++
++      atomic_set(&dev->num_instances, 0);
++      mutex_init(&dev->dev_mutex);
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "vpe_top");
++      /*
++       * HACK: we get resource info from device tree in the form of a list of
++       * VPE sub blocks, the driver currently uses only the base of vpe_top
++       * for register access, the driver should be changed later to access
++       * registers based on the sub block base addresses
++       */
++      dev->base = devm_ioremap(&pdev->dev, res->start, SZ_32K);
++      if (IS_ERR(dev->base)) {
++              ret = PTR_ERR(dev->base);
++              goto v4l2_dev_unreg;
++      }
++
++      irq = platform_get_irq(pdev, 0);
++      ret = devm_request_irq(&pdev->dev, irq, vpe_irq, 0, VPE_MODULE_NAME,
++                      dev);
++      if (ret)
++              goto v4l2_dev_unreg;
++
++      platform_set_drvdata(pdev, dev);
++
++      dev->alloc_ctx = vb2_dma_contig_init_ctx(&pdev->dev);
++      if (IS_ERR(dev->alloc_ctx)) {
++              vpe_err(dev, "Failed to alloc vb2 context\n");
++              ret = PTR_ERR(dev->alloc_ctx);
++              goto v4l2_dev_unreg;
++      }
++
++      dev->m2m_dev = v4l2_m2m_init(&m2m_ops);
++      if (IS_ERR(dev->m2m_dev)) {
++              vpe_err(dev, "Failed to init mem2mem device\n");
++              ret = PTR_ERR(dev->m2m_dev);
++              goto rel_ctx;
++      }
++
++      pm_runtime_enable(&pdev->dev);
++
++      ret = vpe_runtime_get(pdev);
++      if (ret)
++              goto rel_m2m;
++
++      /* Perform clk enable followed by reset */
++      vpe_set_clock_enable(dev, 1);
++
++      vpe_top_reset(dev);
++
++      func = read_field_reg(dev, VPE_PID, VPE_PID_FUNC_MASK,
++              VPE_PID_FUNC_SHIFT);
++      vpe_dbg(dev, "VPE PID function %x\n", func);
++
++      vpe_top_vpdma_reset(dev);
++
++      dev->vpdma = vpdma_create(pdev);
++      if (IS_ERR(dev->vpdma))
++              goto runtime_put;
++
++      vfd = &dev->vfd;
++      *vfd = vpe_videodev;
++      vfd->lock = &dev->dev_mutex;
++      vfd->v4l2_dev = &dev->v4l2_dev;
++
++      ret = video_register_device(vfd, VFL_TYPE_GRABBER, 0);
++      if (ret) {
++              vpe_err(dev, "Failed to register video device\n");
++              goto runtime_put;
++      }
++
++      video_set_drvdata(vfd, dev);
++      snprintf(vfd->name, sizeof(vfd->name), "%s", vpe_videodev.name);
++      dev_info(dev->v4l2_dev.dev, "Device registered as /dev/video%d\n",
++              vfd->num);
++
++      return 0;
++
++runtime_put:
++      vpe_runtime_put(pdev);
++rel_m2m:
++      pm_runtime_disable(&pdev->dev);
++      v4l2_m2m_release(dev->m2m_dev);
++rel_ctx:
++      vb2_dma_contig_cleanup_ctx(dev->alloc_ctx);
++v4l2_dev_unreg:
++      v4l2_device_unregister(&dev->v4l2_dev);
++
++      return ret;
++}
++
++static int vpe_remove(struct platform_device *pdev)
++{
++      struct vpe_dev *dev =
++              (struct vpe_dev *) platform_get_drvdata(pdev);
++
++      v4l2_info(&dev->v4l2_dev, "Removing " VPE_MODULE_NAME);
++
++      v4l2_m2m_release(dev->m2m_dev);
++      video_unregister_device(&dev->vfd);
++      v4l2_device_unregister(&dev->v4l2_dev);
++      vb2_dma_contig_cleanup_ctx(dev->alloc_ctx);
++
++      vpe_set_clock_enable(dev, 0);
++      vpe_runtime_put(pdev);
++      pm_runtime_disable(&pdev->dev);
++
++      return 0;
++}
++
++#if defined(CONFIG_OF)
++static const struct of_device_id vpe_of_match[] = {
++      {
++              .compatible = "ti,vpe",
++      },
++      {},
++};
++#else
++#define vpe_of_match NULL
++#endif
++
++static struct platform_driver vpe_pdrv = {
++      .probe          = vpe_probe,
++      .remove         = vpe_remove,
++      .driver         = {
++              .name   = VPE_MODULE_NAME,
++              .owner  = THIS_MODULE,
++              .of_match_table = vpe_of_match,
++      },
++};
++
++static void __exit vpe_exit(void)
++{
++      platform_driver_unregister(&vpe_pdrv);
++}
++
++static int __init vpe_init(void)
++{
++      return platform_driver_register(&vpe_pdrv);
++}
++
++module_init(vpe_init);
++module_exit(vpe_exit);
++
++MODULE_DESCRIPTION("TI VPE driver");
++MODULE_AUTHOR("Dale Farnsworth, <dale@farnsworth.org>");
++MODULE_LICENSE("GPL");
+--- /dev/null
++++ b/drivers/media/platform/ti-vpe/vpe_regs.h
+@@ -0,0 +1,496 @@
++/*
++ * Copyright (c) 2013 Texas Instruments Inc.
++ *
++ * David Griego, <dagriego@biglakesoftware.com>
++ * Dale Farnsworth, <dale@farnsworth.org>
++ * Archit Taneja, <archit@ti.com>
++ *
++ * 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.
++ */
++
++#ifndef __TI_VPE_REGS_H
++#define __TI_VPE_REGS_H
++
++/* VPE register offsets and field selectors */
++
++/* VPE top level regs */
++#define VPE_PID                               0x0000
++#define VPE_PID_MINOR_MASK            0x3f
++#define VPE_PID_MINOR_SHIFT           0
++#define VPE_PID_CUSTOM_MASK           0x03
++#define VPE_PID_CUSTOM_SHIFT          6
++#define VPE_PID_MAJOR_MASK            0x07
++#define VPE_PID_MAJOR_SHIFT           8
++#define VPE_PID_RTL_MASK              0x1f
++#define VPE_PID_RTL_SHIFT             11
++#define VPE_PID_FUNC_MASK             0xfff
++#define VPE_PID_FUNC_SHIFT            16
++#define VPE_PID_SCHEME_MASK           0x03
++#define VPE_PID_SCHEME_SHIFT          30
++
++#define VPE_SYSCONFIG                 0x0010
++#define VPE_SYSCONFIG_IDLE_MASK               0x03
++#define VPE_SYSCONFIG_IDLE_SHIFT      2
++#define VPE_SYSCONFIG_STANDBY_MASK    0x03
++#define VPE_SYSCONFIG_STANDBY_SHIFT   4
++#define VPE_FORCE_IDLE_MODE           0
++#define VPE_NO_IDLE_MODE              1
++#define VPE_SMART_IDLE_MODE           2
++#define VPE_SMART_IDLE_WAKEUP_MODE    3
++#define VPE_FORCE_STANDBY_MODE                0
++#define VPE_NO_STANDBY_MODE           1
++#define VPE_SMART_STANDBY_MODE                2
++#define VPE_SMART_STANDBY_WAKEUP_MODE 3
++
++#define VPE_INT0_STATUS0_RAW_SET      0x0020
++#define VPE_INT0_STATUS0_RAW          VPE_INT0_STATUS0_RAW_SET
++#define VPE_INT0_STATUS0_CLR          0x0028
++#define VPE_INT0_STATUS0              VPE_INT0_STATUS0_CLR
++#define VPE_INT0_ENABLE0_SET          0x0030
++#define VPE_INT0_ENABLE0              VPE_INT0_ENABLE0_SET
++#define VPE_INT0_ENABLE0_CLR          0x0038
++#define VPE_INT0_LIST0_COMPLETE               (1 << 0)
++#define VPE_INT0_LIST0_NOTIFY         (1 << 1)
++#define VPE_INT0_LIST1_COMPLETE               (1 << 2)
++#define VPE_INT0_LIST1_NOTIFY         (1 << 3)
++#define VPE_INT0_LIST2_COMPLETE               (1 << 4)
++#define VPE_INT0_LIST2_NOTIFY         (1 << 5)
++#define VPE_INT0_LIST3_COMPLETE               (1 << 6)
++#define VPE_INT0_LIST3_NOTIFY         (1 << 7)
++#define VPE_INT0_LIST4_COMPLETE               (1 << 8)
++#define VPE_INT0_LIST4_NOTIFY         (1 << 9)
++#define VPE_INT0_LIST5_COMPLETE               (1 << 10)
++#define VPE_INT0_LIST5_NOTIFY         (1 << 11)
++#define VPE_INT0_LIST6_COMPLETE               (1 << 12)
++#define VPE_INT0_LIST6_NOTIFY         (1 << 13)
++#define VPE_INT0_LIST7_COMPLETE               (1 << 14)
++#define VPE_INT0_LIST7_NOTIFY         (1 << 15)
++#define VPE_INT0_DESCRIPTOR           (1 << 16)
++#define VPE_DEI_FMD_INT                       (1 << 18)
++
++#define VPE_INT0_STATUS1_RAW_SET      0x0024
++#define VPE_INT0_STATUS1_RAW          VPE_INT0_STATUS1_RAW_SET
++#define VPE_INT0_STATUS1_CLR          0x002c
++#define VPE_INT0_STATUS1              VPE_INT0_STATUS1_CLR
++#define VPE_INT0_ENABLE1_SET          0x0034
++#define VPE_INT0_ENABLE1              VPE_INT0_ENABLE1_SET
++#define VPE_INT0_ENABLE1_CLR          0x003c
++#define VPE_INT0_CHANNEL_GROUP0               (1 << 0)
++#define VPE_INT0_CHANNEL_GROUP1               (1 << 1)
++#define VPE_INT0_CHANNEL_GROUP2               (1 << 2)
++#define VPE_INT0_CHANNEL_GROUP3               (1 << 3)
++#define VPE_INT0_CHANNEL_GROUP4               (1 << 4)
++#define VPE_INT0_CHANNEL_GROUP5               (1 << 5)
++#define VPE_INT0_CLIENT                       (1 << 7)
++#define VPE_DEI_ERROR_INT             (1 << 16)
++#define VPE_DS1_UV_ERROR_INT          (1 << 22)
++
++#define VPE_INTC_EOI                  0x00a0
++
++#define VPE_CLK_ENABLE                        0x0100
++#define VPE_VPEDMA_CLK_ENABLE         (1 << 0)
++#define VPE_DATA_PATH_CLK_ENABLE      (1 << 1)
++
++#define VPE_CLK_RESET                 0x0104
++#define VPE_VPDMA_CLK_RESET_MASK      0x1
++#define VPE_VPDMA_CLK_RESET_SHIFT     0
++#define VPE_DATA_PATH_CLK_RESET_MASK  0x1
++#define VPE_DATA_PATH_CLK_RESET_SHIFT 1
++#define VPE_MAIN_RESET_MASK           0x1
++#define VPE_MAIN_RESET_SHIFT          31
++
++#define VPE_CLK_FORMAT_SELECT         0x010c
++#define VPE_CSC_SRC_SELECT_MASK               0x03
++#define VPE_CSC_SRC_SELECT_SHIFT      0
++#define VPE_RGB_OUT_SELECT            (1 << 8)
++#define VPE_DS_SRC_SELECT_MASK                0x07
++#define VPE_DS_SRC_SELECT_SHIFT               9
++#define VPE_DS_BYPASS                 (1 << 16)
++#define VPE_COLOR_SEPARATE_422                (1 << 18)
++
++#define VPE_DS_SRC_DEI_SCALER         (5 << VPE_DS_SRC_SELECT_SHIFT)
++#define VPE_CSC_SRC_DEI_SCALER                (3 << VPE_CSC_SRC_SELECT_SHIFT)
++
++#define VPE_CLK_RANGE_MAP             0x011c
++#define VPE_RANGE_RANGE_MAP_Y_MASK    0x07
++#define VPE_RANGE_RANGE_MAP_Y_SHIFT   0
++#define VPE_RANGE_RANGE_MAP_UV_MASK   0x07
++#define VPE_RANGE_RANGE_MAP_UV_SHIFT  3
++#define VPE_RANGE_MAP_ON              (1 << 6)
++#define VPE_RANGE_REDUCTION_ON                (1 << 28)
++
++/* VPE chrominance upsampler regs */
++#define VPE_US1_R0                    0x0304
++#define VPE_US2_R0                    0x0404
++#define VPE_US3_R0                    0x0504
++#define VPE_US_C1_MASK                        0x3fff
++#define VPE_US_C1_SHIFT                       2
++#define VPE_US_C0_MASK                        0x3fff
++#define VPE_US_C0_SHIFT                       18
++#define VPE_US_MODE_MASK              0x03
++#define VPE_US_MODE_SHIFT             16
++#define VPE_ANCHOR_FID0_C1_MASK               0x3fff
++#define VPE_ANCHOR_FID0_C1_SHIFT      2
++#define VPE_ANCHOR_FID0_C0_MASK               0x3fff
++#define VPE_ANCHOR_FID0_C0_SHIFT      18
++
++#define VPE_US1_R1                    0x0308
++#define VPE_US2_R1                    0x0408
++#define VPE_US3_R1                    0x0508
++#define VPE_ANCHOR_FID0_C3_MASK               0x3fff
++#define VPE_ANCHOR_FID0_C3_SHIFT      2
++#define VPE_ANCHOR_FID0_C2_MASK               0x3fff
++#define VPE_ANCHOR_FID0_C2_SHIFT      18
++
++#define VPE_US1_R2                    0x030c
++#define VPE_US2_R2                    0x040c
++#define VPE_US3_R2                    0x050c
++#define VPE_INTERP_FID0_C1_MASK               0x3fff
++#define VPE_INTERP_FID0_C1_SHIFT      2
++#define VPE_INTERP_FID0_C0_MASK               0x3fff
++#define VPE_INTERP_FID0_C0_SHIFT      18
++
++#define VPE_US1_R3                    0x0310
++#define VPE_US2_R3                    0x0410
++#define VPE_US3_R3                    0x0510
++#define VPE_INTERP_FID0_C3_MASK               0x3fff
++#define VPE_INTERP_FID0_C3_SHIFT      2
++#define VPE_INTERP_FID0_C2_MASK               0x3fff
++#define VPE_INTERP_FID0_C2_SHIFT      18
++
++#define VPE_US1_R4                    0x0314
++#define VPE_US2_R4                    0x0414
++#define VPE_US3_R4                    0x0514
++#define VPE_ANCHOR_FID1_C1_MASK               0x3fff
++#define VPE_ANCHOR_FID1_C1_SHIFT      2
++#define VPE_ANCHOR_FID1_C0_MASK               0x3fff
++#define VPE_ANCHOR_FID1_C0_SHIFT      18
++
++#define VPE_US1_R5                    0x0318
++#define VPE_US2_R5                    0x0418
++#define VPE_US3_R5                    0x0518
++#define VPE_ANCHOR_FID1_C3_MASK               0x3fff
++#define VPE_ANCHOR_FID1_C3_SHIFT      2
++#define VPE_ANCHOR_FID1_C2_MASK               0x3fff
++#define VPE_ANCHOR_FID1_C2_SHIFT      18
++
++#define VPE_US1_R6                    0x031c
++#define VPE_US2_R6                    0x041c
++#define VPE_US3_R6                    0x051c
++#define VPE_INTERP_FID1_C1_MASK               0x3fff
++#define VPE_INTERP_FID1_C1_SHIFT      2
++#define VPE_INTERP_FID1_C0_MASK               0x3fff
++#define VPE_INTERP_FID1_C0_SHIFT      18
++
++#define VPE_US1_R7                    0x0320
++#define VPE_US2_R7                    0x0420
++#define VPE_US3_R7                    0x0520
++#define VPE_INTERP_FID0_C3_MASK               0x3fff
++#define VPE_INTERP_FID0_C3_SHIFT      2
++#define VPE_INTERP_FID0_C2_MASK               0x3fff
++#define VPE_INTERP_FID0_C2_SHIFT      18
++
++/* VPE de-interlacer regs */
++#define VPE_DEI_FRAME_SIZE            0x0600
++#define VPE_DEI_WIDTH_MASK            0x07ff
++#define VPE_DEI_WIDTH_SHIFT           0
++#define VPE_DEI_HEIGHT_MASK           0x07ff
++#define VPE_DEI_HEIGHT_SHIFT          16
++#define VPE_DEI_INTERLACE_BYPASS      (1 << 29)
++#define VPE_DEI_FIELD_FLUSH           (1 << 30)
++#define VPE_DEI_PROGRESSIVE           (1 << 31)
++
++#define VPE_MDT_BYPASS                        0x0604
++#define VPE_MDT_TEMPMAX_BYPASS                (1 << 0)
++#define VPE_MDT_SPATMAX_BYPASS                (1 << 1)
++
++#define VPE_MDT_SF_THRESHOLD          0x0608
++#define VPE_MDT_SF_SC_THR1_MASK               0xff
++#define VPE_MDT_SF_SC_THR1_SHIFT      0
++#define VPE_MDT_SF_SC_THR2_MASK               0xff
++#define VPE_MDT_SF_SC_THR2_SHIFT      0
++#define VPE_MDT_SF_SC_THR3_MASK               0xff
++#define VPE_MDT_SF_SC_THR3_SHIFT      0
++
++#define VPE_EDI_CONFIG                        0x060c
++#define VPE_EDI_INP_MODE_MASK         0x03
++#define VPE_EDI_INP_MODE_SHIFT                0
++#define VPE_EDI_ENABLE_3D             (1 << 2)
++#define VPE_EDI_ENABLE_CHROMA_3D      (1 << 3)
++#define VPE_EDI_CHROMA3D_COR_THR_MASK 0xff
++#define VPE_EDI_CHROMA3D_COR_THR_SHIFT        8
++#define VPE_EDI_DIR_COR_LOWER_THR_MASK        0xff
++#define VPE_EDI_DIR_COR_LOWER_THR_SHIFT       16
++#define VPE_EDI_COR_SCALE_FACTOR_MASK 0xff
++#define VPE_EDI_COR_SCALE_FACTOR_SHIFT        23
++
++#define VPE_DEI_EDI_LUT_R0            0x0610
++#define VPE_EDI_LUT0_MASK             0x1f
++#define VPE_EDI_LUT0_SHIFT            0
++#define VPE_EDI_LUT1_MASK             0x1f
++#define VPE_EDI_LUT1_SHIFT            8
++#define VPE_EDI_LUT2_MASK             0x1f
++#define VPE_EDI_LUT2_SHIFT            16
++#define VPE_EDI_LUT3_MASK             0x1f
++#define VPE_EDI_LUT3_SHIFT            24
++
++#define VPE_DEI_EDI_LUT_R1            0x0614
++#define VPE_EDI_LUT0_MASK             0x1f
++#define VPE_EDI_LUT0_SHIFT            0
++#define VPE_EDI_LUT1_MASK             0x1f
++#define VPE_EDI_LUT1_SHIFT            8
++#define VPE_EDI_LUT2_MASK             0x1f
++#define VPE_EDI_LUT2_SHIFT            16
++#define VPE_EDI_LUT3_MASK             0x1f
++#define VPE_EDI_LUT3_SHIFT            24
++
++#define VPE_DEI_EDI_LUT_R2            0x0618
++#define VPE_EDI_LUT4_MASK             0x1f
++#define VPE_EDI_LUT4_SHIFT            0
++#define VPE_EDI_LUT5_MASK             0x1f
++#define VPE_EDI_LUT5_SHIFT            8
++#define VPE_EDI_LUT6_MASK             0x1f
++#define VPE_EDI_LUT6_SHIFT            16
++#define VPE_EDI_LUT7_MASK             0x1f
++#define VPE_EDI_LUT7_SHIFT            24
++
++#define VPE_DEI_EDI_LUT_R3            0x061c
++#define VPE_EDI_LUT8_MASK             0x1f
++#define VPE_EDI_LUT8_SHIFT            0
++#define VPE_EDI_LUT9_MASK             0x1f
++#define VPE_EDI_LUT9_SHIFT            8
++#define VPE_EDI_LUT10_MASK            0x1f
++#define VPE_EDI_LUT10_SHIFT           16
++#define VPE_EDI_LUT11_MASK            0x1f
++#define VPE_EDI_LUT11_SHIFT           24
++
++#define VPE_DEI_FMD_WINDOW_R0         0x0620
++#define VPE_FMD_WINDOW_MINX_MASK      0x07ff
++#define VPE_FMD_WINDOW_MINX_SHIFT     0
++#define VPE_FMD_WINDOW_MAXX_MASK      0x07ff
++#define VPE_FMD_WINDOW_MAXX_SHIFT     16
++#define VPE_FMD_WINDOW_ENABLE         (1 << 31)
++
++#define VPE_DEI_FMD_WINDOW_R1         0x0624
++#define VPE_FMD_WINDOW_MINY_MASK      0x07ff
++#define VPE_FMD_WINDOW_MINY_SHIFT     0
++#define VPE_FMD_WINDOW_MAXY_MASK      0x07ff
++#define VPE_FMD_WINDOW_MAXY_SHIFT     16
++
++#define VPE_DEI_FMD_CONTROL_R0                0x0628
++#define VPE_FMD_ENABLE                        (1 << 0)
++#define VPE_FMD_LOCK                  (1 << 1)
++#define VPE_FMD_JAM_DIR                       (1 << 2)
++#define VPE_FMD_BED_ENABLE            (1 << 3)
++#define VPE_FMD_CAF_FIELD_THR_MASK    0xff
++#define VPE_FMD_CAF_FIELD_THR_SHIFT   16
++#define VPE_FMD_CAF_LINE_THR_MASK     0xff
++#define VPE_FMD_CAF_LINE_THR_SHIFT    24
++
++#define VPE_DEI_FMD_CONTROL_R1                0x062c
++#define VPE_FMD_CAF_THR_MASK          0x000fffff
++#define VPE_FMD_CAF_THR_SHIFT         0
++
++#define VPE_DEI_FMD_STATUS_R0         0x0630
++#define VPE_FMD_CAF_MASK              0x000fffff
++#define VPE_FMD_CAF_SHIFT             0
++#define VPE_FMD_RESET                 (1 << 24)
++
++#define VPE_DEI_FMD_STATUS_R1         0x0634
++#define VPE_FMD_FIELD_DIFF_MASK               0x0fffffff
++#define VPE_FMD_FIELD_DIFF_SHIFT      0
++
++#define VPE_DEI_FMD_STATUS_R2         0x0638
++#define VPE_FMD_FRAME_DIFF_MASK               0x000fffff
++#define VPE_FMD_FRAME_DIFF_SHIFT      0
++
++/* VPE scaler regs */
++#define VPE_SC_MP_SC0                 0x0700
++#define VPE_INTERLACE_O                       (1 << 0)
++#define VPE_LINEAR                    (1 << 1)
++#define VPE_SC_BYPASS                 (1 << 2)
++#define VPE_INVT_FID                  (1 << 3)
++#define VPE_USE_RAV                   (1 << 4)
++#define VPE_ENABLE_EV                 (1 << 5)
++#define VPE_AUTO_HS                   (1 << 6)
++#define VPE_DCM_2X                    (1 << 7)
++#define VPE_DCM_4X                    (1 << 8)
++#define VPE_HP_BYPASS                 (1 << 9)
++#define VPE_INTERLACE_I                       (1 << 10)
++#define VPE_ENABLE_SIN2_VER_INTP      (1 << 11)
++#define VPE_Y_PK_EN                   (1 << 14)
++#define VPE_TRIM                      (1 << 15)
++#define VPE_SELFGEN_FID                       (1 << 16)
++
++#define VPE_SC_MP_SC1                 0x0704
++#define VPE_ROW_ACC_INC_MASK          0x07ffffff
++#define VPE_ROW_ACC_INC_SHIFT         0
++
++#define VPE_SC_MP_SC2                 0x0708
++#define VPE_ROW_ACC_OFFSET_MASK               0x0fffffff
++#define VPE_ROW_ACC_OFFSET_SHIFT      0
++
++#define VPE_SC_MP_SC3                 0x070c
++#define VPE_ROW_ACC_OFFSET_B_MASK     0x0fffffff
++#define VPE_ROW_ACC_OFFSET_B_SHIFT    0
++
++#define VPE_SC_MP_SC4                 0x0710
++#define VPE_TAR_H_MASK                        0x07ff
++#define VPE_TAR_H_SHIFT                       0
++#define VPE_TAR_W_MASK                        0x07ff
++#define VPE_TAR_W_SHIFT                       12
++#define VPE_LIN_ACC_INC_U_MASK                0x07
++#define VPE_LIN_ACC_INC_U_SHIFT               24
++#define VPE_NLIN_ACC_INIT_U_MASK      0x07
++#define VPE_NLIN_ACC_INIT_U_SHIFT     28
++
++#define VPE_SC_MP_SC5                 0x0714
++#define VPE_SRC_H_MASK                        0x07ff
++#define VPE_SRC_H_SHIFT                       0
++#define VPE_SRC_W_MASK                        0x07ff
++#define VPE_SRC_W_SHIFT                       12
++#define VPE_NLIN_ACC_INC_U_MASK               0x07
++#define VPE_NLIN_ACC_INC_U_SHIFT      24
++
++#define VPE_SC_MP_SC6                 0x0718
++#define VPE_ROW_ACC_INIT_RAV_MASK     0x03ff
++#define VPE_ROW_ACC_INIT_RAV_SHIFT    0
++#define VPE_ROW_ACC_INIT_RAV_B_MASK   0x03ff
++#define VPE_ROW_ACC_INIT_RAV_B_SHIFT  10
++
++#define VPE_SC_MP_SC8                 0x0720
++#define VPE_NLIN_LEFT_MASK            0x07ff
++#define VPE_NLIN_LEFT_SHIFT           0
++#define VPE_NLIN_RIGHT_MASK           0x07ff
++#define VPE_NLIN_RIGHT_SHIFT          12
++
++#define VPE_SC_MP_SC9                 0x0724
++#define VPE_LIN_ACC_INC                       VPE_SC_MP_SC9
++
++#define VPE_SC_MP_SC10                        0x0728
++#define VPE_NLIN_ACC_INIT             VPE_SC_MP_SC10
++
++#define VPE_SC_MP_SC11                        0x072c
++#define VPE_NLIN_ACC_INC              VPE_SC_MP_SC11
++
++#define VPE_SC_MP_SC12                        0x0730
++#define VPE_COL_ACC_OFFSET_MASK               0x01ffffff
++#define VPE_COL_ACC_OFFSET_SHIFT      0
++
++#define VPE_SC_MP_SC13                        0x0734
++#define VPE_SC_FACTOR_RAV_MASK                0x03ff
++#define VPE_SC_FACTOR_RAV_SHIFT               0
++#define VPE_CHROMA_INTP_THR_MASK      0x03ff
++#define VPE_CHROMA_INTP_THR_SHIFT     12
++#define VPE_DELTA_CHROMA_THR_MASK     0x0f
++#define VPE_DELTA_CHROMA_THR_SHIFT    24
++
++#define VPE_SC_MP_SC17                        0x0744
++#define VPE_EV_THR_MASK                       0x03ff
++#define VPE_EV_THR_SHIFT              12
++#define VPE_DELTA_LUMA_THR_MASK               0x0f
++#define VPE_DELTA_LUMA_THR_SHIFT      24
++#define VPE_DELTA_EV_THR_MASK         0x0f
++#define VPE_DELTA_EV_THR_SHIFT                28
++
++#define VPE_SC_MP_SC18                        0x0748
++#define VPE_HS_FACTOR_MASK            0x03ff
++#define VPE_HS_FACTOR_SHIFT           0
++#define VPE_CONF_DEFAULT_MASK         0x01ff
++#define VPE_CONF_DEFAULT_SHIFT                16
++
++#define VPE_SC_MP_SC19                        0x074c
++#define VPE_HPF_COEFF0_MASK           0xff
++#define VPE_HPF_COEFF0_SHIFT          0
++#define VPE_HPF_COEFF1_MASK           0xff
++#define VPE_HPF_COEFF1_SHIFT          8
++#define VPE_HPF_COEFF2_MASK           0xff
++#define VPE_HPF_COEFF2_SHIFT          16
++#define VPE_HPF_COEFF3_MASK           0xff
++#define VPE_HPF_COEFF3_SHIFT          23
++
++#define VPE_SC_MP_SC20                        0x0750
++#define VPE_HPF_COEFF4_MASK           0xff
++#define VPE_HPF_COEFF4_SHIFT          0
++#define VPE_HPF_COEFF5_MASK           0xff
++#define VPE_HPF_COEFF5_SHIFT          8
++#define VPE_HPF_NORM_SHIFT_MASK               0x07
++#define VPE_HPF_NORM_SHIFT_SHIFT      16
++#define VPE_NL_LIMIT_MASK             0x1ff
++#define VPE_NL_LIMIT_SHIFT            20
++
++#define VPE_SC_MP_SC21                        0x0754
++#define VPE_NL_LO_THR_MASK            0x01ff
++#define VPE_NL_LO_THR_SHIFT           0
++#define VPE_NL_LO_SLOPE_MASK          0xff
++#define VPE_NL_LO_SLOPE_SHIFT         16
++
++#define VPE_SC_MP_SC22                        0x0758
++#define VPE_NL_HI_THR_MASK            0x01ff
++#define VPE_NL_HI_THR_SHIFT           0
++#define VPE_NL_HI_SLOPE_SH_MASK               0x07
++#define VPE_NL_HI_SLOPE_SH_SHIFT      16
++
++#define VPE_SC_MP_SC23                        0x075c
++#define VPE_GRADIENT_THR_MASK         0x07ff
++#define VPE_GRADIENT_THR_SHIFT                0
++#define VPE_GRADIENT_THR_RANGE_MASK   0x0f
++#define VPE_GRADIENT_THR_RANGE_SHIFT  12
++#define VPE_MIN_GY_THR_MASK           0xff
++#define VPE_MIN_GY_THR_SHIFT          16
++#define VPE_MIN_GY_THR_RANGE_MASK     0x0f
++#define VPE_MIN_GY_THR_RANGE_SHIFT    28
++
++#define VPE_SC_MP_SC24                        0x0760
++#define VPE_ORG_H_MASK                        0x07ff
++#define VPE_ORG_H_SHIFT                       0
++#define VPE_ORG_W_MASK                        0x07ff
++#define VPE_ORG_W_SHIFT                       16
++
++#define VPE_SC_MP_SC25                        0x0764
++#define VPE_OFF_H_MASK                        0x07ff
++#define VPE_OFF_H_SHIFT                       0
++#define VPE_OFF_W_MASK                        0x07ff
++#define VPE_OFF_W_SHIFT                       16
++
++/* VPE color space converter regs */
++#define VPE_CSC_CSC00                 0x5700
++#define VPE_CSC_A0_MASK                       0x1fff
++#define VPE_CSC_A0_SHIFT              0
++#define VPE_CSC_B0_MASK                       0x1fff
++#define VPE_CSC_B0_SHIFT              16
++
++#define VPE_CSC_CSC01                 0x5704
++#define VPE_CSC_C0_MASK                       0x1fff
++#define VPE_CSC_C0_SHIFT              0
++#define VPE_CSC_A1_MASK                       0x1fff
++#define VPE_CSC_A1_SHIFT              16
++
++#define VPE_CSC_CSC02                 0x5708
++#define VPE_CSC_B1_MASK                       0x1fff
++#define VPE_CSC_B1_SHIFT              0
++#define VPE_CSC_C1_MASK                       0x1fff
++#define VPE_CSC_C1_SHIFT              16
++
++#define VPE_CSC_CSC03                 0x570c
++#define VPE_CSC_A2_MASK                       0x1fff
++#define VPE_CSC_A2_SHIFT              0
++#define VPE_CSC_B2_MASK                       0x1fff
++#define VPE_CSC_B2_SHIFT              16
++
++#define VPE_CSC_CSC04                 0x5710
++#define VPE_CSC_C2_MASK                       0x1fff
++#define VPE_CSC_C2_SHIFT              0
++#define VPE_CSC_D0_MASK                       0x0fff
++#define VPE_CSC_D0_SHIFT              16
++
++#define VPE_CSC_CSC05                 0x5714
++#define VPE_CSC_D1_MASK                       0x0fff
++#define VPE_CSC_D1_SHIFT              0
++#define VPE_CSC_D2_MASK                       0x0fff
++#define VPE_CSC_D2_SHIFT              16
++#define VPE_CSC_BYPASS                        (1 << 28)
++
++#endif
+--- a/drivers/memory/emif.h
++++ b/drivers/memory/emif.h
+@@ -12,548 +12,7 @@
+ #ifndef __EMIF_H
+ #define __EMIF_H
+-/*
+- * Maximum number of different frequencies supported by EMIF driver
+- * Determines the number of entries in the pointer array for register
+- * cache
+- */
+-#define EMIF_MAX_NUM_FREQUENCIES                      6
+-
+-/* State of the core voltage */
+-#define DDR_VOLTAGE_STABLE                            0
+-#define DDR_VOLTAGE_RAMPING                           1
+-
+-/* Defines for timing De-rating */
+-#define EMIF_NORMAL_TIMINGS                           0
+-#define EMIF_DERATED_TIMINGS                          1
+-
+-/* Length of the forced read idle period in terms of cycles */
+-#define EMIF_READ_IDLE_LEN_VAL                                5
+-
+-/*
+- * forced read idle interval to be used when voltage
+- * is changed as part of DVFS/DPS - 1ms
+- */
+-#define READ_IDLE_INTERVAL_DVFS                               (1*1000000)
+-
+-/*
+- * Forced read idle interval to be used when voltage is stable
+- * 50us - or maximum value will do
+- */
+-#define READ_IDLE_INTERVAL_NORMAL                     (50*1000000)
+-
+-/* DLL calibration interval when voltage is NOT stable - 1us */
+-#define DLL_CALIB_INTERVAL_DVFS                               (1*1000000)
+-
+-#define DLL_CALIB_ACK_WAIT_VAL                                5
+-
+-/* Interval between ZQCS commands - hw team recommended value */
+-#define EMIF_ZQCS_INTERVAL_US                         (50*1000)
+-/* Enable ZQ Calibration on exiting Self-refresh */
+-#define ZQ_SFEXITEN_ENABLE                            1
+-/*
+- * ZQ Calibration simultaneously on both chip-selects:
+- * Needs one calibration resistor per CS
+- */
+-#define       ZQ_DUALCALEN_DISABLE                            0
+-#define       ZQ_DUALCALEN_ENABLE                             1
+-
+-#define T_ZQCS_DEFAULT_NS                             90
+-#define T_ZQCL_DEFAULT_NS                             360
+-#define T_ZQINIT_DEFAULT_NS                           1000
+-
+-/* DPD_EN */
+-#define DPD_DISABLE                                   0
+-#define DPD_ENABLE                                    1
+-
+-/*
+- * Default values for the low-power entry to be used if not provided by user.
+- * OMAP4/5 has a hw bug(i735) due to which this value can not be less than 512
+- * Timeout values are in DDR clock 'cycles' and frequency threshold in Hz
+- */
+-#define EMIF_LP_MODE_TIMEOUT_PERFORMANCE              2048
+-#define EMIF_LP_MODE_TIMEOUT_POWER                    512
+-#define EMIF_LP_MODE_FREQ_THRESHOLD                   400000000
+-
+-/* DDR_PHY_CTRL_1 values for EMIF4D - ATTILA PHY combination */
+-#define EMIF_DDR_PHY_CTRL_1_BASE_VAL_ATTILAPHY                0x049FF000
+-#define EMIF_DLL_SLAVE_DLY_CTRL_400_MHZ_ATTILAPHY     0x41
+-#define EMIF_DLL_SLAVE_DLY_CTRL_200_MHZ_ATTILAPHY     0x80
+-#define EMIF_DLL_SLAVE_DLY_CTRL_100_MHZ_AND_LESS_ATTILAPHY 0xFF
+-
+-/* DDR_PHY_CTRL_1 values for EMIF4D5 INTELLIPHY combination */
+-#define EMIF_DDR_PHY_CTRL_1_BASE_VAL_INTELLIPHY               0x0E084200
+-#define EMIF_PHY_TOTAL_READ_LATENCY_INTELLIPHY_PS     10000
+-
+-/* TEMP_ALERT_CONFIG - corresponding to temp gradient 5 C/s */
+-#define TEMP_ALERT_POLL_INTERVAL_DEFAULT_MS           360
+-
+-#define EMIF_T_CSTA                                   3
+-#define EMIF_T_PDLL_UL                                        128
+-
+-/* External PHY control registers magic values */
+-#define EMIF_EXT_PHY_CTRL_1_VAL                               0x04020080
+-#define EMIF_EXT_PHY_CTRL_5_VAL                               0x04010040
+-#define EMIF_EXT_PHY_CTRL_6_VAL                               0x01004010
+-#define EMIF_EXT_PHY_CTRL_7_VAL                               0x00001004
+-#define EMIF_EXT_PHY_CTRL_8_VAL                               0x04010040
+-#define EMIF_EXT_PHY_CTRL_9_VAL                               0x01004010
+-#define EMIF_EXT_PHY_CTRL_10_VAL                      0x00001004
+-#define EMIF_EXT_PHY_CTRL_11_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_12_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_13_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_14_VAL                      0x80080080
+-#define EMIF_EXT_PHY_CTRL_15_VAL                      0x00800800
+-#define EMIF_EXT_PHY_CTRL_16_VAL                      0x08102040
+-#define EMIF_EXT_PHY_CTRL_17_VAL                      0x00000001
+-#define EMIF_EXT_PHY_CTRL_18_VAL                      0x540A8150
+-#define EMIF_EXT_PHY_CTRL_19_VAL                      0xA81502A0
+-#define EMIF_EXT_PHY_CTRL_20_VAL                      0x002A0540
+-#define EMIF_EXT_PHY_CTRL_21_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_22_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_23_VAL                      0x00000000
+-#define EMIF_EXT_PHY_CTRL_24_VAL                      0x00000077
+-
+-#define EMIF_INTELLI_PHY_DQS_GATE_OPENING_DELAY_PS    1200
+-
+-/* Registers offset */
+-#define EMIF_MODULE_ID_AND_REVISION                   0x0000
+-#define EMIF_STATUS                                   0x0004
+-#define EMIF_SDRAM_CONFIG                             0x0008
+-#define EMIF_SDRAM_CONFIG_2                           0x000c
+-#define EMIF_SDRAM_REFRESH_CONTROL                    0x0010
+-#define EMIF_SDRAM_REFRESH_CTRL_SHDW                  0x0014
+-#define EMIF_SDRAM_TIMING_1                           0x0018
+-#define EMIF_SDRAM_TIMING_1_SHDW                      0x001c
+-#define EMIF_SDRAM_TIMING_2                           0x0020
+-#define EMIF_SDRAM_TIMING_2_SHDW                      0x0024
+-#define EMIF_SDRAM_TIMING_3                           0x0028
+-#define EMIF_SDRAM_TIMING_3_SHDW                      0x002c
+-#define EMIF_LPDDR2_NVM_TIMING                                0x0030
+-#define EMIF_LPDDR2_NVM_TIMING_SHDW                   0x0034
+-#define EMIF_POWER_MANAGEMENT_CONTROL                 0x0038
+-#define EMIF_POWER_MANAGEMENT_CTRL_SHDW                       0x003c
+-#define EMIF_LPDDR2_MODE_REG_DATA                     0x0040
+-#define EMIF_LPDDR2_MODE_REG_CONFIG                   0x0050
+-#define EMIF_OCP_CONFIG                                       0x0054
+-#define EMIF_OCP_CONFIG_VALUE_1                               0x0058
+-#define EMIF_OCP_CONFIG_VALUE_2                               0x005c
+-#define EMIF_IODFT_TEST_LOGIC_GLOBAL_CONTROL          0x0060
+-#define EMIF_IODFT_TEST_LOGIC_CTRL_MISR_RESULT                0x0064
+-#define EMIF_IODFT_TEST_LOGIC_ADDRESS_MISR_RESULT     0x0068
+-#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_1      0x006c
+-#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_2      0x0070
+-#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_3      0x0074
+-#define EMIF_PERFORMANCE_COUNTER_1                    0x0080
+-#define EMIF_PERFORMANCE_COUNTER_2                    0x0084
+-#define EMIF_PERFORMANCE_COUNTER_CONFIG                       0x0088
+-#define EMIF_PERFORMANCE_COUNTER_MASTER_REGION_SELECT 0x008c
+-#define EMIF_PERFORMANCE_COUNTER_TIME                 0x0090
+-#define EMIF_MISC_REG                                 0x0094
+-#define EMIF_DLL_CALIB_CTRL                           0x0098
+-#define EMIF_DLL_CALIB_CTRL_SHDW                      0x009c
+-#define EMIF_END_OF_INTERRUPT                         0x00a0
+-#define EMIF_SYSTEM_OCP_INTERRUPT_RAW_STATUS          0x00a4
+-#define EMIF_LL_OCP_INTERRUPT_RAW_STATUS              0x00a8
+-#define EMIF_SYSTEM_OCP_INTERRUPT_STATUS              0x00ac
+-#define EMIF_LL_OCP_INTERRUPT_STATUS                  0x00b0
+-#define EMIF_SYSTEM_OCP_INTERRUPT_ENABLE_SET          0x00b4
+-#define EMIF_LL_OCP_INTERRUPT_ENABLE_SET              0x00b8
+-#define EMIF_SYSTEM_OCP_INTERRUPT_ENABLE_CLEAR                0x00bc
+-#define EMIF_LL_OCP_INTERRUPT_ENABLE_CLEAR            0x00c0
+-#define EMIF_SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG        0x00c8
+-#define EMIF_TEMPERATURE_ALERT_CONFIG                 0x00cc
+-#define EMIF_OCP_ERROR_LOG                            0x00d0
+-#define EMIF_READ_WRITE_LEVELING_RAMP_WINDOW          0x00d4
+-#define EMIF_READ_WRITE_LEVELING_RAMP_CONTROL         0x00d8
+-#define EMIF_READ_WRITE_LEVELING_CONTROL              0x00dc
+-#define EMIF_DDR_PHY_CTRL_1                           0x00e4
+-#define EMIF_DDR_PHY_CTRL_1_SHDW                      0x00e8
+-#define EMIF_DDR_PHY_CTRL_2                           0x00ec
+-#define EMIF_PRIORITY_TO_CLASS_OF_SERVICE_MAPPING     0x0100
+-#define EMIF_CONNECTION_ID_TO_CLASS_OF_SERVICE_1_MAPPING 0x0104
+-#define EMIF_CONNECTION_ID_TO_CLASS_OF_SERVICE_2_MAPPING 0x0108
+-#define EMIF_READ_WRITE_EXECUTION_THRESHOLD           0x0120
+-#define EMIF_COS_CONFIG                                       0x0124
+-#define EMIF_PHY_STATUS_1                             0x0140
+-#define EMIF_PHY_STATUS_2                             0x0144
+-#define EMIF_PHY_STATUS_3                             0x0148
+-#define EMIF_PHY_STATUS_4                             0x014c
+-#define EMIF_PHY_STATUS_5                             0x0150
+-#define EMIF_PHY_STATUS_6                             0x0154
+-#define EMIF_PHY_STATUS_7                             0x0158
+-#define EMIF_PHY_STATUS_8                             0x015c
+-#define EMIF_PHY_STATUS_9                             0x0160
+-#define EMIF_PHY_STATUS_10                            0x0164
+-#define EMIF_PHY_STATUS_11                            0x0168
+-#define EMIF_PHY_STATUS_12                            0x016c
+-#define EMIF_PHY_STATUS_13                            0x0170
+-#define EMIF_PHY_STATUS_14                            0x0174
+-#define EMIF_PHY_STATUS_15                            0x0178
+-#define EMIF_PHY_STATUS_16                            0x017c
+-#define EMIF_PHY_STATUS_17                            0x0180
+-#define EMIF_PHY_STATUS_18                            0x0184
+-#define EMIF_PHY_STATUS_19                            0x0188
+-#define EMIF_PHY_STATUS_20                            0x018c
+-#define EMIF_PHY_STATUS_21                            0x0190
+-#define EMIF_EXT_PHY_CTRL_1                           0x0200
+-#define EMIF_EXT_PHY_CTRL_1_SHDW                      0x0204
+-#define EMIF_EXT_PHY_CTRL_2                           0x0208
+-#define EMIF_EXT_PHY_CTRL_2_SHDW                      0x020c
+-#define EMIF_EXT_PHY_CTRL_3                           0x0210
+-#define EMIF_EXT_PHY_CTRL_3_SHDW                      0x0214
+-#define EMIF_EXT_PHY_CTRL_4                           0x0218
+-#define EMIF_EXT_PHY_CTRL_4_SHDW                      0x021c
+-#define EMIF_EXT_PHY_CTRL_5                           0x0220
+-#define EMIF_EXT_PHY_CTRL_5_SHDW                      0x0224
+-#define EMIF_EXT_PHY_CTRL_6                           0x0228
+-#define EMIF_EXT_PHY_CTRL_6_SHDW                      0x022c
+-#define EMIF_EXT_PHY_CTRL_7                           0x0230
+-#define EMIF_EXT_PHY_CTRL_7_SHDW                      0x0234
+-#define EMIF_EXT_PHY_CTRL_8                           0x0238
+-#define EMIF_EXT_PHY_CTRL_8_SHDW                      0x023c
+-#define EMIF_EXT_PHY_CTRL_9                           0x0240
+-#define EMIF_EXT_PHY_CTRL_9_SHDW                      0x0244
+-#define EMIF_EXT_PHY_CTRL_10                          0x0248
+-#define EMIF_EXT_PHY_CTRL_10_SHDW                     0x024c
+-#define EMIF_EXT_PHY_CTRL_11                          0x0250
+-#define EMIF_EXT_PHY_CTRL_11_SHDW                     0x0254
+-#define EMIF_EXT_PHY_CTRL_12                          0x0258
+-#define EMIF_EXT_PHY_CTRL_12_SHDW                     0x025c
+-#define EMIF_EXT_PHY_CTRL_13                          0x0260
+-#define EMIF_EXT_PHY_CTRL_13_SHDW                     0x0264
+-#define EMIF_EXT_PHY_CTRL_14                          0x0268
+-#define EMIF_EXT_PHY_CTRL_14_SHDW                     0x026c
+-#define EMIF_EXT_PHY_CTRL_15                          0x0270
+-#define EMIF_EXT_PHY_CTRL_15_SHDW                     0x0274
+-#define EMIF_EXT_PHY_CTRL_16                          0x0278
+-#define EMIF_EXT_PHY_CTRL_16_SHDW                     0x027c
+-#define EMIF_EXT_PHY_CTRL_17                          0x0280
+-#define EMIF_EXT_PHY_CTRL_17_SHDW                     0x0284
+-#define EMIF_EXT_PHY_CTRL_18                          0x0288
+-#define EMIF_EXT_PHY_CTRL_18_SHDW                     0x028c
+-#define EMIF_EXT_PHY_CTRL_19                          0x0290
+-#define EMIF_EXT_PHY_CTRL_19_SHDW                     0x0294
+-#define EMIF_EXT_PHY_CTRL_20                          0x0298
+-#define EMIF_EXT_PHY_CTRL_20_SHDW                     0x029c
+-#define EMIF_EXT_PHY_CTRL_21                          0x02a0
+-#define EMIF_EXT_PHY_CTRL_21_SHDW                     0x02a4
+-#define EMIF_EXT_PHY_CTRL_22                          0x02a8
+-#define EMIF_EXT_PHY_CTRL_22_SHDW                     0x02ac
+-#define EMIF_EXT_PHY_CTRL_23                          0x02b0
+-#define EMIF_EXT_PHY_CTRL_23_SHDW                     0x02b4
+-#define EMIF_EXT_PHY_CTRL_24                          0x02b8
+-#define EMIF_EXT_PHY_CTRL_24_SHDW                     0x02bc
+-#define EMIF_EXT_PHY_CTRL_25                          0x02c0
+-#define EMIF_EXT_PHY_CTRL_25_SHDW                     0x02c4
+-#define EMIF_EXT_PHY_CTRL_26                          0x02c8
+-#define EMIF_EXT_PHY_CTRL_26_SHDW                     0x02cc
+-#define EMIF_EXT_PHY_CTRL_27                          0x02d0
+-#define EMIF_EXT_PHY_CTRL_27_SHDW                     0x02d4
+-#define EMIF_EXT_PHY_CTRL_28                          0x02d8
+-#define EMIF_EXT_PHY_CTRL_28_SHDW                     0x02dc
+-#define EMIF_EXT_PHY_CTRL_29                          0x02e0
+-#define EMIF_EXT_PHY_CTRL_29_SHDW                     0x02e4
+-#define EMIF_EXT_PHY_CTRL_30                          0x02e8
+-#define EMIF_EXT_PHY_CTRL_30_SHDW                     0x02ec
+-
+-/* Registers shifts and masks */
+-
+-/* EMIF_MODULE_ID_AND_REVISION */
+-#define SCHEME_SHIFT                                  30
+-#define SCHEME_MASK                                   (0x3 << 30)
+-#define MODULE_ID_SHIFT                                       16
+-#define MODULE_ID_MASK                                        (0xfff << 16)
+-#define RTL_VERSION_SHIFT                             11
+-#define RTL_VERSION_MASK                              (0x1f << 11)
+-#define MAJOR_REVISION_SHIFT                          8
+-#define MAJOR_REVISION_MASK                           (0x7 << 8)
+-#define MINOR_REVISION_SHIFT                          0
+-#define MINOR_REVISION_MASK                           (0x3f << 0)
+-
+-/* STATUS */
+-#define BE_SHIFT                                      31
+-#define BE_MASK                                               (1 << 31)
+-#define DUAL_CLK_MODE_SHIFT                           30
+-#define DUAL_CLK_MODE_MASK                            (1 << 30)
+-#define FAST_INIT_SHIFT                                       29
+-#define FAST_INIT_MASK                                        (1 << 29)
+-#define RDLVLGATETO_SHIFT                             6
+-#define RDLVLGATETO_MASK                              (1 << 6)
+-#define RDLVLTO_SHIFT                                 5
+-#define RDLVLTO_MASK                                  (1 << 5)
+-#define WRLVLTO_SHIFT                                 4
+-#define WRLVLTO_MASK                                  (1 << 4)
+-#define PHY_DLL_READY_SHIFT                           2
+-#define PHY_DLL_READY_MASK                            (1 << 2)
+-
+-/* SDRAM_CONFIG */
+-#define SDRAM_TYPE_SHIFT                              29
+-#define SDRAM_TYPE_MASK                                       (0x7 << 29)
+-#define IBANK_POS_SHIFT                                       27
+-#define IBANK_POS_MASK                                        (0x3 << 27)
+-#define DDR_TERM_SHIFT                                        24
+-#define DDR_TERM_MASK                                 (0x7 << 24)
+-#define DDR2_DDQS_SHIFT                                       23
+-#define DDR2_DDQS_MASK                                        (1 << 23)
+-#define DYN_ODT_SHIFT                                 21
+-#define DYN_ODT_MASK                                  (0x3 << 21)
+-#define DDR_DISABLE_DLL_SHIFT                         20
+-#define DDR_DISABLE_DLL_MASK                          (1 << 20)
+-#define SDRAM_DRIVE_SHIFT                             18
+-#define SDRAM_DRIVE_MASK                              (0x3 << 18)
+-#define CWL_SHIFT                                     16
+-#define CWL_MASK                                      (0x3 << 16)
+-#define NARROW_MODE_SHIFT                             14
+-#define NARROW_MODE_MASK                              (0x3 << 14)
+-#define CL_SHIFT                                      10
+-#define CL_MASK                                               (0xf << 10)
+-#define ROWSIZE_SHIFT                                 7
+-#define ROWSIZE_MASK                                  (0x7 << 7)
+-#define IBANK_SHIFT                                   4
+-#define IBANK_MASK                                    (0x7 << 4)
+-#define EBANK_SHIFT                                   3
+-#define EBANK_MASK                                    (1 << 3)
+-#define PAGESIZE_SHIFT                                        0
+-#define PAGESIZE_MASK                                 (0x7 << 0)
+-
+-/* SDRAM_CONFIG_2 */
+-#define CS1NVMEN_SHIFT                                        30
+-#define CS1NVMEN_MASK                                 (1 << 30)
+-#define EBANK_POS_SHIFT                                       27
+-#define EBANK_POS_MASK                                        (1 << 27)
+-#define RDBNUM_SHIFT                                  4
+-#define RDBNUM_MASK                                   (0x3 << 4)
+-#define RDBSIZE_SHIFT                                 0
+-#define RDBSIZE_MASK                                  (0x7 << 0)
+-
+-/* SDRAM_REFRESH_CONTROL */
+-#define INITREF_DIS_SHIFT                             31
+-#define INITREF_DIS_MASK                              (1 << 31)
+-#define SRT_SHIFT                                     29
+-#define SRT_MASK                                      (1 << 29)
+-#define ASR_SHIFT                                     28
+-#define ASR_MASK                                      (1 << 28)
+-#define PASR_SHIFT                                    24
+-#define PASR_MASK                                     (0x7 << 24)
+-#define REFRESH_RATE_SHIFT                            0
+-#define REFRESH_RATE_MASK                             (0xffff << 0)
+-
+-/* SDRAM_TIMING_1 */
+-#define T_RTW_SHIFT                                   29
+-#define T_RTW_MASK                                    (0x7 << 29)
+-#define T_RP_SHIFT                                    25
+-#define T_RP_MASK                                     (0xf << 25)
+-#define T_RCD_SHIFT                                   21
+-#define T_RCD_MASK                                    (0xf << 21)
+-#define T_WR_SHIFT                                    17
+-#define T_WR_MASK                                     (0xf << 17)
+-#define T_RAS_SHIFT                                   12
+-#define T_RAS_MASK                                    (0x1f << 12)
+-#define T_RC_SHIFT                                    6
+-#define T_RC_MASK                                     (0x3f << 6)
+-#define T_RRD_SHIFT                                   3
+-#define T_RRD_MASK                                    (0x7 << 3)
+-#define T_WTR_SHIFT                                   0
+-#define T_WTR_MASK                                    (0x7 << 0)
+-
+-/* SDRAM_TIMING_2 */
+-#define T_XP_SHIFT                                    28
+-#define T_XP_MASK                                     (0x7 << 28)
+-#define T_ODT_SHIFT                                   25
+-#define T_ODT_MASK                                    (0x7 << 25)
+-#define T_XSNR_SHIFT                                  16
+-#define T_XSNR_MASK                                   (0x1ff << 16)
+-#define T_XSRD_SHIFT                                  6
+-#define T_XSRD_MASK                                   (0x3ff << 6)
+-#define T_RTP_SHIFT                                   3
+-#define T_RTP_MASK                                    (0x7 << 3)
+-#define T_CKE_SHIFT                                   0
+-#define T_CKE_MASK                                    (0x7 << 0)
+-
+-/* SDRAM_TIMING_3 */
+-#define T_PDLL_UL_SHIFT                                       28
+-#define T_PDLL_UL_MASK                                        (0xf << 28)
+-#define T_CSTA_SHIFT                                  24
+-#define T_CSTA_MASK                                   (0xf << 24)
+-#define T_CKESR_SHIFT                                 21
+-#define T_CKESR_MASK                                  (0x7 << 21)
+-#define ZQ_ZQCS_SHIFT                                 15
+-#define ZQ_ZQCS_MASK                                  (0x3f << 15)
+-#define T_TDQSCKMAX_SHIFT                             13
+-#define T_TDQSCKMAX_MASK                              (0x3 << 13)
+-#define T_RFC_SHIFT                                   4
+-#define T_RFC_MASK                                    (0x1ff << 4)
+-#define T_RAS_MAX_SHIFT                                       0
+-#define T_RAS_MAX_MASK                                        (0xf << 0)
+-
+-/* POWER_MANAGEMENT_CONTROL */
+-#define PD_TIM_SHIFT                                  12
+-#define PD_TIM_MASK                                   (0xf << 12)
+-#define DPD_EN_SHIFT                                  11
+-#define DPD_EN_MASK                                   (1 << 11)
+-#define LP_MODE_SHIFT                                 8
+-#define LP_MODE_MASK                                  (0x7 << 8)
+-#define SR_TIM_SHIFT                                  4
+-#define SR_TIM_MASK                                   (0xf << 4)
+-#define CS_TIM_SHIFT                                  0
+-#define CS_TIM_MASK                                   (0xf << 0)
+-
+-/* LPDDR2_MODE_REG_DATA */
+-#define VALUE_0_SHIFT                                 0
+-#define VALUE_0_MASK                                  (0x7f << 0)
+-
+-/* LPDDR2_MODE_REG_CONFIG */
+-#define CS_SHIFT                                      31
+-#define CS_MASK                                               (1 << 31)
+-#define REFRESH_EN_SHIFT                              30
+-#define REFRESH_EN_MASK                                       (1 << 30)
+-#define ADDRESS_SHIFT                                 0
+-#define ADDRESS_MASK                                  (0xff << 0)
+-
+-/* OCP_CONFIG */
+-#define SYS_THRESH_MAX_SHIFT                          24
+-#define SYS_THRESH_MAX_MASK                           (0xf << 24)
+-#define MPU_THRESH_MAX_SHIFT                          20
+-#define MPU_THRESH_MAX_MASK                           (0xf << 20)
+-#define LL_THRESH_MAX_SHIFT                           16
+-#define LL_THRESH_MAX_MASK                            (0xf << 16)
+-
+-/* PERFORMANCE_COUNTER_1 */
+-#define COUNTER1_SHIFT                                        0
+-#define COUNTER1_MASK                                 (0xffffffff << 0)
+-
+-/* PERFORMANCE_COUNTER_2 */
+-#define COUNTER2_SHIFT                                        0
+-#define COUNTER2_MASK                                 (0xffffffff << 0)
+-
+-/* PERFORMANCE_COUNTER_CONFIG */
+-#define CNTR2_MCONNID_EN_SHIFT                                31
+-#define CNTR2_MCONNID_EN_MASK                         (1 << 31)
+-#define CNTR2_REGION_EN_SHIFT                         30
+-#define CNTR2_REGION_EN_MASK                          (1 << 30)
+-#define CNTR2_CFG_SHIFT                                       16
+-#define CNTR2_CFG_MASK                                        (0xf << 16)
+-#define CNTR1_MCONNID_EN_SHIFT                                15
+-#define CNTR1_MCONNID_EN_MASK                         (1 << 15)
+-#define CNTR1_REGION_EN_SHIFT                         14
+-#define CNTR1_REGION_EN_MASK                          (1 << 14)
+-#define CNTR1_CFG_SHIFT                                       0
+-#define CNTR1_CFG_MASK                                        (0xf << 0)
+-
+-/* PERFORMANCE_COUNTER_MASTER_REGION_SELECT */
+-#define MCONNID2_SHIFT                                        24
+-#define MCONNID2_MASK                                 (0xff << 24)
+-#define REGION_SEL2_SHIFT                             16
+-#define REGION_SEL2_MASK                              (0x3 << 16)
+-#define MCONNID1_SHIFT                                        8
+-#define MCONNID1_MASK                                 (0xff << 8)
+-#define REGION_SEL1_SHIFT                             0
+-#define REGION_SEL1_MASK                              (0x3 << 0)
+-
+-/* PERFORMANCE_COUNTER_TIME */
+-#define TOTAL_TIME_SHIFT                              0
+-#define TOTAL_TIME_MASK                                       (0xffffffff << 0)
+-
+-/* DLL_CALIB_CTRL */
+-#define ACK_WAIT_SHIFT                                        16
+-#define ACK_WAIT_MASK                                 (0xf << 16)
+-#define DLL_CALIB_INTERVAL_SHIFT                      0
+-#define DLL_CALIB_INTERVAL_MASK                               (0x1ff << 0)
+-
+-/* END_OF_INTERRUPT */
+-#define EOI_SHIFT                                     0
+-#define EOI_MASK                                      (1 << 0)
+-
+-/* SYSTEM_OCP_INTERRUPT_RAW_STATUS */
+-#define DNV_SYS_SHIFT                                 2
+-#define DNV_SYS_MASK                                  (1 << 2)
+-#define TA_SYS_SHIFT                                  1
+-#define TA_SYS_MASK                                   (1 << 1)
+-#define ERR_SYS_SHIFT                                 0
+-#define ERR_SYS_MASK                                  (1 << 0)
+-
+-/* LOW_LATENCY_OCP_INTERRUPT_RAW_STATUS */
+-#define DNV_LL_SHIFT                                  2
+-#define DNV_LL_MASK                                   (1 << 2)
+-#define TA_LL_SHIFT                                   1
+-#define TA_LL_MASK                                    (1 << 1)
+-#define ERR_LL_SHIFT                                  0
+-#define ERR_LL_MASK                                   (1 << 0)
+-
+-/* SYSTEM_OCP_INTERRUPT_ENABLE_SET */
+-#define EN_DNV_SYS_SHIFT                              2
+-#define EN_DNV_SYS_MASK                                       (1 << 2)
+-#define EN_TA_SYS_SHIFT                                       1
+-#define EN_TA_SYS_MASK                                        (1 << 1)
+-#define EN_ERR_SYS_SHIFT                                      0
+-#define EN_ERR_SYS_MASK                                       (1 << 0)
+-
+-/* LOW_LATENCY_OCP_INTERRUPT_ENABLE_SET */
+-#define EN_DNV_LL_SHIFT                                       2
+-#define EN_DNV_LL_MASK                                        (1 << 2)
+-#define EN_TA_LL_SHIFT                                        1
+-#define EN_TA_LL_MASK                                 (1 << 1)
+-#define EN_ERR_LL_SHIFT                                       0
+-#define EN_ERR_LL_MASK                                        (1 << 0)
+-
+-/* SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG */
+-#define ZQ_CS1EN_SHIFT                                        31
+-#define ZQ_CS1EN_MASK                                 (1 << 31)
+-#define ZQ_CS0EN_SHIFT                                        30
+-#define ZQ_CS0EN_MASK                                 (1 << 30)
+-#define ZQ_DUALCALEN_SHIFT                            29
+-#define ZQ_DUALCALEN_MASK                             (1 << 29)
+-#define ZQ_SFEXITEN_SHIFT                             28
+-#define ZQ_SFEXITEN_MASK                              (1 << 28)
+-#define ZQ_ZQINIT_MULT_SHIFT                          18
+-#define ZQ_ZQINIT_MULT_MASK                           (0x3 << 18)
+-#define ZQ_ZQCL_MULT_SHIFT                            16
+-#define ZQ_ZQCL_MULT_MASK                             (0x3 << 16)
+-#define ZQ_REFINTERVAL_SHIFT                          0
+-#define ZQ_REFINTERVAL_MASK                           (0xffff << 0)
+-
+-/* TEMPERATURE_ALERT_CONFIG */
+-#define TA_CS1EN_SHIFT                                        31
+-#define TA_CS1EN_MASK                                 (1 << 31)
+-#define TA_CS0EN_SHIFT                                        30
+-#define TA_CS0EN_MASK                                 (1 << 30)
+-#define TA_SFEXITEN_SHIFT                             28
+-#define TA_SFEXITEN_MASK                              (1 << 28)
+-#define TA_DEVWDT_SHIFT                                       26
+-#define TA_DEVWDT_MASK                                        (0x3 << 26)
+-#define TA_DEVCNT_SHIFT                                       24
+-#define TA_DEVCNT_MASK                                        (0x3 << 24)
+-#define TA_REFINTERVAL_SHIFT                          0
+-#define TA_REFINTERVAL_MASK                           (0x3fffff << 0)
+-
+-/* OCP_ERROR_LOG */
+-#define MADDRSPACE_SHIFT                              14
+-#define MADDRSPACE_MASK                                       (0x3 << 14)
+-#define MBURSTSEQ_SHIFT                                       11
+-#define MBURSTSEQ_MASK                                        (0x7 << 11)
+-#define MCMD_SHIFT                                    8
+-#define MCMD_MASK                                     (0x7 << 8)
+-#define MCONNID_SHIFT                                 0
+-#define MCONNID_MASK                                  (0xff << 0)
+-
+-/* DDR_PHY_CTRL_1 - EMIF4D */
+-#define DLL_SLAVE_DLY_CTRL_SHIFT_4D                   4
+-#define DLL_SLAVE_DLY_CTRL_MASK_4D                    (0xFF << 4)
+-#define READ_LATENCY_SHIFT_4D                         0
+-#define READ_LATENCY_MASK_4D                          (0xf << 0)
+-
+-/* DDR_PHY_CTRL_1 - EMIF4D5 */
+-#define DLL_HALF_DELAY_SHIFT_4D5                      21
+-#define DLL_HALF_DELAY_MASK_4D5                               (1 << 21)
+-#define READ_LATENCY_SHIFT_4D5                                0
+-#define READ_LATENCY_MASK_4D5                         (0x1f << 0)
+-
+-/* DDR_PHY_CTRL_1_SHDW */
+-#define DDR_PHY_CTRL_1_SHDW_SHIFT                     5
+-#define DDR_PHY_CTRL_1_SHDW_MASK                      (0x7ffffff << 5)
+-#define READ_LATENCY_SHDW_SHIFT                               0
+-#define READ_LATENCY_SHDW_MASK                                (0x1f << 0)
++#include <linux/ti_emif.h>
+ #ifndef __ASSEMBLY__
+ /*
+--- a/drivers/mfd/Kconfig
++++ b/drivers/mfd/Kconfig
+@@ -821,6 +821,17 @@ config MFD_TPS65217
+         This driver can also be built as a module.  If so, the module
+         will be called tps65217.
++config MFD_TPS65218
++      bool "TI TPS65218 Power Management chips"
++      depends on I2C
++      select MFD_CORE
++      select REGMAP_I2C
++      help
++        If you say yes here you get support for the TPS65218 series of
++        Power Management chips.
++        These include voltage regulators, gpio and other features
++        that are often used in portable devices.
++
+ config MFD_TPS6586X
+       bool "TI TPS6586x Power Management chips"
+       depends on I2C=y
+--- a/drivers/mfd/Makefile
++++ b/drivers/mfd/Makefile
+@@ -62,6 +62,7 @@ obj-$(CONFIG_TPS6105X)               += tps6105x.o
+ obj-$(CONFIG_TPS65010)                += tps65010.o
+ obj-$(CONFIG_TPS6507X)                += tps6507x.o
+ obj-$(CONFIG_MFD_TPS65217)    += tps65217.o
++obj-$(CONFIG_MFD_TPS65218)    += tps65218.o
+ obj-$(CONFIG_MFD_TPS65910)    += tps65910.o
+ tps65912-objs                   := tps65912-core.o tps65912-irq.o
+ obj-$(CONFIG_MFD_TPS65912)    += tps65912.o
+--- a/drivers/mfd/omap-usb-host.c
++++ b/drivers/mfd/omap-usb-host.c
+@@ -328,13 +328,13 @@ static int usbhs_runtime_resume(struct d
+       omap_tll_enable(pdata);
+       if (!IS_ERR(omap->ehci_logic_fck))
+-              clk_enable(omap->ehci_logic_fck);
++              clk_prepare_enable(omap->ehci_logic_fck);
+       for (i = 0; i < omap->nports; i++) {
+               switch (pdata->port_mode[i]) {
+               case OMAP_EHCI_PORT_MODE_HSIC:
+                       if (!IS_ERR(omap->hsic60m_clk[i])) {
+-                              r = clk_enable(omap->hsic60m_clk[i]);
++                              r = clk_prepare_enable(omap->hsic60m_clk[i]);
+                               if (r) {
+                                       dev_err(dev,
+                                        "Can't enable port %d hsic60m clk:%d\n",
+@@ -343,7 +343,7 @@ static int usbhs_runtime_resume(struct d
+                       }
+                       if (!IS_ERR(omap->hsic480m_clk[i])) {
+-                              r = clk_enable(omap->hsic480m_clk[i]);
++                              r = clk_prepare_enable(omap->hsic480m_clk[i]);
+                               if (r) {
+                                       dev_err(dev,
+                                        "Can't enable port %d hsic480m clk:%d\n",
+@@ -354,7 +354,7 @@ static int usbhs_runtime_resume(struct d
+               case OMAP_EHCI_PORT_MODE_TLL:
+                       if (!IS_ERR(omap->utmi_clk[i])) {
+-                              r = clk_enable(omap->utmi_clk[i]);
++                              r = clk_prepare_enable(omap->utmi_clk[i]);
+                               if (r) {
+                                       dev_err(dev,
+                                        "Can't enable port %d clk : %d\n",
+@@ -382,15 +382,15 @@ static int usbhs_runtime_suspend(struct
+               switch (pdata->port_mode[i]) {
+               case OMAP_EHCI_PORT_MODE_HSIC:
+                       if (!IS_ERR(omap->hsic60m_clk[i]))
+-                              clk_disable(omap->hsic60m_clk[i]);
++                              clk_disable_unprepare(omap->hsic60m_clk[i]);
+                       if (!IS_ERR(omap->hsic480m_clk[i]))
+-                              clk_disable(omap->hsic480m_clk[i]);
++                              clk_disable_unprepare(omap->hsic480m_clk[i]);
+               /* Fall through as utmi_clks were used in HSIC mode */
+               case OMAP_EHCI_PORT_MODE_TLL:
+                       if (!IS_ERR(omap->utmi_clk[i]))
+-                              clk_disable(omap->utmi_clk[i]);
++                              clk_disable_unprepare(omap->utmi_clk[i]);
+                       break;
+               default:
+                       break;
+@@ -398,7 +398,7 @@ static int usbhs_runtime_suspend(struct
+       }
+       if (!IS_ERR(omap->ehci_logic_fck))
+-              clk_disable(omap->ehci_logic_fck);
++              clk_disable_unprepare(omap->ehci_logic_fck);
+       omap_tll_disable(pdata);
+--- a/drivers/mfd/omap-usb-tll.c
++++ b/drivers/mfd/omap-usb-tll.c
+@@ -429,7 +429,7 @@ int omap_tll_enable(struct usbhs_omap_pl
+                       if (IS_ERR(tll->ch_clk[i]))
+                               continue;
+-                      r = clk_enable(tll->ch_clk[i]);
++                      r = clk_prepare_enable(tll->ch_clk[i]);
+                       if (r) {
+                               dev_err(tll_dev,
+                                "Error enabling ch %d clock: %d\n", i, r);
+@@ -460,7 +460,7 @@ int omap_tll_disable(struct usbhs_omap_p
+       for (i = 0; i < tll->nch; i++) {
+               if (omap_usb_mode_needs_tll(pdata->port_mode[i])) {
+                       if (!IS_ERR(tll->ch_clk[i]))
+-                              clk_disable(tll->ch_clk[i]);
++                              clk_disable_unprepare(tll->ch_clk[i]);
+               }
+       }
+--- a/drivers/mfd/ti_am335x_tscadc.c
++++ b/drivers/mfd/ti_am335x_tscadc.c
+@@ -56,21 +56,25 @@ EXPORT_SYMBOL_GPL(am335x_tsc_se_update);
+ void am335x_tsc_se_set(struct ti_tscadc_dev *tsadc, u32 val)
+ {
+-      spin_lock(&tsadc->reg_lock);
++      unsigned long flags;
++
++      spin_lock_irqsave(&tsadc->reg_lock, flags);
+       tsadc->reg_se_cache = tscadc_readl(tsadc, REG_SE);
+       tsadc->reg_se_cache |= val;
+       am335x_tsc_se_update(tsadc);
+-      spin_unlock(&tsadc->reg_lock);
++      spin_unlock_irqrestore(&tsadc->reg_lock, flags);
+ }
+ EXPORT_SYMBOL_GPL(am335x_tsc_se_set);
+ void am335x_tsc_se_clr(struct ti_tscadc_dev *tsadc, u32 val)
+ {
+-      spin_lock(&tsadc->reg_lock);
++      unsigned long flags;
++
++      spin_lock_irqsave(&tsadc->reg_lock, flags);
+       tsadc->reg_se_cache = tscadc_readl(tsadc, REG_SE);
+       tsadc->reg_se_cache &= ~val;
+       am335x_tsc_se_update(tsadc);
+-      spin_unlock(&tsadc->reg_lock);
++      spin_unlock_irqrestore(&tsadc->reg_lock, flags);
+ }
+ EXPORT_SYMBOL_GPL(am335x_tsc_se_clr);
+--- /dev/null
++++ b/drivers/mfd/tps65218.c
+@@ -0,0 +1,275 @@
++/*
++ * TPS65218 chip family multi-function driver
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether expressed or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License version 2 for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/device.h>
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/init.h>
++#include <linux/i2c.h>
++#include <linux/slab.h>
++#include <linux/regmap.h>
++#include <linux/err.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
++#include <linux/irq.h>
++#include <linux/interrupt.h>
++#include <linux/mutex.h>
++
++#include <linux/mfd/core.h>
++#include <linux/mfd/tps65218.h>
++
++#define TPS65218_PASSWORD_REGS_UNLOCK   0x7D
++
++/**
++ * tps65218_reg_read: Read a single tps65218 register.
++ *
++ * @tps: Device to read from.
++ * @reg: Register to read.
++ * @val: Contians the value
++ */
++int tps65218_reg_read(struct tps65218 *tps, unsigned int reg,
++                      unsigned int *val)
++{
++      return regmap_read(tps->regmap, reg, val);
++}
++EXPORT_SYMBOL_GPL(tps65218_reg_read);
++
++/**
++ * tps65218_reg_write: Write a single tps65218 register.
++ *
++ * @tps65218: Device to write to.
++ * @reg: Register to write to.
++ * @val: Value to write.
++ * @level: Password protected level
++ */
++int tps65218_reg_write(struct tps65218 *tps, unsigned int reg,
++                      unsigned int val, unsigned int level)
++{
++      int ret;
++      unsigned int xor_reg_val;
++
++      switch (level) {
++      case TPS65218_PROTECT_NONE:
++              return regmap_write(tps->regmap, reg, val);
++      case TPS65218_PROTECT_L1:
++              xor_reg_val = reg ^ TPS65218_PASSWORD_REGS_UNLOCK;
++              ret = regmap_write(tps->regmap, TPS65218_REG_PASSWORD,
++                                                      xor_reg_val);
++              if (ret < 0)
++                      return ret;
++
++              return regmap_write(tps->regmap, reg, val);
++      default:
++              return -EINVAL;
++      }
++}
++EXPORT_SYMBOL_GPL(tps65218_reg_write);
++
++/**
++ * tps65218_update_bits: Modify bits w.r.t mask, val and level.
++ *
++ * @tps65218: Device to write to.
++ * @reg: Register to read-write to.
++ * @mask: Mask.
++ * @val: Value to write.
++ * @level: Password protected level
++ */
++static int tps65218_update_bits(struct tps65218 *tps, unsigned int reg,
++              unsigned int mask, unsigned int val, unsigned int level)
++{
++      int ret;
++      unsigned int data;
++
++      ret = tps65218_reg_read(tps, reg, &data);
++      if (ret) {
++              dev_err(tps->dev, "Read from reg 0x%x failed\n", reg);
++              return ret;
++      }
++
++      data &= ~mask;
++      data |= val & mask;
++
++      mutex_lock(&tps->tps_lock);
++      ret = tps65218_reg_write(tps, reg, data, level);
++      if (ret)
++              dev_err(tps->dev, "Write for reg 0x%x failed\n", reg);
++      mutex_unlock(&tps->tps_lock);
++
++      return ret;
++}
++
++int tps65218_set_bits(struct tps65218 *tps, unsigned int reg,
++              unsigned int mask, unsigned int val, unsigned int level)
++{
++      return tps65218_update_bits(tps, reg, mask, val, level);
++}
++EXPORT_SYMBOL_GPL(tps65218_set_bits);
++
++int tps65218_clear_bits(struct tps65218 *tps, unsigned int reg,
++              unsigned int mask, unsigned int level)
++{
++      return tps65218_update_bits(tps, reg, mask, 0, level);
++}
++EXPORT_SYMBOL_GPL(tps65218_clear_bits);
++
++static struct regmap_config tps65218_regmap_config = {
++      .reg_bits = 8,
++      .val_bits = 8,
++};
++
++static const struct regmap_irq tps65218_irqs[] = {
++      /* INT1 IRQs */
++      [TPS65218_PRGC_IRQ] = {
++              .mask = TPS65218_INT1_PRGC,
++      },
++      [TPS65218_CC_AQC_IRQ] = {
++              .mask = TPS65218_INT1_CC_AQC,
++      },
++      [TPS65218_HOT_IRQ] = {
++              .mask = TPS65218_INT1_HOT,
++      },
++      [TPS65218_PB_IRQ] = {
++              .mask = TPS65218_INT1_PB,
++      },
++      [TPS65218_AC_IRQ] = {
++              .mask = TPS65218_INT1_AC,
++      },
++      [TPS65218_VPRG_IRQ] = {
++              .mask = TPS65218_INT1_VPRG,
++      },
++      [TPS65218_INVALID1_IRQ] = {
++      },
++      [TPS65218_INVALID2_IRQ] = {
++      },
++      /* INT2 IRQs*/
++      [TPS65218_LS1_I_IRQ] = {
++              .mask = TPS65218_INT2_LS1_I,
++              .reg_offset = 1,
++      },
++      [TPS65218_LS2_I_IRQ] = {
++              .mask = TPS65218_INT2_LS2_I,
++              .reg_offset = 1,
++      },
++      [TPS65218_LS3_I_IRQ] = {
++              .mask = TPS65218_INT2_LS3_I,
++              .reg_offset = 1,
++      },
++      [TPS65218_LS1_F_IRQ] = {
++              .mask = TPS65218_INT2_LS1_F,
++              .reg_offset = 1,
++      },
++      [TPS65218_LS2_F_IRQ] = {
++              .mask = TPS65218_INT2_LS2_F,
++              .reg_offset = 1,
++      },
++      [TPS65218_LS3_F_IRQ] = {
++              .mask = TPS65218_INT2_LS3_F,
++              .reg_offset = 1,
++      },
++      [TPS65218_INVALID3_IRQ] = {
++      },
++      [TPS65218_INVALID4_IRQ] = {
++      },
++};
++
++static struct regmap_irq_chip tps65218_irq_chip = {
++      .name = "tps65218",
++      .irqs = tps65218_irqs,
++      .num_irqs = ARRAY_SIZE(tps65218_irqs),
++
++      .num_regs = 2,
++      .mask_base = TPS65218_REG_INT_MASK1,
++};
++
++static const struct of_device_id of_tps65218_match_table[] = {
++      { .compatible = "ti,tps65218", },
++      { /* end */ }
++};
++
++static int tps65218_probe(struct i2c_client *client,
++                              const struct i2c_device_id *ids)
++{
++      struct tps65218 *tps;
++      const struct of_device_id *match;
++      int ret;
++
++      match = of_match_device(of_tps65218_match_table, &client->dev);
++      if (!match) {
++              dev_err(&client->dev,
++                      "Failed to find matching dt id\n");
++              return -EINVAL;
++      }
++
++      tps = devm_kzalloc(&client->dev, sizeof(*tps), GFP_KERNEL);
++      if (!tps)
++              return -ENOMEM;
++
++      i2c_set_clientdata(client, tps);
++      tps->dev = &client->dev;
++
++      tps->regmap = devm_regmap_init_i2c(client, &tps65218_regmap_config);
++      if (IS_ERR(tps->regmap)) {
++              ret = PTR_ERR(tps->regmap);
++              dev_err(tps->dev, "Failed to allocate register map: %d\n",
++                      ret);
++              return ret;
++      }
++
++      mutex_init(&tps->tps_lock);
++
++      ret = regmap_add_irq_chip(tps->regmap, tps->irq,
++                      IRQF_ONESHOT, 0, &tps65218_irq_chip,
++                      &tps->irq_data);
++      if (ret < 0)
++              return ret;
++
++      ret = of_platform_populate(client->dev.of_node, NULL, NULL,
++                                 &client->dev);
++      if (ret < 0)
++              goto err_irq;
++
++      return 0;
++
++err_irq:
++      regmap_del_irq_chip(tps->irq, tps->irq_data);
++
++      return ret;
++}
++
++static int tps65218_remove(struct i2c_client *client)
++{
++      struct tps65218 *tps = i2c_get_clientdata(client);
++
++      regmap_del_irq_chip(tps->irq, tps->irq_data);
++
++      return 0;
++}
++
++static struct i2c_driver tps65218_driver = {
++      .driver         = {
++              .name   = "tps65218",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_tps65218_match_table,
++      },
++      .probe          = tps65218_probe,
++      .remove         = tps65218_remove,
++};
++
++module_i2c_driver(tps65218_driver);
++
++MODULE_AUTHOR("J Keerthy <j-keerthy@ti.com>");
++MODULE_DESCRIPTION("TPS65218 chip family multi-function driver");
++MODULE_LICENSE("GPL v2");
+--- a/drivers/mfd/twl6040.c
++++ b/drivers/mfd/twl6040.c
+@@ -238,6 +238,8 @@ int twl6040_power(struct twl6040 *twl604
+               if (twl6040->power_count++)
+                       goto out;
++              clk_prepare_enable(twl6040->clk32k);
++
+               if (gpio_is_valid(twl6040->audpwron)) {
+                       /* use automatic power-up sequence */
+                       ret = twl6040_power_up_automatic(twl6040);
+@@ -281,6 +283,8 @@ int twl6040_power(struct twl6040 *twl604
+               }
+               twl6040->sysclk = 0;
+               twl6040->mclk = 0;
++
++              clk_disable_unprepare(twl6040->clk32k);
+       }
+ out:
+@@ -559,6 +563,12 @@ static int twl6040_probe(struct i2c_clie
+       i2c_set_clientdata(client, twl6040);
++      twl6040->clk32k = devm_clk_get(&client->dev, "clk32k");
++      if (IS_ERR(twl6040->clk32k)) {
++              dev_info(&client->dev, "clk32k is not handled\n");
++              twl6040->clk32k = NULL;
++      }
++
+       twl6040->supplies[0].supply = "vio";
+       twl6040->supplies[1].supply = "v2v1";
+       ret = devm_regulator_bulk_get(&client->dev, TWL6040_NUM_SUPPLIES,
+--- /dev/null
++++ b/drivers/misc/crossbar.c
+@@ -0,0 +1,258 @@
++/*
++ * IRQ/DMA CROSSBAR DRIVER
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *    Sricharan R <r.sricharan@ti.com>
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307
++ * USA
++ */
++#include <linux/crossbar.h>
++#include <linux/regmap.h>
++
++static LIST_HEAD(cb_devlist);
++
++static struct regmap_config cb_regmap_config = {
++      .reg_bits = 32,
++};
++
++static unsigned cb_entry_read(struct cb_line *tmp, const void *cbs)
++{
++      unsigned index = 0;
++
++      tmp->cb_name = cbs;
++      index = strlen(tmp->cb_name) + 1;
++
++      tmp->dev_name = cbs + index;
++      index += strlen(tmp->dev_name) + 1;
++
++      tmp->int_no = be32_to_cpup(cbs + index);
++      index += sizeof(tmp->int_no);
++
++      tmp->cb_no = be32_to_cpup(cbs + index);
++      index += sizeof(tmp->cb_no);
++
++      tmp->offset = be32_to_cpup(cbs + index);
++      index += sizeof(tmp->offset);
++
++      return index;
++}
++
++int crossbar_unmap(struct device_node *cbdev_node, unsigned index)
++{
++      const void *cbs;
++      unsigned size = 0, i = 0;
++      struct cb_line tmp;
++      struct cb_device *cbdev;
++      struct cb_entry *cbentry, *p;
++
++      cbs = of_get_property(cbdev_node, "crossbar-lines", &size);
++      if (!cbs)
++              return -ENOENT;
++
++      size = 0;
++
++      while (i++ < index)
++              size += cb_entry_read(&tmp, cbs + size);
++
++      cb_entry_read(&tmp, cbs + size);
++
++      list_for_each_entry(cbdev, &cb_devlist, node) {
++              if (strcmp(cbdev->name, tmp.cb_name))
++                      continue;
++
++              mutex_lock(&cbdev->cb_lock);
++              list_for_each_entry_safe(cbentry, p, &cbdev->cb_entries,
++                                       cb_list) {
++                      if ((cbentry->line.cb_no == tmp.cb_no) &&
++                          (cbentry->line.int_no == tmp.int_no)) {
++                              list_del(&cbentry->cb_list);
++                              mutex_unlock(&cbdev->cb_lock);
++                              dev_warn(cbdev->dev,
++                                       "unmapped int_no %x mapped to cb %x\n",
++                                       tmp.int_no, tmp.cb_no);
++                              return 0;
++                      }
++              }
++              mutex_unlock(&cbdev->cb_lock);
++              break;
++      }
++
++      dev_warn(cbdev->dev, "%s cb entry %d not found\n",
++               __func__, tmp.cb_no);
++      return -ENOENT;
++}
++EXPORT_SYMBOL(crossbar_unmap);
++
++const int cb_map(struct cb_line cbl)
++{
++      struct cb_device *cbdev;
++      struct cb_entry *cbentry, *tmp;
++      unsigned val;
++
++      /* Get corresponding device pointer */
++      list_for_each_entry(cbdev, &cb_devlist, node) {
++              if (strcmp(cbdev->name, cbl.cb_name))
++                      continue;
++
++              mutex_lock(&cbdev->cb_lock);
++
++              /* Check for invalid and duplicate mapping */
++              list_for_each_entry_safe(cbentry, tmp, &cbdev->cb_entries,
++                                       cb_list) {
++                      if ((cbentry->line.cb_no == cbl.cb_no) &&
++                          (cbentry->line.int_no != cbl.int_no)) {
++                              dev_warn(cbdev->dev,
++                                       "%s irq already mapped to irq no %d",
++                                       cbentry->line.dev_name,
++                                       cbentry->line.int_no);
++                              mutex_unlock(&cbdev->cb_lock);
++                              return -EINVAL;
++                      }
++                      if ((cbentry->line.cb_no == cbl.cb_no) &&
++                          (cbentry->line.int_no == cbl.int_no)) {
++                              mutex_unlock(&cbdev->cb_lock);
++                              return 0;
++                      }
++                      if ((cbentry->line.int_no == cbl.int_no) &&
++                          (cbentry->line.cb_no != cbl.cb_no)) {
++                              dev_warn(cbdev->dev,
++                                       "%s irq replaced by %s irq\n",
++                                       cbentry->line.dev_name,
++                                       cbl.dev_name);
++                              list_del(&(cbentry->cb_list));
++                              break;
++                      }
++              }
++
++              cbentry = devm_kzalloc(cbdev->dev, sizeof(struct cb_entry),
++                                                              GFP_KERNEL);
++              cbentry->line = cbl;
++              list_add_tail(&(cbentry->cb_list), &cbdev->cb_entries);
++
++              regmap_read(cbdev->cb_regmap, cbl.offset, &val);
++
++              /* Print the replaced entry and map the new one */
++              dev_warn(cbdev->dev,
++                       "replacing irq %d mapped to cb input %d with cb input %d\n",
++                       cbl.int_no, val, cbl.cb_no);
++
++              regmap_write(cbdev->cb_regmap, cbl.offset, cbl.cb_no);
++              mutex_unlock(&cbdev->cb_lock);
++              return 0;
++      }
++
++      dev_warn(cbdev->dev, "crossbar device %s not found", cbl.cb_name);
++      return -ENODEV;
++}
++
++int crossbar_map(struct device_node *cbdev_node)
++{
++      const void *cbs;
++      unsigned size = 0, index = 0;
++      int err;
++
++      cbs = of_get_property(cbdev_node, "crossbar-lines", &size);
++      if (!cbs)
++              return -ENOENT;
++
++      while (index < size) {
++              struct cb_line tmp;
++
++              index += cb_entry_read(&tmp, cbs + index);
++
++              err = cb_map(tmp);
++              if (IS_ERR_VALUE(err))
++                      return err;
++      }
++
++      return 0;
++}
++EXPORT_SYMBOL(crossbar_map);
++
++static int crossbar_probe(struct platform_device *pdev)
++{
++      struct cb_device *cbdev;
++      unsigned width;
++      struct device_node *cbdev_node = pdev->dev.of_node;
++      int err;
++      struct resource *res;
++
++      cbdev = devm_kzalloc(&pdev->dev, sizeof(struct cb_device), GFP_KERNEL);
++      if (!cbdev)
++              return -ENOMEM;
++
++      /* Get the device resources */
++      of_property_read_string(cbdev_node, "crossbar-name", &(cbdev->name));
++
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      if (res == NULL)
++              return -ENOENT;
++
++      cbdev->base = devm_ioremap_resource(&pdev->dev, res);
++      if (!cbdev->base)
++              return -ENOMEM;
++
++      cbdev->dev = &pdev->dev;
++
++      of_property_read_u32(cbdev_node, "reg-width", &width);
++
++      cb_regmap_config.val_bits = width;
++      cb_regmap_config.reg_stride = width >> 3;
++
++      cbdev->cb_regmap = devm_regmap_init_mmio(cbdev->dev, cbdev->base,
++                                               &cb_regmap_config);
++
++      if (IS_ERR(cbdev->cb_regmap)) {
++              dev_err(&pdev->dev, "regmap init failed\n");
++              err = PTR_ERR(cbdev->cb_regmap);
++              return err;
++      }
++
++      platform_set_drvdata(pdev, cbdev);
++      list_add_tail(&cbdev->node, &cb_devlist);
++
++      /* INIT LIST HEAD */
++      INIT_LIST_HEAD(&cbdev->cb_entries);
++
++      mutex_init(&cbdev->cb_lock);
++
++      /* map the cross bar entries passed as default from DT */
++      err = crossbar_map(cbdev_node);
++
++      return err;
++}
++
++#ifdef CONFIG_OF
++static const struct of_device_id crossbar_match[] = {
++      {.compatible = "crossbar", },
++      {},
++};
++#endif
++
++static struct platform_driver crossbar_driver = {
++      .probe          = crossbar_probe,
++      .driver         = {
++              .name           = "crossbar",
++              .owner          = THIS_MODULE,
++              .of_match_table = crossbar_match,
++      },
++};
++
++static int __init crossbar_init(void)
++{
++      return platform_driver_register(&crossbar_driver);
++}
++postcore_initcall(crossbar_init);
+--- a/drivers/misc/Kconfig
++++ b/drivers/misc/Kconfig
+@@ -528,6 +528,14 @@ config SRAM
+         the genalloc API. It is supposed to be used for small on-chip SRAM
+         areas found on many SoCs.
++config CROSSBAR
++      bool "on-chip crossbar driver"
++      select REGMAP_MMIO
++      help
++        This driver is for IRQ/DMA crossbar devices which is responsible for
++        muxing the irq/dma requests from external peripherals to the corresponding
++        controller's inputs.
++
+ source "drivers/misc/c2port/Kconfig"
+ source "drivers/misc/eeprom/Kconfig"
+ source "drivers/misc/cb710/Kconfig"
+--- a/drivers/misc/Makefile
++++ b/drivers/misc/Makefile
+@@ -53,3 +53,4 @@ obj-$(CONFIG_INTEL_MEI)              += mei/
+ obj-$(CONFIG_VMWARE_VMCI)     += vmw_vmci/
+ obj-$(CONFIG_LATTICE_ECP3_CONFIG)     += lattice-ecp3-config.o
+ obj-$(CONFIG_SRAM)            += sram.o
++obj-$(CONFIG_CROSSBAR)                += crossbar.o
+--- a/drivers/mmc/core/mmc.c
++++ b/drivers/mmc/core/mmc.c
+@@ -1512,14 +1512,6 @@ static int mmc_suspend(struct mmc_host *
+ }
+ /*
+- * Shutdown callback
+- */
+-static int mmc_shutdown(struct mmc_host *host)
+-{
+-      return _mmc_suspend(host, false);
+-}
+-
+-/*
+  * Resume callback from host.
+  *
+  * This function tries to determine if the same card is still present
+@@ -1608,7 +1600,6 @@ static const struct mmc_bus_ops mmc_ops
+       .resume = NULL,
+       .power_restore = mmc_power_restore,
+       .alive = mmc_alive,
+-      .shutdown = mmc_shutdown,
+ };
+ static const struct mmc_bus_ops mmc_ops_unsafe = {
+@@ -1620,7 +1611,6 @@ static const struct mmc_bus_ops mmc_ops_
+       .runtime_resume = mmc_runtime_resume,
+       .power_restore = mmc_power_restore,
+       .alive = mmc_alive,
+-      .shutdown = mmc_shutdown,
+ };
+ static void mmc_attach_bus_ops(struct mmc_host *host)
+--- a/drivers/mmc/core/sd.c
++++ b/drivers/mmc/core/sd.c
+@@ -1173,7 +1173,6 @@ static const struct mmc_bus_ops mmc_sd_o
+       .resume = NULL,
+       .power_restore = mmc_sd_power_restore,
+       .alive = mmc_sd_alive,
+-      .shutdown = mmc_sd_suspend,
+ };
+ static const struct mmc_bus_ops mmc_sd_ops_unsafe = {
+@@ -1185,7 +1184,6 @@ static const struct mmc_bus_ops mmc_sd_o
+       .resume = mmc_sd_resume,
+       .power_restore = mmc_sd_power_restore,
+       .alive = mmc_sd_alive,
+-      .shutdown = mmc_sd_suspend,
+ };
+ static void mmc_sd_attach_bus_ops(struct mmc_host *host)
+--- a/drivers/mmc/host/omap_hsmmc.c
++++ b/drivers/mmc/host/omap_hsmmc.c
+@@ -45,6 +45,7 @@
+ /* OMAP HSMMC Host Controller Registers */
+ #define OMAP_HSMMC_SYSSTATUS  0x0014
+ #define OMAP_HSMMC_CON                0x002C
++#define OMAP_HSMMC_SDMASA     0x0100
+ #define OMAP_HSMMC_BLK                0x0104
+ #define OMAP_HSMMC_ARG                0x0108
+ #define OMAP_HSMMC_CMD                0x010C
+@@ -58,7 +59,9 @@
+ #define OMAP_HSMMC_STAT               0x0130
+ #define OMAP_HSMMC_IE         0x0134
+ #define OMAP_HSMMC_ISE                0x0138
++#define OMAP_HSMMC_AC12               0x013C
+ #define OMAP_HSMMC_CAPA               0x0140
++#define OMAP_HSMMC_REV                0x01FC
+ #define VS18                  (1 << 26)
+ #define VS30                  (1 << 25)
+@@ -75,11 +78,14 @@
+ #define ICE                   0x1
+ #define ICS                   0x2
+ #define CEN                   (1 << 2)
++#define CLKD_MAX              0x3FF           /* max clock divisor: 1023 */
+ #define CLKD_MASK             0x0000FFC0
+ #define CLKD_SHIFT            6
+ #define DTO_MASK              0x000F0000
+ #define DTO_SHIFT             16
+ #define INIT_STREAM           (1 << 1)
++#define ACEN_ACMD12           (1 << 2)
++#define ACEN_ACMD23           (2 << 2)
+ #define DP_SELECT             (1 << 21)
+ #define DDIR                  (1 << 4)
+ #define DMAE                  0x1
+@@ -111,6 +117,7 @@
+ #define DTO_EN                        (1 << 20)
+ #define DCRC_EN                       (1 << 21)
+ #define DEB_EN                        (1 << 22)
++#define ACE_EN                        (1 << 24)
+ #define CERR_EN                       (1 << 28)
+ #define BADA_EN                       (1 << 29)
+@@ -118,12 +125,27 @@
+               DTO_EN | CIE_EN | CEB_EN | CCRC_EN | CTO_EN | \
+               BRR_EN | BWR_EN | TC_EN | CC_EN)
++#define CNI                   (1 << 7)
++#define ACIE                  (1 << 4)
++#define ACEB                  (1 << 3)
++#define ACCE                  (1 << 2)
++#define ACTO                  (1 << 1)
++#define ACNE                  (1 << 0)
++
+ #define MMC_AUTOSUSPEND_DELAY 100
+ #define MMC_TIMEOUT_MS                20
++#define MMC_TIMEOUT_US                20000
+ #define OMAP_MMC_MIN_CLOCK    400000
+ #define OMAP_MMC_MAX_CLOCK    52000000
+ #define DRIVER_NAME           "omap_hsmmc"
++#define AUTO_CMD12            (1 << 0)        /* Auto CMD12 support */
++#define AUTO_CMD23            (1 << 1)        /* Auto CMD23 support */
++
++#define OMAP_HSMMC_REV_SHIFT  24
++/* HSMMC controller revision on OMAP5, DRA7 */
++#define OMAP_HSMMC_REV_33     0x33
++
+ /*
+  * One controller can have multiple slots, like on some omap boards using
+  * omap.c controller driver. Luckily this is not currently done on any known
+@@ -171,6 +193,10 @@ struct omap_hsmmc_host {
+       unsigned char           bus_mode;
+       unsigned char           power_mode;
+       int                     suspended;
++      u32                     con;
++      u32                     hctl;
++      u32                     sysctl;
++      u32                     capa;
+       int                     irq;
+       int                     use_dma, dma_ch;
+       struct dma_chan         *tx_chan;
+@@ -182,11 +208,19 @@ struct omap_hsmmc_host {
+       int                     reqs_blocked;
+       int                     use_reg;
+       int                     req_in_progress;
++      unsigned long           clk_rate;
++      unsigned int            flags;
+       struct omap_hsmmc_next  next_data;
+-
+       struct  omap_mmc_platform_data  *pdata;
+ };
++static int
++omap_hsmmc_prepare_data(struct omap_hsmmc_host *host, struct mmc_request *req);
++
++static void set_data_timeout(struct omap_hsmmc_host *host,
++                           unsigned int timeout_ns,
++                           unsigned int timeout_clks);
++
+ static int omap_hsmmc_card_detect(struct device *dev, int slot)
+ {
+       struct omap_hsmmc_host *host = dev_get_drvdata(dev);
+@@ -407,6 +441,9 @@ static int omap_hsmmc_gpio_init(struct o
+               ret = gpio_direction_input(pdata->slots[0].switch_pin);
+               if (ret)
+                       goto err_free_sp;
++              ret = gpio_set_debounce(pdata->slots[0].switch_pin, 50000);
++              if (ret)
++                      goto err_free_sp;
+       } else
+               pdata->slots[0].switch_pin = -EINVAL;
+@@ -493,8 +530,8 @@ static u16 calc_divisor(struct omap_hsmm
+       if (ios->clock) {
+               dsor = DIV_ROUND_UP(clk_get_rate(host->fclk), ios->clock);
+-              if (dsor > 250)
+-                      dsor = 250;
++              if (dsor > CLKD_MAX)
++                      dsor = CLKD_MAX;
+       }
+       return dsor;
+@@ -597,25 +634,20 @@ static void omap_hsmmc_set_bus_mode(stru
+ static int omap_hsmmc_context_restore(struct omap_hsmmc_host *host)
+ {
+       struct mmc_ios *ios = &host->mmc->ios;
+-      struct omap_mmc_platform_data *pdata = host->pdata;
+-      int context_loss = 0;
+       u32 hctl, capa;
+       unsigned long timeout;
+-      if (pdata->get_context_loss_count) {
+-              context_loss = pdata->get_context_loss_count(host->dev);
+-              if (context_loss < 0)
+-                      return 1;
+-      }
+-
+-      dev_dbg(mmc_dev(host->mmc), "context was %slost\n",
+-              context_loss == host->context_loss ? "not " : "");
+-      if (host->context_loss == context_loss)
+-              return 1;
+-
+       if (!OMAP_HSMMC_READ(host->base, SYSSTATUS) & RESETDONE)
+               return 1;
++      if (host->con == OMAP_HSMMC_READ(host->base, CON) &&
++          host->hctl == OMAP_HSMMC_READ(host->base, HCTL) &&
++          host->sysctl == OMAP_HSMMC_READ(host->base, SYSCTL) &&
++          host->capa == OMAP_HSMMC_READ(host->base, CAPA))
++              return 0;
++
++      host->context_loss++;
++
+       if (host->pdata->controller_flags & OMAP_HSMMC_SUPPORTS_DUAL_VOLT) {
+               if (host->power_mode != MMC_POWER_OFF &&
+                   (1 << ios->vdd) <= MMC_VDD_23_24)
+@@ -655,9 +687,8 @@ static int omap_hsmmc_context_restore(st
+       omap_hsmmc_set_bus_mode(host);
+ out:
+-      host->context_loss = context_loss;
+-
+-      dev_dbg(mmc_dev(host->mmc), "context is restored\n");
++      dev_dbg(mmc_dev(host->mmc), "context is restored: restore count %d\n",
++              host->context_loss);
+       return 0;
+ }
+@@ -666,15 +697,10 @@ out:
+  */
+ static void omap_hsmmc_context_save(struct omap_hsmmc_host *host)
+ {
+-      struct omap_mmc_platform_data *pdata = host->pdata;
+-      int context_loss;
+-
+-      if (pdata->get_context_loss_count) {
+-              context_loss = pdata->get_context_loss_count(host->dev);
+-              if (context_loss < 0)
+-                      return;
+-              host->context_loss = context_loss;
+-      }
++      host->con =  OMAP_HSMMC_READ(host->base, CON);
++      host->hctl = OMAP_HSMMC_READ(host->base, HCTL);
++      host->sysctl =  OMAP_HSMMC_READ(host->base, SYSCTL);
++      host->capa = OMAP_HSMMC_READ(host->base, CAPA);
+ }
+ #else
+@@ -762,7 +788,7 @@ static DEVICE_ATTR(slot_name, S_IRUGO, o
+  */
+ static void
+ omap_hsmmc_start_command(struct omap_hsmmc_host *host, struct mmc_command *cmd,
+-      struct mmc_data *data)
++      struct mmc_data *data, bool autocmd12)
+ {
+       int cmdreg = 0, resptype = 0, cmdtype = 0;
+@@ -792,6 +818,13 @@ omap_hsmmc_start_command(struct omap_hsm
+               cmdtype = 0x3;
+       cmdreg = (cmd->opcode << 24) | (resptype << 16) | (cmdtype << 22);
++      if ((host->flags & AUTO_CMD23) && mmc_op_multi(cmd->opcode) &&
++          host->mrq->sbc) {
++              cmdreg |= ACEN_ACMD23;
++              OMAP_HSMMC_WRITE(host->base, SDMASA, host->mrq->sbc->arg);
++      } else if ((host->flags & AUTO_CMD12) && mmc_op_multi(cmd->opcode) &&
++                                                              autocmd12)
++              cmdreg |= ACEN_ACMD12;
+       if (data) {
+               cmdreg |= DP_SELECT | MSBS | BCE;
+@@ -870,11 +903,38 @@ omap_hsmmc_xfer_done(struct omap_hsmmc_h
+       else
+               data->bytes_xfered = 0;
+-      if (!data->stop) {
++      if (data->stop && (data->error || (!(host->flags & AUTO_CMD12) &&
++              !host->mrq->sbc))) {
++              /*
++               * If there is any error or open-end read/write with autocmd12
++               * disabled
++               */
++              omap_hsmmc_start_command(host, data->stop, NULL, 0);
++      } else {
++              /* status update for autocmd12 of open-end read/write */
++              if (data->stop && !host->mrq->sbc)
++                      data->stop->resp[0] = OMAP_HSMMC_READ(host->base,
++                                                      RSP76);
+               omap_hsmmc_request_done(host, data->mrq);
+-              return;
+       }
+-      omap_hsmmc_start_command(host, data->stop, NULL);
++
++      return;
++}
++
++static void omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host)
++{
++      struct mmc_request *req;
++      struct dma_chan *chan;
++      req = host->mrq;
++
++      if (!req->data)
++              return;
++      OMAP_HSMMC_WRITE(host->base, BLK, (req->data->blksz)
++                              | (req->data->blocks << 16));
++      set_data_timeout(host, req->data->timeout_ns,
++                              req->data->timeout_clks);
++      chan = omap_hsmmc_get_dma_chan(host, req->data);
++      dma_async_issue_pending(chan);
+ }
+ /*
+@@ -883,6 +943,18 @@ omap_hsmmc_xfer_done(struct omap_hsmmc_h
+ static void
+ omap_hsmmc_cmd_done(struct omap_hsmmc_host *host, struct mmc_command *cmd)
+ {
++      struct mmc_request *req;
++      req = host->mrq;
++
++      if (host->mrq->sbc && (host->cmd == host->mrq->sbc) &&
++          !host->mrq->sbc->error && !(host->flags & AUTO_CMD23)) {
++              host->cmd = NULL;
++              omap_hsmmc_start_dma_transfer(host);
++              omap_hsmmc_start_command(host, host->mrq->cmd,
++                                              host->mrq->data, 0);
++              return;
++      }
++
+       host->cmd = NULL;
+       if (cmd->flags & MMC_RSP_PRESENT) {
+@@ -975,8 +1047,7 @@ static inline void omap_hsmmc_reset_cont
+                                                  unsigned long bit)
+ {
+       unsigned long i = 0;
+-      unsigned long limit = (loops_per_jiffy *
+-                              msecs_to_jiffies(MMC_TIMEOUT_MS));
++      unsigned long limit = MMC_TIMEOUT_US;
+       OMAP_HSMMC_WRITE(host->base, SYSCTL,
+                        OMAP_HSMMC_READ(host->base, SYSCTL) | bit);
+@@ -988,13 +1059,14 @@ static inline void omap_hsmmc_reset_cont
+       if (mmc_slot(host).features & HSMMC_HAS_UPDATED_RESET) {
+               while ((!(OMAP_HSMMC_READ(host->base, SYSCTL) & bit))
+                                       && (i++ < limit))
+-                      cpu_relax();
++                      udelay(1);
+       }
++
+       i = 0;
+       while ((OMAP_HSMMC_READ(host->base, SYSCTL) & bit) &&
+               (i++ < limit))
+-              cpu_relax();
++              udelay(1);
+       if (OMAP_HSMMC_READ(host->base, SYSCTL) & bit)
+               dev_err(mmc_dev(host->mmc),
+@@ -1022,6 +1094,7 @@ static void omap_hsmmc_do_irq(struct oma
+ {
+       struct mmc_data *data;
+       int end_cmd = 0, end_trans = 0;
++      int error = 0;
+       data = host->data;
+       dev_vdbg(mmc_dev(host->mmc), "IRQ Status is %x\n", status);
+@@ -1036,6 +1109,29 @@ static void omap_hsmmc_do_irq(struct oma
+               else if (status & (CCRC_EN | DCRC_EN))
+                       hsmmc_command_incomplete(host, -EILSEQ, end_cmd);
++              if (status & ACE_EN) {
++                      u32 ac12;
++                      ac12 = OMAP_HSMMC_READ(host->base, AC12);
++                      if (!(ac12 & ACNE) && host->mrq->sbc) {
++                              end_cmd = 1;
++                              if (ac12 & ACTO)
++                                      error =  -ETIMEDOUT;
++                              else if (ac12 & (ACCE | ACEB | ACIE))
++                                      error = -EILSEQ;
++                              host->mrq->sbc->error = error;
++                              hsmmc_command_incomplete(host, error, end_cmd);
++                      }
++                      if (!(ac12 & ACNE) && !host->mrq->sbc &&
++                          host->mrq->data) {
++                              end_trans = 1;
++                              if (ac12 & ACTO)
++                                      host->mrq->data->error = -ETIMEDOUT;
++                              else if (ac12 & (ACCE | ACEB | ACIE))
++                                      host->mrq->data->error = -EILSEQ;
++                              omap_hsmmc_reset_controller_fsm(host, SRC);
++                      }
++                      dev_dbg(mmc_dev(host->mmc), "AC12 err: 0x%x\n", ac12);
++              }
+               if (host->data || host->response_busy) {
+                       end_trans = !end_cmd;
+                       host->response_busy = 0;
+@@ -1272,7 +1368,7 @@ static int omap_hsmmc_pre_dma_transfer(s
+ /*
+  * Routine to configure and start DMA for the MMC card
+  */
+-static int omap_hsmmc_start_dma_transfer(struct omap_hsmmc_host *host,
++static int omap_hsmmc_setup_dma_transfer(struct omap_hsmmc_host *host,
+                                       struct mmc_request *req)
+ {
+       struct dma_slave_config cfg;
+@@ -1331,8 +1427,6 @@ static int omap_hsmmc_start_dma_transfer
+       host->dma_ch = 1;
+-      dma_async_issue_pending(chan);
+-
+       return 0;
+ }
+@@ -1348,7 +1442,7 @@ static void set_data_timeout(struct omap
+       if (clkd == 0)
+               clkd = 1;
+-      cycle_ns = 1000000000 / (clk_get_rate(host->fclk) / clkd);
++      cycle_ns = 1000000000 / (host->clk_rate / clkd);
+       timeout = timeout_ns / cycle_ns;
+       timeout += timeout_clks;
+       if (timeout) {
+@@ -1393,12 +1487,8 @@ omap_hsmmc_prepare_data(struct omap_hsmm
+               return 0;
+       }
+-      OMAP_HSMMC_WRITE(host->base, BLK, (req->data->blksz)
+-                                      | (req->data->blocks << 16));
+-      set_data_timeout(host, req->data->timeout_ns, req->data->timeout_clks);
+-
+       if (host->use_dma) {
+-              ret = omap_hsmmc_start_dma_transfer(host, req);
++              ret = omap_hsmmc_setup_dma_transfer(host, req);
+               if (ret != 0) {
+                       dev_err(mmc_dev(host->mmc), "MMC start dma failure\n");
+                       return ret;
+@@ -1472,6 +1562,7 @@ static void omap_hsmmc_request(struct mm
+               host->reqs_blocked = 0;
+       WARN_ON(host->mrq != NULL);
+       host->mrq = req;
++      host->clk_rate = clk_get_rate(host->fclk);
+       err = omap_hsmmc_prepare_data(host, req);
+       if (err) {
+               req->cmd->error = err;
+@@ -1481,8 +1572,12 @@ static void omap_hsmmc_request(struct mm
+               mmc_request_done(mmc, req);
+               return;
+       }
+-
+-      omap_hsmmc_start_command(host, req->cmd, req->data);
++      if (req->sbc && !(host->flags & AUTO_CMD23)) {
++              omap_hsmmc_start_command(host, req->sbc, NULL, 0);
++              return;
++      }
++      omap_hsmmc_start_dma_transfer(host);
++      omap_hsmmc_start_command(host, req->cmd, req->data, 1);
+ }
+ /* Routine to configure clock values. Exposed API to core */
+@@ -1635,13 +1730,9 @@ static int omap_hsmmc_regs_show(struct s
+ {
+       struct mmc_host *mmc = s->private;
+       struct omap_hsmmc_host *host = mmc_priv(mmc);
+-      int context_loss = 0;
+-      if (host->pdata->get_context_loss_count)
+-              context_loss = host->pdata->get_context_loss_count(host->dev);
+-
+-      seq_printf(s, "mmc%d:\n ctx_loss:\t%d:%d\n\nregs:\n",
+-                      mmc->index, host->context_loss, context_loss);
++      seq_printf(s, "mmc%d:\n ctx_loss:\t%d\n\nregs:\n",
++                      mmc->index, host->context_loss);
+       if (host->suspended) {
+               seq_printf(s, "host suspended, can't read registers\n");
+@@ -1778,6 +1869,7 @@ static int omap_hsmmc_probe(struct platf
+       dma_cap_mask_t mask;
+       unsigned tx_req, rx_req;
+       struct pinctrl *pinctrl;
++      u32 revision;
+       match = of_match_device(of_match_ptr(omap_mmc_of_match), &pdev->dev);
+       if (match) {
+@@ -1874,7 +1966,7 @@ static int omap_hsmmc_probe(struct platf
+       omap_hsmmc_context_save(host);
+       /* This can be removed once we support PBIAS with DT */
+-      if (host->dev->of_node && host->mapbase == 0x4809c000)
++      if (host->dev->of_node && res->start == 0x4809c000)
+               host->pbias_disable = 1;
+       host->dbclk = clk_get(&pdev->dev, "mmchsdb_fck");
+@@ -1976,6 +2068,12 @@ static int omap_hsmmc_probe(struct platf
+               host->use_reg = 1;
+       }
++      revision = OMAP_HSMMC_READ(host->base, REV);
++      if ((revision >> OMAP_HSMMC_REV_SHIFT) >= OMAP_HSMMC_REV_33) {
++              mmc->caps |= MMC_CAP_CMD23;
++              host->flags |= AUTO_CMD23;
++      }
++
+       mmc->ocr_avail = mmc_slot(host).ocr_mask;
+       /* Request IRQ for card detect */
+--- a/drivers/mtd/devices/elm.c
++++ b/drivers/mtd/devices/elm.c
+@@ -22,8 +22,11 @@
+ #include <linux/of.h>
+ #include <linux/sched.h>
+ #include <linux/pm_runtime.h>
++#include <linux/mtd/mtd.h>
++#include <linux/mtd/nand.h>
+ #include <linux/platform_data/elm.h>
++#define       DRIVER_NAME                     "omap-elm"
+ #define ELM_SYSCONFIG                 0x010
+ #define ELM_IRQSTATUS                 0x018
+ #define ELM_IRQENABLE                 0x01c
+@@ -82,8 +85,10 @@ struct elm_info {
+       void __iomem *elm_base;
+       struct completion elm_completion;
+       struct list_head list;
++      struct mtd_info *mtd;
+       enum bch_ecc bch_type;
+       struct elm_registers elm_regs;
++      int eccsteps;
+ };
+ static LIST_HEAD(elm_devices);
+@@ -103,19 +108,42 @@ static u32 elm_read_reg(struct elm_info
+  * @dev:      ELM device
+  * @bch_type: Type of BCH ecc
+  */
+-int elm_config(struct device *dev, enum bch_ecc bch_type)
++int elm_config(struct device *dev, struct mtd_info *mtd,
++              enum bch_ecc bch_type)
+ {
+       u32 reg_val;
+-      struct elm_info *info = dev_get_drvdata(dev);
+-
++      struct elm_info  *info;
++      struct nand_chip *chip;
++      if (!dev) {
++              pr_err("%s: ELM device not found\n", DRIVER_NAME);
++              return -ENODEV;
++      }
++      info = dev_get_drvdata(dev);
+       if (!info) {
+-              dev_err(dev, "Unable to configure elm - device not probed?\n");
++              pr_err("%s: ELM device data not found\n", DRIVER_NAME);
+               return -ENODEV;
+       }
+-
++      if (!mtd) {
++              pr_err("%s: MTD device not found\n", DRIVER_NAME);
++              return -ENODEV;
++      }
++      chip = mtd->priv;
++      /* ELM supports error correction in chunks of 512bytes of data only
++       * where each 512bytes of data has its own ECC syndrome */
++      if (chip->ecc.size != 512) {
++              pr_err("%s: invalid ecc_size configuration", DRIVER_NAME);
++              return -EINVAL;
++      }
++      if (mtd->writesize > 4096) {
++              pr_err("%s: page-size > 4096 is not supported", DRIVER_NAME);
++              return -EINVAL;
++      }
++      /* ELM eccsteps required to decode complete NAND page */
++      info->mtd       = mtd;
++      info->bch_type  = bch_type;
++      info->eccsteps = mtd->writesize / chip->ecc.size;
+       reg_val = (bch_type & ECC_BCH_LEVEL_MASK) | (ELM_ECC_SIZE << 16);
+       elm_write_reg(info, ELM_LOCATION_CONFIG, reg_val);
+-      info->bch_type = bch_type;
+       return 0;
+ }
+@@ -152,55 +180,80 @@ static void elm_configure_page_mode(stru
+  * Load syndrome fragment registers with calculated ecc in reverse order.
+  */
+ static void elm_load_syndrome(struct elm_info *info,
+-              struct elm_errorvec *err_vec, u8 *ecc)
++              struct elm_errorvec *err_vec, u8 *ecc_calc)
+ {
++      struct nand_chip *chip  = info->mtd->priv;
++      unsigned int eccbytes   = chip->ecc.bytes;
++      u8 *ecc = ecc_calc;
+       int i, offset;
+       u32 val;
+-      for (i = 0; i < ERROR_VECTOR_MAX; i++) {
+-
++      for (i = 0; i < info->eccsteps; i++) {
+               /* Check error reported */
+               if (err_vec[i].error_reported) {
+                       elm_configure_page_mode(info, i, true);
+-                      offset = ELM_SYNDROME_FRAGMENT_0 +
+-                              SYNDROME_FRAGMENT_REG_SIZE * i;
+-
+-                      /* BCH8 */
+-                      if (info->bch_type) {
+-
+-                              /* syndrome fragment 0 = ecc[9-12B] */
+-                              val = cpu_to_be32(*(u32 *) &ecc[9]);
+-                              elm_write_reg(info, offset, val);
+-
+-                              /* syndrome fragment 1 = ecc[5-8B] */
+-                              offset += 4;
+-                              val = cpu_to_be32(*(u32 *) &ecc[5]);
+-                              elm_write_reg(info, offset, val);
+-
+-                              /* syndrome fragment 2 = ecc[1-4B] */
+-                              offset += 4;
+-                              val = cpu_to_be32(*(u32 *) &ecc[1]);
+-                              elm_write_reg(info, offset, val);
+-
+-                              /* syndrome fragment 3 = ecc[0B] */
+-                              offset += 4;
+-                              val = ecc[0];
+-                              elm_write_reg(info, offset, val);
+-                      } else {
+-                              /* syndrome fragment 0 = ecc[20-52b] bits */
+-                              val = (cpu_to_be32(*(u32 *) &ecc[3]) >> 4) |
+-                                      ((ecc[2] & 0xf) << 28);
+-                              elm_write_reg(info, offset, val);
+-
+-                              /* syndrome fragment 1 = ecc[0-20b] bits */
+-                              offset += 4;
+-                              val = cpu_to_be32(*(u32 *) &ecc[0]) >> 12;
+-                              elm_write_reg(info, offset, val);
++                      offset = SYNDROME_FRAGMENT_REG_SIZE * i;
++                      ecc = ecc_calc + (i * eccbytes);
++                      switch (info->bch_type) {
++                      case BCH4_ECC:
++                              val =   ((*(ecc + 6) >>  4) & 0x0F) |
++                                      *(ecc +  5) <<  4 | *(ecc +  4) << 12 |
++                                      *(ecc +  3) << 20 | *(ecc +  2) << 28;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_0 +
++                                               offset), cpu_to_le32(val));
++                              val =   ((*(ecc + 2) >>  4) & 0x0F) |
++                                      *(ecc +  1) <<  4 | *(ecc +  0) << 12;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_1 +
++                                               offset), cpu_to_le32(val));
++                              break;
++                      case BCH8_ECC:
++                              val =   *(ecc + 12) << 0  | *(ecc + 11) <<  8 |
++                                      *(ecc + 10) << 16 | *(ecc +  9) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_0 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  8) <<  0 | *(ecc +  7) <<  8 |
++                                      *(ecc +  6) << 16 | *(ecc +  5) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_1 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  4) <<  0 | *(ecc +  3) <<  8 |
++                                      *(ecc +  2) << 16 | *(ecc +  1) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_2 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  0) <<  0 & 0x000000FF;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_3 +
++                                               offset), cpu_to_le32(val));
++                              break;
++                      case BCH16_ECC:
++                              val =   *(ecc + 25) << 0  | *(ecc + 24) <<  8 |
++                                      *(ecc + 23) << 16 | *(ecc + 22) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_0 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc + 21) <<  0 | *(ecc + 20) <<  8 |
++                                      *(ecc + 19) << 16 | *(ecc + 18) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_1 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc + 17) <<  0 | *(ecc + 16) <<  8 |
++                                      *(ecc + 15) << 16 | *(ecc + 14) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_2 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc + 13) <<  0 | *(ecc + 12) <<  8 |
++                                      *(ecc + 11) << 16 | *(ecc + 10) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_3 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  9) <<  0 | *(ecc +  8) <<  8 |
++                                      *(ecc +  7) << 16 | *(ecc +  6) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_4 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  5) <<  0 | *(ecc +  4) <<  8 |
++                                      *(ecc +  3) << 16 | *(ecc +  2) << 24;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_5 +
++                                               offset), cpu_to_le32(val));
++                              val =   *(ecc +  1) <<  0 | *(ecc +  0) <<  8;
++                              elm_write_reg(info, (ELM_SYNDROME_FRAGMENT_6 +
++                                               offset), cpu_to_le32(val));
++                              break;
+                       }
+               }
+-
+-              /* Update ecc pointer with ecc byte size */
+-              ecc += info->bch_type ? BCH8_SIZE : BCH4_SIZE;
+       }
+ }
+@@ -223,7 +276,7 @@ static void elm_start_processing(struct
+        * Set syndrome vector valid, so that ELM module
+        * will process it for vectors error is reported
+        */
+-      for (i = 0; i < ERROR_VECTOR_MAX; i++) {
++      for (i = 0; i < info->eccsteps; i++) {
+               if (err_vec[i].error_reported) {
+                       offset = ELM_SYNDROME_FRAGMENT_6 +
+                               SYNDROME_FRAGMENT_REG_SIZE * i;
+@@ -252,7 +305,7 @@ static void elm_error_correction(struct
+       int offset;
+       u32 reg_val;
+-      for (i = 0; i < ERROR_VECTOR_MAX; i++) {
++      for (i = 0; i < info->eccsteps; i++) {
+               /* Check error reported */
+               if (err_vec[i].error_reported) {
+@@ -263,14 +316,12 @@ static void elm_error_correction(struct
+                       if (reg_val & ECC_CORRECTABLE_MASK) {
+                               offset = ELM_ERROR_LOCATION_0 +
+                                       ERROR_LOCATION_SIZE * i;
+-
+                               /* Read count of correctable errors */
+                               err_vec[i].error_count = reg_val &
+                                       ECC_NB_ERRORS_MASK;
+                               /* Update the error locations in error vector */
+                               for (j = 0; j < err_vec[i].error_count; j++) {
+-
+                                       reg_val = elm_read_reg(info, offset);
+                                       err_vec[i].error_loc[j] = reg_val &
+                                               ECC_ERROR_LOCATION_MASK;
+--- a/drivers/mtd/devices/Kconfig
++++ b/drivers/mtd/devices/Kconfig
+@@ -95,13 +95,6 @@ config MTD_M25P80
+         if you want to specify device partitioning or to use a device which
+         doesn't support the JEDEC ID instruction.
+-config M25PXX_USE_FAST_READ
+-      bool "Use FAST_READ OPCode allowing SPI CLK >= 50MHz"
+-      depends on MTD_M25P80
+-      default y
+-      help
+-        This option enables FAST_READ access supported by ST M25Pxx.
+-
+ config MTD_SPEAR_SMI
+       tristate "SPEAR MTD NOR Support through SMI controller"
+       depends on PLAT_SPEAR
+--- a/drivers/mtd/devices/m25p80.c
++++ b/drivers/mtd/devices/m25p80.c
+@@ -41,6 +41,7 @@
+ #define       OPCODE_WRSR             0x01    /* Write status register 1 byte */
+ #define       OPCODE_NORM_READ        0x03    /* Read data bytes (low frequency) */
+ #define       OPCODE_FAST_READ        0x0b    /* Read data bytes (high frequency) */
++#define OPCODE_QUAD_READ      0x6b    /* QUAD READ */
+ #define       OPCODE_PP               0x02    /* Page program (up to 256 bytes) */
+ #define       OPCODE_BE_4K            0x20    /* Erase 4KiB block */
+ #define       OPCODE_BE_4K_PMC        0xd7    /* Erase 4KiB block on PMC chips */
+@@ -48,10 +49,12 @@
+ #define       OPCODE_CHIP_ERASE       0xc7    /* Erase whole flash chip */
+ #define       OPCODE_SE               0xd8    /* Sector erase (usually 64KiB) */
+ #define       OPCODE_RDID             0x9f    /* Read JEDEC ID */
++#define       OPCODE_RDCR             0x35    /* Read configuration register */
+ /* 4-byte address opcodes - used on Spansion and some Macronix flashes. */
+ #define       OPCODE_NORM_READ_4B     0x13    /* Read data bytes (low frequency) */
+ #define       OPCODE_FAST_READ_4B     0x0c    /* Read data bytes (high frequency) */
++#define OPCODE_QUAD_READ_4B   0x6c    /* Read data bytes */
+ #define       OPCODE_PP_4B            0x12    /* Page program (up to 256 bytes) */
+ #define       OPCODE_SE_4B            0xdc    /* Sector erase (usually 64KiB) */
+@@ -76,9 +79,13 @@
+ #define       SR_BP2                  0x10    /* Block protect 2 */
+ #define       SR_SRWD                 0x80    /* SR write protect */
++/* Configuration Register bits. */
++#define CR_QUAD_EN_SPAN               0x2     /* Spansion Quad I/O */
++#define SR_QUAD_EN_MX         0x40    /* Macronix Quad I/O */
++
+ /* Define max times to check status register before we give up. */
+ #define       MAX_READY_WAIT_JIFFIES  (40 * HZ)       /* M25P16 specs 40s max chip erase */
+-#define       MAX_CMD_SIZE            5
++#define       MAX_CMD_SIZE            6
+ #define JEDEC_MFR(_jedec_id)  ((_jedec_id) >> 16)
+@@ -101,6 +108,8 @@ struct m25p {
+       u8                      program_opcode;
+       u8                      *command;
+       bool                    fast_read;
++      bool                    quad_read;
++      bool                    mmap;
+ };
+ static inline struct m25p *mtd_to_m25p(struct mtd_info *mtd)
+@@ -137,6 +146,26 @@ static int read_sr(struct m25p *flash)
+ }
+ /*
++ * Read the configuration register, returning its value in the location
++ * Return the configuration register value.
++ * Returns negative if error occurred.
++ */
++static int read_cr(struct m25p *flash)
++{
++      u8 code = OPCODE_RDCR;
++      int ret;
++      u8 val;
++
++      ret = spi_write_then_read(flash->spi, &code, 1, &val, 1);
++      if (ret < 0) {
++              dev_err(&flash->spi->dev, "error %d reading CR\n", ret);
++              return ret;
++      }
++
++      return val;
++}
++
++/*
+  * Write status register 1 byte
+  * Returns negative if error occurred.
+  */
+@@ -226,6 +255,93 @@ static int wait_till_ready(struct m25p *
+ }
+ /*
++ * It should be something like this. Note the asterisk alignment. You
++ * also could wrap the right edge neatly to nearly 80 characters.
++ */
++static int write_sr_cr(struct m25p *flash, u16 val)
++{
++      flash->command[0] = OPCODE_WRSR;
++      flash->command[1] = val & 0xff;
++      flash->command[2] = (val >> 8);
++
++      return spi_write(flash->spi, flash->command, 3);
++}
++
++static int macronix_quad_enable(struct m25p *flash)
++{
++      int ret, val;
++      u8 cmd[2];
++      cmd[0] = OPCODE_WRSR;
++
++      val = read_sr(flash);
++      cmd[1] = val | SR_QUAD_EN_MX;
++      write_enable(flash);
++
++      spi_write(flash->spi, &cmd, 2);
++
++      if (wait_till_ready(flash))
++              return 1;
++
++      ret = read_sr(flash);
++      if (!(ret > 0 && (ret & SR_QUAD_EN_MX))) {
++              dev_err(&flash->spi->dev,
++                      "Macronix Quad bit not set");
++              return -EINVAL;
++      }
++
++      return 0;
++}
++
++static int spansion_quad_enable(struct m25p *flash)
++{
++      int ret;
++      int quad_en = CR_QUAD_EN_SPAN << 8;
++
++      write_enable(flash);
++
++      ret = write_sr_cr(flash, quad_en);
++      if (ret < 0) {
++              dev_err(&flash->spi->dev,
++                      "error while writing configuration register");
++              return -EINVAL;
++      }
++
++      /* read back and check it */
++      ret = read_cr(flash);
++      if (!(ret > 0 && (ret & CR_QUAD_EN_SPAN))) {
++              dev_err(&flash->spi->dev,
++                      "Spansion Quad bit not set");
++              return -EINVAL;
++      }
++
++      return 0;
++}
++
++static inline int set_quad_mode(struct m25p *flash, u32 jedec_id, int enable)
++{
++      int status;
++
++      switch (JEDEC_MFR(jedec_id)) {
++      case CFI_MFR_MACRONIX:
++              status = macronix_quad_enable(flash);
++              if (status) {
++                      dev_err(&flash->spi->dev,
++                              "Macronix quad not enable");
++                      return -EINVAL;
++              }
++              return status;
++      default:
++              status = spansion_quad_enable(flash);
++              if (status) {
++                      dev_err(&flash->spi->dev,
++                              "Spansion quad not enable");
++                      return -EINVAL;
++              }
++              return status;
++      }
++}
++
++/*
+  * Erase the whole flash memory
+  *
+  * Returns 0 if successful, non-zero otherwise.
+@@ -355,6 +471,13 @@ static int m25p80_erase(struct mtd_info
+       return 0;
+ }
++static inline int m25p80_dummy_cycles_read(struct m25p *flash)
++{
++      if (flash->quad_read || flash->fast_read)
++              return 1;
++      return 0;
++}
++
+ /*
+  * Read an address range from the flash chip.  The address range
+  * may be any size provided it is within the physical boundaries.
+@@ -373,14 +496,14 @@ static int m25p80_read(struct mtd_info *
+       spi_message_init(&m);
+       memset(t, 0, (sizeof t));
+-      /* NOTE:
+-       * OPCODE_FAST_READ (if available) is faster.
+-       * Should add 1 byte DUMMY_BYTE.
+-       */
++      t[0].memory_map = 1;
+       t[0].tx_buf = flash->command;
+-      t[0].len = m25p_cmdsz(flash) + (flash->fast_read ? 1 : 0);
++      t[0].len = flash->mmap ? from : m25p_cmdsz(flash) +
++                      m25p80_dummy_cycles_read(flash);
+       spi_message_add_tail(&t[0], &m);
++      t[1].memory_map = 1;
++      t[1].rx_nbits = flash->quad_read ? SPI_NBITS_QUAD : 1;
+       t[1].rx_buf = buf;
+       t[1].len = len;
+       spi_message_add_tail(&t[1], &m);
+@@ -394,11 +517,6 @@ static int m25p80_read(struct mtd_info *
+               return 1;
+       }
+-      /* FIXME switch to OPCODE_FAST_READ.  It's required for higher
+-       * clocks; and at this writing, every chip this driver handles
+-       * supports that opcode.
+-       */
+-
+       /* Set up the write data buffer. */
+       opcode = flash->read_opcode;
+       flash->command[0] = opcode;
+@@ -406,8 +524,8 @@ static int m25p80_read(struct mtd_info *
+       spi_sync(flash->spi, &m);
+-      *retlen = m.actual_length - m25p_cmdsz(flash) -
+-                      (flash->fast_read ? 1 : 0);
++      *retlen = flash->mmap ? len : m.actual_length - m25p_cmdsz(flash) -
++                      m25p80_dummy_cycles_read(flash);
+       mutex_unlock(&flash->lock);
+@@ -713,6 +831,7 @@ struct flash_info {
+ #define       SST_WRITE       0x04            /* use SST byte programming */
+ #define       M25P_NO_FR      0x08            /* Can't do fastread */
+ #define       SECT_4K_PMC     0x10            /* OPCODE_BE_4K_PMC works uniformly */
++#define M25P80_QUAD_READ      0x20    /* Flash supports Quad Read */
+ };
+ #define INFO(_jedec_id, _ext_id, _sector_size, _n_sectors, _flags)    \
+@@ -789,7 +908,7 @@ static const struct spi_device_id m25p_i
+       { "mx25l12855e", INFO(0xc22618, 0, 64 * 1024, 256, 0) },
+       { "mx25l25635e", INFO(0xc22019, 0, 64 * 1024, 512, 0) },
+       { "mx25l25655e", INFO(0xc22619, 0, 64 * 1024, 512, 0) },
+-      { "mx66l51235l", INFO(0xc2201a, 0, 64 * 1024, 1024, 0) },
++      { "mx66l51235l", INFO(0xc2201a, 0, 64 * 1024, 1024, M25P80_QUAD_READ) },
+       /* Micron */
+       { "n25q064",  INFO(0x20ba17, 0, 64 * 1024, 128, 0) },
+@@ -808,7 +927,7 @@ static const struct spi_device_id m25p_i
+       { "s25sl032p",  INFO(0x010215, 0x4d00,  64 * 1024,  64, 0) },
+       { "s25sl064p",  INFO(0x010216, 0x4d00,  64 * 1024, 128, 0) },
+       { "s25fl256s0", INFO(0x010219, 0x4d00, 256 * 1024, 128, 0) },
+-      { "s25fl256s1", INFO(0x010219, 0x4d01,  64 * 1024, 512, 0) },
++      { "s25fl256s1", INFO(0x010219, 0x4d01,  64 * 1024, 512, M25P80_QUAD_READ) },
+       { "s25fl512s",  INFO(0x010220, 0x4d00, 256 * 1024, 256, 0) },
+       { "s70fl01gs",  INFO(0x010221, 0x4d00, 256 * 1024, 256, 0) },
+       { "s25sl12800", INFO(0x012018, 0x0300, 256 * 1024,  64, 0) },
+@@ -821,7 +940,7 @@ static const struct spi_device_id m25p_i
+       { "s25sl032a",  INFO(0x010215,      0,  64 * 1024,  64, 0) },
+       { "s25sl064a",  INFO(0x010216,      0,  64 * 1024, 128, 0) },
+       { "s25fl016k",  INFO(0xef4015,      0,  64 * 1024,  32, SECT_4K) },
+-      { "s25fl064k",  INFO(0xef4017,      0,  64 * 1024, 128, SECT_4K) },
++      { "s25fl064k",  INFO(0xef4017, 0x4d01,  64 * 1024, 128, SECT_4K) },
+       /* SST -- large erase sizes are "overlays", "sectors" are 4K */
+       { "sst25vf040b", INFO(0xbf258d, 0, 64 * 1024,  8, SECT_4K | SST_WRITE) },
+@@ -949,12 +1068,8 @@ static int m25p_probe(struct spi_device
+       struct flash_info               *info;
+       unsigned                        i;
+       struct mtd_part_parser_data     ppdata;
+-      struct device_node __maybe_unused *np = spi->dev.of_node;
+-
+-#ifdef CONFIG_MTD_OF_PARTS
+-      if (!of_device_is_available(np))
+-              return -ENODEV;
+-#endif
++      struct device_node *np = spi->dev.of_node;
++      int ret;
+       /* Platform data helps sort out which chip type we have, as
+        * well as how this board partitions it.  If we don't have
+@@ -1001,15 +1116,14 @@ static int m25p_probe(struct spi_device
+               }
+       }
+-      flash = kzalloc(sizeof *flash, GFP_KERNEL);
++      flash = devm_kzalloc(&spi->dev, sizeof(*flash), GFP_KERNEL);
+       if (!flash)
+               return -ENOMEM;
+-      flash->command = kmalloc(MAX_CMD_SIZE + (flash->fast_read ? 1 : 0),
+-                                      GFP_KERNEL);
+-      if (!flash->command) {
+-              kfree(flash);
++
++
++      flash->command = devm_kzalloc(&spi->dev, MAX_CMD_SIZE, GFP_KERNEL);
++      if (!flash->command)
+               return -ENOMEM;
+-      }
+       flash->spi = spi;
+       mutex_init(&flash->lock);
+@@ -1039,6 +1153,15 @@ static int m25p_probe(struct spi_device
+       flash->mtd._erase = m25p80_erase;
+       flash->mtd._read = m25p80_read;
++      if (spi->mode & SPI_RX_QUAD && info->flags & M25P80_QUAD_READ) {
++              ret = set_quad_mode(flash, info->jedec_id, 1);
++              if (ret) {
++                      dev_err(&flash->spi->dev, "quad mode not supported\n");
++                      return ret;
++              }
++              flash->quad_read = true;
++      }
++
+       /* flash protection support for STmicro chips */
+       if (JEDEC_MFR(info->jedec_id) == CFI_MFR_ST) {
+               flash->mtd._lock = m25p80_lock;
+@@ -1071,18 +1194,21 @@ static int m25p_probe(struct spi_device
+       flash->page_size = info->page_size;
+       flash->mtd.writebufsize = flash->page_size;
+-      flash->fast_read = false;
+-      if (np && of_property_read_bool(np, "m25p,fast-read"))
++      if (np)
++              /* If we were instantiated by DT, use it */
++              flash->fast_read = of_property_read_bool(np, "m25p,fast-read");
++      else
++              /* If we weren't instantiated by DT, default to fast-read */
+               flash->fast_read = true;
+-#ifdef CONFIG_M25PXX_USE_FAST_READ
+-      flash->fast_read = true;
+-#endif
++      /* Some devices cannot do fast-read, no matter what DT tells us */
+       if (info->flags & M25P_NO_FR)
+               flash->fast_read = false;
+       /* Default commands */
+-      if (flash->fast_read)
++      if (flash->quad_read)
++              flash->read_opcode = OPCODE_QUAD_READ;
++      else if (flash->fast_read)
+               flash->read_opcode = OPCODE_FAST_READ;
+       else
+               flash->read_opcode = OPCODE_NORM_READ;
+@@ -1094,21 +1220,14 @@ static int m25p_probe(struct spi_device
+       else if (flash->mtd.size > 0x1000000) {
+               /* enable 4-byte addressing if the device exceeds 16MiB */
+               flash->addr_width = 4;
+-              if (JEDEC_MFR(info->jedec_id) == CFI_MFR_AMD) {
+-                      /* Dedicated 4-byte command set */
+-                      flash->read_opcode = flash->fast_read ?
+-                              OPCODE_FAST_READ_4B :
+-                              OPCODE_NORM_READ_4B;
+-                      flash->program_opcode = OPCODE_PP_4B;
+-                      /* No small sector erase for 4-byte command set */
+-                      flash->erase_opcode = OPCODE_SE_4B;
+-                      flash->mtd.erasesize = info->sector_size;
+-              } else
+-                      set_4byte(flash, info->jedec_id, 1);
++              set_4byte(flash, info->jedec_id, 1);
+       } else {
+               flash->addr_width = 3;
+       }
++      if (spi->mode & SPI_RX_MMAP)
++              flash->mmap = true;
++
+       dev_info(&spi->dev, "%s (%lld Kbytes)\n", id->name,
+                       (long long)flash->mtd.size >> 10);
+@@ -1142,14 +1261,10 @@ static int m25p_probe(struct spi_device
+ static int m25p_remove(struct spi_device *spi)
+ {
+       struct m25p     *flash = spi_get_drvdata(spi);
+-      int             status;
+       /* Clean up MTD stuff. */
+-      status = mtd_device_unregister(&flash->mtd);
+-      if (status == 0) {
+-              kfree(flash->command);
+-              kfree(flash);
+-      }
++      mtd_device_unregister(&flash->mtd);
++
+       return 0;
+ }
+--- a/drivers/mtd/nand/Kconfig
++++ b/drivers/mtd/nand/Kconfig
+@@ -96,35 +96,13 @@ config MTD_NAND_OMAP2
+ config MTD_NAND_OMAP_BCH
+       depends on MTD_NAND && MTD_NAND_OMAP2 && ARCH_OMAP3
+-      tristate "Enable support for hardware BCH error correction"
++      tristate "Support hardware based BCH error correction"
+       default n
+       select BCH
+-      select BCH_CONST_PARAMS
+       help
+-       Support for hardware BCH error correction.
+-
+-choice
+-      prompt "BCH error correction capability"
+-      depends on MTD_NAND_OMAP_BCH
+-
+-config MTD_NAND_OMAP_BCH8
+-      bool "8 bits / 512 bytes (recommended)"
+-      help
+-       Support correcting up to 8 bitflips per 512-byte block.
+-       This will use 13 bytes of spare area per 512 bytes of page data.
+-       This is the recommended mode, as 4-bit mode does not work
+-       on some OMAP3 revisions, due to a hardware bug.
+-
+-config MTD_NAND_OMAP_BCH4
+-      bool "4 bits / 512 bytes"
+-      help
+-       Support correcting up to 4 bitflips per 512-byte block.
+-       This will use 7 bytes of spare area per 512 bytes of page data.
+-       Note that this mode does not work on some OMAP3 revisions, due to a
+-       hardware bug. Please check your OMAP datasheet before selecting this
+-       mode.
+-
+-endchoice
++        Some devices have built-in ELM hardware engine, which can be used to
++        locate and correct errors when using BCH ECC scheme. This enables the
++        driver support for same.
+ if MTD_NAND_OMAP_BCH
+ config BCH_CONST_M
+--- a/drivers/mtd/nand/omap2.c
++++ b/drivers/mtd/nand/omap2.c
+@@ -25,8 +25,11 @@
+ #include <linux/of.h>
+ #include <linux/of_device.h>
+-#ifdef CONFIG_MTD_NAND_OMAP_BCH
++#ifdef CONFIG_MTD_NAND_ECC_BCH
+ #include <linux/bch.h>
++#include <linux/mtd/nand_bch.h>
++#endif
++#ifdef CONFIG_MTD_NAND_OMAP_BCH
+ #include <linux/platform_data/elm.h>
+ #endif
+@@ -35,6 +38,10 @@
+ #define       DRIVER_NAME     "omap2-nand"
+ #define       OMAP_NAND_TIMEOUT_MS    5000
++#define GPMC_ECC_READ         0 /* Reset Hardware ECC for read */
++#define GPMC_ECC_WRITE                1 /* Reset Hardware ECC for write */
++#define GPMC_ECC_READSYN      2 /* Reset before syndrom is read back */
++
+ #define NAND_Ecc_P1e          (1 << 0)
+ #define NAND_Ecc_P2e          (1 << 1)
+ #define NAND_Ecc_P4e          (1 << 2)
+@@ -103,13 +110,9 @@
+ #define P4o_s(a)      (TF(a & NAND_Ecc_P4o)           << 1)
+ #define       PREFETCH_CONFIG1_CS_SHIFT       24
+-#define       ECC_CONFIG_CS_SHIFT             1
+ #define       CS_MASK                         0x7
+ #define       ENABLE_PREFETCH                 (0x1 << 7)
+ #define       DMA_MPU_MODE_SHIFT              2
+-#define       ECCSIZE0_SHIFT                  12
+-#define       ECCSIZE1_SHIFT                  22
+-#define       ECC1RESULTSIZE                  0x1
+ #define       ECCCLEAR                        0x100
+ #define       ECC1                            0x1
+ #define       PREFETCH_FIFOTHRESHOLD_MAX      0x40
+@@ -120,33 +123,24 @@
+ #define OMAP24XX_DMA_GPMC             4
+-#define BCH8_MAX_ERROR                8       /* upto 8 bit correctable */
+-#define BCH4_MAX_ERROR                4       /* upto 4 bit correctable */
+-
+ #define SECTOR_BYTES          512
+ /* 4 bit padding to make byte aligned, 56 = 52 + 4 */
+ #define BCH4_BIT_PAD          4
+-#define BCH8_ECC_MAX          ((SECTOR_BYTES + BCH8_ECC_OOB_BYTES) * 8)
+-#define BCH4_ECC_MAX          ((SECTOR_BYTES + BCH4_ECC_OOB_BYTES) * 8)
+-/* GPMC ecc engine settings for read */
+-#define BCH_WRAPMODE_1                1       /* BCH wrap mode 1 */
+-#define BCH8R_ECC_SIZE0               0x1a    /* ecc_size0 = 26 */
+-#define BCH8R_ECC_SIZE1               0x2     /* ecc_size1 = 2 */
+-#define BCH4R_ECC_SIZE0               0xd     /* ecc_size0 = 13 */
+-#define BCH4R_ECC_SIZE1               0x3     /* ecc_size1 = 3 */
+-
+-/* GPMC ecc engine settings for write */
+-#define BCH_WRAPMODE_6                6       /* BCH wrap mode 6 */
+-#define BCH_ECC_SIZE0         0x0     /* ecc_size0 = 0, no oob protection */
+-#define BCH_ECC_SIZE1         0x20    /* ecc_size1 = 32 */
++#define BADBLOCK_MARKER_LENGTH                0x2
+ #ifdef CONFIG_MTD_NAND_OMAP_BCH
+-static u_char bch8_vector[] = {0xf3, 0xdb, 0x14, 0x16, 0x8b, 0xd2, 0xbe, 0xcc,
+-      0xac, 0x6b, 0xff, 0x99, 0x7b};
+-static u_char bch4_vector[] = {0x00, 0x6b, 0x31, 0xdd, 0x41, 0xbc, 0x10};
++static u_char bch4_vector[]  = {0x00, 0x6b, 0x31, 0xdd, 0x41, 0xbc, 0x10};
++static u_char bch8_vector[]  = {0xf3, 0xdb, 0x14, 0x16, 0x8b, 0xd2, 0xbe, 0xcc,
++                              0xac, 0x6b, 0xff, 0x99, 0x7b};
++static u_char bch16_vector[] = {0xf5, 0x24, 0x1c, 0xd0, 0x61, 0xb3, 0xf1, 0x55,
++                              0x2e, 0x2c, 0x86, 0xa3, 0xed, 0x36, 0x1b, 0x78,
++                              0x48, 0x76, 0xa9, 0x3b, 0x97, 0xd1, 0x7a, 0x93,
++                              0x07, 0x0e};
+ #endif
+-
++static u8  bch4_polynomial[] = {0x28, 0x13, 0xcc, 0x39, 0x96, 0xac, 0x7f};
++static u8  bch8_polynomial[] = {0xef, 0x51, 0x2e, 0x09, 0xed, 0x93, 0x9a, 0xc2,
++                              0x97, 0x79, 0xe5, 0x24, 0xb5};
+ /* oob info generated runtime depending on ecc algorithm and layout selected */
+ static struct nand_ecclayout omap_oobinfo;
+ /* Define some generic bad / good block scan pattern which are used
+@@ -171,6 +165,7 @@ struct omap_nand_info {
+       int                             gpmc_cs;
+       unsigned long                   phys_base;
+       unsigned long                   mem_size;
++      enum omap_ecc                   ecc_opt;
+       struct completion               comp;
+       struct dma_chan                 *dma;
+       int                             gpmc_irq_fifo;
+@@ -180,16 +175,11 @@ struct omap_nand_info {
+               OMAP_NAND_IO_WRITE,     /* write */
+       } iomode;
+       u_char                          *buf;
+-      int                                     buf_len;
++      int                             buf_len;
+       struct gpmc_nand_regs           reg;
+-
+-#ifdef CONFIG_MTD_NAND_OMAP_BCH
+-      struct bch_control             *bch;
+-      struct nand_ecclayout           ecclayout;
+-      bool                            is_elm_used;
++      /* fields specific for BCHx_HW ECC scheme */
+       struct device                   *elm_dev;
+       struct device_node              *of_node;
+-#endif
+ };
+ /**
+@@ -948,9 +938,11 @@ static int omap_calculate_ecc(struct mtd
+       u32 val;
+       val = readl(info->reg.gpmc_ecc_config);
+-      if (((val >> ECC_CONFIG_CS_SHIFT)  & ~CS_MASK) != info->gpmc_cs)
++      if (((val >> 1) & 0x7) != info->gpmc_cs) {
++              pr_err("%s: invalid ECC configuration for chip-select=%d",
++                              DRIVER_NAME, info->gpmc_cs);
+               return -EINVAL;
+-
++      }
+       /* read ecc result */
+       val = readl(info->reg.gpmc_ecc1_result);
+       *ecc_code++ = val;          /* P128e, ..., P1e */
+@@ -962,47 +954,6 @@ static int omap_calculate_ecc(struct mtd
+ }
+ /**
+- * omap_enable_hwecc - This function enables the hardware ecc functionality
+- * @mtd: MTD device structure
+- * @mode: Read/Write mode
+- */
+-static void omap_enable_hwecc(struct mtd_info *mtd, int mode)
+-{
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                      mtd);
+-      struct nand_chip *chip = mtd->priv;
+-      unsigned int dev_width = (chip->options & NAND_BUSWIDTH_16) ? 1 : 0;
+-      u32 val;
+-
+-      /* clear ecc and enable bits */
+-      val = ECCCLEAR | ECC1;
+-      writel(val, info->reg.gpmc_ecc_control);
+-
+-      /* program ecc and result sizes */
+-      val = ((((info->nand.ecc.size >> 1) - 1) << ECCSIZE1_SHIFT) |
+-                       ECC1RESULTSIZE);
+-      writel(val, info->reg.gpmc_ecc_size_config);
+-
+-      switch (mode) {
+-      case NAND_ECC_READ:
+-      case NAND_ECC_WRITE:
+-              writel(ECCCLEAR | ECC1, info->reg.gpmc_ecc_control);
+-              break;
+-      case NAND_ECC_READSYN:
+-              writel(ECCCLEAR, info->reg.gpmc_ecc_control);
+-              break;
+-      default:
+-              dev_info(&info->pdev->dev,
+-                      "error: unrecognized Mode[%d]!\n", mode);
+-              break;
+-      }
+-
+-      /* (ECC 16 or 8 bit col) | ( CS  )  | ECC Enable */
+-      val = (dev_width << 7) | (info->gpmc_cs << 1) | (0x1);
+-      writel(val, info->reg.gpmc_ecc_config);
+-}
+-
+-/**
+  * omap_wait - wait until the command is done
+  * @mtd: MTD device structure
+  * @chip: NAND Chip structure
+@@ -1058,496 +1009,357 @@ static int omap_dev_ready(struct mtd_inf
+       }
+ }
+-#ifdef CONFIG_MTD_NAND_OMAP_BCH
+-
+ /**
+- * omap3_enable_hwecc_bch - Program OMAP3 GPMC to perform BCH ECC correction
++ * omap_enable_hwecc - Configure OMAP GPMC to perform ECC calculation
+  * @mtd: MTD device structure
+  * @mode: Read/Write mode
+- *
+- * When using BCH, sector size is hardcoded to 512 bytes.
+- * Using wrapping mode 6 both for reading and writing if ELM module not uses
+- * for error correction.
+- * On writing,
+- * eccsize0 = 0  (no additional protected byte in spare area)
+- * eccsize1 = 32 (skip 32 nibbles = 16 bytes per sector in spare area)
++ * Configurations for eccsize0, eccsize1, and bch_wrapmode are based on
++ * GPMC function spec:
++ * Section 4.6.3.2.3: Supported NAND page mappings and ECC schemes
+  */
+-static void omap3_enable_hwecc_bch(struct mtd_info *mtd, int mode)
++static void omap_enable_hwecc(struct mtd_info *mtd, int mode)
+ {
+-      int nerrors;
+-      unsigned int dev_width, nsectors;
+       struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+                                                  mtd);
+       struct nand_chip *chip = mtd->priv;
+-      u32 val, wr_mode;
+-      unsigned int ecc_size1, ecc_size0;
+-
+-      /* Using wrapping mode 6 for writing */
+-      wr_mode = BCH_WRAPMODE_6;
+-
+-      /*
+-       * ECC engine enabled for valid ecc_size0 nibbles
+-       * and disabled for ecc_size1 nibbles.
+-       */
+-      ecc_size0 = BCH_ECC_SIZE0;
+-      ecc_size1 = BCH_ECC_SIZE1;
+-
+-      /* Perform ecc calculation on 512-byte sector */
+-      nsectors = 1;
+-
+-      /* Update number of error correction */
+-      nerrors = info->nand.ecc.strength;
+-
+-      /* Multi sector reading/writing for NAND flash with page size < 4096 */
+-      if (info->is_elm_used && (mtd->writesize <= 4096)) {
+-              if (mode == NAND_ECC_READ) {
+-                      /* Using wrapping mode 1 for reading */
+-                      wr_mode = BCH_WRAPMODE_1;
+-
+-                      /*
+-                       * ECC engine enabled for ecc_size0 nibbles
+-                       * and disabled for ecc_size1 nibbles.
+-                       */
+-                      ecc_size0 = (nerrors == 8) ?
+-                              BCH8R_ECC_SIZE0 : BCH4R_ECC_SIZE0;
+-                      ecc_size1 = (nerrors == 8) ?
+-                              BCH8R_ECC_SIZE1 : BCH4R_ECC_SIZE1;
++      unsigned int dev_width = (chip->options & NAND_BUSWIDTH_16) ? 1 : 0;
++      unsigned int nsectors = (mtd->writesize / SECTOR_BYTES);
++      unsigned int ecc_algo = 0;
++      unsigned int bch_type = 0;
++      unsigned int eccsize1 = 0x00, eccsize0 = 0x00, bch_wrapmode = 0x00;
++      u32 ecc_size_config_val = 0;
++      u32 ecc_config_val = 0;
++
++      switch (info->ecc_opt) {
++      case OMAP_ECC_HAMMING_CODE_HW:
++              ecc_algo = 0x0;
++              bch_wrapmode = 0x00;
++              eccsize0 = (chip->ecc.size >> 1) - 1;
++              eccsize1 = 0;
++              nsectors = 0;
++              break;
++      case OMAP_ECC_BCH4_CODE_HW_DETECTION_SW:
++      case OMAP_ECC_BCH4_CODE_HW:
++              ecc_algo = 0x1;
++              bch_type = 0x0;
++              if (mode == GPMC_ECC_READ) {
++                      bch_wrapmode = 0x01;
++                      eccsize0 = 13; /* ECC bits in nibbles per sector */
++                      eccsize1 = 3;  /* non-ECC bits in nibbles per sector */
++              } else if (mode == GPMC_ECC_WRITE) {
++                      eccsize0 = 0;  /* extra bits in nibbles per sector */
++                      eccsize1 = 32; /* OOB bits in nibbles per sector */
++                      bch_wrapmode = 0x06;
+               }
+-
+-              /* Perform ecc calculation for one page (< 4096) */
+-              nsectors = info->nand.ecc.steps;
++              break;
++      case OMAP_ECC_BCH8_CODE_HW_DETECTION_SW:
++      case OMAP_ECC_BCH8_CODE_HW:
++              ecc_algo = 0x1;
++              bch_type = 0x1;
++              if (mode == GPMC_ECC_READ) {
++                      bch_wrapmode = 0x01;
++                      eccsize0 = 26; /* ECC bits in nibbles per sector */
++                      eccsize1 = 2;  /* non-ECC bits in nibbles per sector */
++              } else if (mode == GPMC_ECC_WRITE) {
++                      bch_wrapmode = 0x01;
++                      eccsize0 = 0;  /* extra bits in nibbles per sector */
++                      eccsize1 = 28; /* OOB bits in nibbles per sector */
++              }
++              break;
++      case OMAP_ECC_BCH16_CODE_HW:
++              ecc_algo = 0x1;
++              bch_type = 0x2;
++              if (mode == GPMC_ECC_READ) {
++                      bch_wrapmode = 0x01;
++                      eccsize0 = 52; /* ECC bits in nibbles per sector */
++                      eccsize1 = 0;  /* non-ECC bits in nibbles per sector */
++              } else if (mode == GPMC_ECC_WRITE) {
++                      bch_wrapmode = 0x01;
++                      eccsize0 = 0;  /* extra bits in nibbles per sector */
++                      eccsize1 = 52; /* OOB bits in nibbles per sector */
++              }
++              break;
++      default:
++              pr_err("selected ECC scheme not supported or not enabled\n");
+       }
+-
+-      writel(ECC1, info->reg.gpmc_ecc_control);
+-
+-      /* Configure ecc size for BCH */
+-      val = (ecc_size1 << ECCSIZE1_SHIFT) | (ecc_size0 << ECCSIZE0_SHIFT);
+-      writel(val, info->reg.gpmc_ecc_size_config);
+-
+-      dev_width = (chip->options & NAND_BUSWIDTH_16) ? 1 : 0;
+-
+-      /* BCH configuration */
+-      val = ((1                        << 16) | /* enable BCH */
+-             (((nerrors == 8) ? 1 : 0) << 12) | /* 8 or 4 bits */
+-             (wr_mode                  <<  8) | /* wrap mode */
+-             (dev_width                <<  7) | /* bus width */
+-             (((nsectors-1) & 0x7)     <<  4) | /* number of sectors */
+-             (info->gpmc_cs            <<  1) | /* ECC CS */
+-             (0x1));                            /* enable ECC */
+-
+-      writel(val, info->reg.gpmc_ecc_config);
+-
+       /* Clear ecc and enable bits */
+       writel(ECCCLEAR | ECC1, info->reg.gpmc_ecc_control);
++      /* Configure ecc size for BCH */
++      ecc_size_config_val = (eccsize1 << 22) | (eccsize0 << 12);
++      writel(ecc_size_config_val, info->reg.gpmc_ecc_size_config);
++      /* Configure device details for BCH engine */
++      ecc_config_val = ((ecc_algo << 16)      | /* HAM1 | BCHx */
++                      (bch_type << 12)        | /* BCH4/BCH8/BCH16 */
++                      (bch_wrapmode << 8)     | /* wrap mode */
++                      (dev_width << 7)        | /* bus width */
++                      (((nsectors-1) & 0x7) << 4) | /* number of sectors */
++                      (info->gpmc_cs <<  1)   | /* ECC CS */
++                      (0x0));                 /* disable ECC */
++      writel(ecc_config_val, info->reg.gpmc_ecc_config);
++      /* enable ECC engine */
++      writel(ecc_config_val | 0x1, info->reg.gpmc_ecc_config);
++      /* Clear ECC and enable bits */
++      writel(ECCCLEAR | ECC1, info->reg.gpmc_ecc_control);
+ }
++#if defined(CONFIG_MTD_NAND_ECC_BCH) || defined(CONFIG_MTD_NAND_OMAP_BCH)
+ /**
+- * omap3_calculate_ecc_bch4 - Generate 7 bytes of ECC bytes
+- * @mtd: MTD device structure
+- * @dat: The pointer to data on which ecc is computed
+- * @ecc_code: The ecc_code buffer
+- */
+-static int omap3_calculate_ecc_bch4(struct mtd_info *mtd, const u_char *dat,
+-                                  u_char *ecc_code)
+-{
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-      unsigned long nsectors, val1, val2;
+-      int i;
+-
+-      nsectors = ((readl(info->reg.gpmc_ecc_config) >> 4) & 0x7) + 1;
+-
+-      for (i = 0; i < nsectors; i++) {
+-
+-              /* Read hw-computed remainder */
+-              val1 = readl(info->reg.gpmc_bch_result0[i]);
+-              val2 = readl(info->reg.gpmc_bch_result1[i]);
+-
+-              /*
+-               * Add constant polynomial to remainder, in order to get an ecc
+-               * sequence of 0xFFs for a buffer filled with 0xFFs; and
+-               * left-justify the resulting polynomial.
+-               */
+-              *ecc_code++ = 0x28 ^ ((val2 >> 12) & 0xFF);
+-              *ecc_code++ = 0x13 ^ ((val2 >>  4) & 0xFF);
+-              *ecc_code++ = 0xcc ^ (((val2 & 0xF) << 4)|((val1 >> 28) & 0xF));
+-              *ecc_code++ = 0x39 ^ ((val1 >> 20) & 0xFF);
+-              *ecc_code++ = 0x96 ^ ((val1 >> 12) & 0xFF);
+-              *ecc_code++ = 0xac ^ ((val1 >> 4) & 0xFF);
+-              *ecc_code++ = 0x7f ^ ((val1 & 0xF) << 4);
+-      }
+-
+-      return 0;
+-}
+-
+-/**
+- * omap3_calculate_ecc_bch8 - Generate 13 bytes of ECC bytes
+- * @mtd: MTD device structure
+- * @dat: The pointer to data on which ecc is computed
+- * @ecc_code: The ecc_code buffer
+- */
+-static int omap3_calculate_ecc_bch8(struct mtd_info *mtd, const u_char *dat,
+-                                  u_char *ecc_code)
+-{
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-      unsigned long nsectors, val1, val2, val3, val4;
+-      int i;
+-
+-      nsectors = ((readl(info->reg.gpmc_ecc_config) >> 4) & 0x7) + 1;
+-
+-      for (i = 0; i < nsectors; i++) {
+-
+-              /* Read hw-computed remainder */
+-              val1 = readl(info->reg.gpmc_bch_result0[i]);
+-              val2 = readl(info->reg.gpmc_bch_result1[i]);
+-              val3 = readl(info->reg.gpmc_bch_result2[i]);
+-              val4 = readl(info->reg.gpmc_bch_result3[i]);
+-
+-              /*
+-               * Add constant polynomial to remainder, in order to get an ecc
+-               * sequence of 0xFFs for a buffer filled with 0xFFs.
+-               */
+-              *ecc_code++ = 0xef ^ (val4 & 0xFF);
+-              *ecc_code++ = 0x51 ^ ((val3 >> 24) & 0xFF);
+-              *ecc_code++ = 0x2e ^ ((val3 >> 16) & 0xFF);
+-              *ecc_code++ = 0x09 ^ ((val3 >> 8) & 0xFF);
+-              *ecc_code++ = 0xed ^ (val3 & 0xFF);
+-              *ecc_code++ = 0x93 ^ ((val2 >> 24) & 0xFF);
+-              *ecc_code++ = 0x9a ^ ((val2 >> 16) & 0xFF);
+-              *ecc_code++ = 0xc2 ^ ((val2 >> 8) & 0xFF);
+-              *ecc_code++ = 0x97 ^ (val2 & 0xFF);
+-              *ecc_code++ = 0x79 ^ ((val1 >> 24) & 0xFF);
+-              *ecc_code++ = 0xe5 ^ ((val1 >> 16) & 0xFF);
+-              *ecc_code++ = 0x24 ^ ((val1 >> 8) & 0xFF);
+-              *ecc_code++ = 0xb5 ^ (val1 & 0xFF);
+-      }
+-
+-      return 0;
+-}
+-
+-/**
+- * omap3_calculate_ecc_bch - Generate bytes of ECC bytes
++ * omap_calculate_ecc_bch - Generate bytes of ECC bytes
+  * @mtd:      MTD device structure
+  * @dat:      The pointer to data on which ecc is computed
+  * @ecc_code: The ecc_code buffer
+  *
+  * Support calculating of BCH4/8 ecc vectors for the page
+  */
+-static int omap3_calculate_ecc_bch(struct mtd_info *mtd, const u_char *dat,
+-                                  u_char *ecc_code)
++static int omap_calculate_ecc_bch(struct mtd_info *mtd, const u_char *dat,
++                                  u_char *ecc_calc)
+ {
+       struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+                                                  mtd);
+-      unsigned long nsectors, bch_val1, bch_val2, bch_val3, bch_val4;
+-      int i, eccbchtsel;
++      struct nand_chip *chip = mtd->priv;
++      enum omap_ecc ecc_opt = info->ecc_opt;
++      struct gpmc_nand_regs   *gpmc_regs = &info->reg;
++      u32 eccbytes = chip->ecc.bytes;
++      u_char *ecc_ptr;
++      u32 nsectors;
++      int i, val;
+-      nsectors = ((readl(info->reg.gpmc_ecc_config) >> 4) & 0x7) + 1;
+-      /*
+-       * find BCH scheme used
+-       * 0 -> BCH4
+-       * 1 -> BCH8
+-       */
+-      eccbchtsel = ((readl(info->reg.gpmc_ecc_config) >> 12) & 0x3);
++      val = readl(info->reg.gpmc_ecc_config);
++      if (((val >> 1) & 0x07) != info->gpmc_cs) {
++              pr_err("%s: invalid ECC configuration for chip-select=%d",
++                              DRIVER_NAME, info->gpmc_cs);
++              return -EINVAL;
++      }
++      nsectors = ((readl(gpmc_regs->gpmc_ecc_config) >> 4) & 0x7) + 1;
+       for (i = 0; i < nsectors; i++) {
+-
+-              /* Read hw-computed remainder */
+-              bch_val1 = readl(info->reg.gpmc_bch_result0[i]);
+-              bch_val2 = readl(info->reg.gpmc_bch_result1[i]);
+-              if (eccbchtsel) {
+-                      bch_val3 = readl(info->reg.gpmc_bch_result2[i]);
+-                      bch_val4 = readl(info->reg.gpmc_bch_result3[i]);
+-              }
+-
+-              if (eccbchtsel) {
+-                      /* BCH8 ecc scheme */
+-                      *ecc_code++ = (bch_val4 & 0xFF);
+-                      *ecc_code++ = ((bch_val3 >> 24) & 0xFF);
+-                      *ecc_code++ = ((bch_val3 >> 16) & 0xFF);
+-                      *ecc_code++ = ((bch_val3 >> 8) & 0xFF);
+-                      *ecc_code++ = (bch_val3 & 0xFF);
+-                      *ecc_code++ = ((bch_val2 >> 24) & 0xFF);
+-                      *ecc_code++ = ((bch_val2 >> 16) & 0xFF);
+-                      *ecc_code++ = ((bch_val2 >> 8) & 0xFF);
+-                      *ecc_code++ = (bch_val2 & 0xFF);
+-                      *ecc_code++ = ((bch_val1 >> 24) & 0xFF);
+-                      *ecc_code++ = ((bch_val1 >> 16) & 0xFF);
+-                      *ecc_code++ = ((bch_val1 >> 8) & 0xFF);
+-                      *ecc_code++ = (bch_val1 & 0xFF);
+-                      /*
+-                       * Setting 14th byte to zero to handle
+-                       * erased page & maintain compatibility
+-                       * with RBL
+-                       */
+-                      *ecc_code++ = 0x0;
+-              } else {
+-                      /* BCH4 ecc scheme */
+-                      *ecc_code++ = ((bch_val2 >> 12) & 0xFF);
+-                      *ecc_code++ = ((bch_val2 >> 4) & 0xFF);
+-                      *ecc_code++ = ((bch_val2 & 0xF) << 4) |
+-                              ((bch_val1 >> 28) & 0xF);
+-                      *ecc_code++ = ((bch_val1 >> 20) & 0xFF);
+-                      *ecc_code++ = ((bch_val1 >> 12) & 0xFF);
+-                      *ecc_code++ = ((bch_val1 >> 4) & 0xFF);
+-                      *ecc_code++ = ((bch_val1 & 0xF) << 4);
+-                      /*
+-                       * Setting 8th byte to zero to handle
+-                       * erased page
+-                       */
+-                      *ecc_code++ = 0x0;
++              ecc_ptr = ecc_calc;
++              switch (ecc_opt) {
++              case OMAP_ECC_HAMMING_CODE_HW:
++                      return -EINVAL;
++              case OMAP_ECC_BCH4_CODE_HW_DETECTION_SW:
++              case OMAP_ECC_BCH4_CODE_HW:
++                      val = readl(gpmc_regs->gpmc_bch_result1[i]);
++                      *(ecc_ptr++) = ((val >> 12) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  4) & 0xFF);
++                      *(ecc_ptr)   = ((val >>  0) << 4) & 0xF0;
++                      val = readl(gpmc_regs->gpmc_bch_result0[i]);
++                      *(ecc_ptr)   = ((val >> 28) & 0x0F) | *(ecc_ptr);
++                      ecc_ptr++;
++                      *(ecc_ptr++) = ((val >> 20) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 12) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  4) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) << 4) & 0xF0;
++                      break;
++              case OMAP_ECC_BCH8_CODE_HW_DETECTION_SW:
++              case OMAP_ECC_BCH8_CODE_HW:
++                      val = readl(gpmc_regs->gpmc_bch_result3[i]);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result2[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result1[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result0[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      break;
++              case OMAP_ECC_BCH16_CODE_HW:
++                      val = readl(gpmc_regs->gpmc_bch_result6[i]);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result5[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result4[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result3[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result2[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result1[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      val = readl(gpmc_regs->gpmc_bch_result0[i]);
++                      *(ecc_ptr++) = ((val >> 24) & 0xFF);
++                      *(ecc_ptr++) = ((val >> 16) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  8) & 0xFF);
++                      *(ecc_ptr++) = ((val >>  0) & 0xFF);
++                      break;
++              default:
++                      return -EINVAL;
+               }
++              /* ECC scheme specific syndrome customizations */
++              switch (ecc_opt) {
++              case OMAP_ECC_HAMMING_CODE_HW:
++                      return -EINVAL;
++              case OMAP_ECC_BCH4_CODE_HW_DETECTION_SW:
++                      for (i = 0; i < eccbytes; i++)
++                              *(ecc_calc + i) = *(ecc_calc + i) ^
++                                                      bch4_polynomial[i];
++                      break;
++              case OMAP_ECC_BCH4_CODE_HW:
++                      *(ecc_ptr++) = 0x00;
++                      break;
++              case OMAP_ECC_BCH8_CODE_HW_DETECTION_SW:
++                      for (i = 0; i < eccbytes; i++)
++                              *(ecc_calc + i) = *(ecc_calc + i) ^
++                                                      bch8_polynomial[i];
++                      break;
++              case OMAP_ECC_BCH8_CODE_HW:
++                      *(ecc_ptr++) = 0x00;
++                      break;
++              case OMAP_ECC_BCH16_CODE_HW:
++                      break;
++              }
++              /* update pointer to next sector */
++              ecc_calc += eccbytes;
+       }
+-
+       return 0;
+ }
++#endif /*defined(CONFIG_MTD_NAND_ECC_BCH) || defined(CONFIG_MTD_NAND_OMAP_BCH)*/
+-/**
+- * erased_sector_bitflips - count bit flips
+- * @data:     data sector buffer
+- * @oob:      oob buffer
+- * @info:     omap_nand_info
+- *
+- * Check the bit flips in erased page falls below correctable level.
+- * If falls below, report the page as erased with correctable bit
+- * flip, else report as uncorrectable page.
+- */
+-static int erased_sector_bitflips(u_char *data, u_char *oob,
+-              struct omap_nand_info *info)
+-{
+-      int flip_bits = 0, i;
+-
+-      for (i = 0; i < info->nand.ecc.size; i++) {
+-              flip_bits += hweight8(~data[i]);
+-              if (flip_bits > info->nand.ecc.strength)
+-                      return 0;
+-      }
+-
+-      for (i = 0; i < info->nand.ecc.bytes - 1; i++) {
+-              flip_bits += hweight8(~oob[i]);
+-              if (flip_bits > info->nand.ecc.strength)
+-                      return 0;
+-      }
+-
+-      /*
+-       * Bit flips falls in correctable level.
+-       * Fill data area with 0xFF
+-       */
+-      if (flip_bits) {
+-              memset(data, 0xFF, info->nand.ecc.size);
+-              memset(oob, 0xFF, info->nand.ecc.bytes);
+-      }
+-
+-      return flip_bits;
+-}
+-
++#ifdef CONFIG_MTD_NAND_OMAP_BCH
+ /**
+  * omap_elm_correct_data - corrects page data area in case error reported
+  * @mtd:      MTD device structure
+  * @data:     page data
+  * @read_ecc: ecc read from nand flash
+- * @calc_ecc: ecc read from HW ECC registers
+- *
+- * Calculated ecc vector reported as zero in case of non-error pages.
+- * In case of error/erased pages non-zero error vector is reported.
+- * In case of non-zero ecc vector, check read_ecc at fixed offset
+- * (x = 13/7 in case of BCH8/4 == 0) to find page programmed or not.
+- * To handle bit flips in this data, count the number of 0's in
+- * read_ecc[x] and check if it greater than 4. If it is less, it is
+- * programmed page, else erased page.
+- *
+- * 1. If page is erased, check with standard ecc vector (ecc vector
+- * for erased page to find any bit flip). If check fails, bit flip
+- * is present in erased page. Count the bit flips in erased page and
+- * if it falls under correctable level, report page with 0xFF and
+- * update the correctable bit information.
+- * 2. If error is reported on programmed page, update elm error
+- * vector and correct the page with ELM error correction routine.
+- *
++ * @calc_ecc: ecc calculated after reading Data and OOB regions from flash
++ * As calc_ecc is calculated over both main & oob, so calc_ecc would be
++ * non-zero only in following cases:
++ * - bit-flips in data or oob region
++ * - erase page, where no ECC is written in OOB area
++ *   However, erased_pages can be differentiated from corrupted pages
++ *   by comparing the calculated ECC with pre-defined syndrome ECC_of_ALL(0xFF)
++ *   Bit-flips in erased-pages would also be caught by comparing, calc_ecc
++ *   with ECC_of_ALL(0xFF)
+  */
+ static int omap_elm_correct_data(struct mtd_info *mtd, u_char *data,
+                               u_char *read_ecc, u_char *calc_ecc)
+ {
+       struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+                       mtd);
+-      int eccsteps = info->nand.ecc.steps;
+-      int i , j, stat = 0;
+-      int eccsize, eccflag, ecc_vector_size;
++      enum omap_ecc ecc_opt = info->ecc_opt;
++      struct nand_chip *chip = mtd->priv;
++      int eccsteps = chip->ecc.steps;
++      int eccsize  = chip->ecc.size;
++      int eccbytes = chip->ecc.bytes;
++      int i , j, stat = 0, ret = 0, flag_read_ecc;
+       struct elm_errorvec err_vec[ERROR_VECTOR_MAX];
+-      u_char *ecc_vec = calc_ecc;
+-      u_char *spare_ecc = read_ecc;
+-      u_char *erased_ecc_vec;
+-      enum bch_ecc type;
++      u_char *ecc;
+       bool is_error_reported = false;
++      u32 bit_pos, byte_pos, error_max, pos;
+       /* Initialize elm error vector to zero */
+       memset(err_vec, 0, sizeof(err_vec));
+-
+-      if (info->nand.ecc.strength == BCH8_MAX_ERROR) {
+-              type = BCH8_ECC;
+-              erased_ecc_vec = bch8_vector;
+-      } else {
+-              type = BCH4_ECC;
+-              erased_ecc_vec = bch4_vector;
+-      }
+-
+-      ecc_vector_size = info->nand.ecc.bytes;
+-
+-      /*
+-       * Remove extra byte padding for BCH8 RBL
+-       * compatibility and erased page handling
+-       */
+-      eccsize = ecc_vector_size - 1;
+-
+       for (i = 0; i < eccsteps ; i++) {
+-              eccflag = 0;    /* initialize eccflag */
+-
+-              /*
+-               * Check any error reported,
+-               * In case of error, non zero ecc reported.
+-               */
+-
+-              for (j = 0; (j < eccsize); j++) {
+-                      if (calc_ecc[j] != 0) {
+-                              eccflag = 1; /* non zero ecc, error present */
++              flag_read_ecc = 0;
++              ecc = calc_ecc + (i * eccbytes);
++              /* check calc_ecc */
++              for (j = 0; j < eccbytes; j++) {
++                      if (*(ecc + j) != 0x00) {
++                              flag_read_ecc = 1;
+                               break;
+                       }
+               }
+-
+-              if (eccflag == 1) {
+-                      /*
+-                       * Set threshold to minimum of 4, half of ecc.strength/2
+-                       * to allow max bit flip in byte to 4
+-                       */
+-                      unsigned int threshold = min_t(unsigned int, 4,
+-                                      info->nand.ecc.strength / 2);
+-
+-                      /*
+-                       * Check data area is programmed by counting
+-                       * number of 0's at fixed offset in spare area.
+-                       * Checking count of 0's against threshold.
+-                       * In case programmed page expects at least threshold
+-                       * zeros in byte.
+-                       * If zeros are less than threshold for programmed page/
+-                       * zeros are more than threshold erased page, either
+-                       * case page reported as uncorrectable.
+-                       */
+-                      if (hweight8(~read_ecc[eccsize]) >= threshold) {
+-                              /*
+-                               * Update elm error vector as
+-                               * data area is programmed
+-                               */
+-                              err_vec[i].error_reported = true;
+-                              is_error_reported = true;
+-                      } else {
+-                              /* Error reported in erased page */
+-                              int bitflip_count;
+-                              u_char *buf = &data[info->nand.ecc.size * i];
+-
+-                              if (memcmp(calc_ecc, erased_ecc_vec, eccsize)) {
+-                                      bitflip_count = erased_sector_bitflips(
+-                                                      buf, read_ecc, info);
+-
+-                                      if (bitflip_count)
+-                                              stat += bitflip_count;
+-                                      else
+-                                              return -EINVAL;
+-                              }
++              /* check if its a erased-page */
++              if (flag_read_ecc) {
++                      switch (ecc_opt) {
++                      case OMAP_ECC_BCH4_CODE_HW:
++                              if (memcmp(ecc, bch4_vector, eccbytes))
++                                      err_vec[i].error_reported = true;
++                              break;
++                      case OMAP_ECC_BCH8_CODE_HW:
++                              if (memcmp(ecc, bch8_vector, eccbytes))
++                                      err_vec[i].error_reported = true;
++                              break;
++                      case OMAP_ECC_BCH16_CODE_HW:
++                              if (memcmp(ecc, bch16_vector, eccbytes))
++                                      err_vec[i].error_reported = true;
++                              break;
++                      default:
++                              pr_err("%s: invalid configuration",
++                                                               DRIVER_NAME);
++                              return -EINVAL;
+                       }
+               }
+-
+-              /* Update the ecc vector */
+-              calc_ecc += ecc_vector_size;
+-              read_ecc += ecc_vector_size;
++              /* page definitely has bit-flips */
++              if (err_vec[i].error_reported)
++                      is_error_reported = true;
+       }
+-      /* Check if any error reported */
+       if (!is_error_reported)
+               return 0;
++      /* detect bit-flips using ELM module */
++      elm_decode_bch_error_page(info->elm_dev, calc_ecc, err_vec);
+-      /* Decode BCH error using ELM module */
+-      elm_decode_bch_error_page(info->elm_dev, ecc_vec, err_vec);
+-
++      /* correct bit-flip */
+       for (i = 0; i < eccsteps; i++) {
+-              if (err_vec[i].error_reported) {
++              if (err_vec[i].error_uncorrectable) {
++                      ret = -EBADMSG;
++              } else if (err_vec[i].error_reported) {
+                       for (j = 0; j < err_vec[i].error_count; j++) {
+-                              u32 bit_pos, byte_pos, error_max, pos;
+-
+-                              if (type == BCH8_ECC)
+-                                      error_max = BCH8_ECC_MAX;
+-                              else
+-                                      error_max = BCH4_ECC_MAX;
+-
+-                              if (info->nand.ecc.strength == BCH8_MAX_ERROR)
+-                                      pos = err_vec[i].error_loc[j];
+-                              else
++                              switch (ecc_opt) {
++                              case OMAP_ECC_BCH4_CODE_HW:
++                                      error_max = SECTOR_BYTES +
++                                                      (eccbytes - 1);
+                                       /* Add 4 to take care 4 bit padding */
+                                       pos = err_vec[i].error_loc[j] +
+-                                              BCH4_BIT_PAD;
+-
+-                              /* Calculate bit position of error */
++                                                      BCH4_BIT_PAD;
++                                      break;
++                              case OMAP_ECC_BCH8_CODE_HW:
++                                      error_max = SECTOR_BYTES +
++                                                      (eccbytes - 1);
++                                      pos = err_vec[i].error_loc[j];
++                                      break;
++                              case OMAP_ECC_BCH16_CODE_HW:
++                                      error_max = SECTOR_BYTES + eccbytes;
++                                      pos = err_vec[i].error_loc[j];
++                                      break;
++                              default:
++                                      return -EINVAL;
++                              }
++                              /* Calculate bit & byte bit-flip position */
+                               bit_pos = pos % 8;
+-
+-                              /* Calculate byte position of error */
+-                              byte_pos = (error_max - pos - 1) / 8;
+-
+-                              if (pos < error_max) {
+-                                      if (byte_pos < 512)
+-                                              data[byte_pos] ^= 1 << bit_pos;
+-                                      else
+-                                              spare_ecc[byte_pos - 512] ^=
++                              byte_pos = error_max - (pos / 8) - 1;
++                              if (byte_pos < SECTOR_BYTES)
++                                      data[byte_pos] ^= 1 << bit_pos;
++                              else if (byte_pos < error_max)
++                                      read_ecc[byte_pos - SECTOR_BYTES] ^=
+                                                       1 << bit_pos;
+-                              }
+-                              /* else, not interested to correct ecc */
++                              else
++                                      ret = -EBADMSG;
+                       }
+               }
+-
+               /* Update number of correctable errors */
+               stat += err_vec[i].error_count;
+-
+               /* Update page data with sector size */
+-              data += info->nand.ecc.size;
+-              spare_ecc += ecc_vector_size;
++              data     += eccsize;
++              read_ecc += eccbytes;
+       }
+-      for (i = 0; i < eccsteps; i++)
+-              /* Return error if uncorrectable error present */
+-              if (err_vec[i].error_uncorrectable)
+-                      return -EINVAL;
+-
+-      return stat;
+-}
+-
+-/**
+- * omap3_correct_data_bch - Decode received data and correct errors
+- * @mtd: MTD device structure
+- * @data: page data
+- * @read_ecc: ecc read from nand flash
+- * @calc_ecc: ecc read from HW ECC registers
+- */
+-static int omap3_correct_data_bch(struct mtd_info *mtd, u_char *data,
+-                                u_char *read_ecc, u_char *calc_ecc)
+-{
+-      int i, count;
+-      /* cannot correct more than 8 errors */
+-      unsigned int errloc[8];
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-
+-      count = decode_bch(info->bch, NULL, 512, read_ecc, calc_ecc, NULL,
+-                         errloc);
+-      if (count > 0) {
+-              /* correct errors */
+-              for (i = 0; i < count; i++) {
+-                      /* correct data only, not ecc bytes */
+-                      if (errloc[i] < 8*512)
+-                              data[errloc[i]/8] ^= 1 << (errloc[i] & 7);
+-                      pr_debug("corrected bitflip %u\n", errloc[i]);
+-              }
+-      } else if (count < 0) {
+-              pr_err("ecc unrecoverable error\n");
+-      }
+-      return count;
++      return (ret < 0) ? ret : stat;
+ }
+ /**
+@@ -1637,186 +1449,30 @@ static int omap_read_page_bch(struct mtd
+ }
+ /**
+- * omap3_free_bch - Release BCH ecc resources
+- * @mtd: MTD device structure
+- */
+-static void omap3_free_bch(struct mtd_info *mtd)
+-{
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-      if (info->bch) {
+-              free_bch(info->bch);
+-              info->bch = NULL;
+-      }
+-}
+-
+-/**
+- * omap3_init_bch - Initialize BCH ECC
+- * @mtd: MTD device structure
+- * @ecc_opt: OMAP ECC mode (OMAP_ECC_BCH4_CODE_HW or OMAP_ECC_BCH8_CODE_HW)
+- */
+-static int omap3_init_bch(struct mtd_info *mtd, int ecc_opt)
+-{
+-      int max_errors;
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-#ifdef CONFIG_MTD_NAND_OMAP_BCH8
+-      const int hw_errors = BCH8_MAX_ERROR;
+-#else
+-      const int hw_errors = BCH4_MAX_ERROR;
+-#endif
+-      enum bch_ecc bch_type;
+-      const __be32 *parp;
+-      int lenp;
+-      struct device_node *elm_node;
+-
+-      info->bch = NULL;
+-
+-      max_errors = (ecc_opt == OMAP_ECC_BCH8_CODE_HW) ?
+-              BCH8_MAX_ERROR : BCH4_MAX_ERROR;
+-      if (max_errors != hw_errors) {
+-              pr_err("cannot configure %d-bit BCH ecc, only %d-bit supported",
+-                     max_errors, hw_errors);
+-              goto fail;
+-      }
+-
+-      info->nand.ecc.size = 512;
+-      info->nand.ecc.hwctl = omap3_enable_hwecc_bch;
+-      info->nand.ecc.mode = NAND_ECC_HW;
+-      info->nand.ecc.strength = max_errors;
+-
+-      if (hw_errors == BCH8_MAX_ERROR)
+-              bch_type = BCH8_ECC;
+-      else
+-              bch_type = BCH4_ECC;
+-
+-      /* Detect availability of ELM module */
+-      parp = of_get_property(info->of_node, "elm_id", &lenp);
+-      if ((parp == NULL) && (lenp != (sizeof(void *) * 2))) {
+-              pr_err("Missing elm_id property, fall back to Software BCH\n");
+-              info->is_elm_used = false;
+-      } else {
+-              struct platform_device *pdev;
+-
+-              elm_node = of_find_node_by_phandle(be32_to_cpup(parp));
+-              pdev = of_find_device_by_node(elm_node);
+-              info->elm_dev = &pdev->dev;
+-
+-              if (elm_config(info->elm_dev, bch_type) == 0)
+-                      info->is_elm_used = true;
+-      }
+-
+-      if (info->is_elm_used && (mtd->writesize <= 4096)) {
+-
+-              if (hw_errors == BCH8_MAX_ERROR)
+-                      info->nand.ecc.bytes = BCH8_SIZE;
+-              else
+-                      info->nand.ecc.bytes = BCH4_SIZE;
+-
+-              info->nand.ecc.correct = omap_elm_correct_data;
+-              info->nand.ecc.calculate = omap3_calculate_ecc_bch;
+-              info->nand.ecc.read_page = omap_read_page_bch;
+-              info->nand.ecc.write_page = omap_write_page_bch;
+-      } else {
+-              /*
+-               * software bch library is only used to detect and
+-               * locate errors
+-               */
+-              info->bch = init_bch(13, max_errors,
+-                              0x201b /* hw polynomial */);
+-              if (!info->bch)
+-                      goto fail;
+-
+-              info->nand.ecc.correct = omap3_correct_data_bch;
+-
+-              /*
+-               * The number of corrected errors in an ecc block that will
+-               * trigger block scrubbing defaults to the ecc strength (4 or 8)
+-               * Set mtd->bitflip_threshold here to define a custom threshold.
+-               */
+-
+-              if (max_errors == 8) {
+-                      info->nand.ecc.bytes = 13;
+-                      info->nand.ecc.calculate = omap3_calculate_ecc_bch8;
+-              } else {
+-                      info->nand.ecc.bytes = 7;
+-                      info->nand.ecc.calculate = omap3_calculate_ecc_bch4;
+-              }
+-      }
+-
+-      pr_info("enabling NAND BCH ecc with %d-bit correction\n", max_errors);
+-      return 0;
+-fail:
+-      omap3_free_bch(mtd);
+-      return -1;
+-}
+-
+-/**
+- * omap3_init_bch_tail - Build an oob layout for BCH ECC correction.
+- * @mtd: MTD device structure
+- */
+-static int omap3_init_bch_tail(struct mtd_info *mtd)
+-{
+-      int i, steps, offset;
+-      struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+-                                                 mtd);
+-      struct nand_ecclayout *layout = &info->ecclayout;
+-
+-      /* build oob layout */
+-      steps = mtd->writesize/info->nand.ecc.size;
+-      layout->eccbytes = steps*info->nand.ecc.bytes;
+-
+-      /* do not bother creating special oob layouts for small page devices */
+-      if (mtd->oobsize < 64) {
+-              pr_err("BCH ecc is not supported on small page devices\n");
+-              goto fail;
++ * is_elm_present - checks for presence of ELM module by scanning DT nodes
++ * @omap_nand_info: NAND device structure containing platform data
++ * @bch_type: 0x0=BCH4, 0x1=BCH8, 0x2=BCH16
++ */
++static int is_elm_present(struct omap_nand_info *info,
++                      struct device_node *elm_node, enum bch_ecc bch_type)
++{
++      struct platform_device *pdev;
++      /* check whether elm-id is passed via DT */
++      if (!elm_node) {
++              pr_err("nand: error: ELM DT node not found\n");
++              return -ENODEV;
+       }
+-
+-      /* reserve 2 bytes for bad block marker */
+-      if (layout->eccbytes+2 > mtd->oobsize) {
+-              pr_err("no oob layout available for oobsize %d eccbytes %u\n",
+-                     mtd->oobsize, layout->eccbytes);
+-              goto fail;
++      pdev = of_find_device_by_node(elm_node);
++      /* check whether ELM device is registered */
++      if (!pdev) {
++              pr_err("nand: error: ELM device not found\n");
++              return -ENODEV;
+       }
+-
+-      /* ECC layout compatible with RBL for BCH8 */
+-      if (info->is_elm_used && (info->nand.ecc.bytes == BCH8_SIZE))
+-              offset = 2;
+-      else
+-              offset = mtd->oobsize - layout->eccbytes;
+-
+-      /* put ecc bytes at oob tail */
+-      for (i = 0; i < layout->eccbytes; i++)
+-              layout->eccpos[i] = offset + i;
+-
+-      if (info->is_elm_used && (info->nand.ecc.bytes == BCH8_SIZE))
+-              layout->oobfree[0].offset = 2 + layout->eccbytes * steps;
+-      else
+-              layout->oobfree[0].offset = 2;
+-
+-      layout->oobfree[0].length = mtd->oobsize-2-layout->eccbytes;
+-      info->nand.ecc.layout = layout;
+-
+-      if (!(info->nand.options & NAND_BUSWIDTH_16))
+-              info->nand.badblock_pattern = &bb_descrip_flashbased;
++      /* ELM module available, now configure it */
++      info->elm_dev = &pdev->dev;
++      if (elm_config(info->elm_dev, &info->mtd, bch_type))
++              return -ENODEV;
+       return 0;
+-fail:
+-      omap3_free_bch(mtd);
+-      return -1;
+-}
+-
+-#else
+-static int omap3_init_bch(struct mtd_info *mtd, int ecc_opt)
+-{
+-      pr_err("CONFIG_MTD_NAND_OMAP_BCH is not enabled\n");
+-      return -1;
+-}
+-static int omap3_init_bch_tail(struct mtd_info *mtd)
+-{
+-      return -1;
+-}
+-static void omap3_free_bch(struct mtd_info *mtd)
+-{
+ }
+ #endif /* CONFIG_MTD_NAND_OMAP_BCH */
+@@ -1824,10 +1480,13 @@ static int omap_nand_probe(struct platfo
+ {
+       struct omap_nand_info           *info;
+       struct omap_nand_platform_data  *pdata;
++      struct mtd_info                 *mtd;
++      struct nand_chip                *chip;
++      struct nand_ecclayout           *ecclayout;
+       int                             err;
+-      int                             i, offset;
+-      dma_cap_mask_t mask;
+-      unsigned sig;
++      int                             i;
++      dma_cap_mask_t                  mask;
++      unsigned                        sig;
+       struct resource                 *res;
+       struct mtd_part_parser_data     ppdata = {};
+@@ -1846,20 +1505,22 @@ static int omap_nand_probe(struct platfo
+       spin_lock_init(&info->controller.lock);
+       init_waitqueue_head(&info->controller.wq);
+-      info->pdev = pdev;
++      mtd                     = &info->mtd;
++      mtd->name               = dev_name(&pdev->dev);
++      mtd->owner              = THIS_MODULE;
++      mtd->priv               = &info->nand;
++      chip                    = mtd->priv;
++      chip->ecc.priv          = NULL;
++      info->pdev              = pdev;
+       info->gpmc_cs           = pdata->cs;
+       info->reg               = pdata->reg;
++      info->ecc_opt           = pdata->ecc_opt;
+-      info->mtd.priv          = &info->nand;
+-      info->mtd.name          = dev_name(&pdev->dev);
+-      info->mtd.owner         = THIS_MODULE;
+-
+-      info->nand.options      = pdata->devsize;
++      info->nand.options      = NAND_BUSWIDTH_AUTO;
+       info->nand.options      |= NAND_SKIP_BBTSCAN;
+-#ifdef CONFIG_MTD_NAND_OMAP_BCH
+       info->of_node           = pdata->of_node;
+-#endif
++
+       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+       if (res == NULL) {
+@@ -1903,6 +1564,30 @@ static int omap_nand_probe(struct platfo
+               info->nand.chip_delay = 50;
+       }
++      /* scan NAND device conncted to controller */
++      if (nand_scan_ident(mtd, 1, NULL)) {
++              err = -ENXIO;
++              goto out_release_mem_region;
++      }
++      pr_info("%s: detected %s NAND flash\n", DRIVER_NAME,
++                      (info->nand.options & NAND_BUSWIDTH_16) ? "x16" : "x8");
++      if ((info->nand.options & NAND_BUSWIDTH_16) !=
++                      (pdata->devsize & NAND_BUSWIDTH_16)) {
++              pr_err("%s: but incorrectly configured as %s", DRIVER_NAME,
++                      (pdata->devsize & NAND_BUSWIDTH_16) ? "x16" : "x8");
++              err = -EINVAL;
++              goto out_release_mem_region;
++      }
++
++      /* check for small page devices */
++      if ((mtd->oobsize < 64) &&
++              (pdata->ecc_opt != OMAP_ECC_HAMMING_CODE_HW)) {
++              pr_err("small page devices are not supported\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++      }
++
++      /* populate read & write API based on xfer_type selected */
+       switch (pdata->xfer_type) {
+       case NAND_OMAP_PREFETCH_POLLED:
+               info->nand.read_buf   = omap_read_buf_pref;
+@@ -1992,64 +1677,218 @@ static int omap_nand_probe(struct platfo
+               goto out_release_mem_region;
+       }
+-      /* select the ecc type */
+-      if (pdata->ecc_opt == OMAP_ECC_HAMMING_CODE_DEFAULT)
+-              info->nand.ecc.mode = NAND_ECC_SOFT;
+-      else if ((pdata->ecc_opt == OMAP_ECC_HAMMING_CODE_HW) ||
+-              (pdata->ecc_opt == OMAP_ECC_HAMMING_CODE_HW_ROMCODE)) {
++      /* populate MTD interface based on ECC scheme */
++      chip->ecclayout         = &omap_oobinfo;
++      chip->ecc.layout        = &omap_oobinfo;
++      ecclayout               = &omap_oobinfo;
++      switch (pdata->ecc_opt) {
++      case OMAP_ECC_HAMMING_CODE_HW:
++              pr_info("nand: using OMAP_ECC_HAMMING_CODE_HW\n");
++              info->nand.ecc.mode             = NAND_ECC_HW;
+               info->nand.ecc.bytes            = 3;
+               info->nand.ecc.size             = 512;
+               info->nand.ecc.strength         = 1;
+               info->nand.ecc.calculate        = omap_calculate_ecc;
+               info->nand.ecc.hwctl            = omap_enable_hwecc;
+               info->nand.ecc.correct          = omap_correct_data;
+-              info->nand.ecc.mode             = NAND_ECC_HW;
+-      } else if ((pdata->ecc_opt == OMAP_ECC_BCH4_CODE_HW) ||
+-                 (pdata->ecc_opt == OMAP_ECC_BCH8_CODE_HW)) {
+-              err = omap3_init_bch(&info->mtd, pdata->ecc_opt);
+-              if (err) {
++              /* define custom ECC layout */
++              ecclayout->eccbytes             = info->nand.ecc.bytes *
++                                                      (mtd->writesize /
++                                                      info->nand.ecc.size);
++              if (info->nand.options & NAND_BUSWIDTH_16)
++                      ecclayout->eccpos[0]    = BADBLOCK_MARKER_LENGTH;
++              else
++                      ecclayout->eccpos[0]    = 1;
++              ecclayout->oobfree->offset      = ecclayout->eccpos[0] +
++                                                      ecclayout->eccbytes;
++              goto custom_ecc_layout;
++              break;
++      case OMAP_ECC_BCH4_CODE_HW_DETECTION_SW:
++#ifdef CONFIG_MTD_NAND_ECC_BCH
++              pr_info("nand: using OMAP_ECC_BCH4_CODE_HW_DETECTION_SW\n");
++              info->nand.ecc.mode             = NAND_ECC_HW;
++              info->nand.ecc.size             = 512;
++              info->nand.ecc.bytes            = 7;
++              info->nand.ecc.strength         = 4;
++              info->nand.ecc.hwctl            = omap_enable_hwecc;
++              info->nand.ecc.correct          = nand_bch_correct_data;
++              info->nand.ecc.calculate        = omap_calculate_ecc_bch;
++              /* define custom ECC layout */
++              ecclayout->eccbytes             = info->nand.ecc.bytes *
++                                                      (mtd->writesize /
++                                                      info->nand.ecc.size);
++              ecclayout->eccpos[0]            = info->mtd.oobsize -
++                                                      ecclayout->eccbytes;
++              ecclayout->oobfree->offset      = BADBLOCK_MARKER_LENGTH;
++              /* software bch library is used for locating errors */
++              info->nand.ecc.priv             = nand_bch_init(mtd,
++                                              info->nand.ecc.size,
++                                              info->nand.ecc.bytes,
++                                              &info->nand.ecc.layout);
++              if (!info->nand.ecc.priv) {
++                      pr_err("nand: error: unable to use s/w BCH library\n");
+                       err = -EINVAL;
+                       goto out_release_mem_region;
+               }
+-      }
+-
+-      /* DIP switches on some boards change between 8 and 16 bit
+-       * bus widths for flash.  Try the other width if the first try fails.
+-       */
+-      if (nand_scan_ident(&info->mtd, 1, NULL)) {
+-              info->nand.options ^= NAND_BUSWIDTH_16;
+-              if (nand_scan_ident(&info->mtd, 1, NULL)) {
+-                      err = -ENXIO;
++              goto custom_ecc_layout;
++#else
++              pr_err("nand: error: CONFIG_MTD_NAND_ECC_BCH not enabled\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++#endif
++              break;
++      case OMAP_ECC_BCH4_CODE_HW:
++#ifdef CONFIG_MTD_NAND_OMAP_BCH
++              pr_info("nand: using OMAP_ECC_BCH4_CODE_HW ECC scheme\n");
++              info->nand.ecc.mode             = NAND_ECC_HW;
++              info->nand.ecc.size             = 512;
++              /* 14th bit is kept reserved for ROM-code compatibility */
++              info->nand.ecc.bytes            = 7 + 1;
++              info->nand.ecc.strength         = 4;
++              info->nand.ecc.hwctl            = omap_enable_hwecc;
++              info->nand.ecc.correct          = omap_elm_correct_data;
++              info->nand.ecc.calculate        = omap_calculate_ecc_bch;
++              info->nand.ecc.read_page        = omap_read_page_bch;
++              info->nand.ecc.write_page       = omap_write_page_bch;
++              /* This ECC scheme requires ELM H/W block */
++              if (is_elm_present(info, pdata->elm_of_node, BCH4_ECC) < 0) {
++                      pr_err("nand: error: could not initialize ELM\n");
++                      err = -ENODEV;
+                       goto out_release_mem_region;
+               }
+-      }
+-
+-      /* rom code layout */
+-      if (pdata->ecc_opt == OMAP_ECC_HAMMING_CODE_HW_ROMCODE) {
+-
+-              if (info->nand.options & NAND_BUSWIDTH_16)
+-                      offset = 2;
+-              else {
+-                      offset = 1;
+-                      info->nand.badblock_pattern = &bb_descrip_flashbased;
+-              }
+-              omap_oobinfo.eccbytes = 3 * (info->mtd.oobsize/16);
+-              for (i = 0; i < omap_oobinfo.eccbytes; i++)
+-                      omap_oobinfo.eccpos[i] = i+offset;
+-
+-              omap_oobinfo.oobfree->offset = offset + omap_oobinfo.eccbytes;
+-              omap_oobinfo.oobfree->length = info->mtd.oobsize -
+-                                      (offset + omap_oobinfo.eccbytes);
+-
+-              info->nand.ecc.layout = &omap_oobinfo;
+-      } else if ((pdata->ecc_opt == OMAP_ECC_BCH4_CODE_HW) ||
+-                 (pdata->ecc_opt == OMAP_ECC_BCH8_CODE_HW)) {
+-              /* build OOB layout for BCH ECC correction */
+-              err = omap3_init_bch_tail(&info->mtd);
+-              if (err) {
++              /* define custom ECC layout */
++              ecclayout->eccbytes             = info->nand.ecc.bytes *
++                                                      (mtd->writesize /
++                                                      info->nand.ecc.size);
++              ecclayout->eccpos[0]            = BADBLOCK_MARKER_LENGTH;
++              ecclayout->oobfree->offset      = ecclayout->eccpos[0] +
++                                                      ecclayout->eccbytes;
++              goto custom_ecc_layout;
++#else
++              pr_err("nand: error: CONFIG_MTD_NAND_OMAP_BCH not enabled\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++#endif
++              break;
++      case OMAP_ECC_BCH8_CODE_HW_DETECTION_SW:
++#ifdef CONFIG_MTD_NAND_ECC_BCH
++              pr_info("nand: using OMAP_ECC_BCH8_CODE_HW_DETECTION_SW\n");
++              info->nand.ecc.mode             = NAND_ECC_HW;
++              info->nand.ecc.size             = 512;
++              info->nand.ecc.bytes            = 13;
++              info->nand.ecc.strength         = 8;
++              info->nand.ecc.hwctl            = omap_enable_hwecc;
++              info->nand.ecc.correct          = nand_bch_correct_data;
++              info->nand.ecc.calculate        = omap_calculate_ecc_bch;
++              /* define custom ECC layout */
++              ecclayout->eccbytes             = info->nand.ecc.bytes *
++                                                      (mtd->writesize /
++                                                      info->nand.ecc.size);
++              ecclayout->eccpos[0]            = info->mtd.oobsize -
++                                                      ecclayout->eccbytes;
++              ecclayout->oobfree->offset      = BADBLOCK_MARKER_LENGTH;
++              /* software bch library is used for locating errors */
++              info->nand.ecc.priv             = nand_bch_init(mtd,
++                                              info->nand.ecc.size,
++                                              info->nand.ecc.bytes,
++                                              &info->nand.ecc.layout);
++              if (!info->nand.ecc.priv) {
++                      pr_err("nand: error: unable to use s/w BCH library\n");
+                       err = -EINVAL;
+                       goto out_release_mem_region;
+               }
++              goto custom_ecc_layout;
++#else
++              pr_err("nand: error: CONFIG_MTD_NAND_ECC_BCH not enabled\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++#endif
++              break;
++      case OMAP_ECC_BCH8_CODE_HW:
++#ifdef CONFIG_MTD_NAND_OMAP_BCH
++              pr_info("nand: using OMAP_ECC_BCH8_CODE_HW ECC scheme\n");
++              info->nand.ecc.mode             = NAND_ECC_HW;
++              info->nand.ecc.size             = 512;
++              /* 14th bit is kept reserved for ROM-code compatibility */
++              info->nand.ecc.bytes            = 13 + 1;
++              info->nand.ecc.strength         = 8;
++              info->nand.ecc.hwctl            = omap_enable_hwecc;
++              info->nand.ecc.correct          = omap_elm_correct_data;
++              info->nand.ecc.calculate        = omap_calculate_ecc_bch;
++              info->nand.ecc.read_page        = omap_read_page_bch;
++              info->nand.ecc.write_page       = omap_write_page_bch;
++              /* This ECC scheme requires ELM H/W block */
++              if (is_elm_present(info, pdata->elm_of_node, BCH8_ECC) < 0) {
++                      pr_err("nand: error: could not initialize ELM\n");
++                      err = -ENODEV;
++                      goto out_release_mem_region;
++              }
++              /* define custom ECC layout */
++              ecclayout->eccbytes             = info->nand.ecc.bytes *
++                                                      (mtd->writesize /
++                                                      info->nand.ecc.size);
++              ecclayout->eccpos[0]            = BADBLOCK_MARKER_LENGTH;
++              ecclayout->oobfree->offset      = ecclayout->eccpos[0] +
++                                                      ecclayout->eccbytes;
++              goto custom_ecc_layout;
++#else
++              pr_err("nand: error: CONFIG_MTD_NAND_OMAP_BCH not enabled\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++#endif
++              break;
++      case OMAP_ECC_BCH16_CODE_HW:
++#ifdef CONFIG_MTD_NAND_OMAP_BCH
++              pr_info("using OMAP_ECC_BCH16_CODE_HW ECC scheme\n");
++              chip->ecc.mode          = NAND_ECC_HW;
++              chip->ecc.size          = 512;
++              /* 14th bit is kept reserved for ROM-code compatibility */
++              chip->ecc.bytes         = 26;
++              chip->ecc.strength      = 16;
++              chip->ecc.hwctl         = omap_enable_hwecc;
++              chip->ecc.correct       = omap_elm_correct_data;
++              chip->ecc.calculate     = omap_calculate_ecc_bch;
++              chip->ecc.read_page     = omap_read_page_bch;
++              chip->ecc.write_page    = omap_write_page_bch;
++              /* ELM H/W engine is used for locating errors */
++              if (is_elm_present(info, pdata->elm_of_node, BCH16_ECC) < 0) {
++                      pr_err("ELM module not detected, required for ECC\n");
++                      err = -EINVAL;
++                      goto out_release_mem_region;
++              }
++              /* define custom ECC layout */
++              omap_oobinfo.eccbytes   = chip->ecc.bytes *
++                                         (mtd->writesize / chip->ecc.size);
++              omap_oobinfo.eccpos[0]  = BADBLOCK_MARKER_LENGTH;
++              omap_oobinfo.oobfree->offset = omap_oobinfo.eccpos[0] +
++                                              omap_oobinfo.eccbytes;
++              goto custom_ecc_layout;
++#else
++              pr_err("nand: error: CONFIG_MTD_NAND_OMAP_BCH not enabled\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++#endif
++      default:
++              pr_err("nand: error: invalid or unsupported ECC scheme\n");
++              err = -EINVAL;
++              goto out_release_mem_region;
++      }
++
++custom_ecc_layout:
++      /* populate remaining info for custom ecc layout */
++      pr_info("%s: using custom ecc layout\n", DRIVER_NAME);
++      ecclayout->oobfree->length = mtd->oobsize - BADBLOCK_MARKER_LENGTH
++                                              - ecclayout->eccbytes;
++      if (!(info->nand.options & NAND_BUSWIDTH_16))
++              info->nand.badblock_pattern = &bb_descrip_flashbased;
++      for (i = 1; i < ecclayout->eccbytes; i++)
++              ecclayout->eccpos[i] = ecclayout->eccpos[0] + i;
++      /* check if NAND OOBSIZE meets ECC scheme requirement */
++      if (mtd->oobsize < (ecclayout->eccbytes + BADBLOCK_MARKER_LENGTH)) {
++              pr_err("not enough OOB bytes required = %d, available=%d\n",
++                      ecclayout->eccbytes, mtd->oobsize);
++              err = -EINVAL;
++              goto out_release_mem_region;
+       }
+       /* second phase scan */
+@@ -2074,7 +1913,14 @@ out_release_mem_region:
+       if (info->gpmc_irq_fifo > 0)
+               free_irq(info->gpmc_irq_fifo, info);
+       release_mem_region(info->phys_base, info->mem_size);
++
+ out_free_info:
++#ifdef CONFIG_MTD_NAND_ECC_BCH
++      if (info->nand.ecc.priv) {
++              nand_bch_free(info->nand.ecc.priv);
++              info->nand.ecc.priv = NULL;
++      }
++#endif
+       kfree(info);
+       return err;
+@@ -2085,8 +1931,12 @@ static int omap_nand_remove(struct platf
+       struct mtd_info *mtd = platform_get_drvdata(pdev);
+       struct omap_nand_info *info = container_of(mtd, struct omap_nand_info,
+                                                       mtd);
+-      omap3_free_bch(&info->mtd);
+-
++#ifdef CONFIG_MTD_NAND_ECC_BCH
++      if (info->nand.ecc.priv) {
++              nand_bch_free(info->nand.ecc.priv);
++              info->nand.ecc.priv = NULL;
++      }
++#endif
+       if (info->dma)
+               dma_release_channel(info->dma);
+--- a/drivers/mtd/tests/oobtest.c
++++ b/drivers/mtd/tests/oobtest.c
+@@ -210,11 +210,29 @@ static int verify_eraseblock(int ebnum)
+ static int verify_eraseblock_in_one_go(int ebnum)
+ {
+       struct mtd_oob_ops ops;
+-      int err = 0;
++      int i, err = 0;
+       loff_t addr = ebnum * mtd->erasesize;
+       size_t len = mtd->ecclayout->oobavail * pgcnt;
+-      prandom_bytes_state(&rnd_state, writebuf, len);
++      /*
++       * if mtd->ecclayout->oobavail is not a multiple of 4 then
++       * while generating psuedo random numbers to write to flash
++       * prandom_bytes_state () generates the extra random bytes
++       * which wont be done if we do for the whole length. So check
++       * for mtd->ecclayout->oobavail if its multiple of 4 then
++       * generate for full len (mtd->ecclayout->oobavail * pgcnt)
++       * else generate prandom of mtd->ecclayout->oobavail bytes
++       * pgcnt times.
++       */
++
++      if (mtd->ecclayout->oobavail % sizeof(u32)) {
++              for (i = 0; i < len; i += mtd->ecclayout->oobavail)
++                      prandom_bytes_state(&rnd_state, writebuf + i,
++                                              mtd->ecclayout->oobavail);
++      } else {
++              prandom_bytes_state(&rnd_state, writebuf, len);
++      }
++
+       ops.mode      = MTD_OPS_AUTO_OOB;
+       ops.len       = 0;
+       ops.retlen    = 0;
+@@ -266,7 +284,7 @@ static int verify_all_eraseblocks(void)
+ static int __init mtd_oobtest_init(void)
+ {
+       int err = 0;
+-      unsigned int i;
++      unsigned int i, j;
+       uint64_t tmp;
+       struct mtd_oob_ops ops;
+       loff_t addr = 0, addr0;
+@@ -341,7 +359,6 @@ static int __init mtd_oobtest_init(void)
+       err = verify_all_eraseblocks();
+       if (err)
+               goto out;
+-
+       /*
+        * Second test: write all OOB, a block at a time, read it back and
+        * verify.
+@@ -591,10 +608,26 @@ static int __init mtd_oobtest_init(void)
+       prandom_seed_state(&rnd_state, 11);
+       pr_info("verifying all eraseblocks\n");
+       for (i = 0; i < ebcnt - 1; ++i) {
++              size_t sz = mtd->ecclayout->oobavail;
+               if (bbt[i] || bbt[i + 1])
+                       continue;
+-              prandom_bytes_state(&rnd_state, writebuf,
+-                                      mtd->ecclayout->oobavail * 2);
++      /*
++       * if mtd->ecclayout->oobavail is not a multiple of 4 then
++       * while generating psuedo random numbers to write to flash
++       * prandom_bytes_state () generates the extra random bytes
++       * which wont be done if we do for the whole length. So check
++       * for mtd->ecclayout->oobavail if its multiple of 4 then
++       * generate for full len (mtd->ecclayout->oobavail * pgcnt)
++       * else generate prandom of mtd->ecclayout->oobavail bytes
++       * pgcnt times.
++       */
++              if (sz % sizeof(u32)) {
++                      for (j = 0; j < sz * 2; j += sz)
++                              prandom_bytes_state(&rnd_state,
++                                                      writebuf + j , sz);
++              } else {
++                      prandom_bytes_state(&rnd_state, writebuf, sz * 2);
++              }
+               addr = (i + 1) * mtd->erasesize - mtd->writesize;
+               ops.mode      = MTD_OPS_AUTO_OOB;
+               ops.len       = 0;
+--- a/drivers/net/ethernet/ti/cpsw.c
++++ b/drivers/net/ethernet/ti/cpsw.c
+@@ -367,8 +367,6 @@ struct cpsw_priv {
+       spinlock_t                      lock;
+       struct platform_device          *pdev;
+       struct net_device               *ndev;
+-      struct resource                 *cpsw_res;
+-      struct resource                 *cpsw_wr_res;
+       struct napi_struct              napi;
+       struct device                   *dev;
+       struct cpsw_platform_data       data;
+@@ -1016,6 +1014,10 @@ static void cpsw_slave_open(struct cpsw_
+               dev_info(priv->dev, "phy found : id is : 0x%x\n",
+                        slave->phy->phy_id);
+               phy_start(slave->phy);
++
++              /* Configure GMII_SEL register */
++              cpsw_phy_sel(&priv->pdev->dev, slave->phy->interface,
++                           slave->slave_num);
+       }
+ }
+@@ -1705,62 +1707,55 @@ static int cpsw_probe_dt(struct cpsw_pla
+       if (of_property_read_u32(node, "active_slave", &prop)) {
+               pr_err("Missing active_slave property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->active_slave = prop;
+       if (of_property_read_u32(node, "cpts_clock_mult", &prop)) {
+               pr_err("Missing cpts_clock_mult property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->cpts_clock_mult = prop;
+       if (of_property_read_u32(node, "cpts_clock_shift", &prop)) {
+               pr_err("Missing cpts_clock_shift property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->cpts_clock_shift = prop;
+-      data->slave_data = kcalloc(data->slaves, sizeof(struct cpsw_slave_data),
+-                                 GFP_KERNEL);
++      data->slave_data = devm_kzalloc(&pdev->dev, data->slaves
++                                      * sizeof(struct cpsw_slave_data),
++                                      GFP_KERNEL);
+       if (!data->slave_data)
+-              return -EINVAL;
++              return -ENOMEM;
+       if (of_property_read_u32(node, "cpdma_channels", &prop)) {
+               pr_err("Missing cpdma_channels property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->channels = prop;
+       if (of_property_read_u32(node, "ale_entries", &prop)) {
+               pr_err("Missing ale_entries property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->ale_entries = prop;
+       if (of_property_read_u32(node, "bd_ram_size", &prop)) {
+               pr_err("Missing bd_ram_size property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->bd_ram_size = prop;
+       if (of_property_read_u32(node, "rx_descs", &prop)) {
+               pr_err("Missing rx_descs property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->rx_descs = prop;
+       if (of_property_read_u32(node, "mac_control", &prop)) {
+               pr_err("Missing mac_control property in the DT.\n");
+-              ret = -EINVAL;
+-              goto error_ret;
++              return -EINVAL;
+       }
+       data->mac_control = prop;
+@@ -1791,8 +1786,7 @@ static int cpsw_probe_dt(struct cpsw_pla
+               parp = of_get_property(slave_node, "phy_id", &lenp);
+               if ((parp == NULL) || (lenp != (sizeof(void *) * 2))) {
+                       pr_err("Missing slave[%d] phy_id property\n", i);
+-                      ret = -EINVAL;
+-                      goto error_ret;
++                      return -EINVAL;
+               }
+               mdio_node = of_find_node_by_phandle(be32_to_cpup(parp));
+               phyid = be32_to_cpup(parp+1);
+@@ -1822,10 +1816,6 @@ static int cpsw_probe_dt(struct cpsw_pla
+       }
+       return 0;
+-
+-error_ret:
+-      kfree(data->slave_data);
+-      return ret;
+ }
+ static int cpsw_probe_dual_emac(struct platform_device *pdev,
+@@ -1867,7 +1857,6 @@ static int cpsw_probe_dual_emac(struct p
+       priv_sl2->coal_intvl = 0;
+       priv_sl2->bus_freq_mhz = priv->bus_freq_mhz;
+-      priv_sl2->cpsw_res = priv->cpsw_res;
+       priv_sl2->regs = priv->regs;
+       priv_sl2->host_port = priv->host_port;
+       priv_sl2->host_port_regs = priv->host_port_regs;
+@@ -1911,8 +1900,8 @@ static int cpsw_probe(struct platform_de
+       struct cpsw_priv                *priv;
+       struct cpdma_params             dma_params;
+       struct cpsw_ale_params          ale_params;
+-      void __iomem                    *ss_regs, *wr_regs;
+-      struct resource                 *res;
++      void __iomem                    *ss_regs;
++      struct resource                 *res, *ss_res;
+       u32 slave_offset, sliver_offset, slave_size;
+       int ret = 0, i, k = 0;
+@@ -1948,7 +1937,7 @@ static int cpsw_probe(struct platform_de
+       if (cpsw_probe_dt(&priv->data, pdev)) {
+               pr_err("cpsw: platform data missing\n");
+               ret = -ENODEV;
+-              goto clean_ndev_ret;
++              goto clean_runtime_disable_ret;
+       }
+       data = &priv->data;
+@@ -1962,11 +1951,12 @@ static int cpsw_probe(struct platform_de
+       memcpy(ndev->dev_addr, priv->mac_addr, ETH_ALEN);
+-      priv->slaves = kzalloc(sizeof(struct cpsw_slave) * data->slaves,
+-                             GFP_KERNEL);
++      priv->slaves = devm_kzalloc(&pdev->dev,
++                                  sizeof(struct cpsw_slave) * data->slaves,
++                                  GFP_KERNEL);
+       if (!priv->slaves) {
+-              ret = -EBUSY;
+-              goto clean_ndev_ret;
++              ret = -ENOMEM;
++              goto clean_runtime_disable_ret;
+       }
+       for (i = 0; i < data->slaves; i++)
+               priv->slaves[i].slave_num = i;
+@@ -1974,55 +1964,31 @@ static int cpsw_probe(struct platform_de
+       priv->slaves[0].ndev = ndev;
+       priv->emac_port = 0;
+-      priv->clk = clk_get(&pdev->dev, "fck");
++      priv->clk = devm_clk_get(&pdev->dev, "fck");
+       if (IS_ERR(priv->clk)) {
+-              dev_err(&pdev->dev, "fck is not found\n");
++              dev_err(priv->dev, "fck is not found\n");
+               ret = -ENODEV;
+-              goto clean_slave_ret;
++              goto clean_runtime_disable_ret;
+       }
+       priv->coal_intvl = 0;
+       priv->bus_freq_mhz = clk_get_rate(priv->clk) / 1000000;
+-      priv->cpsw_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+-      if (!priv->cpsw_res) {
+-              dev_err(priv->dev, "error getting i/o resource\n");
+-              ret = -ENOENT;
+-              goto clean_clk_ret;
+-      }
+-      if (!request_mem_region(priv->cpsw_res->start,
+-                              resource_size(priv->cpsw_res), ndev->name)) {
+-              dev_err(priv->dev, "failed request i/o region\n");
+-              ret = -ENXIO;
+-              goto clean_clk_ret;
+-      }
+-      ss_regs = ioremap(priv->cpsw_res->start, resource_size(priv->cpsw_res));
+-      if (!ss_regs) {
+-              dev_err(priv->dev, "unable to map i/o region\n");
+-              goto clean_cpsw_iores_ret;
++      ss_res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      ss_regs = devm_ioremap_resource(&pdev->dev, ss_res);
++      if (IS_ERR(ss_regs)) {
++              ret = PTR_ERR(ss_regs);
++              goto clean_runtime_disable_ret;
+       }
+       priv->regs = ss_regs;
+       priv->version = __raw_readl(&priv->regs->id_ver);
+       priv->host_port = HOST_PORT_NUM;
+-      priv->cpsw_wr_res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+-      if (!priv->cpsw_wr_res) {
+-              dev_err(priv->dev, "error getting i/o resource\n");
+-              ret = -ENOENT;
+-              goto clean_iomap_ret;
+-      }
+-      if (!request_mem_region(priv->cpsw_wr_res->start,
+-                      resource_size(priv->cpsw_wr_res), ndev->name)) {
+-              dev_err(priv->dev, "failed request i/o region\n");
+-              ret = -ENXIO;
+-              goto clean_iomap_ret;
+-      }
+-      wr_regs = ioremap(priv->cpsw_wr_res->start,
+-                              resource_size(priv->cpsw_wr_res));
+-      if (!wr_regs) {
+-              dev_err(priv->dev, "unable to map i/o region\n");
+-              goto clean_cpsw_wr_iores_ret;
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
++      priv->wr_regs = devm_ioremap_resource(&pdev->dev, res);
++      if (IS_ERR(priv->wr_regs)) {
++              ret = PTR_ERR(priv->wr_regs);
++              goto clean_runtime_disable_ret;
+       }
+-      priv->wr_regs = wr_regs;
+       memset(&dma_params, 0, sizeof(dma_params));
+       memset(&ale_params, 0, sizeof(ale_params));
+@@ -2053,12 +2019,12 @@ static int cpsw_probe(struct platform_de
+               slave_size           = CPSW2_SLAVE_SIZE;
+               sliver_offset        = CPSW2_SLIVER_OFFSET;
+               dma_params.desc_mem_phys =
+-                      (u32 __force) priv->cpsw_res->start + CPSW2_BD_OFFSET;
++                      (u32 __force) ss_res->start + CPSW2_BD_OFFSET;
+               break;
+       default:
+               dev_err(priv->dev, "unknown version 0x%08x\n", priv->version);
+               ret = -ENODEV;
+-              goto clean_cpsw_wr_iores_ret;
++              goto clean_runtime_disable_ret;
+       }
+       for (i = 0; i < priv->data.slaves; i++) {
+               struct cpsw_slave *slave = &priv->slaves[i];
+@@ -2086,7 +2052,7 @@ static int cpsw_probe(struct platform_de
+       if (!priv->dma) {
+               dev_err(priv->dev, "error initializing dma\n");
+               ret = -ENOMEM;
+-              goto clean_wr_iomap_ret;
++              goto clean_runtime_disable_ret;
+       }
+       priv->txch = cpdma_chan_create(priv->dma, tx_chan_num(0),
+@@ -2121,8 +2087,8 @@ static int cpsw_probe(struct platform_de
+       while ((res = platform_get_resource(priv->pdev, IORESOURCE_IRQ, k))) {
+               for (i = res->start; i <= res->end; i++) {
+-                      if (request_irq(i, cpsw_interrupt, 0,
+-                                      dev_name(&pdev->dev), priv)) {
++                      if (devm_request_irq(&pdev->dev, i, cpsw_interrupt, 0,
++                                           dev_name(priv->dev), priv)) {
+                               dev_err(priv->dev, "error attaching irq\n");
+                               goto clean_ale_ret;
+                       }
+@@ -2144,7 +2110,7 @@ static int cpsw_probe(struct platform_de
+       if (ret) {
+               dev_err(priv->dev, "error registering net device\n");
+               ret = -ENODEV;
+-              goto clean_irq_ret;
++              goto clean_ale_ret;
+       }
+       if (cpts_register(&pdev->dev, priv->cpts,
+@@ -2152,44 +2118,27 @@ static int cpsw_probe(struct platform_de
+               dev_err(priv->dev, "error registering cpts device\n");
+       cpsw_notice(priv, probe, "initialized device (regs %x, irq %d)\n",
+-                priv->cpsw_res->start, ndev->irq);
++                  ss_res->start, ndev->irq);
+       if (priv->data.dual_emac) {
+               ret = cpsw_probe_dual_emac(pdev, priv);
+               if (ret) {
+                       cpsw_err(priv, probe, "error probe slave 2 emac interface\n");
+-                      goto clean_irq_ret;
++                      goto clean_ale_ret;
+               }
+       }
+       return 0;
+-clean_irq_ret:
+-      for (i = 0; i < priv->num_irqs; i++)
+-              free_irq(priv->irqs_table[i], priv);
+ clean_ale_ret:
+       cpsw_ale_destroy(priv->ale);
+ clean_dma_ret:
+       cpdma_chan_destroy(priv->txch);
+       cpdma_chan_destroy(priv->rxch);
+       cpdma_ctlr_destroy(priv->dma);
+-clean_wr_iomap_ret:
+-      iounmap(priv->wr_regs);
+-clean_cpsw_wr_iores_ret:
+-      release_mem_region(priv->cpsw_wr_res->start,
+-                         resource_size(priv->cpsw_wr_res));
+-clean_iomap_ret:
+-      iounmap(priv->regs);
+-clean_cpsw_iores_ret:
+-      release_mem_region(priv->cpsw_res->start,
+-                         resource_size(priv->cpsw_res));
+-clean_clk_ret:
+-      clk_put(priv->clk);
+-clean_slave_ret:
++clean_runtime_disable_ret:
+       pm_runtime_disable(&pdev->dev);
+-      kfree(priv->slaves);
+ clean_ndev_ret:
+-      kfree(priv->data.slave_data);
+       free_netdev(priv->ndev);
+       return ret;
+ }
+@@ -2198,30 +2147,18 @@ static int cpsw_remove(struct platform_d
+ {
+       struct net_device *ndev = platform_get_drvdata(pdev);
+       struct cpsw_priv *priv = netdev_priv(ndev);
+-      int i;
+       if (priv->data.dual_emac)
+               unregister_netdev(cpsw_get_slave_ndev(priv, 1));
+       unregister_netdev(ndev);
+       cpts_unregister(priv->cpts);
+-      for (i = 0; i < priv->num_irqs; i++)
+-              free_irq(priv->irqs_table[i], priv);
+       cpsw_ale_destroy(priv->ale);
+       cpdma_chan_destroy(priv->txch);
+       cpdma_chan_destroy(priv->rxch);
+       cpdma_ctlr_destroy(priv->dma);
+-      iounmap(priv->regs);
+-      release_mem_region(priv->cpsw_res->start,
+-                         resource_size(priv->cpsw_res));
+-      iounmap(priv->wr_regs);
+-      release_mem_region(priv->cpsw_wr_res->start,
+-                         resource_size(priv->cpsw_wr_res));
+       pm_runtime_disable(&pdev->dev);
+-      clk_put(priv->clk);
+-      kfree(priv->slaves);
+-      kfree(priv->data.slave_data);
+       if (priv->data.dual_emac)
+               free_netdev(cpsw_get_slave_ndev(priv, 1));
+       free_netdev(ndev);
+--- a/drivers/net/ethernet/ti/cpsw.h
++++ b/drivers/net/ethernet/ti/cpsw.h
+@@ -39,4 +39,6 @@ struct cpsw_platform_data {
+       bool    dual_emac;      /* Enable Dual EMAC mode */
+ };
++void cpsw_phy_sel(struct device *dev, phy_interface_t phy_mode, int slave);
++
+ #endif /* __CPSW_H__ */
+--- /dev/null
++++ b/drivers/net/ethernet/ti/cpsw-phy-sel.c
+@@ -0,0 +1,161 @@
++/* Texas Instruments Ethernet Switch Driver
++ *
++ * Copyright (C) 2013 Texas Instruments
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++
++#include <linux/platform_device.h>
++#include <linux/module.h>
++#include <linux/netdevice.h>
++#include <linux/phy.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
++
++#include "cpsw.h"
++
++/* AM33xx SoC specific definitions for the CONTROL port */
++#define AM33XX_GMII_SEL_MODE_MII      0
++#define AM33XX_GMII_SEL_MODE_RMII     1
++#define AM33XX_GMII_SEL_MODE_RGMII    2
++
++#define AM33XX_GMII_SEL_RMII2_IO_CLK_EN       BIT(7)
++#define AM33XX_GMII_SEL_RMII1_IO_CLK_EN       BIT(6)
++
++struct cpsw_phy_sel_priv {
++      struct device   *dev;
++      u32 __iomem     *gmii_sel;
++      bool            rmii_clock_external;
++      void (*cpsw_phy_sel)(struct cpsw_phy_sel_priv *priv,
++                           phy_interface_t phy_mode, int slave);
++};
++
++
++static void cpsw_gmii_sel_am3352(struct cpsw_phy_sel_priv *priv,
++                               phy_interface_t phy_mode, int slave)
++{
++      u32 reg;
++      u32 mask;
++      u32 mode = 0;
++
++      reg = readl(priv->gmii_sel);
++
++      switch (phy_mode) {
++      case PHY_INTERFACE_MODE_RMII:
++              mode = AM33XX_GMII_SEL_MODE_RMII;
++              break;
++
++      case PHY_INTERFACE_MODE_RGMII:
++      case PHY_INTERFACE_MODE_RGMII_ID:
++      case PHY_INTERFACE_MODE_RGMII_RXID:
++      case PHY_INTERFACE_MODE_RGMII_TXID:
++              mode = AM33XX_GMII_SEL_MODE_RGMII;
++              break;
++
++      case PHY_INTERFACE_MODE_MII:
++      default:
++              mode = AM33XX_GMII_SEL_MODE_MII;
++              break;
++      };
++
++      mask = 0x3 << (slave * 2) | BIT(slave + 6);
++      mode <<= slave * 2;
++
++      if (priv->rmii_clock_external) {
++              if (slave == 0)
++                      mode |= AM33XX_GMII_SEL_RMII1_IO_CLK_EN;
++              else
++                      mode |= AM33XX_GMII_SEL_RMII2_IO_CLK_EN;
++      }
++
++      reg &= ~mask;
++      reg |= mode;
++
++      writel(reg, priv->gmii_sel);
++}
++
++static struct platform_driver cpsw_phy_sel_driver;
++static int match(struct device *dev, void *data)
++{
++      struct device_node *node = (struct device_node *)data;
++      return dev->of_node == node &&
++              dev->driver == &cpsw_phy_sel_driver.driver;
++}
++
++void cpsw_phy_sel(struct device *dev, phy_interface_t phy_mode, int slave)
++{
++      struct device_node *node;
++      struct cpsw_phy_sel_priv *priv;
++
++      node = of_get_child_by_name(dev->of_node, "cpsw-phy-sel");
++      if (!node) {
++              dev_err(dev, "Phy mode driver DT not found\n");
++              return;
++      }
++
++      dev = bus_find_device(&platform_bus_type, NULL, node, match);
++      priv = dev_get_drvdata(dev);
++
++      priv->cpsw_phy_sel(priv, phy_mode, slave);
++}
++EXPORT_SYMBOL_GPL(cpsw_phy_sel);
++
++static const struct of_device_id cpsw_phy_sel_id_table[] = {
++      {
++              .compatible     = "ti,am3352-cpsw-phy-sel",
++              .data           = &cpsw_gmii_sel_am3352,
++      },
++      {}
++};
++MODULE_DEVICE_TABLE(of, cpsw_phy_sel_id_table);
++
++static int cpsw_phy_sel_probe(struct platform_device *pdev)
++{
++      struct resource *res;
++      const struct of_device_id *of_id;
++      struct cpsw_phy_sel_priv *priv;
++
++      of_id = of_match_node(cpsw_phy_sel_id_table, pdev->dev.of_node);
++      if (!of_id)
++              return -EINVAL;
++
++      priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
++      if (!priv) {
++              dev_err(&pdev->dev, "unable to alloc memory for cpsw phy sel\n");
++              return -ENOMEM;
++      }
++
++      priv->cpsw_phy_sel = of_id->data;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "gmii-sel");
++      priv->gmii_sel = devm_ioremap_resource(&pdev->dev, res);
++      if (IS_ERR(priv->gmii_sel))
++              return PTR_ERR(priv->gmii_sel);
++
++      if (of_find_property(pdev->dev.of_node, "rmii-clock-ext", NULL))
++              priv->rmii_clock_external = true;
++
++      dev_set_drvdata(&pdev->dev, priv);
++
++      return 0;
++}
++
++static struct platform_driver cpsw_phy_sel_driver = {
++      .probe          = cpsw_phy_sel_probe,
++      .driver         = {
++              .name   = "cpsw-phy-sel",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(cpsw_phy_sel_id_table),
++      },
++};
++
++module_platform_driver(cpsw_phy_sel_driver);
++MODULE_AUTHOR("Mugunthan V N <mugunthanvnm@ti.com>");
++MODULE_LICENSE("GPL v2");
+--- a/drivers/net/ethernet/ti/Kconfig
++++ b/drivers/net/ethernet/ti/Kconfig
+@@ -49,11 +49,19 @@ config TI_DAVINCI_CPDMA
+         To compile this driver as a module, choose M here: the module
+         will be called davinci_cpdma.  This is recommended.
++config TI_CPSW_PHY_SEL
++      boolean "TI CPSW Switch Phy sel Support"
++      depends on TI_CPSW
++      ---help---
++        This driver supports configuring of the phy mode connected to
++        the CPSW.
++
+ config TI_CPSW
+       tristate "TI CPSW Switch Support"
+       depends on ARM && (ARCH_DAVINCI || SOC_AM33XX)
+       select TI_DAVINCI_CPDMA
+       select TI_DAVINCI_MDIO
++      select TI_CPSW_PHY_SEL
+       ---help---
+         This driver supports TI's CPSW Ethernet Switch.
+--- a/drivers/net/ethernet/ti/Makefile
++++ b/drivers/net/ethernet/ti/Makefile
+@@ -7,5 +7,6 @@ obj-$(CONFIG_CPMAC) += cpmac.o
+ obj-$(CONFIG_TI_DAVINCI_EMAC) += davinci_emac.o
+ obj-$(CONFIG_TI_DAVINCI_MDIO) += davinci_mdio.o
+ obj-$(CONFIG_TI_DAVINCI_CPDMA) += davinci_cpdma.o
++obj-$(CONFIG_TI_CPSW_PHY_SEL) += cpsw-phy-sel.o
+ obj-$(CONFIG_TI_CPSW) += ti_cpsw.o
+ ti_cpsw-y := cpsw_ale.o cpsw.o cpts.o
+--- a/drivers/net/usb/smsc95xx.c
++++ b/drivers/net/usb/smsc95xx.c
+@@ -31,6 +31,9 @@
+ #include <linux/crc32.h>
+ #include <linux/usb/usbnet.h>
+ #include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_net.h>
++
+ #include "smsc95xx.h"
+ #define SMSC_CHIPNAME                 "smsc95xx"
+@@ -62,6 +65,8 @@
+ #define SUSPEND_ALLMODES              (SUSPEND_SUSPEND0 | SUSPEND_SUSPEND1 | \
+                                        SUSPEND_SUSPEND2 | SUSPEND_SUSPEND3)
++#define SMSC95XX_OF_NAME      "/smsc95xx@"
++
+ struct smsc95xx_priv {
+       u32 mac_cr;
+       u32 hash_hi;
+@@ -767,6 +772,10 @@ static int smsc95xx_ioctl(struct net_dev
+ static void smsc95xx_init_mac_address(struct usbnet *dev)
+ {
++      struct device_node *ap = NULL;
++      const char *mac = NULL;
++      char *of_name = SMSC95XX_OF_NAME;
++
+       /* try reading mac address from EEPROM */
+       if (smsc95xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
+                       dev->net->dev_addr) == 0) {
+@@ -777,6 +786,20 @@ static void smsc95xx_init_mac_address(st
+               }
+       }
++#ifdef CONFIG_OF
++      sprintf(of_name, "%s%i", SMSC95XX_OF_NAME, dev->udev->dev.id);
++      ap = of_find_node_by_path(of_name);
++      if (ap) {
++              mac = of_get_mac_address(ap);
++              if ((mac != NULL) && (is_valid_ether_addr(mac))) {
++                      /* Device tree has a mac for this so use that */
++                      memcpy(dev->net->dev_addr, mac, ETH_ALEN);
++                      netif_dbg(dev, ifup, dev->net, "MAC address read from DTB\n");
++                      return;
++              }
++      }
++#endif
++
+       /* no eeprom, or eeprom values are invalid. generate random MAC */
+       eth_hw_addr_random(dev->net);
+       netif_dbg(dev, ifup, dev->net, "MAC address set to eth_random_addr\n");
+--- /dev/null
++++ b/drivers/phy/Kconfig
+@@ -0,0 +1,63 @@
++#
++# PHY
++#
++
++menu "PHY Subsystem"
++
++config GENERIC_PHY
++      tristate "PHY Core"
++      help
++        Generic PHY support.
++
++        This framework is designed to provide a generic interface for PHY
++        devices present in the kernel. This layer will have the generic
++        API by which phy drivers can create PHY using the phy framework and
++        phy users can obtain reference to the PHY. All the users of this
++        framework should select this config.
++
++config OMAP_CONTROL_PHY
++      tristate "OMAP CONTROL PHY Driver"
++      help
++        Enable this to add support for the PHY part present in the control
++        module. This driver has API to power on the USB2 PHY and to write to
++        the mailbox. The mailbox is present only in omap4 and the register to
++        power on the USB2 PHY is present in OMAP4 and OMAP5. OMAP5 has an
++        additional register to power on USB3 PHY/SATA PHY/PCIE PHY
++        (PIPE3 PHY).
++
++config OMAP_USB2
++      tristate "OMAP USB2 PHY Driver"
++      depends on ARCH_OMAP2PLUS
++      depends on USB_SUPPORT
++      select GENERIC_PHY
++      select USB_PHY
++      select OMAP_CONTROL_PHY
++      help
++        Enable this to support the transceiver that is part of SOC. This
++        driver takes care of all the PHY functionality apart from comparator.
++        The USB OTG controller communicates with the comparator using this
++        driver.
++
++config OMAP_PIPE3
++      tristate "OMAP PIPE3 PHY Driver"
++      select GENERIC_PHY
++      select OMAP_CONTROL_PHY
++      help
++        Enable this to support the PIPE3 PHY that is part of SOC. This
++        driver takes care of all the PHY functionality apart from comparator.
++        This driver interacts with the "OMAP Control PHY Driver" to power
++        on/off the PHY.
++
++config TWL4030_USB
++      tristate "TWL4030 USB Transceiver Driver"
++      depends on TWL4030_CORE && REGULATOR_TWL4030 && USB_MUSB_OMAP2PLUS
++      depends on USB_SUPPORT
++      select GENERIC_PHY
++      select USB_PHY
++      help
++        Enable this to support the USB OTG transceiver on TWL4030
++        family chips (including the TWL5030 and TPS659x0 devices).
++        This transceiver supports high and full speed devices plus,
++        in host mode, low speed.
++
++endmenu
+--- /dev/null
++++ b/drivers/phy/Makefile
+@@ -0,0 +1,9 @@
++#
++# Makefile for the phy drivers.
++#
++
++obj-$(CONFIG_GENERIC_PHY)     += phy-core.o
++obj-$(CONFIG_OMAP_CONTROL_PHY)        += phy-omap-control.o
++obj-$(CONFIG_OMAP_USB2)               += phy-omap-usb2.o
++obj-$(CONFIG_OMAP_PIPE3)      += phy-omap-pipe3.o
++obj-$(CONFIG_TWL4030_USB)     += phy-twl4030-usb.o
+--- /dev/null
++++ b/drivers/phy/phy-core.c
+@@ -0,0 +1,698 @@
++/*
++ * phy-core.c  --  Generic Phy framework.
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/export.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/device.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/phy/phy.h>
++#include <linux/idr.h>
++#include <linux/pm_runtime.h>
++
++static struct class *phy_class;
++static DEFINE_MUTEX(phy_provider_mutex);
++static LIST_HEAD(phy_provider_list);
++static DEFINE_IDA(phy_ida);
++
++static void devm_phy_release(struct device *dev, void *res)
++{
++      struct phy *phy = *(struct phy **)res;
++
++      phy_put(phy);
++}
++
++static void devm_phy_provider_release(struct device *dev, void *res)
++{
++      struct phy_provider *phy_provider = *(struct phy_provider **)res;
++
++      of_phy_provider_unregister(phy_provider);
++}
++
++static void devm_phy_consume(struct device *dev, void *res)
++{
++      struct phy *phy = *(struct phy **)res;
++
++      phy_destroy(phy);
++}
++
++static int devm_phy_match(struct device *dev, void *res, void *match_data)
++{
++      return res == match_data;
++}
++
++static struct phy *phy_lookup(struct device *device, const char *port)
++{
++      unsigned int count;
++      struct phy *phy;
++      struct device *dev;
++      struct phy_consumer *consumers;
++      struct class_dev_iter iter;
++
++      class_dev_iter_init(&iter, phy_class, NULL, NULL);
++      while ((dev = class_dev_iter_next(&iter))) {
++              phy = to_phy(dev);
++              count = phy->init_data->num_consumers;
++              consumers = phy->init_data->consumers;
++              while (count--) {
++                      if (!strcmp(consumers->dev_name, dev_name(device)) &&
++                                      !strcmp(consumers->port, port)) {
++                              class_dev_iter_exit(&iter);
++                              return phy;
++                      }
++                      consumers++;
++              }
++      }
++
++      class_dev_iter_exit(&iter);
++      return ERR_PTR(-ENODEV);
++}
++
++static struct phy_provider *of_phy_provider_lookup(struct device_node *node)
++{
++      struct phy_provider *phy_provider;
++
++      list_for_each_entry(phy_provider, &phy_provider_list, list) {
++              if (phy_provider->dev->of_node == node)
++                      return phy_provider;
++      }
++
++      return ERR_PTR(-EPROBE_DEFER);
++}
++
++int phy_pm_runtime_get(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return -ENOTSUPP;
++
++      return pm_runtime_get(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_get);
++
++int phy_pm_runtime_get_sync(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return -ENOTSUPP;
++
++      return pm_runtime_get_sync(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_get_sync);
++
++int phy_pm_runtime_put(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return -ENOTSUPP;
++
++      return pm_runtime_put(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_put);
++
++int phy_pm_runtime_put_sync(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return -ENOTSUPP;
++
++      return pm_runtime_put_sync(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_put_sync);
++
++void phy_pm_runtime_allow(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return;
++
++      pm_runtime_allow(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_allow);
++
++void phy_pm_runtime_forbid(struct phy *phy)
++{
++      if (!pm_runtime_enabled(&phy->dev))
++              return;
++
++      pm_runtime_forbid(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_pm_runtime_forbid);
++
++int phy_init(struct phy *phy)
++{
++      int ret;
++
++      ret = phy_pm_runtime_get_sync(phy);
++      if (ret < 0 && ret != -ENOTSUPP)
++              return ret;
++
++      mutex_lock(&phy->mutex);
++      if (phy->init_count++ == 0 && phy->ops->init) {
++              ret = phy->ops->init(phy);
++              if (ret < 0) {
++                      dev_err(&phy->dev, "phy init failed --> %d\n", ret);
++                      goto out;
++              }
++      }
++
++out:
++      mutex_unlock(&phy->mutex);
++      phy_pm_runtime_put(phy);
++      return ret;
++}
++EXPORT_SYMBOL_GPL(phy_init);
++
++int phy_exit(struct phy *phy)
++{
++      int ret;
++
++      ret = phy_pm_runtime_get_sync(phy);
++      if (ret < 0 && ret != -ENOTSUPP)
++              return ret;
++
++      mutex_lock(&phy->mutex);
++      if (--phy->init_count == 0 && phy->ops->exit) {
++              ret = phy->ops->exit(phy);
++              if (ret < 0) {
++                      dev_err(&phy->dev, "phy exit failed --> %d\n", ret);
++                      goto out;
++              }
++      }
++
++out:
++      mutex_unlock(&phy->mutex);
++      phy_pm_runtime_put(phy);
++      return ret;
++}
++EXPORT_SYMBOL_GPL(phy_exit);
++
++int phy_power_on(struct phy *phy)
++{
++      int ret = -ENOTSUPP;
++
++      ret = phy_pm_runtime_get_sync(phy);
++      if (ret < 0 && ret != -ENOTSUPP)
++              return ret;
++
++      mutex_lock(&phy->mutex);
++      if (phy->power_count++ == 0 && phy->ops->power_on) {
++              ret = phy->ops->power_on(phy);
++              if (ret < 0) {
++                      dev_err(&phy->dev, "phy poweron failed --> %d\n", ret);
++                      goto out;
++              }
++      }
++
++out:
++      mutex_unlock(&phy->mutex);
++
++      return ret;
++}
++EXPORT_SYMBOL_GPL(phy_power_on);
++
++int phy_power_off(struct phy *phy)
++{
++      int ret = -ENOTSUPP;
++
++      mutex_lock(&phy->mutex);
++      if (--phy->power_count == 0 && phy->ops->power_off) {
++              ret =  phy->ops->power_off(phy);
++              if (ret < 0) {
++                      dev_err(&phy->dev, "phy poweroff failed --> %d\n", ret);
++                      goto out;
++              }
++      }
++
++out:
++      mutex_unlock(&phy->mutex);
++      phy_pm_runtime_put(phy);
++
++      return ret;
++}
++EXPORT_SYMBOL_GPL(phy_power_off);
++
++/**
++ * of_phy_get() - lookup and obtain a reference to a phy by phandle
++ * @dev: device that requests this phy
++ * @index: the index of the phy
++ *
++ * Returns the phy associated with the given phandle value,
++ * after getting a refcount to it or -ENODEV if there is no such phy or
++ * -EPROBE_DEFER if there is a phandle to the phy, but the device is
++ * not yet loaded. This function uses of_xlate call back function provided
++ * while registering the phy_provider to find the phy instance.
++ */
++static struct phy *of_phy_get(struct device *dev, int index)
++{
++      int ret;
++      struct phy_provider *phy_provider;
++      struct phy *phy = NULL;
++      struct of_phandle_args args;
++
++      ret = of_parse_phandle_with_args(dev->of_node, "phys", "#phy-cells",
++              index, &args);
++      if (ret) {
++              dev_dbg(dev, "failed to get phy in %s node\n",
++                      dev->of_node->full_name);
++              return ERR_PTR(-ENODEV);
++      }
++
++      mutex_lock(&phy_provider_mutex);
++      phy_provider = of_phy_provider_lookup(args.np);
++      if (IS_ERR(phy_provider) || !try_module_get(phy_provider->owner)) {
++              phy = ERR_PTR(-EPROBE_DEFER);
++              goto err0;
++      }
++
++      phy = phy_provider->of_xlate(phy_provider->dev, &args);
++      module_put(phy_provider->owner);
++
++err0:
++      mutex_unlock(&phy_provider_mutex);
++      of_node_put(args.np);
++
++      return phy;
++}
++
++/**
++ * phy_put() - release the PHY
++ * @phy: the phy returned by phy_get()
++ *
++ * Releases a refcount the caller received from phy_get().
++ */
++void phy_put(struct phy *phy)
++{
++      if (IS_ERR(phy))
++              return;
++
++      module_put(phy->ops->owner);
++      put_device(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_put);
++
++/**
++ * devm_phy_put() - release the PHY
++ * @dev: device that wants to release this phy
++ * @phy: the phy returned by devm_phy_get()
++ *
++ * destroys the devres associated with this phy and invokes phy_put
++ * to release the phy.
++ */
++void devm_phy_put(struct device *dev, struct phy *phy)
++{
++      int r;
++
++      r = devres_destroy(dev, devm_phy_release, devm_phy_match, phy);
++      dev_WARN_ONCE(dev, r, "couldn't find PHY resource\n");
++}
++EXPORT_SYMBOL_GPL(devm_phy_put);
++
++/**
++ * of_phy_simple_xlate() - returns the phy instance from phy provider
++ * @dev: the PHY provider device
++ * @args: of_phandle_args (not used here)
++ *
++ * Intended to be used by phy provider for the common case where #phy-cells is
++ * 0. For other cases where #phy-cells is greater than '0', the phy provider
++ * should provide a custom of_xlate function that reads the *args* and returns
++ * the appropriate phy.
++ */
++struct phy *of_phy_simple_xlate(struct device *dev, struct of_phandle_args
++      *args)
++{
++      struct phy *phy;
++      struct class_dev_iter iter;
++      struct device_node *node = dev->of_node;
++
++      class_dev_iter_init(&iter, phy_class, NULL, NULL);
++      while ((dev = class_dev_iter_next(&iter))) {
++              phy = to_phy(dev);
++              if (node != phy->dev.of_node)
++                      continue;
++
++              class_dev_iter_exit(&iter);
++              return phy;
++      }
++
++      class_dev_iter_exit(&iter);
++      return ERR_PTR(-ENODEV);
++}
++EXPORT_SYMBOL_GPL(of_phy_simple_xlate);
++
++/**
++ * phy_get() - lookup and obtain a reference to a phy.
++ * @dev: device that requests this phy
++ * @string: the phy name as given in the dt data or the name of the controller
++ * port for non-dt case
++ *
++ * Returns the phy driver, after getting a refcount to it; or
++ * -ENODEV if there is no such phy.  The caller is responsible for
++ * calling phy_put() to release that count.
++ */
++struct phy *phy_get(struct device *dev, const char *string)
++{
++      int index = 0;
++      struct phy *phy = NULL;
++
++      if (string == NULL) {
++              dev_WARN(dev, "missing string\n");
++              return ERR_PTR(-EINVAL);
++      }
++
++      if (dev->of_node) {
++              index = of_property_match_string(dev->of_node, "phy-names",
++                      string);
++              phy = of_phy_get(dev, index);
++              if (IS_ERR(phy)) {
++                      dev_err(dev, "unable to find phy\n");
++                      return phy;
++              }
++      } else {
++              phy = phy_lookup(dev, string);
++              if (IS_ERR(phy)) {
++                      dev_err(dev, "unable to find phy\n");
++                      return phy;
++              }
++      }
++
++      if (!try_module_get(phy->ops->owner))
++              return ERR_PTR(-EPROBE_DEFER);
++
++      get_device(&phy->dev);
++
++      return phy;
++}
++EXPORT_SYMBOL_GPL(phy_get);
++
++/**
++ * devm_phy_get() - lookup and obtain a reference to a phy.
++ * @dev: device that requests this phy
++ * @string: the phy name as given in the dt data or phy device name
++ * for non-dt case
++ *
++ * Gets the phy using phy_get(), and associates a device with it using
++ * devres. On driver detach, release function is invoked on the devres data,
++ * then, devres data is freed.
++ */
++struct phy *devm_phy_get(struct device *dev, const char *string)
++{
++      struct phy **ptr, *phy;
++
++      ptr = devres_alloc(devm_phy_release, sizeof(*ptr), GFP_KERNEL);
++      if (!ptr)
++              return ERR_PTR(-ENOMEM);
++
++      phy = phy_get(dev, string);
++      if (!IS_ERR(phy)) {
++              *ptr = phy;
++              devres_add(dev, ptr);
++      } else {
++              devres_free(ptr);
++      }
++
++      return phy;
++}
++EXPORT_SYMBOL_GPL(devm_phy_get);
++
++/**
++ * phy_create() - create a new phy
++ * @dev: device that is creating the new phy
++ * @ops: function pointers for performing phy operations
++ * @init_data: contains the list of PHY consumers or NULL
++ *
++ * Called to create a phy using phy framework.
++ */
++struct phy *phy_create(struct device *dev, const struct phy_ops *ops,
++      struct phy_init_data *init_data)
++{
++      int ret;
++      int id;
++      struct phy *phy;
++
++      if (!dev) {
++              dev_WARN(dev, "no device provided for PHY\n");
++              ret = -EINVAL;
++              goto err0;
++      }
++
++      phy = kzalloc(sizeof(*phy), GFP_KERNEL);
++      if (!phy) {
++              ret = -ENOMEM;
++              goto err0;
++      }
++
++      id = ida_simple_get(&phy_ida, 0, 0, GFP_KERNEL);
++      if (id < 0) {
++              dev_err(dev, "unable to get id\n");
++              ret = id;
++              goto err0;
++      }
++
++      device_initialize(&phy->dev);
++      mutex_init(&phy->mutex);
++
++      phy->dev.class = phy_class;
++      phy->dev.parent = dev;
++      phy->dev.of_node = dev->of_node;
++      phy->id = id;
++      phy->ops = ops;
++      phy->init_data = init_data;
++
++      ret = dev_set_name(&phy->dev, "phy-%s.%d", dev_name(dev), id);
++      if (ret)
++              goto err1;
++
++      ret = device_add(&phy->dev);
++      if (ret)
++              goto err1;
++
++      if (pm_runtime_enabled(dev)) {
++              pm_runtime_enable(&phy->dev);
++              pm_runtime_no_callbacks(&phy->dev);
++      }
++
++      return phy;
++
++err1:
++      ida_remove(&phy_ida, phy->id);
++      put_device(&phy->dev);
++      kfree(phy);
++
++err0:
++      return ERR_PTR(ret);
++}
++EXPORT_SYMBOL_GPL(phy_create);
++
++/**
++ * devm_phy_create() - create a new phy
++ * @dev: device that is creating the new phy
++ * @ops: function pointers for performing phy operations
++ * @init_data: contains the list of PHY consumers or NULL
++ *
++ * Creates a new PHY device adding it to the PHY class.
++ * While at that, it also associates the device with the phy using devres.
++ * On driver detach, release function is invoked on the devres data,
++ * then, devres data is freed.
++ */
++struct phy *devm_phy_create(struct device *dev, const struct phy_ops *ops,
++      struct phy_init_data *init_data)
++{
++      struct phy **ptr, *phy;
++
++      ptr = devres_alloc(devm_phy_consume, sizeof(*ptr), GFP_KERNEL);
++      if (!ptr)
++              return ERR_PTR(-ENOMEM);
++
++      phy = phy_create(dev, ops, init_data);
++      if (!IS_ERR(phy)) {
++              *ptr = phy;
++              devres_add(dev, ptr);
++      } else {
++              devres_free(ptr);
++      }
++
++      return phy;
++}
++EXPORT_SYMBOL_GPL(devm_phy_create);
++
++/**
++ * phy_destroy() - destroy the phy
++ * @phy: the phy to be destroyed
++ *
++ * Called to destroy the phy.
++ */
++void phy_destroy(struct phy *phy)
++{
++      pm_runtime_disable(&phy->dev);
++      device_unregister(&phy->dev);
++}
++EXPORT_SYMBOL_GPL(phy_destroy);
++
++/**
++ * devm_phy_destroy() - destroy the PHY
++ * @dev: device that wants to release this phy
++ * @phy: the phy returned by devm_phy_get()
++ *
++ * destroys the devres associated with this phy and invokes phy_destroy
++ * to destroy the phy.
++ */
++void devm_phy_destroy(struct device *dev, struct phy *phy)
++{
++      int r;
++
++      r = devres_destroy(dev, devm_phy_consume, devm_phy_match, phy);
++      dev_WARN_ONCE(dev, r, "couldn't find PHY resource\n");
++}
++EXPORT_SYMBOL_GPL(devm_phy_destroy);
++
++/**
++ * __of_phy_provider_register() - create/register phy provider with the framework
++ * @dev: struct device of the phy provider
++ * @owner: the module owner containing of_xlate
++ * @of_xlate: function pointer to obtain phy instance from phy provider
++ *
++ * Creates struct phy_provider from dev and of_xlate function pointer.
++ * This is used in the case of dt boot for finding the phy instance from
++ * phy provider.
++ */
++struct phy_provider *__of_phy_provider_register(struct device *dev,
++      struct module *owner, struct phy * (*of_xlate)(struct device *dev,
++      struct of_phandle_args *args))
++{
++      struct phy_provider *phy_provider;
++
++      phy_provider = kzalloc(sizeof(*phy_provider), GFP_KERNEL);
++      if (!phy_provider)
++              return ERR_PTR(-ENOMEM);
++
++      phy_provider->dev = dev;
++      phy_provider->owner = owner;
++      phy_provider->of_xlate = of_xlate;
++
++      mutex_lock(&phy_provider_mutex);
++      list_add_tail(&phy_provider->list, &phy_provider_list);
++      mutex_unlock(&phy_provider_mutex);
++
++      return phy_provider;
++}
++EXPORT_SYMBOL_GPL(__of_phy_provider_register);
++
++/**
++ * __devm_of_phy_provider_register() - create/register phy provider with the
++ * framework
++ * @dev: struct device of the phy provider
++ * @owner: the module owner containing of_xlate
++ * @of_xlate: function pointer to obtain phy instance from phy provider
++ *
++ * Creates struct phy_provider from dev and of_xlate function pointer.
++ * This is used in the case of dt boot for finding the phy instance from
++ * phy provider. While at that, it also associates the device with the
++ * phy provider using devres. On driver detach, release function is invoked
++ * on the devres data, then, devres data is freed.
++ */
++struct phy_provider *__devm_of_phy_provider_register(struct device *dev,
++      struct module *owner, struct phy * (*of_xlate)(struct device *dev,
++      struct of_phandle_args *args))
++{
++      struct phy_provider **ptr, *phy_provider;
++
++      ptr = devres_alloc(devm_phy_provider_release, sizeof(*ptr), GFP_KERNEL);
++      if (!ptr)
++              return ERR_PTR(-ENOMEM);
++
++      phy_provider = __of_phy_provider_register(dev, owner, of_xlate);
++      if (!IS_ERR(phy_provider)) {
++              *ptr = phy_provider;
++              devres_add(dev, ptr);
++      } else {
++              devres_free(ptr);
++      }
++
++      return phy_provider;
++}
++EXPORT_SYMBOL_GPL(__devm_of_phy_provider_register);
++
++/**
++ * of_phy_provider_unregister() - unregister phy provider from the framework
++ * @phy_provider: phy provider returned by of_phy_provider_register()
++ *
++ * Removes the phy_provider created using of_phy_provider_register().
++ */
++void of_phy_provider_unregister(struct phy_provider *phy_provider)
++{
++      if (IS_ERR(phy_provider))
++              return;
++
++      mutex_lock(&phy_provider_mutex);
++      list_del(&phy_provider->list);
++      kfree(phy_provider);
++      mutex_unlock(&phy_provider_mutex);
++}
++EXPORT_SYMBOL_GPL(of_phy_provider_unregister);
++
++/**
++ * devm_of_phy_provider_unregister() - remove phy provider from the framework
++ * @dev: struct device of the phy provider
++ *
++ * destroys the devres associated with this phy provider and invokes
++ * of_phy_provider_unregister to unregister the phy provider.
++ */
++void devm_of_phy_provider_unregister(struct device *dev,
++      struct phy_provider *phy_provider) {
++      int r;
++
++      r = devres_destroy(dev, devm_phy_provider_release, devm_phy_match,
++              phy_provider);
++      dev_WARN_ONCE(dev, r, "couldn't find PHY provider device resource\n");
++}
++EXPORT_SYMBOL_GPL(devm_of_phy_provider_unregister);
++
++/**
++ * phy_release() - release the phy
++ * @dev: the dev member within phy
++ *
++ * When the last reference to the device is removed, it is called
++ * from the embedded kobject as release method.
++ */
++static void phy_release(struct device *dev)
++{
++      struct phy *phy;
++
++      phy = to_phy(dev);
++      dev_vdbg(dev, "releasing '%s'\n", dev_name(dev));
++      ida_remove(&phy_ida, phy->id);
++      kfree(phy);
++}
++
++static int __init phy_core_init(void)
++{
++      phy_class = class_create(THIS_MODULE, "phy");
++      if (IS_ERR(phy_class)) {
++              pr_err("failed to create phy class --> %ld\n",
++                      PTR_ERR(phy_class));
++              return PTR_ERR(phy_class);
++      }
++
++      phy_class->dev_release = phy_release;
++
++      return 0;
++}
++module_init(phy_core_init);
++
++static void __exit phy_core_exit(void)
++{
++      class_destroy(phy_class);
++}
++module_exit(phy_core_exit);
++
++MODULE_DESCRIPTION("Generic PHY Framework");
++MODULE_AUTHOR("Kishon Vijay Abraham I <kishon@ti.com>");
++MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/phy/phy-omap-control.c
+@@ -0,0 +1,319 @@
++/*
++ * omap-control-phy.c - The PHY part of control module.
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_device.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/clk.h>
++#include <linux/phy/omap_control_phy.h>
++
++/**
++ * omap_control_phy_power - power on/off the phy using control module reg
++ * @dev: the control module device
++ * @on: 0 or 1, based on powering on or off the PHY
++ */
++void omap_control_phy_power(struct device *dev, int on)
++{
++      u32 val;
++      unsigned long rate;
++      struct omap_control_phy *control_phy;
++
++      if (IS_ERR(dev) || !dev) {
++              pr_err("%s: invalid device\n", __func__);
++              return;
++      }
++
++      control_phy = dev_get_drvdata(dev);
++      if (!control_phy) {
++              dev_err(dev, "%s: invalid control phy device\n", __func__);
++              return;
++      }
++
++      if (control_phy->type == OMAP_CTRL_TYPE_OTGHS)
++              return;
++
++      val = readl(control_phy->power);
++
++      switch (control_phy->type) {
++      case OMAP_CTRL_TYPE_USB2:
++              if (on)
++                      val &= ~OMAP_CTRL_DEV_PHY_PD;
++              else
++                      val |= OMAP_CTRL_DEV_PHY_PD;
++              break;
++
++      case OMAP_CTRL_TYPE_PIPE3:
++              rate = clk_get_rate(control_phy->sys_clk);
++              rate = rate/1000000;
++
++              if (on) {
++                      val &= ~(OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_MASK |
++                              OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_MASK);
++                      val |= OMAP_CTRL_PIPE3_PHY_TX_RX_POWERON <<
++                              OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT;
++                      val |= rate <<
++                              OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_SHIFT;
++              } else {
++                      val &= ~OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_MASK;
++                      val |= OMAP_CTRL_PIPE3_PHY_TX_RX_POWEROFF <<
++                              OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT;
++              }
++              break;
++
++      case OMAP_CTRL_TYPE_DRA7USB2:
++              if (on)
++                      val &= ~OMAP_CTRL_USB2_PHY_PD;
++              else
++                      val |= OMAP_CTRL_USB2_PHY_PD;
++              break;
++
++      case OMAP_CTRL_TYPE_AM437USB2:
++              if (on) {
++                      val &= ~(AM437X_CTRL_USB2_PHY_PD |
++                                      AM437X_CTRL_USB2_OTG_PD);
++                      val |= (AM437X_CTRL_USB2_OTGVDET_EN |
++                                      AM437X_CTRL_USB2_OTGSESSEND_EN);
++              } else {
++                      val &= ~(AM437X_CTRL_USB2_OTGVDET_EN |
++                                      AM437X_CTRL_USB2_OTGSESSEND_EN);
++                      val |= (AM437X_CTRL_USB2_PHY_PD |
++                                       AM437X_CTRL_USB2_OTG_PD);
++              }
++              break;
++      default:
++              dev_err(dev, "%s: type %d not recognized\n",
++                                      __func__, control_phy->type);
++              break;
++      }
++
++      writel(val, control_phy->power);
++}
++EXPORT_SYMBOL_GPL(omap_control_phy_power);
++
++/**
++ * omap_control_usb_host_mode - set AVALID, VBUSVALID and ID pin in grounded
++ * @ctrl_phy: struct omap_control_phy *
++ *
++ * Writes to the mailbox register to notify the usb core that a usb
++ * device has been connected.
++ */
++static void omap_control_usb_host_mode(struct omap_control_phy *ctrl_phy)
++{
++      u32 val;
++
++      val = readl(ctrl_phy->otghs_control);
++      val &= ~(OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND);
++      val |= OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID;
++      writel(val, ctrl_phy->otghs_control);
++}
++
++/**
++ * omap_control_usb_device_mode - set AVALID, VBUSVALID and ID pin in high
++ * impedance
++ * @ctrl_phy: struct omap_control_phy *
++ *
++ * Writes to the mailbox register to notify the usb core that it has been
++ * connected to a usb host.
++ */
++static void omap_control_usb_device_mode(struct omap_control_phy *ctrl_phy)
++{
++      u32 val;
++
++      val = readl(ctrl_phy->otghs_control);
++      val &= ~OMAP_CTRL_DEV_SESSEND;
++      val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_AVALID |
++              OMAP_CTRL_DEV_VBUSVALID;
++      writel(val, ctrl_phy->otghs_control);
++}
++
++/**
++ * omap_control_usb_set_sessionend - Enable SESSIONEND and IDIG to high
++ * impedance
++ * @ctrl_phy: struct omap_control_phy *
++ *
++ * Writes to the mailbox register to notify the usb core it's now in
++ * disconnected state.
++ */
++static void omap_control_usb_set_sessionend(struct omap_control_phy *ctrl_phy)
++{
++      u32 val;
++
++      val = readl(ctrl_phy->otghs_control);
++      val &= ~(OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID);
++      val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND;
++      writel(val, ctrl_phy->otghs_control);
++}
++
++/**
++ * omap_control_usb_set_mode - Calls to functions to set USB in one of host mode
++ * or device mode or to denote disconnected state
++ * @dev: the control module device
++ * @mode: The mode to which usb should be configured
++ *
++ * This is an API to write to the mailbox register to notify the usb core that
++ * a usb device has been connected.
++ */
++void omap_control_usb_set_mode(struct device *dev,
++      enum omap_control_usb_mode mode)
++{
++      struct omap_control_phy *ctrl_phy;
++
++      if (IS_ERR(dev) || !dev)
++              return;
++
++      ctrl_phy = dev_get_drvdata(dev);
++
++      if (!ctrl_phy) {
++              dev_err(dev, "Invalid control phy device\n");
++              return;
++      }
++
++      if (ctrl_phy->type != OMAP_CTRL_TYPE_OTGHS)
++              return;
++
++      switch (mode) {
++      case USB_MODE_HOST:
++              omap_control_usb_host_mode(ctrl_phy);
++              break;
++      case USB_MODE_DEVICE:
++              omap_control_usb_device_mode(ctrl_phy);
++              break;
++      case USB_MODE_DISCONNECT:
++              omap_control_usb_set_sessionend(ctrl_phy);
++              break;
++      default:
++              dev_vdbg(dev, "invalid omap control usb mode\n");
++      }
++}
++EXPORT_SYMBOL_GPL(omap_control_usb_set_mode);
++
++#ifdef CONFIG_OF
++
++static const enum omap_control_phy_type otghs_data = OMAP_CTRL_TYPE_OTGHS;
++static const enum omap_control_phy_type usb2_data = OMAP_CTRL_TYPE_USB2;
++static const enum omap_control_phy_type pipe3_data = OMAP_CTRL_TYPE_PIPE3;
++static const enum omap_control_phy_type dra7usb2_data = OMAP_CTRL_TYPE_DRA7USB2;
++static const enum omap_control_phy_type am437usb2_data = OMAP_CTRL_TYPE_AM437USB2;
++
++static const struct of_device_id omap_control_phy_id_table[] = {
++      {
++              .compatible = "ti,control-phy-otghs",
++              .data = &otghs_data,
++      },
++      {
++              .compatible = "ti,control-phy-usb2",
++              .data = &usb2_data,
++      },
++      {
++              .compatible = "ti,control-phy-pipe3",
++              .data = &pipe3_data,
++      },
++      {
++              .compatible = "ti,control-phy-dra7usb2",
++              .data = &dra7usb2_data,
++      },
++      {
++              .compatible = "ti,control-phy-am437usb2",
++              .data = &am437usb2_data,
++      },
++      {},
++};
++MODULE_DEVICE_TABLE(of, omap_control_phy_id_table);
++#endif
++
++static int omap_control_phy_probe(struct platform_device *pdev)
++{
++      struct resource *res;
++      const struct of_device_id *of_id;
++      struct omap_control_phy *control_phy;
++
++      of_id = of_match_device(of_match_ptr(omap_control_phy_id_table),
++                                                              &pdev->dev);
++      if (!of_id)
++              return -EINVAL;
++
++      control_phy = devm_kzalloc(&pdev->dev, sizeof(*control_phy),
++              GFP_KERNEL);
++      if (!control_phy) {
++              dev_err(&pdev->dev, "unable to alloc memory for control phy\n");
++              return -ENOMEM;
++      }
++
++      control_phy->dev = &pdev->dev;
++      control_phy->type = *(enum omap_control_phy_type *)of_id->data;
++
++      if (control_phy->type == OMAP_CTRL_TYPE_OTGHS) {
++              res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
++                      "otghs_control");
++              control_phy->otghs_control = devm_ioremap_resource(
++                      &pdev->dev, res);
++              if (IS_ERR(control_phy->otghs_control))
++                      return PTR_ERR(control_phy->otghs_control);
++      } else {
++              res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
++                              "power");
++              control_phy->power = devm_ioremap_resource(&pdev->dev, res);
++              if (IS_ERR(control_phy->power)) {
++                      dev_err(&pdev->dev, "Couldn't get power register\n");
++                      return PTR_ERR(control_phy->power);
++              }
++      }
++
++      if (control_phy->type == OMAP_CTRL_TYPE_PIPE3) {
++              control_phy->sys_clk = devm_clk_get(control_phy->dev,
++                      "sys_clkin");
++              if (IS_ERR(control_phy->sys_clk)) {
++                      pr_err("%s: unable to get sys_clkin\n", __func__);
++                      return -EINVAL;
++              }
++      }
++
++      dev_set_drvdata(control_phy->dev, control_phy);
++
++      return 0;
++}
++
++static struct platform_driver omap_control_phy_driver = {
++      .probe          = omap_control_phy_probe,
++      .driver         = {
++              .name   = "omap-control-phy",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(omap_control_phy_id_table),
++      },
++};
++
++static int __init omap_control_phy_init(void)
++{
++      return platform_driver_register(&omap_control_phy_driver);
++}
++subsys_initcall(omap_control_phy_init);
++
++static void __exit omap_control_phy_exit(void)
++{
++      platform_driver_unregister(&omap_control_phy_driver);
++}
++module_exit(omap_control_phy_exit);
++
++MODULE_ALIAS("platform: omap_control_phy");
++MODULE_AUTHOR("Texas Instruments Inc.");
++MODULE_DESCRIPTION("OMAP Control Module PHY Driver");
++MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/phy/phy-omap-pipe3.c
+@@ -0,0 +1,430 @@
++/*
++ * omap-pipe3 - PHY driver for SATA, USB and PCIE in OMAP platforms
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++#include <linux/phy/omap_pipe3.h>
++#include <linux/phy/phy.h>
++#include <linux/of.h>
++#include <linux/clk.h>
++#include <linux/err.h>
++#include <linux/pm_runtime.h>
++#include <linux/delay.h>
++#include <linux/phy/omap_control_phy.h>
++#include <linux/of_platform.h>
++
++#define       PLL_STATUS              0x00000004
++#define       PLL_GO                  0x00000008
++#define       PLL_CONFIGURATION1      0x0000000C
++#define       PLL_CONFIGURATION2      0x00000010
++#define       PLL_CONFIGURATION3      0x00000014
++#define       PLL_CONFIGURATION4      0x00000020
++
++#define       PLL_REGM_MASK           0x001FFE00
++#define       PLL_REGM_SHIFT          9
++#define       PLL_REGM_F_MASK         0x0003FFFF
++#define       PLL_REGM_F_SHIFT        0
++#define       PLL_REGN_MASK           0x000001FE
++#define       PLL_REGN_SHIFT          1
++#define       PLL_SELFREQDCO_MASK     0x0000000E
++#define       PLL_SELFREQDCO_SHIFT    1
++#define       PLL_SD_MASK             0x0003FC00
++#define       PLL_SD_SHIFT            10
++#define       SET_PLL_GO              0x1
++#define       PLL_TICOPWDN            0x10000
++#define       PLL_LOCK                0x2
++#define       PLL_IDLE                0x1
++
++/*
++ * This is an Empirical value that works, need to confirm the actual
++ * value required for the PIPE3PHY_PLL_CONFIGURATION2.PLL_IDLE status
++ * to be correctly reflected in the PIPE3PHY_PLL_STATUS register.
++ */
++# define PLL_IDLE_TIME  100;
++
++static struct pipe3_dpll_map dpll_map_usb[] = {
++      {12000000, {1250, 5, 4, 20, 0} },       /* 12 MHz */
++      {16800000, {3125, 20, 4, 20, 0} },      /* 16.8 MHz */
++      {19200000, {1172, 8, 4, 20, 65537} },   /* 19.2 MHz */
++      {20000000, {1000, 7, 4, 10, 0} },       /* 20 MHz */
++      {26000000, {1250, 12, 4, 20, 0} },      /* 26 MHz */
++      {38400000, {3125, 47, 4, 20, 92843} },  /* 38.4 MHz */
++      { },                                    /* Terminator */
++};
++
++static struct pipe3_dpll_map dpll_map_sata[] = {
++      {12000000, {1000, 7, 4, 6, 0} },        /* 12 MHz */
++      {16800000, {714, 7, 4, 6, 0} },         /* 16.8 MHz */
++      {19200000, {625, 7, 4, 6, 0} },         /* 19.2 MHz */
++      {20000000, {600, 7, 4, 6, 0} },         /* 20 MHz */
++      {26000000, {461, 7, 4, 6, 0} },         /* 26 MHz */
++      {38400000, {312, 7, 4, 6, 0} },         /* 38.4 MHz */
++      { },                                    /* Terminator */
++};
++
++static struct pipe3_dpll_params *omap_pipe3_get_dpll_params(struct omap_pipe3
++                                                                      *pipe3)
++{
++      unsigned long rate;
++      struct pipe3_dpll_map *dpll_map = pipe3->dpll_map;
++
++      rate = clk_get_rate(pipe3->sys_clk);
++
++      for (; dpll_map->rate; dpll_map++) {
++              if (rate == dpll_map->rate)
++                      return &dpll_map->params;
++      }
++
++      dev_err(pipe3->dev,
++                "No DPLL configuration for %lu Hz SYS CLK\n", rate);
++      return 0;
++}
++
++static int omap_pipe3_power_off(struct phy *x)
++{
++      struct omap_pipe3 *phy = phy_get_drvdata(x);
++      int val;
++      int timeout = PLL_IDLE_TIME;
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
++      val |= PLL_IDLE;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
++
++      do {
++              val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
++              if (val & PLL_TICOPWDN)
++                      break;
++              udelay(1);
++      } while (--timeout);
++
++      omap_control_phy_power(phy->control_dev, 0);
++
++      return 0;
++}
++
++static int omap_pipe3_power_on(struct phy *x)
++{
++      struct omap_pipe3 *phy = phy_get_drvdata(x);
++      int val;
++      int timeout = PLL_IDLE_TIME;
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
++      val &= ~PLL_IDLE;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
++
++      do {
++              val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
++              if (!(val & PLL_TICOPWDN))
++                      break;
++              udelay(1);
++      } while (--timeout);
++
++      msleep(100);
++
++      return 0;
++}
++
++static void omap_pipe3_dpll_relock(struct omap_pipe3 *phy)
++{
++      u32             val;
++      unsigned long   timeout;
++
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_GO, SET_PLL_GO);
++
++      timeout = jiffies + msecs_to_jiffies(20);
++      do {
++              val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_STATUS);
++              if (val & PLL_LOCK)
++                      break;
++      } while (!WARN_ON(time_after(jiffies, timeout)));
++}
++
++static int omap_pipe3_dpll_lock(struct omap_pipe3 *phy)
++{
++      u32                     val;
++      unsigned long           rate;
++      struct pipe3_dpll_params *dpll_params;
++
++      rate = clk_get_rate(phy->sys_clk);
++      dpll_params = omap_pipe3_get_dpll_params(phy);
++      if (!dpll_params) {
++              return -EINVAL;
++      }
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
++      val &= ~PLL_REGN_MASK;
++      val |= dpll_params->n << PLL_REGN_SHIFT;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
++      val &= ~PLL_SELFREQDCO_MASK;
++      val |= dpll_params->freq << PLL_SELFREQDCO_SHIFT;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
++      val &= ~PLL_REGM_MASK;
++      val |= dpll_params->m << PLL_REGM_SHIFT;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION4);
++      val &= ~PLL_REGM_F_MASK;
++      val |= dpll_params->mf << PLL_REGM_F_SHIFT;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION4, val);
++
++      val = omap_pipe3_readl(phy->pll_ctrl_base, PLL_CONFIGURATION3);
++      val &= ~PLL_SD_MASK;
++      val |= dpll_params->sd << PLL_SD_SHIFT;
++      omap_pipe3_writel(phy->pll_ctrl_base, PLL_CONFIGURATION3, val);
++
++      omap_pipe3_dpll_relock(phy);
++
++      return 0;
++}
++
++static int omap_pipe3_init(struct phy *x)
++{
++      struct omap_pipe3 *phy = phy_get_drvdata(x);
++      int ret;
++
++      ret = omap_pipe3_dpll_lock(phy);
++      if (ret)
++              return ret;
++
++      omap_control_phy_power(phy->control_dev, 1);
++
++      return 0;
++}
++
++static struct phy_ops ops = {
++      .init           = omap_pipe3_init,
++      .power_on       = omap_pipe3_power_on,
++      .power_off      = omap_pipe3_power_off,
++      .owner          = THIS_MODULE,
++};
++
++#ifdef CONFIG_OF
++static const struct of_device_id omap_pipe3_id_table[] = {
++      {
++              .compatible = "ti,phy-pipe3-usb3",
++              .data = dpll_map_usb,
++      },
++      {
++              .compatible = "ti,phy-pipe3-sata",
++              .data = dpll_map_sata,
++      },
++      {},
++};
++MODULE_DEVICE_TABLE(of, omap_pipe3_id_table);
++#endif
++
++static int omap_pipe3_probe(struct platform_device *pdev)
++{
++      struct omap_pipe3 *phy;
++      struct phy *generic_phy;
++      struct phy_provider *phy_provider;
++      struct resource *res;
++      struct device_node *node = pdev->dev.of_node;
++      struct device_node *control_node;
++      struct platform_device *control_pdev;
++      const struct of_device_id *match;
++
++      match = of_match_device(of_match_ptr(omap_pipe3_id_table), &pdev->dev);
++      if (!match)
++              return -EINVAL;
++
++      phy = devm_kzalloc(&pdev->dev, sizeof(*phy), GFP_KERNEL);
++      if (!phy) {
++              dev_err(&pdev->dev, "unable to alloc mem for OMAP PIPE3 PHY\n");
++              return -ENOMEM;
++      }
++
++      phy->dpll_map = (struct pipe3_dpll_map *)match->data;
++      if (!phy->dpll_map) {
++              dev_err(&pdev->dev, "no dpll data\n");
++              return -EINVAL;
++      }
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pll_ctrl");
++      phy->pll_ctrl_base = devm_ioremap_resource(&pdev->dev, res);
++      if (IS_ERR(phy->pll_ctrl_base))
++              return PTR_ERR(phy->pll_ctrl_base);
++
++      phy->dev                = &pdev->dev;
++
++      phy->wkupclk = devm_clk_get(phy->dev, "wkupclk");
++      if (IS_ERR(phy->wkupclk))
++              dev_dbg(&pdev->dev, "unable to get wkupclk\n");
++      else
++              clk_prepare(phy->wkupclk);
++
++      phy->optclk = devm_clk_get(phy->dev, "refclk");
++      if (IS_ERR(phy->optclk))
++              dev_dbg(&pdev->dev, "unable to get refclk\n");
++      else
++              clk_prepare(phy->optclk);
++
++      phy->optclk2 = devm_clk_get(phy->dev, "refclk2");
++      if (IS_ERR(phy->optclk2))
++              dev_dbg(&pdev->dev, "unable to get refclk2\n");
++      else
++              clk_prepare(phy->optclk2);
++
++      phy->sys_clk = devm_clk_get(phy->dev, "sys_clkin");
++      if (IS_ERR(phy->sys_clk)) {
++              pr_err("%s: unable to get sys_clkin\n", __func__);
++              return -EINVAL;
++      }
++
++      control_node = of_parse_phandle(node, "ctrl-module", 0);
++      if (!control_node) {
++              dev_err(&pdev->dev, "Failed to get control device phandle\n");
++              return -EINVAL;
++      }
++
++      phy_provider = devm_of_phy_provider_register(phy->dev,
++                      of_phy_simple_xlate);
++      if (IS_ERR(phy_provider))
++              return PTR_ERR(phy_provider);
++
++      control_pdev = of_find_device_by_node(control_node);
++      if (!control_pdev) {
++              dev_err(&pdev->dev, "Failed to get control device\n");
++              return -EINVAL;
++      }
++
++      phy->control_dev = &control_pdev->dev;
++
++      omap_control_phy_power(phy->control_dev, 0);
++
++      platform_set_drvdata(pdev, phy);
++      pm_runtime_enable(phy->dev);
++
++      generic_phy = devm_phy_create(phy->dev, &ops, NULL);
++      if (IS_ERR(generic_phy))
++              return PTR_ERR(generic_phy);
++
++      phy_set_drvdata(generic_phy, phy);
++
++      pm_runtime_get(&pdev->dev);
++
++      return 0;
++}
++
++static int omap_pipe3_remove(struct platform_device *pdev)
++{
++      struct omap_pipe3 *phy = platform_get_drvdata(pdev);
++
++      if (!IS_ERR(phy->wkupclk))
++              clk_unprepare(phy->wkupclk);
++      if (!IS_ERR(phy->optclk))
++              clk_unprepare(phy->optclk);
++      if (!IS_ERR(phy->optclk2))
++              clk_unprepare(phy->optclk2);
++      if (!pm_runtime_suspended(&pdev->dev))
++              pm_runtime_put(&pdev->dev);
++      pm_runtime_disable(&pdev->dev);
++
++      return 0;
++}
++
++#ifdef CONFIG_PM_RUNTIME
++
++static int omap_pipe3_runtime_suspend(struct device *dev)
++{
++      struct omap_pipe3       *phy = dev_get_drvdata(dev);
++
++      if (!IS_ERR(phy->wkupclk))
++              clk_disable(phy->wkupclk);
++      if (!IS_ERR(phy->optclk))
++              clk_disable(phy->optclk);
++      if (!IS_ERR(phy->optclk2))
++              clk_disable(phy->optclk2);
++
++      return 0;
++}
++
++static int omap_pipe3_runtime_resume(struct device *dev)
++{
++      u32 ret = 0;
++      struct omap_pipe3       *phy = dev_get_drvdata(dev);
++
++      if (!IS_ERR(phy->optclk)) {
++              ret = clk_enable(phy->optclk);
++              if (ret) {
++                      dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
++                      goto err1;
++              }
++      }
++
++      if (!IS_ERR(phy->wkupclk)) {
++              ret = clk_enable(phy->wkupclk);
++              if (ret) {
++                      dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
++                      goto err2;
++              }
++      }
++
++      if (!IS_ERR(phy->optclk2)) {
++              ret = clk_enable(phy->optclk2);
++              if (ret) {
++                      dev_err(phy->dev, "Failed to enable optclk2 %d\n", ret);
++                      goto err3;
++              }
++      }
++
++      return 0;
++
++err3:
++      if (!IS_ERR(phy->wkupclk))
++              clk_disable(phy->wkupclk);
++err2:
++      if (!IS_ERR(phy->optclk))
++              clk_disable(phy->optclk);
++
++err1:
++      return ret;
++}
++
++static const struct dev_pm_ops omap_pipe3_pm_ops = {
++      SET_RUNTIME_PM_OPS(omap_pipe3_runtime_suspend,
++              omap_pipe3_runtime_resume, NULL)
++};
++
++#define DEV_PM_OPS     (&omap_pipe3_pm_ops)
++#else
++#define DEV_PM_OPS     NULL
++#endif
++
++static struct platform_driver omap_pipe3_driver = {
++      .probe          = omap_pipe3_probe,
++      .remove         = omap_pipe3_remove,
++      .driver         = {
++              .name   = "omap-pipe3",
++              .owner  = THIS_MODULE,
++              .pm     = DEV_PM_OPS,
++              .of_match_table = of_match_ptr(omap_pipe3_id_table),
++      },
++};
++
++module_platform_driver(omap_pipe3_driver);
++
++MODULE_ALIAS("platform: omap_pipe3");
++MODULE_AUTHOR("Texas Instruments Inc.");
++MODULE_DESCRIPTION("OMAP PIPE3 phy driver");
++MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/phy/phy-omap-usb2.c
+@@ -0,0 +1,326 @@
++/*
++ * omap-usb2.c - USB PHY, talking to musb controller in OMAP.
++ *
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/io.h>
++#include <linux/phy/omap_usb.h>
++#include <linux/usb/phy_companion.h>
++#include <linux/clk.h>
++#include <linux/err.h>
++#include <linux/pm_runtime.h>
++#include <linux/delay.h>
++#include <linux/phy/omap_control_phy.h>
++#include <linux/phy/phy.h>
++#include <linux/of_platform.h>
++#include <linux/phy/phy.h>
++#include <linux/of_platform.h>
++
++/**
++ * omap_usb2_set_comparator - links the comparator present in the sytem with
++ *    this phy
++ * @comparator - the companion phy(comparator) for this phy
++ *
++ * The phy companion driver should call this API passing the phy_companion
++ * filled with set_vbus and start_srp to be used by usb phy.
++ *
++ * For use by phy companion driver
++ */
++int omap_usb2_set_comparator(struct phy_companion *comparator)
++{
++      struct omap_usb *phy;
++      struct usb_phy  *x = usb_get_phy(USB_PHY_TYPE_USB2);
++
++      if (IS_ERR(x))
++              return -ENODEV;
++
++      phy = phy_to_omapusb(x);
++      phy->comparator = comparator;
++      return 0;
++}
++EXPORT_SYMBOL_GPL(omap_usb2_set_comparator);
++
++static int omap_usb_set_vbus(struct usb_otg *otg, bool enabled)
++{
++      struct omap_usb *phy = phy_to_omapusb(otg->phy);
++
++      if (!phy->comparator)
++              return -ENODEV;
++
++      return phy->comparator->set_vbus(phy->comparator, enabled);
++}
++
++static int omap_usb_start_srp(struct usb_otg *otg)
++{
++      struct omap_usb *phy = phy_to_omapusb(otg->phy);
++
++      if (!phy->comparator)
++              return -ENODEV;
++
++      return phy->comparator->start_srp(phy->comparator);
++}
++
++static int omap_usb_set_host(struct usb_otg *otg, struct usb_bus *host)
++{
++      struct usb_phy  *phy = otg->phy;
++
++      otg->host = host;
++      if (!host)
++              phy->state = OTG_STATE_UNDEFINED;
++
++      return 0;
++}
++
++static int omap_usb_set_peripheral(struct usb_otg *otg,
++              struct usb_gadget *gadget)
++{
++      struct usb_phy  *phy = otg->phy;
++
++      otg->gadget = gadget;
++      if (!gadget)
++              phy->state = OTG_STATE_UNDEFINED;
++
++      return 0;
++}
++
++static int omap_usb_power_off(struct phy *x)
++{
++      struct omap_usb *phy = phy_get_drvdata(x);
++
++      omap_control_phy_power(phy->control_dev, 0);
++
++      return 0;
++}
++
++static int omap_usb_power_on(struct phy *x)
++{
++      struct omap_usb *phy = phy_get_drvdata(x);
++
++      omap_control_phy_power(phy->control_dev, 1);
++
++      return 0;
++}
++
++static struct phy_ops ops = {
++      .power_on       = omap_usb_power_on,
++      .power_off      = omap_usb_power_off,
++      .owner          = THIS_MODULE,
++};
++
++#ifdef CONFIG_OF
++static const struct usb_phy_data omap_usb2_data = {
++      .label = "omap_usb2",
++      .flags = OMAP_USB2_HAS_START_SRP | OMAP_USB2_HAS_SET_VBUS,
++};
++
++static const struct usb_phy_data am437x_usb2_data = {
++      .label = "am437x_usb2",
++      .flags =  0,
++};
++
++static const struct of_device_id omap_usb2_id_table[] = {
++      {
++              .compatible = "ti,omap-usb2",
++              .data = &omap_usb2_data,
++      },
++      {
++              .compatible = "ti,am437x-usb2",
++              .data = &am437x_usb2_data,
++      },
++      {},
++};
++MODULE_DEVICE_TABLE(of, omap_usb2_id_table);
++#endif
++
++static int omap_usb2_probe(struct platform_device *pdev)
++{
++      struct omap_usb *phy;
++      struct usb_otg *otg;
++      struct device_node *node = pdev->dev.of_node;
++      struct device_node *control_node;
++      struct platform_device *control_pdev;
++      struct phy *generic_phy;
++      struct phy_provider *phy_provider;
++      const struct of_device_id *of_id;
++      struct usb_phy_data *phy_data;
++
++      of_id = of_match_device(of_match_ptr(omap_usb2_id_table), &pdev->dev);
++
++      if (!of_id)
++              return -EINVAL;
++      phy_data = (struct usb_phy_data *)of_id->data;
++
++      phy = devm_kzalloc(&pdev->dev, sizeof(*phy), GFP_KERNEL);
++      if (!phy) {
++              dev_err(&pdev->dev, "unable to allocate memory for USB2 PHY\n");
++              return -ENOMEM;
++      }
++
++      otg = devm_kzalloc(&pdev->dev, sizeof(*otg), GFP_KERNEL);
++      if (!otg) {
++              dev_err(&pdev->dev, "unable to allocate memory for USB OTG\n");
++              return -ENOMEM;
++      }
++
++      phy->dev                = &pdev->dev;
++
++      phy->phy.dev            = phy->dev;
++      phy->phy.label          = phy_data->label;
++      phy->phy.otg            = otg;
++      phy->phy.type           = USB_PHY_TYPE_USB2;
++
++      phy_provider = devm_of_phy_provider_register(phy->dev,
++                      of_phy_simple_xlate);
++      if (IS_ERR(phy_provider))
++              return PTR_ERR(phy_provider);
++
++      control_node = of_parse_phandle(node, "ctrl-module", 0);
++      if (!control_node) {
++              dev_err(&pdev->dev, "Failed to get control device phandle\n");
++              return -EINVAL;
++      }
++
++      control_pdev = of_find_device_by_node(control_node);
++      if (!control_pdev) {
++              dev_err(&pdev->dev, "Failed to get control device\n");
++              return -EINVAL;
++      }
++
++      phy->control_dev = &control_pdev->dev;
++
++      omap_control_phy_power(phy->control_dev, 0);
++
++      otg->set_host           = omap_usb_set_host;
++      otg->set_peripheral     = omap_usb_set_peripheral;
++      if (phy_data->flags & OMAP_USB2_HAS_SET_VBUS)
++              otg->set_vbus           = omap_usb_set_vbus;
++      if (phy_data->flags & OMAP_USB2_HAS_START_SRP)
++              otg->start_srp          = omap_usb_start_srp;
++      otg->phy                = &phy->phy;
++
++      platform_set_drvdata(pdev, phy);
++      pm_runtime_enable(phy->dev);
++
++      generic_phy = devm_phy_create(phy->dev, &ops, NULL);
++      if (IS_ERR(generic_phy))
++              return PTR_ERR(generic_phy);
++
++      phy_set_drvdata(generic_phy, phy);
++
++      phy->wkupclk = devm_clk_get(phy->dev, "wkupclk");
++      if (IS_ERR(phy->wkupclk)) {
++              dev_err(&pdev->dev, "unable to get wkupclk\n");
++              return PTR_ERR(phy->wkupclk);
++      }
++      clk_prepare(phy->wkupclk);
++
++      phy->optclk = devm_clk_get(phy->dev, "refclk");
++      if (IS_ERR(phy->optclk))
++              dev_dbg(&pdev->dev, "unable to get refclk\n");
++      else
++              clk_prepare(phy->optclk);
++
++      usb_add_phy_dev(&phy->phy);
++
++      return 0;
++}
++
++static int omap_usb2_remove(struct platform_device *pdev)
++{
++      struct omap_usb *phy = platform_get_drvdata(pdev);
++
++      clk_unprepare(phy->wkupclk);
++      if (!IS_ERR(phy->optclk))
++              clk_unprepare(phy->optclk);
++      usb_remove_phy(&phy->phy);
++
++      return 0;
++}
++
++#ifdef CONFIG_PM_RUNTIME
++
++static int omap_usb2_runtime_suspend(struct device *dev)
++{
++      struct platform_device  *pdev = to_platform_device(dev);
++      struct omap_usb *phy = platform_get_drvdata(pdev);
++
++      clk_disable(phy->wkupclk);
++      if (!IS_ERR(phy->optclk))
++              clk_disable(phy->optclk);
++
++      return 0;
++}
++
++static int omap_usb2_runtime_resume(struct device *dev)
++{
++      struct platform_device  *pdev = to_platform_device(dev);
++      struct omap_usb *phy = platform_get_drvdata(pdev);
++      int ret;
++
++      ret = clk_enable(phy->wkupclk);
++      if (ret < 0) {
++              dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
++              goto err0;
++      }
++
++      if (!IS_ERR(phy->optclk)) {
++              ret = clk_enable(phy->optclk);
++              if (ret < 0) {
++                      dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
++                      goto err1;
++              }
++      }
++
++      return 0;
++
++err1:
++      clk_disable(phy->wkupclk);
++
++err0:
++      return ret;
++}
++
++static const struct dev_pm_ops omap_usb2_pm_ops = {
++      SET_RUNTIME_PM_OPS(omap_usb2_runtime_suspend, omap_usb2_runtime_resume,
++              NULL)
++};
++
++#define DEV_PM_OPS     (&omap_usb2_pm_ops)
++#else
++#define DEV_PM_OPS     NULL
++#endif
++
++static struct platform_driver omap_usb2_driver = {
++      .probe          = omap_usb2_probe,
++      .remove         = omap_usb2_remove,
++      .driver         = {
++              .name   = "omap-usb2",
++              .owner  = THIS_MODULE,
++              .pm     = DEV_PM_OPS,
++              .of_match_table = of_match_ptr(omap_usb2_id_table),
++      },
++};
++
++module_platform_driver(omap_usb2_driver);
++
++MODULE_ALIAS("platform: omap_usb2");
++MODULE_AUTHOR("Texas Instruments Inc.");
++MODULE_DESCRIPTION("OMAP USB2 phy driver");
++MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/phy/phy-twl4030-usb.c
+@@ -0,0 +1,815 @@
++/*
++ * twl4030_usb - TWL4030 USB transceiver, talking to OMAP OTG controller
++ *
++ * Copyright (C) 2004-2007 Texas Instruments
++ * Copyright (C) 2008 Nokia Corporation
++ * Contact: Felipe Balbi <felipe.balbi@nokia.com>
++ *
++ * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
++ *
++ * Current status:
++ *    - HS USB ULPI mode works.
++ *    - 3-pin mode support may be added in future.
++ */
++
++#include <linux/module.h>
++#include <linux/init.h>
++#include <linux/interrupt.h>
++#include <linux/platform_device.h>
++#include <linux/spinlock.h>
++#include <linux/workqueue.h>
++#include <linux/io.h>
++#include <linux/delay.h>
++#include <linux/usb/otg.h>
++#include <linux/phy/phy.h>
++#include <linux/usb/musb-omap.h>
++#include <linux/usb/ulpi.h>
++#include <linux/i2c/twl.h>
++#include <linux/regulator/consumer.h>
++#include <linux/err.h>
++#include <linux/slab.h>
++
++/* Register defines */
++
++#define MCPC_CTRL                     0x30
++#define MCPC_CTRL_RTSOL                       (1 << 7)
++#define MCPC_CTRL_EXTSWR              (1 << 6)
++#define MCPC_CTRL_EXTSWC              (1 << 5)
++#define MCPC_CTRL_VOICESW             (1 << 4)
++#define MCPC_CTRL_OUT64K              (1 << 3)
++#define MCPC_CTRL_RTSCTSSW            (1 << 2)
++#define MCPC_CTRL_HS_UART             (1 << 0)
++
++#define MCPC_IO_CTRL                  0x33
++#define MCPC_IO_CTRL_MICBIASEN                (1 << 5)
++#define MCPC_IO_CTRL_CTS_NPU          (1 << 4)
++#define MCPC_IO_CTRL_RXD_PU           (1 << 3)
++#define MCPC_IO_CTRL_TXDTYP           (1 << 2)
++#define MCPC_IO_CTRL_CTSTYP           (1 << 1)
++#define MCPC_IO_CTRL_RTSTYP           (1 << 0)
++
++#define MCPC_CTRL2                    0x36
++#define MCPC_CTRL2_MCPC_CK_EN         (1 << 0)
++
++#define OTHER_FUNC_CTRL                       0x80
++#define OTHER_FUNC_CTRL_BDIS_ACON_EN  (1 << 4)
++#define OTHER_FUNC_CTRL_FIVEWIRE_MODE (1 << 2)
++
++#define OTHER_IFC_CTRL                        0x83
++#define OTHER_IFC_CTRL_OE_INT_EN      (1 << 6)
++#define OTHER_IFC_CTRL_CEA2011_MODE   (1 << 5)
++#define OTHER_IFC_CTRL_FSLSSERIALMODE_4PIN    (1 << 4)
++#define OTHER_IFC_CTRL_HIZ_ULPI_60MHZ_OUT     (1 << 3)
++#define OTHER_IFC_CTRL_HIZ_ULPI               (1 << 2)
++#define OTHER_IFC_CTRL_ALT_INT_REROUTE        (1 << 0)
++
++#define OTHER_INT_EN_RISE             0x86
++#define OTHER_INT_EN_FALL             0x89
++#define OTHER_INT_STS                 0x8C
++#define OTHER_INT_LATCH                       0x8D
++#define OTHER_INT_VB_SESS_VLD         (1 << 7)
++#define OTHER_INT_DM_HI                       (1 << 6) /* not valid for "latch" reg */
++#define OTHER_INT_DP_HI                       (1 << 5) /* not valid for "latch" reg */
++#define OTHER_INT_BDIS_ACON           (1 << 3) /* not valid for "fall" regs */
++#define OTHER_INT_MANU                        (1 << 1)
++#define OTHER_INT_ABNORMAL_STRESS     (1 << 0)
++
++#define ID_STATUS                     0x96
++#define ID_RES_FLOAT                  (1 << 4)
++#define ID_RES_440K                   (1 << 3)
++#define ID_RES_200K                   (1 << 2)
++#define ID_RES_102K                   (1 << 1)
++#define ID_RES_GND                    (1 << 0)
++
++#define POWER_CTRL                    0xAC
++#define POWER_CTRL_OTG_ENAB           (1 << 5)
++
++#define OTHER_IFC_CTRL2                       0xAF
++#define OTHER_IFC_CTRL2_ULPI_STP_LOW  (1 << 4)
++#define OTHER_IFC_CTRL2_ULPI_TXEN_POL (1 << 3)
++#define OTHER_IFC_CTRL2_ULPI_4PIN_2430        (1 << 2)
++#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_MASK   (3 << 0) /* bits 0 and 1 */
++#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_INT1N  (0 << 0)
++#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_INT2N  (1 << 0)
++
++#define REG_CTRL_EN                   0xB2
++#define REG_CTRL_ERROR                        0xB5
++#define ULPI_I2C_CONFLICT_INTEN               (1 << 0)
++
++#define OTHER_FUNC_CTRL2              0xB8
++#define OTHER_FUNC_CTRL2_VBAT_TIMER_EN        (1 << 0)
++
++/* following registers do not have separate _clr and _set registers */
++#define VBUS_DEBOUNCE                 0xC0
++#define ID_DEBOUNCE                   0xC1
++#define VBAT_TIMER                    0xD3
++#define PHY_PWR_CTRL                  0xFD
++#define PHY_PWR_PHYPWD                        (1 << 0)
++#define PHY_CLK_CTRL                  0xFE
++#define PHY_CLK_CTRL_CLOCKGATING_EN   (1 << 2)
++#define PHY_CLK_CTRL_CLK32K_EN                (1 << 1)
++#define REQ_PHY_DPLL_CLK              (1 << 0)
++#define PHY_CLK_CTRL_STS              0xFF
++#define PHY_DPLL_CLK                  (1 << 0)
++
++/* In module TWL_MODULE_PM_MASTER */
++#define STS_HW_CONDITIONS             0x0F
++
++/* In module TWL_MODULE_PM_RECEIVER */
++#define VUSB_DEDICATED1                       0x7D
++#define VUSB_DEDICATED2                       0x7E
++#define VUSB1V5_DEV_GRP                       0x71
++#define VUSB1V5_TYPE                  0x72
++#define VUSB1V5_REMAP                 0x73
++#define VUSB1V8_DEV_GRP                       0x74
++#define VUSB1V8_TYPE                  0x75
++#define VUSB1V8_REMAP                 0x76
++#define VUSB3V1_DEV_GRP                       0x77
++#define VUSB3V1_TYPE                  0x78
++#define VUSB3V1_REMAP                 0x79
++
++/* In module TWL4030_MODULE_INTBR */
++#define PMBR1                         0x0D
++#define GPIO_USB_4PIN_ULPI_2430C      (3 << 0)
++
++struct twl4030_usb {
++      struct usb_phy          phy;
++      struct device           *dev;
++
++      /* TWL4030 internal USB regulator supplies */
++      struct regulator        *usb1v5;
++      struct regulator        *usb1v8;
++      struct regulator        *usb3v1;
++
++      /* for vbus reporting with irqs disabled */
++      spinlock_t              lock;
++
++      /* pin configuration */
++      enum twl4030_usb_mode   usb_mode;
++
++      int                     irq;
++      enum omap_musb_vbus_id_status linkstat;
++      bool                    vbus_supplied;
++      u8                      asleep;
++      bool                    irq_enabled;
++
++      struct delayed_work     id_workaround_work;
++};
++
++/* internal define on top of container_of */
++#define phy_to_twl(x)         container_of((x), struct twl4030_usb, phy)
++
++/*-------------------------------------------------------------------------*/
++
++static int twl4030_i2c_write_u8_verify(struct twl4030_usb *twl,
++              u8 module, u8 data, u8 address)
++{
++      u8 check;
++
++      if ((twl_i2c_write_u8(module, data, address) >= 0) &&
++          (twl_i2c_read_u8(module, &check, address) >= 0) &&
++                                              (check == data))
++              return 0;
++      dev_dbg(twl->dev, "Write%d[%d,0x%x] wrote %02x but read %02x\n",
++                      1, module, address, check, data);
++
++      /* Failed once: Try again */
++      if ((twl_i2c_write_u8(module, data, address) >= 0) &&
++          (twl_i2c_read_u8(module, &check, address) >= 0) &&
++                                              (check == data))
++              return 0;
++      dev_dbg(twl->dev, "Write%d[%d,0x%x] wrote %02x but read %02x\n",
++                      2, module, address, check, data);
++
++      /* Failed again: Return error */
++      return -EBUSY;
++}
++
++#define twl4030_usb_write_verify(twl, address, data)  \
++      twl4030_i2c_write_u8_verify(twl, TWL_MODULE_USB, (data), (address))
++
++static inline int twl4030_usb_write(struct twl4030_usb *twl,
++              u8 address, u8 data)
++{
++      int ret = 0;
++
++      ret = twl_i2c_write_u8(TWL_MODULE_USB, data, address);
++      if (ret < 0)
++              dev_dbg(twl->dev,
++                      "TWL4030:USB:Write[0x%x] Error %d\n", address, ret);
++      return ret;
++}
++
++static inline int twl4030_readb(struct twl4030_usb *twl, u8 module, u8 address)
++{
++      u8 data;
++      int ret = 0;
++
++      ret = twl_i2c_read_u8(module, &data, address);
++      if (ret >= 0)
++              ret = data;
++      else
++              dev_dbg(twl->dev,
++                      "TWL4030:readb[0x%x,0x%x] Error %d\n",
++                                      module, address, ret);
++
++      return ret;
++}
++
++static inline int twl4030_usb_read(struct twl4030_usb *twl, u8 address)
++{
++      return twl4030_readb(twl, TWL_MODULE_USB, address);
++}
++
++/*-------------------------------------------------------------------------*/
++
++static inline int
++twl4030_usb_set_bits(struct twl4030_usb *twl, u8 reg, u8 bits)
++{
++      return twl4030_usb_write(twl, ULPI_SET(reg), bits);
++}
++
++static inline int
++twl4030_usb_clear_bits(struct twl4030_usb *twl, u8 reg, u8 bits)
++{
++      return twl4030_usb_write(twl, ULPI_CLR(reg), bits);
++}
++
++/*-------------------------------------------------------------------------*/
++
++static bool twl4030_is_driving_vbus(struct twl4030_usb *twl)
++{
++      int ret;
++
++      ret = twl4030_usb_read(twl, PHY_CLK_CTRL_STS);
++      if (ret < 0 || !(ret & PHY_DPLL_CLK))
++              /*
++               * if clocks are off, registers are not updated,
++               * but we can assume we don't drive VBUS in this case
++               */
++              return false;
++
++      ret = twl4030_usb_read(twl, ULPI_OTG_CTRL);
++      if (ret < 0)
++              return false;
++
++      return (ret & (ULPI_OTG_DRVVBUS | ULPI_OTG_CHRGVBUS)) ? true : false;
++}
++
++static enum omap_musb_vbus_id_status
++      twl4030_usb_linkstat(struct twl4030_usb *twl)
++{
++      int     status;
++      enum omap_musb_vbus_id_status linkstat = OMAP_MUSB_UNKNOWN;
++
++      twl->vbus_supplied = false;
++
++      /*
++       * For ID/VBUS sensing, see manual section 15.4.8 ...
++       * except when using only battery backup power, two
++       * comparators produce VBUS_PRES and ID_PRES signals,
++       * which don't match docs elsewhere.  But ... BIT(7)
++       * and BIT(2) of STS_HW_CONDITIONS, respectively, do
++       * seem to match up.  If either is true the USB_PRES
++       * signal is active, the OTG module is activated, and
++       * its interrupt may be raised (may wake the system).
++       */
++      status = twl4030_readb(twl, TWL_MODULE_PM_MASTER, STS_HW_CONDITIONS);
++      if (status < 0)
++              dev_err(twl->dev, "USB link status err %d\n", status);
++      else if (status & (BIT(7) | BIT(2))) {
++              if (status & BIT(7)) {
++                      if (twl4030_is_driving_vbus(twl))
++                              status &= ~BIT(7);
++                      else
++                              twl->vbus_supplied = true;
++              }
++
++              if (status & BIT(2))
++                      linkstat = OMAP_MUSB_ID_GROUND;
++              else if (status & BIT(7))
++                      linkstat = OMAP_MUSB_VBUS_VALID;
++              else
++                      linkstat = OMAP_MUSB_VBUS_OFF;
++      } else {
++              if (twl->linkstat != OMAP_MUSB_UNKNOWN)
++                      linkstat = OMAP_MUSB_VBUS_OFF;
++      }
++
++      dev_dbg(twl->dev, "HW_CONDITIONS 0x%02x/%d; link %d\n",
++                      status, status, linkstat);
++
++      /* REVISIT this assumes host and peripheral controllers
++       * are registered, and that both are active...
++       */
++
++      return linkstat;
++}
++
++static void twl4030_usb_set_mode(struct twl4030_usb *twl, int mode)
++{
++      twl->usb_mode = mode;
++
++      switch (mode) {
++      case T2_USB_MODE_ULPI:
++              twl4030_usb_clear_bits(twl, ULPI_IFC_CTRL,
++                                      ULPI_IFC_CTRL_CARKITMODE);
++              twl4030_usb_set_bits(twl, POWER_CTRL, POWER_CTRL_OTG_ENAB);
++              twl4030_usb_clear_bits(twl, ULPI_FUNC_CTRL,
++                                      ULPI_FUNC_CTRL_XCVRSEL_MASK |
++                                      ULPI_FUNC_CTRL_OPMODE_MASK);
++              break;
++      case -1:
++              /* FIXME: power on defaults */
++              break;
++      default:
++              dev_err(twl->dev, "unsupported T2 transceiver mode %d\n",
++                              mode);
++              break;
++      };
++}
++
++static void twl4030_i2c_access(struct twl4030_usb *twl, int on)
++{
++      unsigned long timeout;
++      int val = twl4030_usb_read(twl, PHY_CLK_CTRL);
++
++      if (val >= 0) {
++              if (on) {
++                      /* enable DPLL to access PHY registers over I2C */
++                      val |= REQ_PHY_DPLL_CLK;
++                      WARN_ON(twl4030_usb_write_verify(twl, PHY_CLK_CTRL,
++                                              (u8)val) < 0);
++
++                      timeout = jiffies + HZ;
++                      while (!(twl4030_usb_read(twl, PHY_CLK_CTRL_STS) &
++                                                      PHY_DPLL_CLK)
++                              && time_before(jiffies, timeout))
++                                      udelay(10);
++                      if (!(twl4030_usb_read(twl, PHY_CLK_CTRL_STS) &
++                                                      PHY_DPLL_CLK))
++                              dev_err(twl->dev, "Timeout setting T2 HSUSB "
++                                              "PHY DPLL clock\n");
++              } else {
++                      /* let ULPI control the DPLL clock */
++                      val &= ~REQ_PHY_DPLL_CLK;
++                      WARN_ON(twl4030_usb_write_verify(twl, PHY_CLK_CTRL,
++                                              (u8)val) < 0);
++              }
++      }
++}
++
++static void __twl4030_phy_power(struct twl4030_usb *twl, int on)
++{
++      u8 pwr = twl4030_usb_read(twl, PHY_PWR_CTRL);
++
++      if (on)
++              pwr &= ~PHY_PWR_PHYPWD;
++      else
++              pwr |= PHY_PWR_PHYPWD;
++
++      WARN_ON(twl4030_usb_write_verify(twl, PHY_PWR_CTRL, pwr) < 0);
++}
++
++static void twl4030_phy_power(struct twl4030_usb *twl, int on)
++{
++      int ret;
++
++      if (on) {
++              ret = regulator_enable(twl->usb3v1);
++              if (ret)
++                      dev_err(twl->dev, "Failed to enable usb3v1\n");
++
++              ret = regulator_enable(twl->usb1v8);
++              if (ret)
++                      dev_err(twl->dev, "Failed to enable usb1v8\n");
++
++              /*
++               * Disabling usb3v1 regulator (= writing 0 to VUSB3V1_DEV_GRP
++               * in twl4030) resets the VUSB_DEDICATED2 register. This reset
++               * enables VUSB3V1_SLEEP bit that remaps usb3v1 ACTIVE state to
++               * SLEEP. We work around this by clearing the bit after usv3v1
++               * is re-activated. This ensures that VUSB3V1 is really active.
++               */
++              twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB_DEDICATED2);
++
++              ret = regulator_enable(twl->usb1v5);
++              if (ret)
++                      dev_err(twl->dev, "Failed to enable usb1v5\n");
++
++              __twl4030_phy_power(twl, 1);
++              twl4030_usb_write(twl, PHY_CLK_CTRL,
++                                twl4030_usb_read(twl, PHY_CLK_CTRL) |
++                                      (PHY_CLK_CTRL_CLOCKGATING_EN |
++                                              PHY_CLK_CTRL_CLK32K_EN));
++      } else {
++              __twl4030_phy_power(twl, 0);
++              regulator_disable(twl->usb1v5);
++              regulator_disable(twl->usb1v8);
++              regulator_disable(twl->usb3v1);
++      }
++}
++
++static int twl4030_phy_power_off(struct phy *phy)
++{
++      struct twl4030_usb *twl = phy_get_drvdata(phy);
++
++      if (twl->asleep)
++              return 0;
++
++      twl4030_phy_power(twl, 0);
++      twl->asleep = 1;
++      dev_dbg(twl->dev, "%s\n", __func__);
++      return 0;
++}
++
++static void __twl4030_phy_power_on(struct twl4030_usb *twl)
++{
++      twl4030_phy_power(twl, 1);
++      twl4030_i2c_access(twl, 1);
++      twl4030_usb_set_mode(twl, twl->usb_mode);
++      if (twl->usb_mode == T2_USB_MODE_ULPI)
++              twl4030_i2c_access(twl, 0);
++}
++
++static int twl4030_phy_power_on(struct phy *phy)
++{
++      struct twl4030_usb *twl = phy_get_drvdata(phy);
++
++      if (!twl->asleep)
++              return 0;
++      __twl4030_phy_power_on(twl);
++      twl->asleep = 0;
++      dev_dbg(twl->dev, "%s\n", __func__);
++
++      /*
++       * XXX When VBUS gets driven after musb goes to A mode,
++       * ID_PRES related interrupts no longer arrive, why?
++       * Register itself is updated fine though, so we must poll.
++       */
++      if (twl->linkstat == OMAP_MUSB_ID_GROUND) {
++              cancel_delayed_work(&twl->id_workaround_work);
++              schedule_delayed_work(&twl->id_workaround_work, HZ);
++      }
++      return 0;
++}
++
++static int twl4030_usb_ldo_init(struct twl4030_usb *twl)
++{
++      /* Enable writing to power configuration registers */
++      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG1,
++                       TWL4030_PM_MASTER_PROTECT_KEY);
++
++      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG2,
++                       TWL4030_PM_MASTER_PROTECT_KEY);
++
++      /* Keep VUSB3V1 LDO in sleep state until VBUS/ID change detected*/
++      /*twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB_DEDICATED2);*/
++
++      /* input to VUSB3V1 LDO is from VBAT, not VBUS */
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0x14, VUSB_DEDICATED1);
++
++      /* Initialize 3.1V regulator */
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB3V1_DEV_GRP);
++
++      twl->usb3v1 = devm_regulator_get(twl->dev, "usb3v1");
++      if (IS_ERR(twl->usb3v1))
++              return -ENODEV;
++
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB3V1_TYPE);
++
++      /* Initialize 1.5V regulator */
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V5_DEV_GRP);
++
++      twl->usb1v5 = devm_regulator_get(twl->dev, "usb1v5");
++      if (IS_ERR(twl->usb1v5))
++              return -ENODEV;
++
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V5_TYPE);
++
++      /* Initialize 1.8V regulator */
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V8_DEV_GRP);
++
++      twl->usb1v8 = devm_regulator_get(twl->dev, "usb1v8");
++      if (IS_ERR(twl->usb1v8))
++              return -ENODEV;
++
++      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V8_TYPE);
++
++      /* disable access to power configuration registers */
++      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, 0,
++                       TWL4030_PM_MASTER_PROTECT_KEY);
++
++      return 0;
++}
++
++static ssize_t twl4030_usb_vbus_show(struct device *dev,
++              struct device_attribute *attr, char *buf)
++{
++      struct twl4030_usb *twl = dev_get_drvdata(dev);
++      unsigned long flags;
++      int ret = -EINVAL;
++
++      spin_lock_irqsave(&twl->lock, flags);
++      ret = sprintf(buf, "%s\n",
++                      twl->vbus_supplied ? "on" : "off");
++      spin_unlock_irqrestore(&twl->lock, flags);
++
++      return ret;
++}
++static DEVICE_ATTR(vbus, 0444, twl4030_usb_vbus_show, NULL);
++
++static irqreturn_t twl4030_usb_irq(int irq, void *_twl)
++{
++      struct twl4030_usb *twl = _twl;
++      enum omap_musb_vbus_id_status status;
++      bool status_changed = false;
++
++      status = twl4030_usb_linkstat(twl);
++
++      spin_lock_irq(&twl->lock);
++      if (status >= 0 && status != twl->linkstat) {
++              twl->linkstat = status;
++              status_changed = true;
++      }
++      spin_unlock_irq(&twl->lock);
++
++      if (status_changed) {
++              /* FIXME add a set_power() method so that B-devices can
++               * configure the charger appropriately.  It's not always
++               * correct to consume VBUS power, and how much current to
++               * consume is a function of the USB configuration chosen
++               * by the host.
++               *
++               * REVISIT usb_gadget_vbus_connect(...) as needed, ditto
++               * its disconnect() sibling, when changing to/from the
++               * USB_LINK_VBUS state.  musb_hdrc won't care until it
++               * starts to handle softconnect right.
++               */
++              omap_musb_mailbox(status);
++      }
++      sysfs_notify(&twl->dev->kobj, NULL, "vbus");
++
++      return IRQ_HANDLED;
++}
++
++static void twl4030_id_workaround_work(struct work_struct *work)
++{
++      struct twl4030_usb *twl = container_of(work, struct twl4030_usb,
++              id_workaround_work.work);
++      enum omap_musb_vbus_id_status status;
++      bool status_changed = false;
++
++      status = twl4030_usb_linkstat(twl);
++
++      spin_lock_irq(&twl->lock);
++      if (status >= 0 && status != twl->linkstat) {
++              twl->linkstat = status;
++              status_changed = true;
++      }
++      spin_unlock_irq(&twl->lock);
++
++      if (status_changed) {
++              dev_dbg(twl->dev, "handle missing status change to %d\n",
++                              status);
++              omap_musb_mailbox(status);
++      }
++
++      /* don't schedule during sleep - irq works right then */
++      if (status == OMAP_MUSB_ID_GROUND && !twl->asleep) {
++              cancel_delayed_work(&twl->id_workaround_work);
++              schedule_delayed_work(&twl->id_workaround_work, HZ);
++      }
++}
++
++static int twl4030_phy_init(struct phy *phy)
++{
++      struct twl4030_usb *twl = phy_get_drvdata(phy);
++      enum omap_musb_vbus_id_status status;
++
++      /*
++       * Start in sleep state, we'll get called through set_suspend()
++       * callback when musb is runtime resumed and it's time to start.
++       */
++      __twl4030_phy_power(twl, 0);
++      twl->asleep = 1;
++
++      status = twl4030_usb_linkstat(twl);
++      twl->linkstat = status;
++
++      if (status == OMAP_MUSB_ID_GROUND || status == OMAP_MUSB_VBUS_VALID) {
++              omap_musb_mailbox(twl->linkstat);
++              twl4030_phy_power_on(phy);
++      }
++
++      sysfs_notify(&twl->dev->kobj, NULL, "vbus");
++      return 0;
++}
++
++static int twl4030_set_peripheral(struct usb_otg *otg,
++                                      struct usb_gadget *gadget)
++{
++      if (!otg)
++              return -ENODEV;
++
++      otg->gadget = gadget;
++      if (!gadget)
++              otg->phy->state = OTG_STATE_UNDEFINED;
++
++      return 0;
++}
++
++static int twl4030_set_host(struct usb_otg *otg, struct usb_bus *host)
++{
++      if (!otg)
++              return -ENODEV;
++
++      otg->host = host;
++      if (!host)
++              otg->phy->state = OTG_STATE_UNDEFINED;
++
++      return 0;
++}
++
++static const struct phy_ops ops = {
++      .init           = twl4030_phy_init,
++      .power_on       = twl4030_phy_power_on,
++      .power_off      = twl4030_phy_power_off,
++      .owner          = THIS_MODULE,
++};
++
++static int twl4030_usb_probe(struct platform_device *pdev)
++{
++      struct twl4030_usb_data *pdata = dev_get_platdata(&pdev->dev);
++      struct twl4030_usb      *twl;
++      struct phy              *phy;
++      int                     status, err;
++      struct usb_otg          *otg;
++      struct device_node      *np = pdev->dev.of_node;
++      struct phy_provider     *phy_provider;
++      struct phy_init_data    *init_data = NULL;
++
++      twl = devm_kzalloc(&pdev->dev, sizeof *twl, GFP_KERNEL);
++      if (!twl)
++              return -ENOMEM;
++
++      if (np)
++              of_property_read_u32(np, "usb_mode",
++                              (enum twl4030_usb_mode *)&twl->usb_mode);
++      else if (pdata) {
++              twl->usb_mode = pdata->usb_mode;
++              init_data = pdata->init_data;
++      } else {
++              dev_err(&pdev->dev, "twl4030 initialized without pdata\n");
++              return -EINVAL;
++      }
++
++      otg = devm_kzalloc(&pdev->dev, sizeof *otg, GFP_KERNEL);
++      if (!otg)
++              return -ENOMEM;
++
++      twl->dev                = &pdev->dev;
++      twl->irq                = platform_get_irq(pdev, 0);
++      twl->vbus_supplied      = false;
++      twl->asleep             = 1;
++      twl->linkstat           = OMAP_MUSB_UNKNOWN;
++
++      twl->phy.dev            = twl->dev;
++      twl->phy.label          = "twl4030";
++      twl->phy.otg            = otg;
++      twl->phy.type           = USB_PHY_TYPE_USB2;
++
++      otg->phy                = &twl->phy;
++      otg->set_host           = twl4030_set_host;
++      otg->set_peripheral     = twl4030_set_peripheral;
++
++      phy_provider = devm_of_phy_provider_register(twl->dev,
++              of_phy_simple_xlate);
++      if (IS_ERR(phy_provider))
++              return PTR_ERR(phy_provider);
++
++      phy = devm_phy_create(twl->dev, &ops, init_data);
++      if (IS_ERR(phy)) {
++              dev_dbg(&pdev->dev, "Failed to create PHY\n");
++              return PTR_ERR(phy);
++      }
++
++      phy_set_drvdata(phy, twl);
++
++      /* init spinlock for workqueue */
++      spin_lock_init(&twl->lock);
++
++      INIT_DELAYED_WORK(&twl->id_workaround_work, twl4030_id_workaround_work);
++
++      err = twl4030_usb_ldo_init(twl);
++      if (err) {
++              dev_err(&pdev->dev, "ldo init failed\n");
++              return err;
++      }
++      usb_add_phy_dev(&twl->phy);
++
++      platform_set_drvdata(pdev, twl);
++      if (device_create_file(&pdev->dev, &dev_attr_vbus))
++              dev_warn(&pdev->dev, "could not create sysfs file\n");
++
++      ATOMIC_INIT_NOTIFIER_HEAD(&twl->phy.notifier);
++
++      /* Our job is to use irqs and status from the power module
++       * to keep the transceiver disabled when nothing's connected.
++       *
++       * FIXME we actually shouldn't start enabling it until the
++       * USB controller drivers have said they're ready, by calling
++       * set_host() and/or set_peripheral() ... OTG_capable boards
++       * need both handles, otherwise just one suffices.
++       */
++      twl->irq_enabled = true;
++      status = devm_request_threaded_irq(twl->dev, twl->irq, NULL,
++                      twl4030_usb_irq, IRQF_TRIGGER_FALLING |
++                      IRQF_TRIGGER_RISING | IRQF_ONESHOT, "twl4030_usb", twl);
++      if (status < 0) {
++              dev_dbg(&pdev->dev, "can't get IRQ %d, err %d\n",
++                      twl->irq, status);
++              return status;
++      }
++
++      dev_info(&pdev->dev, "Initialized TWL4030 USB module\n");
++      return 0;
++}
++
++static int twl4030_usb_remove(struct platform_device *pdev)
++{
++      struct twl4030_usb *twl = platform_get_drvdata(pdev);
++      int val;
++
++      cancel_delayed_work(&twl->id_workaround_work);
++      device_remove_file(twl->dev, &dev_attr_vbus);
++
++      /* set transceiver mode to power on defaults */
++      twl4030_usb_set_mode(twl, -1);
++
++      /* autogate 60MHz ULPI clock,
++       * clear dpll clock request for i2c access,
++       * disable 32KHz
++       */
++      val = twl4030_usb_read(twl, PHY_CLK_CTRL);
++      if (val >= 0) {
++              val |= PHY_CLK_CTRL_CLOCKGATING_EN;
++              val &= ~(PHY_CLK_CTRL_CLK32K_EN | REQ_PHY_DPLL_CLK);
++              twl4030_usb_write(twl, PHY_CLK_CTRL, (u8)val);
++      }
++
++      /* disable complete OTG block */
++      twl4030_usb_clear_bits(twl, POWER_CTRL, POWER_CTRL_OTG_ENAB);
++
++      if (!twl->asleep)
++              twl4030_phy_power(twl, 0);
++
++      return 0;
++}
++
++#ifdef CONFIG_OF
++static const struct of_device_id twl4030_usb_id_table[] = {
++      { .compatible = "ti,twl4030-usb" },
++      {}
++};
++MODULE_DEVICE_TABLE(of, twl4030_usb_id_table);
++#endif
++
++static struct platform_driver twl4030_usb_driver = {
++      .probe          = twl4030_usb_probe,
++      .remove         = twl4030_usb_remove,
++      .driver         = {
++              .name   = "twl4030_usb",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(twl4030_usb_id_table),
++      },
++};
++
++static int __init twl4030_usb_init(void)
++{
++      return platform_driver_register(&twl4030_usb_driver);
++}
++subsys_initcall(twl4030_usb_init);
++
++static void __exit twl4030_usb_exit(void)
++{
++      platform_driver_unregister(&twl4030_usb_driver);
++}
++module_exit(twl4030_usb_exit);
++
++MODULE_ALIAS("platform:twl4030_usb");
++MODULE_AUTHOR("Texas Instruments, Inc, Nokia Corporation");
++MODULE_DESCRIPTION("TWL4030 USB transceiver driver");
++MODULE_LICENSE("GPL");
+--- a/drivers/regulator/core.c
++++ b/drivers/regulator/core.c
+@@ -124,6 +124,51 @@ static const char *rdev_get_name(struct
+               return "";
+ }
++static void regulator_lock(struct regulator_dev *rdev)
++{
++      struct regulator_dev *locking_rdev = rdev;
++
++      while (locking_rdev->supply)
++              locking_rdev = locking_rdev->supply->rdev;
++
++      if (!mutex_trylock(&locking_rdev->mutex)) {
++              if (locking_rdev->lock_owner == current) {
++                      locking_rdev->lock_count++;
++                      dev_dbg(&locking_rdev->dev,
++                              "Is locked. locking %s (ref=%u)\n",
++                              rdev_get_name(rdev),
++                              locking_rdev->lock_count);
++                      return;
++              }
++              mutex_lock(&locking_rdev->mutex);
++      }
++
++      WARN_ON_ONCE(locking_rdev->lock_owner != NULL);
++      WARN_ON_ONCE(locking_rdev->lock_count != 0);
++
++      locking_rdev->lock_count = 1;
++      locking_rdev->lock_owner = current;
++      dev_dbg(&locking_rdev->dev, "Is locked. locking %s\n",
++              rdev_get_name(rdev));
++}
++
++static void regulator_unlock(struct regulator_dev *rdev)
++{
++      struct regulator_dev *locking_rdev = rdev;
++
++      while (locking_rdev->supply)
++              locking_rdev = locking_rdev->supply->rdev;
++
++      dev_dbg(&locking_rdev->dev, "Is unlocked. unlocking %s (ref=%u)\n",
++              rdev_get_name(rdev), locking_rdev->lock_count);
++
++      if (--locking_rdev->lock_count)
++              return;
++
++      locking_rdev->lock_owner = NULL;
++      mutex_unlock(&locking_rdev->mutex);
++}
++
+ /**
+  * of_get_regulator - get a regulator device node based on supply name
+  * @dev: Device pointer for the consumer (of regulator) device
+@@ -306,9 +351,9 @@ static ssize_t regulator_uV_show(struct
+       struct regulator_dev *rdev = dev_get_drvdata(dev);
+       ssize_t ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       ret = sprintf(buf, "%d\n", _regulator_get_voltage(rdev));
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+@@ -372,9 +417,9 @@ static ssize_t regulator_state_show(stru
+       struct regulator_dev *rdev = dev_get_drvdata(dev);
+       ssize_t ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       ret = regulator_print_state(buf, _regulator_is_enabled(rdev));
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+@@ -482,10 +527,10 @@ static ssize_t regulator_total_uA_show(s
+       struct regulator *regulator;
+       int uA = 0;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       list_for_each_entry(regulator, &rdev->consumer_list, list)
+               uA += regulator->uA_load;
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return sprintf(buf, "%d\n", uA);
+ }
+ static DEVICE_ATTR(requested_microamps, 0444, regulator_total_uA_show, NULL);
+@@ -1123,7 +1168,7 @@ static struct regulator *create_regulato
+       if (regulator == NULL)
+               return NULL;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       regulator->rdev = rdev;
+       list_add(&regulator->list, &rdev->consumer_list);
+@@ -1175,12 +1220,12 @@ static struct regulator *create_regulato
+           _regulator_is_enabled(rdev))
+               regulator->always_on = true;
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return regulator;
+ overflow_err:
+       list_del(&regulator->list);
+       kfree(regulator);
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return NULL;
+ }
+@@ -1774,9 +1819,9 @@ int regulator_enable(struct regulator *r
+                       return ret;
+       }
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       ret = _regulator_enable(rdev);
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       if (ret != 0 && rdev->supply)
+               regulator_disable(rdev->supply);
+@@ -1866,9 +1911,9 @@ int regulator_disable(struct regulator *
+       if (regulator->always_on)
+               return 0;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       ret = _regulator_disable(rdev);
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       if (ret == 0 && rdev->supply)
+               regulator_disable(rdev->supply);
+@@ -1912,10 +1957,10 @@ int regulator_force_disable(struct regul
+       struct regulator_dev *rdev = regulator->rdev;
+       int ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       regulator->uA_load = 0;
+       ret = _regulator_force_disable(regulator->rdev);
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       if (rdev->supply)
+               while (rdev->open_count--)
+@@ -1931,7 +1976,7 @@ static void regulator_disable_work(struc
+                                                 disable_work.work);
+       int count, i, ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       BUG_ON(!rdev->deferred_disables);
+@@ -1944,7 +1989,7 @@ static void regulator_disable_work(struc
+                       rdev_err(rdev, "Deferred disable failed: %d\n", ret);
+       }
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       if (rdev->supply) {
+               for (i = 0; i < count; i++) {
+@@ -1980,9 +2025,9 @@ int regulator_disable_deferred(struct re
+       if (!ms)
+               return regulator_disable(regulator);
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       rdev->deferred_disables++;
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       ret = queue_delayed_work(system_power_efficient_wq,
+                                &rdev->disable_work,
+@@ -2026,9 +2071,9 @@ int regulator_is_enabled(struct regulato
+       if (regulator->always_on)
+               return 1;
+-      mutex_lock(&regulator->rdev->mutex);
++      regulator_lock(regulator->rdev);
+       ret = _regulator_is_enabled(regulator->rdev);
+-      mutex_unlock(&regulator->rdev->mutex);
++      regulator_unlock(regulator->rdev);
+       return ret;
+ }
+@@ -2097,9 +2142,9 @@ int regulator_list_voltage(struct regula
+       if (!ops->list_voltage || selector >= rdev->desc->n_voltages)
+               return -EINVAL;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       ret = ops->list_voltage(rdev, selector);
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       if (ret > 0) {
+               if (ret < rdev->constraints->min_uV)
+@@ -2298,7 +2343,7 @@ int regulator_set_voltage(struct regulat
+       int ret = 0;
+       int old_min_uV, old_max_uV;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /* If we're setting the same range as last time the change
+        * should be a noop (some cpufreq implementations use the same
+@@ -2334,12 +2379,12 @@ int regulator_set_voltage(struct regulat
+               goto out2;
+       
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ out2:
+       regulator->min_uV = old_min_uV;
+       regulator->max_uV = old_max_uV;
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+ EXPORT_SYMBOL_GPL(regulator_set_voltage);
+@@ -2442,7 +2487,7 @@ int regulator_sync_voltage(struct regula
+       struct regulator_dev *rdev = regulator->rdev;
+       int ret, min_uV, max_uV;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       if (!rdev->desc->ops->set_voltage &&
+           !rdev->desc->ops->set_voltage_sel) {
+@@ -2471,7 +2516,7 @@ int regulator_sync_voltage(struct regula
+       ret = _regulator_do_set_voltage(rdev, min_uV, max_uV);
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+ EXPORT_SYMBOL_GPL(regulator_sync_voltage);
+@@ -2511,11 +2556,11 @@ int regulator_get_voltage(struct regulat
+ {
+       int ret;
+-      mutex_lock(&regulator->rdev->mutex);
++      regulator_lock(regulator->rdev);
+       ret = _regulator_get_voltage(regulator->rdev);
+-      mutex_unlock(&regulator->rdev->mutex);
++      regulator_unlock(regulator->rdev);
+       return ret;
+ }
+@@ -2543,7 +2588,7 @@ int regulator_set_current_limit(struct r
+       struct regulator_dev *rdev = regulator->rdev;
+       int ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /* sanity check */
+       if (!rdev->desc->ops->set_current_limit) {
+@@ -2558,7 +2603,7 @@ int regulator_set_current_limit(struct r
+       ret = rdev->desc->ops->set_current_limit(rdev, min_uA, max_uA);
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+ EXPORT_SYMBOL_GPL(regulator_set_current_limit);
+@@ -2567,7 +2612,7 @@ static int _regulator_get_current_limit(
+ {
+       int ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /* sanity check */
+       if (!rdev->desc->ops->get_current_limit) {
+@@ -2577,7 +2622,7 @@ static int _regulator_get_current_limit(
+       ret = rdev->desc->ops->get_current_limit(rdev);
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+@@ -2613,7 +2658,7 @@ int regulator_set_mode(struct regulator
+       int ret;
+       int regulator_curr_mode;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /* sanity check */
+       if (!rdev->desc->ops->set_mode) {
+@@ -2637,7 +2682,7 @@ int regulator_set_mode(struct regulator
+       ret = rdev->desc->ops->set_mode(rdev, mode);
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+ EXPORT_SYMBOL_GPL(regulator_set_mode);
+@@ -2646,7 +2691,7 @@ static unsigned int _regulator_get_mode(
+ {
+       int ret;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /* sanity check */
+       if (!rdev->desc->ops->get_mode) {
+@@ -2656,7 +2701,7 @@ static unsigned int _regulator_get_mode(
+       ret = rdev->desc->ops->get_mode(rdev);
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+@@ -2708,7 +2753,7 @@ int regulator_set_optimum_mode(struct re
+       if (rdev->supply)
+               input_uV = regulator_get_voltage(rdev->supply);
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       /*
+        * first check to see if we can set modes at all, otherwise just
+@@ -2769,7 +2814,7 @@ int regulator_set_optimum_mode(struct re
+       }
+       ret = mode;
+ out:
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+ EXPORT_SYMBOL_GPL(regulator_set_optimum_mode);
+@@ -2797,7 +2842,7 @@ int regulator_allow_bypass(struct regula
+           !(rdev->constraints->valid_ops_mask & REGULATOR_CHANGE_BYPASS))
+               return 0;
+-      mutex_lock(&rdev->mutex);
++      regulator_lock(rdev);
+       if (enable && !regulator->bypass) {
+               rdev->bypass_count++;
+@@ -2821,7 +2866,7 @@ int regulator_allow_bypass(struct regula
+       if (ret == 0)
+               regulator->bypass = enable;
+-      mutex_unlock(&rdev->mutex);
++      regulator_unlock(rdev);
+       return ret;
+ }
+@@ -3540,9 +3585,9 @@ int regulator_suspend_prepare(suspend_st
+       mutex_lock(&regulator_list_mutex);
+       list_for_each_entry(rdev, &regulator_list, list) {
+-              mutex_lock(&rdev->mutex);
++              regulator_lock(rdev);
+               ret = suspend_prepare(rdev, state);
+-              mutex_unlock(&rdev->mutex);
++              regulator_unlock(rdev);
+               if (ret < 0) {
+                       rdev_err(rdev, "failed to prepare\n");
+@@ -3570,7 +3615,7 @@ int regulator_suspend_finish(void)
+       list_for_each_entry(rdev, &regulator_list, list) {
+               struct regulator_ops *ops = rdev->desc->ops;
+-              mutex_lock(&rdev->mutex);
++              regulator_lock(rdev);
+               if ((rdev->use_count > 0  || rdev->constraints->always_on) &&
+                               ops->enable) {
+                       error = ops->enable(rdev);
+@@ -3589,7 +3634,7 @@ int regulator_suspend_finish(void)
+                               ret = error;
+               }
+ unlock:
+-              mutex_unlock(&rdev->mutex);
++              regulator_unlock(rdev);
+       }
+       mutex_unlock(&regulator_list_mutex);
+       return ret;
+@@ -3777,7 +3822,7 @@ static int __init regulator_init_complet
+               if (!ops->disable || (c && c->always_on))
+                       continue;
+-              mutex_lock(&rdev->mutex);
++              regulator_lock(rdev);
+               if (rdev->use_count)
+                       goto unlock;
+@@ -3809,7 +3854,7 @@ static int __init regulator_init_complet
+               }
+ unlock:
+-              mutex_unlock(&rdev->mutex);
++              regulator_unlock(rdev);
+       }
+       mutex_unlock(&regulator_list_mutex);
+--- a/drivers/regulator/Kconfig
++++ b/drivers/regulator/Kconfig
+@@ -492,6 +492,15 @@ config REGULATOR_TPS65217
+         voltage regulators. It supports software based voltage control
+         for different voltage domains
++config REGULATOR_TPS65218
++      tristate "TI TPS65218 Power regulators"
++      depends on MFD_TPS65218
++      help
++        This driver supports TPS65218 voltage regulator chips. TPS65218
++        provides six step-down converters and one general-purpose LDO
++        voltage regulators. It supports software based voltage control
++        for different voltage domains
++
+ config REGULATOR_TPS6524X
+       tristate "TI TPS6524X Power regulators"
+       depends on SPI
+@@ -571,5 +580,19 @@ config REGULATOR_WM8994
+         This driver provides support for the voltage regulators on the
+         WM8994 CODEC.
++config REGULATOR_TIAVSCLASS0
++      tristate "Adaptive Voltage Scaling class 0 support for TI SoCs"
++      depends on ARCH_OMAP2PLUS
++      help
++        AVS is a power management technique which finely controls the
++        operating voltage of a device in order to optimize (i.e. reduce)
++        its power consumption.
++        At a given operating point, the voltage is adapted depending on
++        static factors (chip manufacturing process) and this adapted
++        voltage is made available in an efuse offset.
++        AVS is also called SmartReflex on OMAP devices.
++
++        Say Y here to enable Adaptive Voltage Scaling class 0 support.
++
+ endif
+--- a/drivers/regulator/Makefile
++++ b/drivers/regulator/Makefile
+@@ -63,6 +63,7 @@ obj-$(CONFIG_REGULATOR_TPS65023) += tps6
+ obj-$(CONFIG_REGULATOR_TPS6507X) += tps6507x-regulator.o
+ obj-$(CONFIG_REGULATOR_TPS65090) += tps65090-regulator.o
+ obj-$(CONFIG_REGULATOR_TPS65217) += tps65217-regulator.o
++obj-$(CONFIG_REGULATOR_TPS65218) += tps65218-regulator.o
+ obj-$(CONFIG_REGULATOR_TPS6524X) += tps6524x-regulator.o
+ obj-$(CONFIG_REGULATOR_TPS6586X) += tps6586x-regulator.o
+ obj-$(CONFIG_REGULATOR_TPS65910) += tps65910-regulator.o
+@@ -76,6 +77,7 @@ obj-$(CONFIG_REGULATOR_WM831X) += wm831x
+ obj-$(CONFIG_REGULATOR_WM8350) += wm8350-regulator.o
+ obj-$(CONFIG_REGULATOR_WM8400) += wm8400-regulator.o
+ obj-$(CONFIG_REGULATOR_WM8994) += wm8994-regulator.o
++obj-$(CONFIG_REGULATOR_TIAVSCLASS0) += ti-avs-class0-regulator.o
+ ccflags-$(CONFIG_REGULATOR_DEBUG) += -DDEBUG
+--- /dev/null
++++ b/drivers/regulator/ti-avs-class0-regulator.c
+@@ -0,0 +1,349 @@
++/*
++ * Texas Instrument SmartReflex AVS Class 0 driver
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *    Nishanth Menon
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++#define pr_fmt(fmt)  KBUILD_MODNAME ": %s(): " fmt, __func__
++
++#include <linux/err.h>
++#include <linux/init.h>
++#include <linux/io.h>
++#include <linux/module.h>
++#include <linux/of_device.h>
++#include <linux/of.h>
++#include <linux/platform_device.h>
++#include <linux/regulator/consumer.h>
++#include <linux/regulator/driver.h>
++#include <linux/regulator/machine.h>
++#include <linux/regulator/of_regulator.h>
++#include <linux/slab.h>
++#include <linux/string.h>
++
++/**
++ * struct tiavs_class0_data - class data for the regulator instance
++ * @desc:             regulator descriptor
++ * @reg:              regulator that will actually set the voltage
++ * @volt_set_table:   voltage to set data table
++ * @current_idx:      current index
++ * @voltage_tolerance:        % tolerance for voltage(optional)
++ */
++struct tiavs_class0_data {
++      struct regulator_desc desc;
++      struct regulator *reg;
++      unsigned int *volt_set_table;
++      int current_idx;
++      u32 voltage_tolerance;
++};
++
++/**
++ * tiavs_class0_set_voltage_sel() - set voltage
++ * @rdev:     regulator device
++ * @sel:      set voltage corresponding to selector
++ *
++ * This searches for a best case match and uses the child regulator to set
++ * appropriate voltage
++ *
++ * Return: -ENODEV if no proper regulator data/-EINVAL if no match,bad efuse
++ * else returns regulator set result
++ */
++static int tiavs_class0_set_voltage_sel(struct regulator_dev *rdev,
++                                      unsigned sel)
++{
++      struct tiavs_class0_data *data = rdev_get_drvdata(rdev);
++      const struct regulator_desc *desc = rdev->desc;
++      struct regulator *reg;
++      int vset, ret, tol;
++
++      if (!data) {
++              pr_err("No regulator drvdata\n");
++              return -ENODEV;
++      }
++
++      reg = data->reg;
++      if (!reg) {
++              pr_err("No regulator\n");
++              return -ENODEV;
++      }
++
++      if (!desc->n_voltages || !data->volt_set_table) {
++              pr_err("No valid voltage table entries?\n");
++              return -EINVAL;
++      }
++
++      if (sel >= desc->n_voltages) {
++              pr_err("sel(%d) > max voltage table entries(%d)\n", sel,
++                     desc->n_voltages);
++              return -EINVAL;
++      }
++
++      vset = data->volt_set_table[sel];
++
++      /* Adjust for % tolerance needed */
++      tol = DIV_ROUND_UP(vset * data->voltage_tolerance, 100);
++      ret = regulator_set_voltage_tol(reg, vset, tol);
++      if (!ret)
++              data->current_idx = sel;
++
++      return ret;
++}
++
++/**
++ * tiavs_class0_get_voltage_sel() - Get voltage selector
++ * @rdev:     regulator device
++ *
++ * Return: -ENODEV if no proper regulator data/-EINVAL if no data,
++ * else returns current index.
++ */
++static int tiavs_class0_get_voltage_sel(struct regulator_dev *rdev)
++{
++      const struct regulator_desc *desc = rdev->desc;
++      struct tiavs_class0_data *data = rdev_get_drvdata(rdev);
++
++      if (!data) {
++              pr_err("No regulator drvdata\n");
++              return -ENODEV;
++      }
++
++      if (!desc->n_voltages || !data->volt_set_table) {
++              pr_err("No valid voltage table entries?\n");
++              return -EINVAL;
++      }
++
++      if (data->current_idx > desc->n_voltages) {
++              pr_err("Corrupted data structure?? idx(%d) > n_voltages(%d)\n",
++                     data->current_idx, desc->n_voltages);
++              return -EINVAL;
++      }
++
++      return data->current_idx;
++}
++
++static struct regulator_ops tiavs_class0_ops = {
++      .list_voltage = regulator_list_voltage_table,
++
++      .set_voltage_sel = tiavs_class0_set_voltage_sel,
++      .get_voltage_sel = tiavs_class0_get_voltage_sel,
++
++};
++
++static const struct of_device_id tiavs_class0_of_match[] = {
++      {.compatible = "ti,avsclass0",},
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, tiavs_class0_of_match);
++
++/**
++ * tiavs_class0_probe() - AVS class 0 probe
++ * @pdev: matching platform device
++ *
++ * We support only device tree provided data here. Once we find a regulator,
++ * efuse offsets, we pick up the efuse register voltages store them per
++ * instance.
++ *
++ * Return: if everything goes through, we return 0, else corresponding error
++ * value is returned.
++ */
++static int tiavs_class0_probe(struct platform_device *pdev)
++{
++      const struct of_device_id *match;
++      struct device_node *np = pdev->dev.of_node;
++      struct property *prop;
++      struct resource *res;
++      struct regulator *reg;
++      struct regulator_init_data *initdata = NULL;
++      struct regulator_config config = { };
++      struct regulation_constraints *c;
++      struct regulator_dev *rdev;
++      struct regulator_desc *desc;
++      struct tiavs_class0_data *data;
++      void __iomem *base;
++      const __be32 *val;
++      unsigned int *volt_table;
++      bool efuse_is_uV = false;
++      int proplen, i, ret;
++      int reg_v, min_uV = INT_MAX, max_uV = 0;
++      int best_val = INT_MAX, choice = -EINVAL;
++
++      match = of_match_device(tiavs_class0_of_match, &pdev->dev);
++      if (match)
++              initdata = of_get_regulator_init_data(&pdev->dev, np);
++      if (!initdata) {
++              dev_err(&pdev->dev, "No proper OF?\n");
++              return -ENODEV;
++      }
++
++      /* look for avs-supply */
++      reg = devm_regulator_get(&pdev->dev, "avs");
++      if (IS_ERR(reg)) {
++              ret = PTR_ERR(reg);
++              reg = NULL;
++              dev_err(&pdev->dev, "avs_class0 regulator not available(%d)\n",
++                      ret);
++              return ret;
++      }
++
++      data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
++      if (!data) {
++              dev_err(&pdev->dev, "No memory to alloc data!\n");
++              return -ENOMEM;
++      }
++      data->reg = reg;
++
++      desc = &data->desc;
++      desc->name = dev_name(&pdev->dev);
++      desc->owner = THIS_MODULE;
++      desc->type = REGULATOR_VOLTAGE;
++      desc->ops = &tiavs_class0_ops;
++
++      /* pick up optional properties */
++      of_property_read_u32(np, "voltage-tolerance", &data->voltage_tolerance);
++      efuse_is_uV = of_property_read_bool(np,
++                                          "ti,avsclass0-microvolt-values");
++
++      /* pick up Efuse based voltages */
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      if (!res) {
++              dev_err(&pdev->dev, "Unable to get IO resource\n");
++              return -ENODEV;
++      }
++
++      base = devm_ioremap_nocache(&pdev->dev, res->start, resource_size(res));
++      if (!base) {
++              dev_err(&pdev->dev, "Unable to map Efuse registers\n");
++              return -ENOMEM;
++      }
++
++      /* Fetch efuse-settings. */
++      prop = of_find_property(np, "efuse-settings", NULL);
++      if (!prop) {
++              dev_err(&pdev->dev, "No 'efuse-settings' property found\n");
++              return -EINVAL;
++      }
++
++      proplen = prop->length / sizeof(int);
++
++      data->volt_set_table =
++          devm_kzalloc(&pdev->dev, sizeof(unsigned int) * (proplen / 2),
++                       GFP_KERNEL);
++      if (!data->volt_set_table) {
++              dev_err(&pdev->dev, "Unable to Allocate voltage set table\n");
++              return -ENOMEM;
++      }
++
++      volt_table =
++          devm_kzalloc(&pdev->dev, sizeof(unsigned int) * (proplen / 2),
++                       GFP_KERNEL);
++      if (!volt_table) {
++              dev_err(&pdev->dev,
++                      "Unable to Allocate voltage lookup table\n");
++              return -ENOMEM;
++      }
++
++      val = prop->value;
++      for (i = 0; i < proplen / 2; i++) {
++              u32 efuse_offset;
++
++              volt_table[i] = be32_to_cpup(val++);
++              efuse_offset = be32_to_cpup(val++);
++
++              data->volt_set_table[i] = efuse_is_uV ?
++                  readl(base + efuse_offset) :
++                  readw(base + efuse_offset) * 1000;
++
++              /* Find min/max for the voltage sets */
++              if (min_uV > volt_table[i])
++                      min_uV = volt_table[i];
++              if (max_uV < volt_table[i])
++                      max_uV = volt_table[i];
++
++              dev_dbg(&pdev->dev, "[%d] efuse=0x%08x volt_table=%d vset=%d\n",
++                      i, efuse_offset, volt_table[i],
++                      data->volt_set_table[i]);
++      }
++      desc->n_voltages = i;
++      desc->volt_table = volt_table;
++
++      /* Search for a best match voltage */
++      reg_v = regulator_get_voltage(reg);
++      if (reg_v < 0) {
++              dev_err(&pdev->dev, "Regulator error %d for get_voltage!\n",
++                      reg_v);
++              return reg_v;
++      }
++
++      for (i = 0; i < desc->n_voltages; i++)
++              if (data->volt_set_table[i] < best_val &&
++                  data->volt_set_table[i] >= reg_v) {
++                      best_val = data->volt_set_table[i];
++                      choice = i;
++              }
++
++      if (choice == -EINVAL) {
++              dev_err(&pdev->dev, "No match regulator V=%d\n", reg_v);
++              return -EINVAL;
++      }
++      data->current_idx = choice;
++
++      /*
++       * Constrain board-specific capabilities according to what
++       * this driver can actually do.
++       */
++      c = &initdata->constraints;
++      if (desc->n_voltages > 1)
++              c->valid_ops_mask |= REGULATOR_CHANGE_VOLTAGE;
++      c->always_on = true;
++
++      c->min_uV = min_uV;
++      c->max_uV = max_uV;
++
++      config.dev = &pdev->dev;
++      config.init_data = initdata;
++      config.driver_data = data;
++      config.of_node = pdev->dev.of_node;
++
++      rdev = regulator_register(desc, &config);
++      if (IS_ERR(rdev)) {
++              dev_err(&pdev->dev, "can't register %s, %ld\n",
++                      desc->name, PTR_ERR(rdev));
++              return PTR_ERR(rdev);
++      }
++      platform_set_drvdata(pdev, rdev);
++
++      return 0;
++}
++
++static int tiavs_class0_remove(struct platform_device *pdev)
++{
++      struct regulator_dev *rdev = platform_get_drvdata(pdev);
++
++      regulator_unregister(rdev);
++      return 0;
++}
++
++MODULE_ALIAS("platform:tiavs_class0");
++
++static struct platform_driver tiavs_class0_driver = {
++      .probe = tiavs_class0_probe,
++      .remove = tiavs_class0_remove,
++      .driver = {
++                 .name = "tiavs_class0",
++                 .owner = THIS_MODULE,
++                 .of_match_table = of_match_ptr(tiavs_class0_of_match),
++                 },
++};
++module_platform_driver(tiavs_class0_driver);
++
++MODULE_DESCRIPTION("TI SmartReflex AVS class 0 regulator driver");
++MODULE_AUTHOR("Texas Instruments Inc.");
++MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/regulator/tps65218-regulator.c
+@@ -0,0 +1,392 @@
++/*
++ * tps65218-regulator.c
++ *
++ * Regulator driver for TPS65218 PMIC
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether expressed or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License version 2 for more details.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/device.h>
++#include <linux/init.h>
++#include <linux/err.h>
++#include <linux/platform_device.h>
++#include <linux/of_device.h>
++#include <linux/regulator/of_regulator.h>
++#include <linux/regulator/driver.h>
++#include <linux/regulator/machine.h>
++#include <linux/mfd/tps65218.h>
++
++static unsigned int tps65218_ramp_delay = 4000;
++
++#define TPS65218_REGULATOR(_name, _id, _ops, _n, _vr, _vm, _er, _em, _t) \
++      {                                               \
++              .name           = _name,                \
++              .id             = _id,                  \
++              .ops            = &_ops,                \
++              .n_voltages     = _n,                   \
++              .type           = REGULATOR_VOLTAGE,    \
++              .owner          = THIS_MODULE,          \
++              .vsel_reg       = _vr,                  \
++              .vsel_mask      = _vm,                  \
++              .enable_reg     = _er,  \
++              .enable_mask    = _em,                  \
++              .volt_table     = _t,                   \
++      }                                               \
++
++#define TPS65218_INFO(_id, _nm, _min, _max, _f1, _f2) \
++      {                                               \
++              .id             = _id,                  \
++              .name           = _nm,                  \
++              .min_uV         = _min,                 \
++              .max_uV         = _max,                 \
++              .vsel_to_uv     = _f1,                  \
++              .uv_to_vsel     = _f2,                  \
++      }
++
++static int tps65218_ldo1_dcdc3_vsel_to_uv(unsigned int vsel)
++{
++      int uV = 0;
++
++      if (vsel <= 26)
++              uV = vsel * 25000 + 900000;
++      else
++              uV = (vsel - 26) * 50000 + 1550000;
++
++      return uV;
++}
++
++static int tps65218_ldo1_dcdc3_uv_to_vsel(int uV, unsigned int *vsel)
++{
++      if (uV <= 15500000)
++              *vsel = DIV_ROUND_UP(uV - 900000, 25000);
++      else
++              *vsel = 26 + DIV_ROUND_UP(uV - 1550000, 50000);
++
++      return 0;
++}
++
++static int tps65218_dcdc1_2_vsel_to_uv(unsigned int vsel)
++{
++      int uV = 0;
++
++      if (vsel <= 50)
++              uV = vsel * 10000 + 850000;
++      else
++              uV = (vsel - 50) * 25000 + 1350000;
++
++      return uV;
++}
++
++static int tps65218_dcdc1_2_uv_to_vsel(int uV, unsigned int *vsel)
++{
++      if (uV <= 13500000)
++              *vsel = DIV_ROUND_UP(uV - 850000, 10000);
++      else
++              *vsel = 50 + DIV_ROUND_UP(uV - 1350000, 25000);
++
++      return 0;
++}
++
++static int tps65218_dcd4_vsel_to_uv(unsigned int vsel)
++{
++      int uV = 0;
++
++      if (vsel <= 15)
++              uV = vsel * 25000 + 1175000;
++      else
++              uV = (vsel - 15) * 50000 + 1550000;
++
++      return uV;
++}
++
++static int tps65218_dcdc4_uv_to_vsel(int uV, unsigned int *vsel)
++{
++      if (uV <= 15500000)
++              *vsel = DIV_ROUND_UP(uV - 1175000, 25000);
++      else
++              *vsel = 15 + DIV_ROUND_UP(uV - 1550000, 50000);
++
++      return 0;
++}
++
++static struct tps_info tps65218_pmic_regs[] = {
++      TPS65218_INFO(0, "DCDC1", 850000, 1675000, tps65218_dcdc1_2_vsel_to_uv,
++                    tps65218_dcdc1_2_uv_to_vsel),
++      TPS65218_INFO(1, "DCDC2", 850000, 1675000, tps65218_dcdc1_2_vsel_to_uv,
++                    tps65218_dcdc1_2_uv_to_vsel),
++      TPS65218_INFO(2, "DCDC3", 900000, 3400000,
++                    tps65218_ldo1_dcdc3_vsel_to_uv,
++                    tps65218_ldo1_dcdc3_uv_to_vsel),
++      TPS65218_INFO(3, "DCDC4", 1175000, 3400000, tps65218_dcd4_vsel_to_uv,
++                    tps65218_dcdc4_uv_to_vsel),
++      TPS65218_INFO(4, "DCDC5", 1000000, 1000000, NULL, NULL),
++      TPS65218_INFO(5, "DCDC6", 1800000, 1800000, NULL, NULL),
++      TPS65218_INFO(6, "LDO1", 900000, 3400000,
++                    tps65218_ldo1_dcdc3_vsel_to_uv,
++                    tps65218_ldo1_dcdc3_uv_to_vsel),
++};
++
++#define TPS65218_OF_MATCH(comp, label) \
++      { \
++              .compatible = comp, \
++              .data = &label, \
++      }
++
++static const struct of_device_id tps65218_of_match[] = {
++      TPS65218_OF_MATCH("ti,tps65218-dcdc1", tps65218_pmic_regs[0]),
++      TPS65218_OF_MATCH("ti,tps65218-dcdc2", tps65218_pmic_regs[1]),
++      TPS65218_OF_MATCH("ti,tps65218-dcdc3", tps65218_pmic_regs[2]),
++      TPS65218_OF_MATCH("ti,tps65218-dcdc4", tps65218_pmic_regs[3]),
++      TPS65218_OF_MATCH("ti,tps65218-dcdc5", tps65218_pmic_regs[4]),
++      TPS65218_OF_MATCH("ti,tps65218-dcdc6", tps65218_pmic_regs[5]),
++      TPS65218_OF_MATCH("ti,tps65218-ldo1", tps65218_pmic_regs[6]),
++};
++MODULE_DEVICE_TABLE(of, tps65218_of_match);
++
++static int tps65218_pmic_set_voltage_sel(struct regulator_dev *dev,
++                                       unsigned selector)
++{
++      int ret;
++      struct tps65218 *tps = rdev_get_drvdata(dev);
++      unsigned int rid = rdev_get_id(dev);
++
++      /* Set the voltage based on vsel value and write protect level is 2 */
++      ret = tps65218_set_bits(tps, dev->desc->vsel_reg, dev->desc->vsel_mask,
++                              selector, TPS65218_PROTECT_L1);
++
++      /* Set GO bit for DCDC1/2 to initiate voltage transistion */
++      switch (rid) {
++      case TPS65218_DCDC_1:
++      case TPS65218_DCDC_2:
++              ret = tps65218_set_bits(tps, TPS65218_REG_CONTRL_SLEW_RATE,
++                                      TPS65218_SLEW_RATE_GO,
++                                      TPS65218_SLEW_RATE_GO,
++                                      TPS65218_PROTECT_L1);
++              break;
++      }
++
++      return ret;
++}
++
++static int tps65218_pmic_map_voltage(struct regulator_dev *dev,
++                                   int min_uV, int max_uV)
++{
++      struct tps65218 *tps = rdev_get_drvdata(dev);
++      unsigned int sel, rid = rdev_get_id(dev);
++      int ret;
++
++      if (rid < TPS65218_DCDC_1 || rid > TPS65218_LDO_1)
++              return -EINVAL;
++
++      if (min_uV < tps->info[rid]->min_uV)
++              min_uV = tps->info[rid]->min_uV;
++
++      if (max_uV < tps->info[rid]->min_uV || min_uV > tps->info[rid]->max_uV)
++              return -EINVAL;
++
++      ret = tps->info[rid]->uv_to_vsel(min_uV, &sel);
++      if (ret)
++              return ret;
++
++      return sel;
++}
++
++static int tps65218_pmic_list_voltage(struct regulator_dev *dev,
++                                      unsigned selector)
++{
++      struct tps65218 *tps = rdev_get_drvdata(dev);
++      unsigned int rid = rdev_get_id(dev);
++
++      if (rid < TPS65218_DCDC_1 || rid > TPS65218_LDO_1)
++              return -EINVAL;
++
++      if (selector >= dev->desc->n_voltages)
++              return -EINVAL;
++
++      return tps->info[rid]->vsel_to_uv(selector);
++}
++
++static int tps65218_pmic_enable(struct regulator_dev *dev)
++{
++      struct tps65218 *tps = rdev_get_drvdata(dev);
++      unsigned int rid = rdev_get_id(dev);
++
++      if (rid < TPS65218_DCDC_1 || rid > TPS65218_LDO_1)
++              return -EINVAL;
++
++      /* Enable the regulator and password protection is level 1 */
++      return tps65218_set_bits(tps, dev->desc->enable_reg,
++                               dev->desc->enable_mask, dev->desc->enable_mask,
++                               TPS65218_PROTECT_L1);
++}
++
++static int tps65218_pmic_disable(struct regulator_dev *dev)
++{
++      struct tps65218 *tps = rdev_get_drvdata(dev);
++      unsigned int rid = rdev_get_id(dev);
++
++      if (rid < TPS65218_DCDC_1 || rid > TPS65218_LDO_1)
++              return -EINVAL;
++
++      /* Disable the regulator and password protection is level 1 */
++      return tps65218_clear_bits(tps, dev->desc->enable_reg,
++                                 dev->desc->enable_mask, TPS65218_PROTECT_L1);
++}
++
++static int tps65218_set_voltage_time_sel(struct regulator_dev *rdev,
++      unsigned int old_selector, unsigned int new_selector)
++{
++      int old_uv, new_uv;
++
++      old_uv = tps65218_pmic_list_voltage(rdev, old_selector);
++      if (old_uv < 0)
++              return old_uv;
++
++      new_uv = tps65218_pmic_list_voltage(rdev, new_selector);
++      if (new_uv < 0)
++              return new_uv;
++
++      return DIV_ROUND_UP(abs(old_uv - new_uv), tps65218_ramp_delay);
++}
++
++/* Operations permitted on DCDC1, DCDC2 */
++static struct regulator_ops tps65218_dcdc12_ops = {
++      .is_enabled             = regulator_is_enabled_regmap,
++      .enable                 = tps65218_pmic_enable,
++      .disable                = tps65218_pmic_disable,
++      .get_voltage_sel        = regulator_get_voltage_sel_regmap,
++      .set_voltage_sel        = tps65218_pmic_set_voltage_sel,
++      .list_voltage           = tps65218_pmic_list_voltage,
++      .map_voltage            = tps65218_pmic_map_voltage,
++      .set_voltage_time_sel   = tps65218_set_voltage_time_sel,
++};
++
++/* Operations permitted on DCDC3, DCDC4 and LDO1 */
++static struct regulator_ops tps65218_ldo1_dcdc34_ops = {
++      .is_enabled             = regulator_is_enabled_regmap,
++      .enable                 = tps65218_pmic_enable,
++      .disable                = tps65218_pmic_disable,
++      .get_voltage_sel        = regulator_get_voltage_sel_regmap,
++      .set_voltage_sel        = tps65218_pmic_set_voltage_sel,
++      .list_voltage           = tps65218_pmic_list_voltage,
++      .map_voltage            = tps65218_pmic_map_voltage,
++};
++
++/* Operations permitted on DCDC5, DCDC6 */
++static struct regulator_ops tps65218_dcdc56_pmic_ops = {
++      .is_enabled             = regulator_is_enabled_regmap,
++      .enable                 = tps65218_pmic_enable,
++      .disable                = tps65218_pmic_disable,
++};
++
++static const struct regulator_desc regulators[] = {
++      TPS65218_REGULATOR("DCDC1", TPS65218_DCDC_1, tps65218_dcdc12_ops, 64,
++                         TPS65218_REG_CONTROL_DCDC1,
++                         TPS65218_CONTROL_DCDC1_MASK,
++                         TPS65218_REG_ENABLE1, TPS65218_ENABLE1_DC1_EN, NULL),
++      TPS65218_REGULATOR("DCDC2", TPS65218_DCDC_2, tps65218_dcdc12_ops, 64,
++                         TPS65218_REG_CONTROL_DCDC2,
++                         TPS65218_CONTROL_DCDC2_MASK,
++                         TPS65218_REG_ENABLE1, TPS65218_ENABLE1_DC2_EN, NULL),
++      TPS65218_REGULATOR("DCDC3", TPS65218_DCDC_3, tps65218_ldo1_dcdc34_ops,
++                         64, TPS65218_REG_CONTROL_DCDC3,
++                         TPS65218_CONTROL_DCDC3_MASK, TPS65218_REG_ENABLE1,
++                         TPS65218_ENABLE1_DC3_EN, NULL),
++      TPS65218_REGULATOR("DCDC4", TPS65218_DCDC_4, tps65218_ldo1_dcdc34_ops,
++                         53, TPS65218_REG_CONTROL_DCDC4,
++                         TPS65218_CONTROL_DCDC4_MASK,
++                         TPS65218_REG_ENABLE1, TPS65218_ENABLE1_DC4_EN, NULL),
++      TPS65218_REGULATOR("DCDC5", TPS65218_DCDC_5, tps65218_dcdc56_pmic_ops,
++                         1, -1, -1, TPS65218_REG_ENABLE1,
++                         TPS65218_ENABLE1_DC5_EN, NULL),
++      TPS65218_REGULATOR("DCDC6", TPS65218_DCDC_6, tps65218_dcdc56_pmic_ops,
++                         1, -1, -1, TPS65218_REG_ENABLE1,
++                         TPS65218_ENABLE1_DC6_EN, NULL),
++      TPS65218_REGULATOR("LDO1", TPS65218_LDO_1, tps65218_ldo1_dcdc34_ops, 64,
++                         TPS65218_REG_CONTROL_DCDC4,
++                         TPS65218_CONTROL_LDO1_MASK, TPS65218_REG_ENABLE2,
++                         TPS65218_ENABLE2_LDO1_EN, NULL),
++};
++
++static int tps65218_regulator_probe(struct platform_device *pdev)
++{
++      struct tps65218 *tps = dev_get_drvdata(pdev->dev.parent);
++      struct regulator_init_data *init_data;
++      const struct tps_info   *template;
++      struct regulator_dev *rdev;
++      const struct of_device_id       *match;
++      struct regulator_config config = { };
++      int id;
++
++      match = of_match_device(tps65218_of_match, &pdev->dev);
++      if (match) {
++              template = match->data;
++              id = template->id;
++              init_data = of_get_regulator_init_data(&pdev->dev,
++                                                    pdev->dev.of_node);
++      } else {
++              return -ENODEV;
++      }
++
++      platform_set_drvdata(pdev, tps);
++
++      tps->info[id] = &tps65218_pmic_regs[id];
++      config.dev = &pdev->dev;
++      config.init_data = init_data;
++      config.driver_data = tps;
++      config.regmap = tps->regmap;
++
++      rdev = regulator_register(&regulators[id], &config);
++      if (IS_ERR(rdev)) {
++              dev_err(tps->dev, "failed to register %s regulator\n",
++                      pdev->name);
++              return PTR_ERR(rdev);
++      }
++
++      /* Save regulator */
++      tps->rdev[id] = rdev;
++
++      return 0;
++}
++
++static int tps65218_regulator_remove(struct platform_device *pdev)
++{
++      struct tps65218 *tps = platform_get_drvdata(pdev);
++      const struct of_device_id       *match;
++      const struct tps_info           *template;
++
++      match = of_match_device(tps65218_of_match, &pdev->dev);
++      template = match->data;
++      regulator_unregister(tps->rdev[template->id]);
++      platform_set_drvdata(pdev, NULL);
++
++      return 0;
++}
++
++static struct platform_driver tps65218_regulator_driver = {
++      .driver = {
++              .name = "tps65218-pmic",
++              .owner = THIS_MODULE,
++              .of_match_table = of_match_ptr(tps65218_of_match),
++      },
++      .probe = tps65218_regulator_probe,
++      .remove = tps65218_regulator_remove,
++};
++
++module_platform_driver(tps65218_regulator_driver);
++
++MODULE_AUTHOR("J Keerthy <j-keerthy@ti.com>");
++MODULE_DESCRIPTION("TPS65218 voltage regulator driver");
++MODULE_ALIAS("platform:tps65218-pmic");
++MODULE_LICENSE("GPL v2");
+--- a/drivers/reset/core.c
++++ b/drivers/reset/core.c
+@@ -127,6 +127,38 @@ int reset_control_deassert(struct reset_
+ EXPORT_SYMBOL_GPL(reset_control_deassert);
+ /**
++ * reset_control_is_reset - check reset status
++ * @rstc: reset controller
++ *
++ * Returns a boolean or negative error code
++ *
++ */
++int reset_control_is_reset(struct reset_control *rstc)
++{
++      if (rstc->rcdev->ops->is_reset)
++              return rstc->rcdev->ops->is_reset(rstc->rcdev, rstc->id);
++
++      return -ENOSYS;
++}
++EXPORT_SYMBOL_GPL(reset_control_is_reset);
++
++/**
++ * reset_control_clear_reset - clear the reset
++ * @rstc: reset controller
++ *
++ * Returns zero on success or negative error code
++ *
++ */
++int reset_control_clear_reset(struct reset_control *rstc)
++{
++      if (rstc->rcdev->ops->clear_reset)
++              return rstc->rcdev->ops->clear_reset(rstc->rcdev, rstc->id);
++
++      return -ENOSYS;
++}
++EXPORT_SYMBOL_GPL(reset_control_clear_reset);
++
++/**
+  * reset_control_get - Lookup and obtain a reference to a reset controller.
+  * @dev: device to be reset by the controller
+  * @id: reset line name
+--- a/drivers/reset/Kconfig
++++ b/drivers/reset/Kconfig
+@@ -11,3 +11,17 @@ menuconfig RESET_CONTROLLER
+         via GPIOs or SoC-internal reset controller modules.
+         If unsure, say no.
++
++if    RESET_CONTROLLER
++
++config        RESET_TI
++      bool "TI reset controller"
++      help
++        Reset controller support for TI SoC's
++
++        Reset controller found in TI's AM series of SoC's like
++        AM335x and AM43x and OMAP SoC's like OMAP5 and DRA7
++
++        If unsure, say no.
++
++endif
+--- a/drivers/reset/Makefile
++++ b/drivers/reset/Makefile
+@@ -1 +1,2 @@
+ obj-$(CONFIG_RESET_CONTROLLER) += core.o
++obj-$(CONFIG_RESET_TI) += ti_reset.o
+--- /dev/null
++++ b/drivers/reset/ti_reset.c
+@@ -0,0 +1,172 @@
++/*
++ * PRCM reset driver for TI SoC's
++ *
++ * 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.
++ */
++#include <linux/device.h>
++#include <linux/err.h>
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/of_device.h>
++#include <linux/reset.h>
++#include <linux/reset-controller.h>
++#include <linux/platform_device.h>
++#include <linux/io.h>
++
++#define DRIVER_NAME "ti_reset"
++
++struct ti_reset_reg_data {
++      u32     rstctrl_offs;
++      u32     rstst_offs;
++      u8      rstctrl_bit;
++      u8      rstst_bit;
++};
++
++struct ti_reset_data {
++      struct  ti_reset_reg_data *reg_data;
++      u8      nr_resets;
++};
++
++static void __iomem *reg_base;
++static const struct ti_reset_data *reset_data;
++
++static struct ti_reset_reg_data am335x_reset_reg_data[] = {
++      {
++              .rstctrl_offs   = 0x1104,
++              .rstst_offs     = 0x1114,
++              .rstctrl_bit    = 0,
++              .rstst_bit      = 0,
++      },
++};
++
++static struct ti_reset_data am335x_reset_data = {
++      .reg_data       = am335x_reset_reg_data,
++      .nr_resets      = ARRAY_SIZE(am335x_reset_reg_data),
++};
++
++static struct ti_reset_reg_data am43x_reset_reg_data[] = {
++      {
++              .rstctrl_offs   = 0x410,
++              .rstst_offs     = 0x414,
++              .rstctrl_bit    = 0,
++              .rstst_bit      = 0,
++      },
++};
++
++static struct ti_reset_data am43x_reset_data = {
++      .reg_data       = am43x_reset_reg_data,
++      .nr_resets      = ARRAY_SIZE(am43x_reset_reg_data),
++};
++
++static struct ti_reset_reg_data dra7_reset_reg_data[] = {
++      {
++              .rstctrl_offs   = 0x1310,
++              .rstst_offs     = 0x1314,
++              .rstctrl_bit    = 0,
++              .rstst_bit      = 0,
++      },
++};
++
++static struct ti_reset_data dra7_reset_data = {
++      .reg_data       = dra7_reset_reg_data,
++      .nr_resets      = ARRAY_SIZE(dra7_reset_reg_data),
++};
++
++static int ti_reset_clear_reset(struct reset_controller_dev *rcdev,
++                                unsigned long id)
++{
++      void __iomem *reg = reset_data->reg_data[id].rstst_offs + reg_base;
++      u8 bit = reset_data->reg_data[id].rstst_bit;
++      u32 val = readl(reg);
++
++      val &= ~(1 << bit);
++      val |= 1 << bit;
++      writel(val, reg);
++      return 0;
++}
++
++static int ti_reset_is_reset(struct reset_controller_dev *rcdev,
++                             unsigned long id)
++{
++      void __iomem *reg = reset_data->reg_data[id].rstst_offs + reg_base;
++      u8 bit = reset_data->reg_data[id].rstst_bit;
++      u32 val = readl(reg);
++
++      val &= (1 << bit);
++      return !!val;
++}
++
++static int ti_reset_deassert(struct reset_controller_dev *rcdev,
++                             unsigned long id)
++{
++      void __iomem *reg = reset_data->reg_data[id].rstctrl_offs +
++                              reg_base;
++      u8 bit = reset_data->reg_data[id].rstctrl_bit;
++      u32 val = readl(reg);
++
++      val &= ~(1 << bit);
++      writel(val, reg);
++      return 0;
++}
++
++static struct reset_control_ops ti_reset_ops = {
++      .deassert = ti_reset_deassert,
++      .is_reset = ti_reset_is_reset,
++      .clear_reset = ti_reset_clear_reset,
++};
++
++static struct reset_controller_dev ti_reset_controller = {
++      .ops = &ti_reset_ops,
++};
++
++static const struct of_device_id ti_reset_of_match[] = {
++      { .compatible = "ti,am3352-prcm", .data = &am335x_reset_data,},
++      { .compatible = "ti,am4372-prcm", .data = &am43x_reset_data,},
++      { .compatible = "ti,dra7-prcm", .data = &dra7_reset_data,},
++      {},
++};
++
++static int ti_reset_probe(struct platform_device *pdev)
++{
++      struct resource *res;
++      const struct of_device_id *id;
++
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      reg_base = devm_ioremap_resource(&pdev->dev, res);
++      if (IS_ERR(reg_base))
++              return PTR_ERR(reg_base);
++
++      ti_reset_controller.of_node = pdev->dev.of_node;
++      id = of_match_device(ti_reset_of_match, &pdev->dev);
++      reset_data = id->data;
++      ti_reset_controller.nr_resets = reset_data->nr_resets;
++
++      reset_controller_register(&ti_reset_controller);
++
++      return 0;
++}
++
++static int ti_reset_remove(struct platform_device *pdev)
++{
++      reset_controller_unregister(&ti_reset_controller);
++
++      return 0;
++}
++
++static struct platform_driver ti_reset_driver = {
++      .probe  = ti_reset_probe,
++      .remove = ti_reset_remove,
++      .driver = {
++              .name           = DRIVER_NAME,
++              .owner          = THIS_MODULE,
++              .of_match_table = of_match_ptr(ti_reset_of_match),
++      },
++};
++module_platform_driver(ti_reset_driver);
++
++MODULE_DESCRIPTION("PRCM reset driver for TI SoC's");
++MODULE_LICENSE("GPL v2");
++MODULE_ALIAS("platform:" DRIVER_NAME);
+--- a/drivers/rtc/rtc-omap.c
++++ b/drivers/rtc/rtc-omap.c
+@@ -393,6 +393,10 @@ static int __init omap_rtc_probe(struct
+        */
+       rtc_write(0, OMAP_RTC_INTERRUPTS_REG);
++      /* Selecting CLK cource for RTC */
++      rtc_writel((1 << 3) | (1 << 6), OMAP_RTC_OSC_REG);
++      rtc_writel(0x3, OMAP_RTC_IRQWAKEEN);
++
+       /* clear old status */
+       reg = rtc_read(OMAP_RTC_STATUS_REG);
+       if (reg & (u8) OMAP_RTC_STATUS_POWER_UP) {
+--- a/drivers/spi/spi-ti-qspi.c
++++ b/drivers/spi/spi-ti-qspi.c
+@@ -41,14 +41,13 @@ struct ti_qspi_regs {
+ struct ti_qspi {
+       struct completion       transfer_complete;
+-      /* IRQ synchronization */
+-      spinlock_t              lock;
+-
+       /* list synchronization */
+       struct mutex            list_lock;
+       struct spi_master       *master;
+       void __iomem            *base;
++      void __iomem            *ctrl_base;
++      void __iomem            *mmap_base;
+       struct clk              *fclk;
+       struct device           *dev;
+@@ -57,7 +56,9 @@ struct ti_qspi {
+       u32 spi_max_frequency;
+       u32 cmd;
+       u32 dc;
+-      u32 stat;
++
++      bool memory_mapped;
++      bool ctrl_mod;
+ };
+ #define QSPI_PID                      (0x0)
+@@ -113,6 +114,23 @@ struct ti_qspi {
+ #define QSPI_CSPOL(n)                 (1 << (1 + n * 8))
+ #define QSPI_CKPOL(n)                 (1 << (n * 8))
++#define MM_SWITCH     0x01
++#define MEM_CS                0x100
++#define MEM_CS_DIS    0xfffff0ff
++
++#define       QSPI_CMD_RD             (0x3 << 0)
++#define QSPI_CMD_DUAL_RD      (0x3b << 0)
++#define       QSPI_CMD_QUAD_RD        (0x6b << 0)
++#define       QSPI_CMD_READ_FAST      (0x0b << 0)
++#define       QSPI_SETUP0_A_BYTES     (0x3 << 8)
++#define       QSPI_SETUP0_NO_BITS     (0x0 << 10)
++#define       QSPI_SETUP0_8_BITS      (0x1 << 10)
++#define       QSPI_SETUP0_RD_NORMAL   (0x0 << 12)
++#define QSPI_SETUP0_RD_DUAL   (0x1 << 12)
++#define       QSPI_SETUP0_RD_QUAD     (0x3 << 12)
++#define       QSPI_CMD_WRITE          (0x2 << 16)
++#define       QSPI_NUM_DUMMY_BITS     (0x0 << 24)
++
+ #define       QSPI_FRAME                      4096
+ #define QSPI_AUTOSUSPEND_TIMEOUT         2000
+@@ -129,12 +147,37 @@ static inline void ti_qspi_write(struct
+       writel(val, qspi->base + reg);
+ }
++void enable_qspi_memory_mapped(struct ti_qspi *qspi)
++{
++      u32 val;
++
++      ti_qspi_write(qspi, MM_SWITCH, QSPI_SPI_SWITCH_REG);
++      if (qspi->ctrl_mod) {
++              val = readl(qspi->ctrl_base);
++              val |= MEM_CS;
++              writel(val, qspi->ctrl_base);
++      }
++}
++
++void disable_qspi_memory_mapped(struct ti_qspi *qspi)
++{
++      u32 val;
++
++      ti_qspi_write(qspi, ~MM_SWITCH, QSPI_SPI_SWITCH_REG);
++      if (qspi->ctrl_mod) {
++              val = readl(qspi->ctrl_base);
++              val |= MEM_CS_DIS;
++              writel(val, qspi->ctrl_base);
++      }
++}
++
+ static int ti_qspi_setup(struct spi_device *spi)
+ {
+       struct ti_qspi  *qspi = spi_master_get_devdata(spi->master);
+       struct ti_qspi_regs *ctx_reg = &qspi->ctx_reg;
+       int clk_div = 0, ret;
+-      u32 clk_ctrl_reg, clk_rate, clk_mask;
++      u32 clk_ctrl_reg, clk_rate, clk_mask, memval = 0;
++      qspi->dc = 0;
+       if (spi->master->busy) {
+               dev_dbg(qspi->dev, "master busy doing other trasnfers\n");
+@@ -182,6 +225,37 @@ static int ti_qspi_setup(struct spi_devi
+       ti_qspi_write(qspi, clk_mask, QSPI_SPI_CLOCK_CNTRL_REG);
+       ctx_reg->clkctrl = clk_mask;
++      if (spi->mode & SPI_CPHA)
++              qspi->dc |= QSPI_CKPHA(spi->chip_select);
++      if (spi->mode & SPI_CPOL)
++              qspi->dc |= QSPI_CKPOL(spi->chip_select);
++      if (spi->mode & SPI_CS_HIGH)
++              qspi->dc |= QSPI_CSPOL(spi->chip_select);
++
++      ti_qspi_write(qspi, qspi->dc, QSPI_SPI_DC_REG);
++
++      if (qspi->memory_mapped) {
++              switch (spi->mode) {
++              case SPI_TX_DUAL:
++                      memval |= (QSPI_CMD_DUAL_RD | QSPI_SETUP0_A_BYTES |
++                              QSPI_SETUP0_8_BITS | QSPI_SETUP0_RD_DUAL |
++                              QSPI_CMD_WRITE | QSPI_NUM_DUMMY_BITS);
++                      break;
++              case SPI_TX_QUAD:
++                      memval |= (QSPI_CMD_QUAD_RD | QSPI_SETUP0_A_BYTES |
++                              QSPI_SETUP0_8_BITS | QSPI_SETUP0_RD_QUAD |
++                              QSPI_CMD_WRITE | QSPI_NUM_DUMMY_BITS);
++                      break;
++              default:
++                      memval |= (QSPI_CMD_RD | QSPI_SETUP0_A_BYTES |
++                              QSPI_SETUP0_NO_BITS | QSPI_SETUP0_RD_NORMAL |
++                              QSPI_CMD_WRITE | QSPI_NUM_DUMMY_BITS);
++                      break;
++              }
++              ti_qspi_write(qspi, memval, QSPI_SPI_SETUP0_REG);
++              spi->mode |= SPI_RX_MMAP;
++      }
++
+       pm_runtime_mark_last_busy(qspi->dev);
+       ret = pm_runtime_put_autosuspend(qspi->dev);
+       if (ret < 0) {
+@@ -344,16 +418,7 @@ static int ti_qspi_start_transfer_one(st
+       struct spi_transfer *t;
+       int status = 0, ret;
+       int frame_length;
+-
+-      /* setup device control reg */
+-      qspi->dc = 0;
+-
+-      if (spi->mode & SPI_CPHA)
+-              qspi->dc |= QSPI_CKPHA(spi->chip_select);
+-      if (spi->mode & SPI_CPOL)
+-              qspi->dc |= QSPI_CKPOL(spi->chip_select);
+-      if (spi->mode & SPI_CS_HIGH)
+-              qspi->dc |= QSPI_CSPOL(spi->chip_select);
++      size_t from = 0;
+       frame_length = (m->frame_length << 3) / spi->bits_per_word;
+@@ -366,11 +431,20 @@ static int ti_qspi_start_transfer_one(st
+       qspi->cmd |= QSPI_WC_CMD_INT_EN;
+       ti_qspi_write(qspi, QSPI_WC_INT_EN, QSPI_INTR_ENABLE_SET_REG);
+-      ti_qspi_write(qspi, qspi->dc, QSPI_SPI_DC_REG);
+       mutex_lock(&qspi->list_lock);
+       list_for_each_entry(t, &m->transfers, transfer_list) {
++              if (t->memory_map) {
++                      if (t->tx_buf) {
++                              from = t->len;
++                              continue;
++                      }
++                      enable_qspi_memory_mapped(qspi);
++                      memcpy(t->rx_buf, qspi->mmap_base + from, t->len);
++                      disable_qspi_memory_mapped(qspi);
++                      goto out;
++              }
+               qspi->cmd |= QSPI_WLEN(t->bits_per_word);
+               ret = qspi_transfer_msg(qspi, t);
+@@ -383,6 +457,7 @@ static int ti_qspi_start_transfer_one(st
+               m->actual_length += t->len;
+       }
++out:
+       mutex_unlock(&qspi->list_lock);
+       m->status = status;
+@@ -397,13 +472,12 @@ static irqreturn_t ti_qspi_isr(int irq,
+ {
+       struct ti_qspi *qspi = dev_id;
+       u16 int_stat;
++      u32 stat;
+       irqreturn_t ret = IRQ_HANDLED;
+-      spin_lock(&qspi->lock);
+-
+       int_stat = ti_qspi_read(qspi, QSPI_INTR_STATUS_ENABLED_CLEAR);
+-      qspi->stat = ti_qspi_read(qspi, QSPI_SPI_STATUS_REG);
++      stat = ti_qspi_read(qspi, QSPI_SPI_STATUS_REG);
+       if (!int_stat) {
+               dev_dbg(qspi->dev, "No IRQ triggered\n");
+@@ -411,35 +485,14 @@ static irqreturn_t ti_qspi_isr(int irq,
+               goto out;
+       }
+-      ret = IRQ_WAKE_THREAD;
+-
+-      ti_qspi_write(qspi, QSPI_WC_INT_DISABLE, QSPI_INTR_ENABLE_CLEAR_REG);
+       ti_qspi_write(qspi, QSPI_WC_INT_DISABLE,
+                               QSPI_INTR_STATUS_ENABLED_CLEAR);
+-
++      if (stat & WC)
++              complete(&qspi->transfer_complete);
+ out:
+-      spin_unlock(&qspi->lock);
+-
+       return ret;
+ }
+-static irqreturn_t ti_qspi_threaded_isr(int this_irq, void *dev_id)
+-{
+-      struct ti_qspi *qspi = dev_id;
+-      unsigned long flags;
+-
+-      spin_lock_irqsave(&qspi->lock, flags);
+-
+-      if (qspi->stat & WC)
+-              complete(&qspi->transfer_complete);
+-
+-      spin_unlock_irqrestore(&qspi->lock, flags);
+-
+-      ti_qspi_write(qspi, QSPI_WC_INT_EN, QSPI_INTR_ENABLE_SET_REG);
+-
+-      return IRQ_HANDLED;
+-}
+-
+ static int ti_qspi_runtime_resume(struct device *dev)
+ {
+       struct ti_qspi      *qspi;
+@@ -463,7 +516,7 @@ static int ti_qspi_probe(struct platform
+ {
+       struct  ti_qspi *qspi;
+       struct spi_master *master;
+-      struct resource         *r;
++      struct resource         *r, *res_ctrl, *res_mmap;
+       struct device_node *np = pdev->dev.of_node;
+       u32 max_freq;
+       int ret = 0, num_cs, irq;
+@@ -472,7 +525,7 @@ static int ti_qspi_probe(struct platform
+       if (!master)
+               return -ENOMEM;
+-      master->mode_bits = SPI_CPOL | SPI_CPHA;
++      master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_RX_QUAD | SPI_RX_MMAP;
+       master->bus_num = -1;
+       master->flags = SPI_MASTER_HALF_DUPLEX;
+@@ -491,7 +544,16 @@ static int ti_qspi_probe(struct platform
+       qspi->master = master;
+       qspi->dev = &pdev->dev;
+-      r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "qspi_base");
++      if (r == NULL) {
++              dev_err(&pdev->dev, "missing platform resources data\n");
++              return -ENODEV;
++      }
++
++      res_mmap = platform_get_resource_byname(pdev,
++                      IORESOURCE_MEM, "qspi_mmap");
++      res_ctrl = platform_get_resource_byname(pdev,
++                      IORESOURCE_MEM, "qspi_ctrlmod");
+       irq = platform_get_irq(pdev, 0);
+       if (irq < 0) {
+@@ -499,7 +561,6 @@ static int ti_qspi_probe(struct platform
+               return irq;
+       }
+-      spin_lock_init(&qspi->lock);
+       mutex_init(&qspi->list_lock);
+       qspi->base = devm_ioremap_resource(&pdev->dev, r);
+@@ -508,8 +569,24 @@ static int ti_qspi_probe(struct platform
+               goto free_master;
+       }
+-      ret = devm_request_threaded_irq(&pdev->dev, irq, ti_qspi_isr,
+-                      ti_qspi_threaded_isr, 0,
++      if (res_ctrl) {
++              qspi->ctrl_mod = true;
++              qspi->ctrl_base = devm_ioremap_resource(&pdev->dev, res_ctrl);
++              if (IS_ERR(qspi->ctrl_base)) {
++                      ret = PTR_ERR(qspi->ctrl_base);
++                      goto free_master;
++              }
++      }
++
++      if (res_mmap) {
++              qspi->mmap_base = devm_ioremap_resource(&pdev->dev, res_mmap);
++              if (IS_ERR(qspi->mmap_base)) {
++                      ret = PTR_ERR(qspi->mmap_base);
++                      goto free_master;
++              }
++      }
++
++      ret = devm_request_irq(&pdev->dev, irq, ti_qspi_isr, 0,
+                       dev_name(&pdev->dev), qspi);
+       if (ret < 0) {
+               dev_err(&pdev->dev, "Failed to register ISR for IRQ %d\n",
+@@ -532,6 +609,9 @@ static int ti_qspi_probe(struct platform
+       if (!of_property_read_u32(np, "spi-max-frequency", &max_freq))
+               qspi->spi_max_frequency = max_freq;
++      if (of_property_read_bool(np, "mmap_read"))
++              qspi->memory_mapped = true;
++
+       ret = spi_register_master(master);
+       if (ret)
+               goto free_master;
+@@ -547,6 +627,7 @@ static int ti_qspi_remove(struct platfor
+ {
+       struct  ti_qspi *qspi = platform_get_drvdata(pdev);
++      ti_qspi_write(qspi, QSPI_WC_INT_DISABLE, QSPI_INTR_ENABLE_CLEAR_REG);
+       spi_unregister_master(qspi->master);
+       return 0;
+--- a/drivers/tty/serial/omap-serial.c
++++ b/drivers/tty/serial/omap-serial.c
+@@ -240,8 +240,8 @@ serial_omap_baud_is_mode16(struct uart_p
+ {
+       unsigned int n13 = port->uartclk / (13 * baud);
+       unsigned int n16 = port->uartclk / (16 * baud);
+-      int baudAbsDiff13 = baud - (port->uartclk / (13 * n13));
+-      int baudAbsDiff16 = baud - (port->uartclk / (16 * n16));
++      int baudAbsDiff13 = n13 ? (baud - (port->uartclk / (13 * n13))) : INT_MAX;
++      int baudAbsDiff16 = n16 ? (baud - (port->uartclk / (16 * n16))) : INT_MAX;
+       if(baudAbsDiff13 < 0)
+               baudAbsDiff13 = -baudAbsDiff13;
+       if(baudAbsDiff16 < 0)
+--- a/drivers/usb/dwc3/core.c
++++ b/drivers/usb/dwc3/core.c
+@@ -80,8 +80,6 @@ static void dwc3_core_soft_reset(struct
+       reg |= DWC3_GUSB2PHYCFG_PHYSOFTRST;
+       dwc3_writel(dwc->regs, DWC3_GUSB2PHYCFG(0), reg);
+-      usb_phy_init(dwc->usb2_phy);
+-      usb_phy_init(dwc->usb3_phy);
+       mdelay(100);
+       /* Clear USB3 PHY reset */
+@@ -343,6 +341,11 @@ static void dwc3_core_exit(struct dwc3 *
+ {
+       usb_phy_shutdown(dwc->usb2_phy);
+       usb_phy_shutdown(dwc->usb3_phy);
++
++      if (dwc->usb2_generic_phy)
++              phy_power_off(dwc->usb2_generic_phy);
++      if (dwc->usb3_generic_phy)
++              phy_power_off(dwc->usb3_generic_phy);
+ }
+ #define DWC3_ALIGN_MASK               (16 - 1)
+@@ -387,16 +390,102 @@ static int dwc3_probe(struct platform_de
+       if (node) {
+               dwc->maximum_speed = of_usb_get_maximum_speed(node);
+-              dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 0);
+-              dwc->usb3_phy = devm_usb_get_phy_by_phandle(dev, "usb-phy", 1);
++              switch (dwc->maximum_speed) {
++              case USB_SPEED_SUPER:
++                      if (of_property_read_bool(node, "usb-phy")) {
++                              dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev,
++                                      "usb-phy", 0);
++                              if (IS_ERR(dwc->usb2_phy))
++                                      return PTR_ERR(dwc->usb2_phy);
++                              dwc->usb3_phy = devm_usb_get_phy_by_phandle(dev,
++                                      "usb-phy", 1);
++                              if (IS_ERR(dwc->usb3_phy))
++                                      return PTR_ERR(dwc->usb3_phy);
++                      } else {
++                              dwc->usb2_phy = NULL;
++                              dwc->usb3_phy = NULL;
++                      }
++
++                      if (of_property_read_bool(node, "phys")) {
++                              dwc->usb2_generic_phy = devm_phy_get(dev,
++                                      "usb2-phy");
++                              if (IS_ERR(dwc->usb2_generic_phy)) {
++                                      dev_err(dev, "no usb2 phy configured");
++                                      return PTR_ERR(dwc->usb2_generic_phy);
++                              }
++
++                              dwc->usb3_generic_phy = devm_phy_get(dev,
++                                      "usb3-phy");
++                              if (IS_ERR(dwc->usb3_generic_phy)) {
++                                      dev_err(dev, "no usb3 phy configured");
++                                      return PTR_ERR(dwc->usb3_generic_phy);
++                              }
++                      } else {
++                              dwc->usb2_generic_phy = NULL;
++                              dwc->usb3_generic_phy = NULL;
++                      }
++                      break;
++              case USB_SPEED_HIGH:
++              case USB_SPEED_FULL:
++              case USB_SPEED_LOW:
++                      dwc->usb3_phy = NULL;
++                      dwc->usb3_generic_phy = NULL;
++                      if (of_property_read_bool(node, "usb-phy")) {
++                              dwc->usb2_phy = devm_usb_get_phy_by_phandle(dev,
++                                      "usb-phy", 0);
++                              if (IS_ERR(dwc->usb2_phy))
++                                      return PTR_ERR(dwc->usb2_phy);
++                      } else {
++                              dwc->usb2_phy = NULL;
++                      }
++                      if (of_property_read_bool(node, "phys")) {
++                              dwc->usb2_generic_phy = devm_phy_get(dev,
++                                      "usb2-phy");
++                              if (IS_ERR(dwc->usb2_generic_phy)) {
++                                      dev_err(dev, "no usb2 phy configured");
++                                      return PTR_ERR(dwc->usb2_generic_phy);
++                      }
++                      } else {
++                              dwc->usb2_generic_phy = NULL;
++                      }
++                      break;
++              }
+               dwc->needs_fifo_resize = of_property_read_bool(node, "tx-fifo-resize");
+               dwc->dr_mode = of_usb_get_dr_mode(node);
+       } else if (pdata) {
+               dwc->maximum_speed = pdata->maximum_speed;
+-              dwc->usb2_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB2);
+-              dwc->usb3_phy = devm_usb_get_phy(dev, USB_PHY_TYPE_USB3);
++              switch (dwc->maximum_speed) {
++              case USB_SPEED_SUPER:
++                      if (pdata->has_phy) {
++                              dwc->usb2_phy = devm_usb_get_phy(dev,
++                                      USB_PHY_TYPE_USB2);
++                              if (IS_ERR(dwc->usb2_phy))
++                                      return PTR_ERR(dwc->usb2_phy);
++                              dwc->usb3_phy = devm_usb_get_phy(dev,
++                                      USB_PHY_TYPE_USB3);
++                              if (IS_ERR(dwc->usb3_phy))
++                                      return PTR_ERR(dwc->usb3_phy);
++                      } else {
++                              dwc->usb2_phy = NULL;
++                              dwc->usb3_phy = NULL;
++                      }
++                      break;
++              case USB_SPEED_HIGH:
++              case USB_SPEED_FULL:
++              case USB_SPEED_LOW:
++                      dwc->usb3_phy = NULL;
++                      if (pdata->has_phy) {
++                              dwc->usb2_phy = devm_usb_get_phy(dev,
++                                      USB_PHY_TYPE_USB2);
++                              if (IS_ERR(dwc->usb2_phy))
++                                      return PTR_ERR(dwc->usb2_phy);
++                      } else {
++                              dwc->usb2_phy = NULL;
++                      }
++                      break;
++              }
+               dwc->needs_fifo_resize = pdata->tx_fifo_resize;
+               dwc->dr_mode = pdata->dr_mode;
+@@ -409,36 +498,6 @@ static int dwc3_probe(struct platform_de
+       if (dwc->maximum_speed == USB_SPEED_UNKNOWN)
+               dwc->maximum_speed = USB_SPEED_SUPER;
+-      if (IS_ERR(dwc->usb2_phy)) {
+-              ret = PTR_ERR(dwc->usb2_phy);
+-
+-              /*
+-               * if -ENXIO is returned, it means PHY layer wasn't
+-               * enabled, so it makes no sense to return -EPROBE_DEFER
+-               * in that case, since no PHY driver will ever probe.
+-               */
+-              if (ret == -ENXIO)
+-                      return ret;
+-
+-              dev_err(dev, "no usb2 phy configured\n");
+-              return -EPROBE_DEFER;
+-      }
+-
+-      if (IS_ERR(dwc->usb3_phy)) {
+-              ret = PTR_ERR(dwc->usb3_phy);
+-
+-              /*
+-               * if -ENXIO is returned, it means PHY layer wasn't
+-               * enabled, so it makes no sense to return -EPROBE_DEFER
+-               * in that case, since no PHY driver will ever probe.
+-               */
+-              if (ret == -ENXIO)
+-                      return ret;
+-
+-              dev_err(dev, "no usb3 phy configured\n");
+-              return -EPROBE_DEFER;
+-      }
+-
+       dwc->xhci_resources[0].start = res->start;
+       dwc->xhci_resources[0].end = dwc->xhci_resources[0].start +
+                                       DWC3_XHCI_REGS_END;
+@@ -455,9 +514,20 @@ static int dwc3_probe(struct platform_de
+       if (IS_ERR(regs))
+               return PTR_ERR(regs);
++      usb_phy_init(dwc->usb2_phy);
++      usb_phy_init(dwc->usb3_phy);
+       usb_phy_set_suspend(dwc->usb2_phy, 0);
+       usb_phy_set_suspend(dwc->usb3_phy, 0);
++      if (dwc->usb2_generic_phy) {
++              phy_init(dwc->usb2_generic_phy);
++              phy_power_on(dwc->usb2_generic_phy);
++      }
++      if (dwc->usb3_generic_phy) {
++              phy_init(dwc->usb3_generic_phy);
++              phy_power_on(dwc->usb3_generic_phy);
++      }
++
+       spin_lock_init(&dwc->lock);
+       platform_set_drvdata(pdev, dwc);
+@@ -584,7 +654,12 @@ static int dwc3_remove(struct platform_d
+       usb_phy_set_suspend(dwc->usb2_phy, 1);
+       usb_phy_set_suspend(dwc->usb3_phy, 1);
+-      pm_runtime_put(&pdev->dev);
++      if (dwc->usb2_generic_phy)
++              phy_power_off(dwc->usb2_generic_phy);
++      if (dwc->usb3_generic_phy)
++              phy_power_off(dwc->usb3_generic_phy);
++
++      pm_runtime_put_sync(&pdev->dev);
+       pm_runtime_disable(&pdev->dev);
+       dwc3_debugfs_exit(dwc);
+@@ -681,6 +756,11 @@ static int dwc3_suspend(struct device *d
+       usb_phy_shutdown(dwc->usb3_phy);
+       usb_phy_shutdown(dwc->usb2_phy);
++      if (dwc->usb2_generic_phy)
++              phy_exit(dwc->usb2_generic_phy);
++      if (dwc->usb3_generic_phy)
++              phy_exit(dwc->usb3_generic_phy);
++
+       return 0;
+ }
+@@ -691,6 +771,12 @@ static int dwc3_resume(struct device *de
+       usb_phy_init(dwc->usb3_phy);
+       usb_phy_init(dwc->usb2_phy);
++
++      if (dwc->usb2_generic_phy)
++              phy_init(dwc->usb2_generic_phy);
++      if (dwc->usb3_generic_phy)
++              phy_init(dwc->usb3_generic_phy);
++
+       msleep(100);
+       spin_lock_irqsave(&dwc->lock, flags);
+--- a/drivers/usb/dwc3/core.h
++++ b/drivers/usb/dwc3/core.h
+@@ -31,6 +31,8 @@
+ #include <linux/usb/gadget.h>
+ #include <linux/usb/otg.h>
++#include <linux/phy/phy.h>
++
+ /* Global constants */
+ #define DWC3_EP0_BOUNCE_SIZE  512
+ #define DWC3_ENDPOINTS_NUM    32
+@@ -613,6 +615,8 @@ struct dwc3_scratchpad_array {
+  * @dr_mode: requested mode of operation
+  * @usb2_phy: pointer to USB2 PHY
+  * @usb3_phy: pointer to USB3 PHY
++ * @usb2_generic_phy: pointer to USB2 PHY
++ * @usb3_generic_phy: pointer to USB3 PHY
+  * @dcfg: saved contents of DCFG register
+  * @gctl: saved contents of GCTL register
+  * @is_selfpowered: true when we are selfpowered
+@@ -665,6 +669,9 @@ struct dwc3 {
+       struct usb_phy          *usb2_phy;
+       struct usb_phy          *usb3_phy;
++      struct phy              *usb2_generic_phy;
++      struct phy              *usb3_generic_phy;
++
+       void __iomem            *regs;
+       size_t                  regs_size;
+--- a/drivers/usb/dwc3/dwc3-omap.c
++++ b/drivers/usb/dwc3/dwc3-omap.c
+@@ -535,7 +535,7 @@ static int dwc3_omap_probe(struct platfo
+               edev = of_extcon_get_extcon_dev(dev, 0);
+               if (IS_ERR(edev)) {
+                       dev_vdbg(dev, "couldn't get extcon device\n");
+-                      ret = PTR_ERR(edev);
++                      ret = -EPROBE_DEFER;
+                       goto err2;
+               }
+--- a/drivers/usb/dwc3/dwc3-pci.c
++++ b/drivers/usb/dwc3/dwc3-pci.c
+@@ -165,7 +165,6 @@ static int dwc3_pci_probe(struct pci_dev
+       return 0;
+ err3:
+-      pci_set_drvdata(pci, NULL);
+       platform_device_put(dwc3);
+ err1:
+       pci_disable_device(pci);
+@@ -180,7 +179,6 @@ static void dwc3_pci_remove(struct pci_d
+       platform_device_unregister(glue->dwc3);
+       platform_device_unregister(glue->usb2_phy);
+       platform_device_unregister(glue->usb3_phy);
+-      pci_set_drvdata(pci, NULL);
+       pci_disable_device(pci);
+ }
+--- a/drivers/usb/dwc3/Kconfig
++++ b/drivers/usb/dwc3/Kconfig
+@@ -1,6 +1,9 @@
+ config USB_DWC3
+       tristate "DesignWare USB3 DRD Core Support"
+       depends on (USB || USB_GADGET) && HAS_DMA
++      depends on EXTCON
++      select USB_PHY
++      select GENERIC_PHY
+       select USB_XHCI_PLATFORM if USB_SUPPORT && USB_XHCI_HCD
+       help
+         Say Y or M here if your system has a Dual Role SuperSpeed
+--- a/drivers/usb/dwc3/platform_data.h
++++ b/drivers/usb/dwc3/platform_data.h
+@@ -24,4 +24,5 @@ struct dwc3_platform_data {
+       enum usb_device_speed maximum_speed;
+       enum usb_dr_mode dr_mode;
+       bool tx_fifo_resize;
++      bool has_phy;
+ };
+--- a/drivers/usb/gadget/acm_ms.c
++++ b/drivers/usb/gadget/acm_ms.c
+@@ -31,16 +31,7 @@
+ #define ACM_MS_VENDOR_NUM     0x1d6b  /* Linux Foundation */
+ #define ACM_MS_PRODUCT_NUM    0x0106  /* Composite Gadget: ACM + MS*/
+-/*-------------------------------------------------------------------------*/
+-
+-/*
+- * Kbuild is not very cooperative with respect to linking separately
+- * compiled library objects into one module.  So for now we won't use
+- * separate compilation ... ensuring init/exit sections work to shrink
+- * the runtime footprint, and giving us at least some parts of what
+- * a "gcc --combine ... part1.c part2.c part3.c ... " build would.
+- */
+-#include "f_mass_storage.c"
++#include "f_mass_storage.h"
+ /*-------------------------------------------------------------------------*/
+ USB_GADGET_COMPOSITE_OPTIONS();
+@@ -104,18 +95,35 @@ static struct usb_gadget_strings *dev_st
+ /****************************** Configurations ******************************/
+ static struct fsg_module_parameters fsg_mod_data = { .stall = 1 };
+-FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data);
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++
++static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS;
+-static struct fsg_common fsg_common;
++#else
++
++/*
++ * Number of buffers we will use.
++ * 2 is usually enough for good buffering pipeline
++ */
++#define fsg_num_buffers       CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS
++
++#endif /* CONFIG_USB_DEBUG */
++
++FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data);
+ /*-------------------------------------------------------------------------*/
+ static struct usb_function *f_acm;
+ static struct usb_function_instance *f_acm_inst;
++
++static struct usb_function_instance *fi_msg;
++static struct usb_function *f_msg;
++
+ /*
+  * We _always_ have both ACM and mass storage functions.
+  */
+ static int __init acm_ms_do_config(struct usb_configuration *c)
+ {
++      struct fsg_opts *opts;
+       int     status;
+       if (gadget_is_otg(c->cdev->gadget)) {
+@@ -123,31 +131,37 @@ static int __init acm_ms_do_config(struc
+               c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
+       }
+-      f_acm_inst = usb_get_function_instance("acm");
+-      if (IS_ERR(f_acm_inst))
+-              return PTR_ERR(f_acm_inst);
++      opts = fsg_opts_from_func_inst(fi_msg);
+       f_acm = usb_get_function(f_acm_inst);
+-      if (IS_ERR(f_acm)) {
+-              status = PTR_ERR(f_acm);
+-              goto err_func;
++      if (IS_ERR(f_acm))
++              return PTR_ERR(f_acm);
++
++      f_msg = usb_get_function(fi_msg);
++      if (IS_ERR(f_msg)) {
++              status = PTR_ERR(f_msg);
++              goto put_acm;
+       }
+       status = usb_add_function(c, f_acm);
+       if (status < 0)
+-              goto err_conf;
++              goto put_msg;
+-      status = fsg_bind_config(c->cdev, c, &fsg_common);
+-      if (status < 0)
+-              goto err_fsg;
++      status = fsg_common_run_thread(opts->common);
++      if (status)
++              goto remove_acm;
++
++      status = usb_add_function(c, f_msg);
++      if (status)
++              goto remove_acm;
+       return 0;
+-err_fsg:
++remove_acm:
+       usb_remove_function(c, f_acm);
+-err_conf:
++put_msg:
++      usb_put_function(f_msg);
++put_acm:
+       usb_put_function(f_acm);
+-err_func:
+-      usb_put_function_instance(f_acm_inst);
+       return status;
+ }
+@@ -163,45 +177,82 @@ static struct usb_configuration acm_ms_c
+ static int __init acm_ms_bind(struct usb_composite_dev *cdev)
+ {
+       struct usb_gadget       *gadget = cdev->gadget;
++      struct fsg_opts         *opts;
++      struct fsg_config       config;
+       int                     status;
+-      void                    *retp;
+-      /* set up mass storage function */
+-      retp = fsg_common_from_params(&fsg_common, cdev, &fsg_mod_data);
+-      if (IS_ERR(retp)) {
+-              status = PTR_ERR(retp);
+-              return PTR_ERR(retp);
++      f_acm_inst = usb_get_function_instance("acm");
++      if (IS_ERR(f_acm_inst))
++              return PTR_ERR(f_acm_inst);
++
++      fi_msg = usb_get_function_instance("mass_storage");
++      if (IS_ERR(fi_msg)) {
++              status = PTR_ERR(fi_msg);
++              goto fail_get_msg;
+       }
++      /* set up mass storage function */
++      fsg_config_from_params(&config, &fsg_mod_data, fsg_num_buffers);
++      opts = fsg_opts_from_func_inst(fi_msg);
++
++      opts->no_configfs = true;
++      status = fsg_common_set_num_buffers(opts->common, fsg_num_buffers);
++      if (status)
++              goto fail;
++
++      status = fsg_common_set_nluns(opts->common, config.nluns);
++      if (status)
++              goto fail_set_nluns;
++
++      status = fsg_common_set_cdev(opts->common, cdev, config.can_stall);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_sysfs(opts->common, true);
++      status = fsg_common_create_luns(opts->common, &config);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_inquiry_string(opts->common, config.vendor_name,
++                                    config.product_name);
+       /*
+        * Allocate string descriptor numbers ... note that string
+        * contents can be overridden by the composite_dev glue.
+        */
+       status = usb_string_ids_tab(cdev, strings_dev);
+       if (status < 0)
+-              goto fail1;
++              goto fail_string_ids;
+       device_desc.iManufacturer = strings_dev[USB_GADGET_MANUFACTURER_IDX].id;
+       device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
+       /* register our configuration */
+       status = usb_add_config(cdev, &acm_ms_config_driver, acm_ms_do_config);
+       if (status < 0)
+-              goto fail1;
++              goto fail_string_ids;
+       usb_composite_overwrite_options(cdev, &coverwrite);
+       dev_info(&gadget->dev, "%s, version: " DRIVER_VERSION "\n",
+                       DRIVER_DESC);
+-      fsg_common_put(&fsg_common);
+       return 0;
+       /* error recovery */
+-fail1:
+-      fsg_common_put(&fsg_common);
++fail_string_ids:
++      fsg_common_remove_luns(opts->common);
++fail_set_cdev:
++      fsg_common_free_luns(opts->common);
++fail_set_nluns:
++      fsg_common_free_buffers(opts->common);
++fail:
++      usb_put_function_instance(fi_msg);
++fail_get_msg:
++      usb_put_function_instance(f_acm_inst);
+       return status;
+ }
+ static int __exit acm_ms_unbind(struct usb_composite_dev *cdev)
+ {
++      usb_put_function(f_msg);
++      usb_put_function_instance(fi_msg);
+       usb_put_function(f_acm);
+       usb_put_function_instance(f_acm_inst);
+       return 0;
+--- a/drivers/usb/gadget/amd5536udc.c
++++ b/drivers/usb/gadget/amd5536udc.c
+@@ -3078,8 +3078,6 @@ static void udc_pci_remove(struct pci_de
+       if (dev->active)
+               pci_disable_device(pdev);
+-      pci_set_drvdata(pdev, NULL);
+-
+       udc_remove(dev);
+ }
+--- a/drivers/usb/gadget/configfs.c
++++ b/drivers/usb/gadget/configfs.c
+@@ -557,7 +557,7 @@ static struct config_group *function_mak
+       fi = usb_get_function_instance(func_name);
+       if (IS_ERR(fi))
+-              return ERR_PTR(PTR_ERR(fi));
++              return ERR_CAST(fi);
+       ret = config_item_set_name(&fi->group.cg_item, name);
+       if (ret) {
+@@ -991,6 +991,14 @@ static struct configfs_subsystem gadget_
+       .su_mutex = __MUTEX_INITIALIZER(gadget_subsys.su_mutex),
+ };
++void unregister_gadget_item(struct config_item *item)
++{
++      struct gadget_info *gi = to_gadget_info(item);
++
++      unregister_gadget(gi);
++}
++EXPORT_SYMBOL(unregister_gadget_item);
++
+ static int __init gadget_cfs_init(void)
+ {
+       int ret;
+--- /dev/null
++++ b/drivers/usb/gadget/configfs.h
+@@ -0,0 +1,6 @@
++#ifndef USB__GADGET__CONFIGFS__H
++#define USB__GADGET__CONFIGFS__H
++
++void unregister_gadget_item(struct config_item *item);
++
++#endif /*  USB__GADGET__CONFIGFS__H */
+--- a/drivers/usb/gadget/f_mass_storage.c
++++ b/drivers/usb/gadget/f_mass_storage.c
+@@ -213,12 +213,14 @@
+ #include <linux/spinlock.h>
+ #include <linux/string.h>
+ #include <linux/freezer.h>
++#include <linux/module.h>
+ #include <linux/usb/ch9.h>
+ #include <linux/usb/gadget.h>
+ #include <linux/usb/composite.h>
+ #include "gadget_chips.h"
++#include "configfs.h"
+ /*------------------------------------------------------------------------*/
+@@ -228,26 +230,30 @@
+ static const char fsg_string_interface[] = "Mass Storage";
+-#include "storage_common.c"
++#include "storage_common.h"
++#include "f_mass_storage.h"
++/* Static strings, in UTF-8 (for simplicity we use only ASCII characters) */
++static struct usb_string              fsg_strings[] = {
++      {FSG_STRING_INTERFACE,          fsg_string_interface},
++      {}
++};
++
++static struct usb_gadget_strings      fsg_stringtab = {
++      .language       = 0x0409,               /* en-us */
++      .strings        = fsg_strings,
++};
++
++static struct usb_gadget_strings *fsg_strings_array[] = {
++      &fsg_stringtab,
++      NULL,
++};
+ /*-------------------------------------------------------------------------*/
+ struct fsg_dev;
+ struct fsg_common;
+-/* FSF callback functions */
+-struct fsg_operations {
+-      /*
+-       * Callback function to call when thread exits.  If no
+-       * callback is set or it returns value lower then zero MSF
+-       * will force eject all LUNs it operates on (including those
+-       * marked as non-removable or with prevent_medium_removal flag
+-       * set).
+-       */
+-      int (*thread_exits)(struct fsg_common *common);
+-};
+-
+ /* Data shared by all the FSG instances. */
+ struct fsg_common {
+       struct usb_gadget       *gadget;
+@@ -268,13 +274,14 @@ struct fsg_common {
+       struct fsg_buffhd       *next_buffhd_to_fill;
+       struct fsg_buffhd       *next_buffhd_to_drain;
+       struct fsg_buffhd       *buffhds;
++      unsigned int            fsg_num_buffers;
+       int                     cmnd_size;
+       u8                      cmnd[MAX_COMMAND_SIZE];
+       unsigned int            nluns;
+       unsigned int            lun;
+-      struct fsg_lun          *luns;
++      struct fsg_lun          **luns;
+       struct fsg_lun          *curlun;
+       unsigned int            bulk_out_maxpacket;
+@@ -294,6 +301,7 @@ struct fsg_common {
+       unsigned int            short_packet_received:1;
+       unsigned int            bad_lun_okay:1;
+       unsigned int            running:1;
++      unsigned int            sysfs:1;
+       int                     thread_wakeup_needed;
+       struct completion       thread_notifier;
+@@ -313,27 +321,6 @@ struct fsg_common {
+       struct kref             ref;
+ };
+-struct fsg_config {
+-      unsigned nluns;
+-      struct fsg_lun_config {
+-              const char *filename;
+-              char ro;
+-              char removable;
+-              char cdrom;
+-              char nofua;
+-      } luns[FSG_MAX_LUNS];
+-
+-      /* Callback functions. */
+-      const struct fsg_operations     *ops;
+-      /* Gadget's private data. */
+-      void                    *private_data;
+-
+-      const char *vendor_name;                /*  8 characters or less */
+-      const char *product_name;               /* 16 characters or less */
+-
+-      char                    can_stall;
+-};
+-
+ struct fsg_dev {
+       struct usb_function     function;
+       struct usb_gadget       *gadget;        /* Copy of cdev->gadget */
+@@ -615,13 +602,14 @@ static bool start_out_transfer(struct fs
+       return true;
+ }
+-static int sleep_thread(struct fsg_common *common)
++static int sleep_thread(struct fsg_common *common, bool can_freeze)
+ {
+       int     rc = 0;
+       /* Wait until a signal arrives or we are woken up */
+       for (;;) {
+-              try_to_freeze();
++              if (can_freeze)
++                      try_to_freeze();
+               set_current_state(TASK_INTERRUPTIBLE);
+               if (signal_pending(current)) {
+                       rc = -EINTR;
+@@ -695,7 +683,7 @@ static int do_read(struct fsg_common *co
+               /* Wait for the next buffer to become available */
+               bh = common->next_buffhd_to_fill;
+               while (bh->state != BUF_STATE_EMPTY) {
+-                      rc = sleep_thread(common);
++                      rc = sleep_thread(common, false);
+                       if (rc)
+                               return rc;
+               }
+@@ -950,7 +938,7 @@ static int do_write(struct fsg_common *c
+               }
+               /* Wait for something to happen */
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, false);
+               if (rc)
+                       return rc;
+       }
+@@ -1517,7 +1505,7 @@ static int throw_away_data(struct fsg_co
+               }
+               /* Otherwise wait for something to happen */
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, true);
+               if (rc)
+                       return rc;
+       }
+@@ -1638,7 +1626,7 @@ static int send_status(struct fsg_common
+       /* Wait for the next buffer to become available */
+       bh = common->next_buffhd_to_fill;
+       while (bh->state != BUF_STATE_EMPTY) {
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, true);
+               if (rc)
+                       return rc;
+       }
+@@ -1841,7 +1829,7 @@ static int do_scsi_command(struct fsg_co
+       bh = common->next_buffhd_to_fill;
+       common->next_buffhd_to_drain = bh;
+       while (bh->state != BUF_STATE_EMPTY) {
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, true);
+               if (rc)
+                       return rc;
+       }
+@@ -2172,7 +2160,7 @@ static int received_cbw(struct fsg_dev *
+               common->data_dir = DATA_DIR_NONE;
+       common->lun = cbw->Lun;
+       if (common->lun < common->nluns)
+-              common->curlun = &common->luns[common->lun];
++              common->curlun = common->luns[common->lun];
+       else
+               common->curlun = NULL;
+       common->tag = cbw->Tag;
+@@ -2187,7 +2175,7 @@ static int get_next_command(struct fsg_c
+       /* Wait for the next buffer to become available */
+       bh = common->next_buffhd_to_fill;
+       while (bh->state != BUF_STATE_EMPTY) {
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, true);
+               if (rc)
+                       return rc;
+       }
+@@ -2206,7 +2194,7 @@ static int get_next_command(struct fsg_c
+       /* Wait for the CBW to arrive */
+       while (bh->state != BUF_STATE_FULL) {
+-              rc = sleep_thread(common);
++              rc = sleep_thread(common, true);
+               if (rc)
+                       return rc;
+       }
+@@ -2244,7 +2232,7 @@ reset:
+       if (common->fsg) {
+               fsg = common->fsg;
+-              for (i = 0; i < fsg_num_buffers; ++i) {
++              for (i = 0; i < common->fsg_num_buffers; ++i) {
+                       struct fsg_buffhd *bh = &common->buffhds[i];
+                       if (bh->inreq) {
+@@ -2303,7 +2291,7 @@ reset:
+       clear_bit(IGNORE_BULK_OUT, &fsg->atomic_bitflags);
+       /* Allocate the requests */
+-      for (i = 0; i < fsg_num_buffers; ++i) {
++      for (i = 0; i < common->fsg_num_buffers; ++i) {
+               struct fsg_buffhd       *bh = &common->buffhds[i];
+               rc = alloc_request(common, fsg->bulk_in, &bh->inreq);
+@@ -2320,7 +2308,9 @@ reset:
+       common->running = 1;
+       for (i = 0; i < common->nluns; ++i)
+-              common->luns[i].unit_attention_data = SS_RESET_OCCURRED;
++              if (common->luns[i])
++                      common->luns[i]->unit_attention_data =
++                              SS_RESET_OCCURRED;
+       return rc;
+ }
+@@ -2372,7 +2362,7 @@ static void handle_exception(struct fsg_
+       /* Cancel all the pending transfers */
+       if (likely(common->fsg)) {
+-              for (i = 0; i < fsg_num_buffers; ++i) {
++              for (i = 0; i < common->fsg_num_buffers; ++i) {
+                       bh = &common->buffhds[i];
+                       if (bh->inreq_busy)
+                               usb_ep_dequeue(common->fsg->bulk_in, bh->inreq);
+@@ -2384,13 +2374,13 @@ static void handle_exception(struct fsg_
+               /* Wait until everything is idle */
+               for (;;) {
+                       int num_active = 0;
+-                      for (i = 0; i < fsg_num_buffers; ++i) {
++                      for (i = 0; i < common->fsg_num_buffers; ++i) {
+                               bh = &common->buffhds[i];
+                               num_active += bh->inreq_busy + bh->outreq_busy;
+                       }
+                       if (num_active == 0)
+                               break;
+-                      if (sleep_thread(common))
++                      if (sleep_thread(common, true))
+                               return;
+               }
+@@ -2407,7 +2397,7 @@ static void handle_exception(struct fsg_
+        */
+       spin_lock_irq(&common->lock);
+-      for (i = 0; i < fsg_num_buffers; ++i) {
++      for (i = 0; i < common->fsg_num_buffers; ++i) {
+               bh = &common->buffhds[i];
+               bh->state = BUF_STATE_EMPTY;
+       }
+@@ -2420,7 +2410,9 @@ static void handle_exception(struct fsg_
+               common->state = FSG_STATE_STATUS_PHASE;
+       else {
+               for (i = 0; i < common->nluns; ++i) {
+-                      curlun = &common->luns[i];
++                      curlun = common->luns[i];
++                      if (!curlun)
++                              continue;
+                       curlun->prevent_medium_removal = 0;
+                       curlun->sense_data = SS_NO_SENSE;
+                       curlun->unit_attention_data = SS_NO_SENSE;
+@@ -2462,8 +2454,9 @@ static void handle_exception(struct fsg_
+                * CONFIG_CHANGE cases.
+                */
+               /* for (i = 0; i < common->nluns; ++i) */
+-              /*      common->luns[i].unit_attention_data = */
+-              /*              SS_RESET_OCCURRED;  */
++              /*      if (common->luns[i]) */
++              /*              common->luns[i]->unit_attention_data = */
++              /*                      SS_RESET_OCCURRED;  */
+               break;
+       case FSG_STATE_CONFIG_CHANGE:
+@@ -2524,7 +2517,7 @@ static int fsg_main_thread(void *common_
+               }
+               if (!common->running) {
+-                      sleep_thread(common);
++                      sleep_thread(common, true);
+                       continue;
+               }
+@@ -2559,12 +2552,13 @@ static int fsg_main_thread(void *common_
+       if (!common->ops || !common->ops->thread_exits
+        || common->ops->thread_exits(common) < 0) {
+-              struct fsg_lun *curlun = common->luns;
++              struct fsg_lun **curlun_it = common->luns;
+               unsigned i = common->nluns;
+               down_write(&common->filesem);
+-              for (; i--; ++curlun) {
+-                      if (!fsg_lun_is_open(curlun))
++              for (; i--; ++curlun_it) {
++                      struct fsg_lun *curlun = *curlun_it;
++                      if (!curlun || !fsg_lun_is_open(curlun))
+                               continue;
+                       fsg_lun_close(curlun);
+@@ -2580,6 +2574,56 @@ static int fsg_main_thread(void *common_
+ /*************************** DEVICE ATTRIBUTES ***************************/
++static ssize_t ro_show(struct device *dev, struct device_attribute *attr, char *buf)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++
++      return fsg_show_ro(curlun, buf);
++}
++
++static ssize_t nofua_show(struct device *dev, struct device_attribute *attr,
++                        char *buf)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++
++      return fsg_show_nofua(curlun, buf);
++}
++
++static ssize_t file_show(struct device *dev, struct device_attribute *attr,
++                       char *buf)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
++
++      return fsg_show_file(curlun, filesem, buf);
++}
++
++static ssize_t ro_store(struct device *dev, struct device_attribute *attr,
++                      const char *buf, size_t count)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
++
++      return fsg_store_ro(curlun, filesem, buf, count);
++}
++
++static ssize_t nofua_store(struct device *dev, struct device_attribute *attr,
++                         const char *buf, size_t count)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++
++      return fsg_store_nofua(curlun, buf, count);
++}
++
++static ssize_t file_store(struct device *dev, struct device_attribute *attr,
++                        const char *buf, size_t count)
++{
++      struct fsg_lun          *curlun = fsg_lun_from_dev(dev);
++      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
++
++      return fsg_store_file(curlun, filesem, buf, count);
++}
++
+ static DEVICE_ATTR_RW(ro);
+ static DEVICE_ATTR_RW(nofua);
+ static DEVICE_ATTR_RW(file);
+@@ -2597,221 +2641,422 @@ static void fsg_lun_release(struct devic
+       /* Nothing needs to be done */
+ }
+-static inline void fsg_common_get(struct fsg_common *common)
++void fsg_common_get(struct fsg_common *common)
+ {
+       kref_get(&common->ref);
+ }
++EXPORT_SYMBOL_GPL(fsg_common_get);
+-static inline void fsg_common_put(struct fsg_common *common)
++void fsg_common_put(struct fsg_common *common)
+ {
+       kref_put(&common->ref, fsg_common_release);
+ }
++EXPORT_SYMBOL_GPL(fsg_common_put);
+-static struct fsg_common *fsg_common_init(struct fsg_common *common,
+-                                        struct usb_composite_dev *cdev,
+-                                        struct fsg_config *cfg)
+-{
+-      struct usb_gadget *gadget = cdev->gadget;
+-      struct fsg_buffhd *bh;
+-      struct fsg_lun *curlun;
+-      struct fsg_lun_config *lcfg;
+-      int nluns, i, rc;
+-      char *pathbuf;
+-
+-      rc = fsg_num_buffers_validate();
+-      if (rc != 0)
+-              return ERR_PTR(rc);
+-
+-      /* Find out how many LUNs there should be */
+-      nluns = cfg->nluns;
+-      if (nluns < 1 || nluns > FSG_MAX_LUNS) {
+-              dev_err(&gadget->dev, "invalid number of LUNs: %u\n", nluns);
+-              return ERR_PTR(-EINVAL);
+-      }
++/* check if fsg_num_buffers is within a valid range */
++static inline int fsg_num_buffers_validate(unsigned int fsg_num_buffers)
++{
++      if (fsg_num_buffers >= 2 && fsg_num_buffers <= 4)
++              return 0;
++      pr_err("fsg_num_buffers %u is out of range (%d to %d)\n",
++             fsg_num_buffers, 2, 4);
++      return -EINVAL;
++}
+-      /* Allocate? */
++static struct fsg_common *fsg_common_setup(struct fsg_common *common)
++{
+       if (!common) {
+-              common = kzalloc(sizeof *common, GFP_KERNEL);
++              common = kzalloc(sizeof(*common), GFP_KERNEL);
+               if (!common)
+                       return ERR_PTR(-ENOMEM);
+               common->free_storage_on_release = 1;
+       } else {
+-              memset(common, 0, sizeof *common);
+               common->free_storage_on_release = 0;
+       }
++      init_rwsem(&common->filesem);
++      spin_lock_init(&common->lock);
++      kref_init(&common->ref);
++      init_completion(&common->thread_notifier);
++      init_waitqueue_head(&common->fsg_wait);
++      common->state = FSG_STATE_TERMINATED;
+-      common->buffhds = kcalloc(fsg_num_buffers,
+-                                sizeof *(common->buffhds), GFP_KERNEL);
+-      if (!common->buffhds) {
+-              if (common->free_storage_on_release)
+-                      kfree(common);
+-              return ERR_PTR(-ENOMEM);
++      return common;
++}
++
++void fsg_common_set_sysfs(struct fsg_common *common, bool sysfs)
++{
++      common->sysfs = sysfs;
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_sysfs);
++
++static void _fsg_common_free_buffers(struct fsg_buffhd *buffhds, unsigned n)
++{
++      if (buffhds) {
++              struct fsg_buffhd *bh = buffhds;
++              while (n--) {
++                      kfree(bh->buf);
++                      ++bh;
++              }
++              kfree(buffhds);
+       }
++}
+-      common->ops = cfg->ops;
+-      common->private_data = cfg->private_data;
++int fsg_common_set_num_buffers(struct fsg_common *common, unsigned int n)
++{
++      struct fsg_buffhd *bh, *buffhds;
++      int i, rc;
+-      common->gadget = gadget;
+-      common->ep0 = gadget->ep0;
+-      common->ep0req = cdev->req;
+-      common->cdev = cdev;
++      rc = fsg_num_buffers_validate(n);
++      if (rc != 0)
++              return rc;
+-      /* Maybe allocate device-global string IDs, and patch descriptors */
+-      if (fsg_strings[FSG_STRING_INTERFACE].id == 0) {
+-              rc = usb_string_id(cdev);
+-              if (unlikely(rc < 0))
++      buffhds = kcalloc(n, sizeof(*buffhds), GFP_KERNEL);
++      if (!buffhds)
++              return -ENOMEM;
++
++      /* Data buffers cyclic list */
++      bh = buffhds;
++      i = n;
++      goto buffhds_first_it;
++      do {
++              bh->next = bh + 1;
++              ++bh;
++buffhds_first_it:
++              bh->buf = kmalloc(FSG_BUFLEN, GFP_KERNEL);
++              if (unlikely(!bh->buf))
+                       goto error_release;
+-              fsg_strings[FSG_STRING_INTERFACE].id = rc;
+-              fsg_intf_desc.iInterface = rc;
+-      }
++      } while (--i);
++      bh->next = buffhds;
++
++      _fsg_common_free_buffers(common->buffhds, common->fsg_num_buffers);
++      common->fsg_num_buffers = n;
++      common->buffhds = buffhds;
++
++      return 0;
++error_release:
+       /*
+-       * Create the LUNs, open their backing files, and register the
+-       * LUN devices in sysfs.
++       * "buf"s pointed to by heads after n - i are NULL
++       * so releasing them won't hurt
+        */
+-      curlun = kcalloc(nluns, sizeof(*curlun), GFP_KERNEL);
+-      if (unlikely(!curlun)) {
+-              rc = -ENOMEM;
+-              goto error_release;
+-      }
+-      common->luns = curlun;
++      _fsg_common_free_buffers(buffhds, n);
+-      init_rwsem(&common->filesem);
++      return -ENOMEM;
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_num_buffers);
+-      for (i = 0, lcfg = cfg->luns; i < nluns; ++i, ++curlun, ++lcfg) {
+-              curlun->cdrom = !!lcfg->cdrom;
+-              curlun->ro = lcfg->cdrom || lcfg->ro;
+-              curlun->initially_ro = curlun->ro;
+-              curlun->removable = lcfg->removable;
+-              curlun->dev.release = fsg_lun_release;
+-              curlun->dev.parent = &gadget->dev;
+-              /* curlun->dev.driver = &fsg_driver.driver; XXX */
+-              dev_set_drvdata(&curlun->dev, &common->filesem);
+-              dev_set_name(&curlun->dev, "lun%d", i);
++static inline void fsg_common_remove_sysfs(struct fsg_lun *lun)
++{
++      device_remove_file(&lun->dev, &dev_attr_nofua);
++      /*
++       * device_remove_file() =>
++       *
++       * here the attr (e.g. dev_attr_ro) is only used to be passed to:
++       *
++       *      sysfs_remove_file() =>
++       *
++       *      here e.g. both dev_attr_ro_cdrom and dev_attr_ro are in
++       *      the same namespace and
++       *      from here only attr->name is passed to:
++       *
++       *              sysfs_hash_and_remove()
++       *
++       *              attr->name is the same for dev_attr_ro_cdrom and
++       *              dev_attr_ro
++       *              attr->name is the same for dev_attr_file and
++       *              dev_attr_file_nonremovable
++       *
++       * so we don't differentiate between removing e.g. dev_attr_ro_cdrom
++       * and dev_attr_ro
++       */
++      device_remove_file(&lun->dev, &dev_attr_ro);
++      device_remove_file(&lun->dev, &dev_attr_file);
++}
+-              rc = device_register(&curlun->dev);
+-              if (rc) {
+-                      INFO(common, "failed to register LUN%d: %d\n", i, rc);
+-                      common->nluns = i;
+-                      put_device(&curlun->dev);
+-                      goto error_release;
+-              }
++void fsg_common_remove_lun(struct fsg_lun *lun, bool sysfs)
++{
++      if (sysfs) {
++              fsg_common_remove_sysfs(lun);
++              device_unregister(&lun->dev);
++      }
++      fsg_lun_close(lun);
++      kfree(lun);
++}
++EXPORT_SYMBOL_GPL(fsg_common_remove_lun);
+-              rc = device_create_file(&curlun->dev,
+-                                      curlun->cdrom
+-                                    ? &dev_attr_ro_cdrom
+-                                    : &dev_attr_ro);
+-              if (rc)
+-                      goto error_luns;
+-              rc = device_create_file(&curlun->dev,
+-                                      curlun->removable
+-                                    ? &dev_attr_file
+-                                    : &dev_attr_file_nonremovable);
+-              if (rc)
+-                      goto error_luns;
+-              rc = device_create_file(&curlun->dev, &dev_attr_nofua);
+-              if (rc)
+-                      goto error_luns;
++static void _fsg_common_remove_luns(struct fsg_common *common, int n)
++{
++      int i;
+-              if (lcfg->filename) {
+-                      rc = fsg_lun_open(curlun, lcfg->filename);
+-                      if (rc)
+-                              goto error_luns;
+-              } else if (!curlun->removable) {
+-                      ERROR(common, "no file given for LUN%d\n", i);
+-                      rc = -EINVAL;
+-                      goto error_luns;
++      for (i = 0; i < n; ++i)
++              if (common->luns[i]) {
++                      fsg_common_remove_lun(common->luns[i], common->sysfs);
++                      common->luns[i] = NULL;
+               }
++}
++EXPORT_SYMBOL_GPL(fsg_common_remove_luns);
++
++void fsg_common_remove_luns(struct fsg_common *common)
++{
++      _fsg_common_remove_luns(common, common->nluns);
++}
++
++void fsg_common_free_luns(struct fsg_common *common)
++{
++      fsg_common_remove_luns(common);
++      kfree(common->luns);
++      common->luns = NULL;
++}
++EXPORT_SYMBOL_GPL(fsg_common_free_luns);
++
++int fsg_common_set_nluns(struct fsg_common *common, int nluns)
++{
++      struct fsg_lun **curlun;
++
++      /* Find out how many LUNs there should be */
++      if (nluns < 1 || nluns > FSG_MAX_LUNS) {
++              pr_err("invalid number of LUNs: %u\n", nluns);
++              return -EINVAL;
+       }
++
++      curlun = kcalloc(nluns, sizeof(*curlun), GFP_KERNEL);
++      if (unlikely(!curlun))
++              return -ENOMEM;
++
++      if (common->luns)
++              fsg_common_free_luns(common);
++
++      common->luns = curlun;
+       common->nluns = nluns;
+-      /* Data buffers cyclic list */
+-      bh = common->buffhds;
+-      i = fsg_num_buffers;
+-      goto buffhds_first_it;
+-      do {
+-              bh->next = bh + 1;
+-              ++bh;
+-buffhds_first_it:
+-              bh->buf = kmalloc(FSG_BUFLEN, GFP_KERNEL);
+-              if (unlikely(!bh->buf)) {
+-                      rc = -ENOMEM;
+-                      goto error_release;
+-              }
+-      } while (--i);
+-      bh->next = common->buffhds;
++      pr_info("Number of LUNs=%d\n", common->nluns);
+-      /* Prepare inquiryString */
+-      i = get_default_bcdDevice();
+-      snprintf(common->inquiry_string, sizeof common->inquiry_string,
+-               "%-8s%-16s%04x", cfg->vendor_name ?: "Linux",
+-               /* Assume product name dependent on the first LUN */
+-               cfg->product_name ?: (common->luns->cdrom
+-                                   ? "File-CD Gadget"
+-                                   : "File-Stor Gadget"),
+-               i);
++      return 0;
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_nluns);
++
++void fsg_common_set_ops(struct fsg_common *common,
++                      const struct fsg_operations *ops)
++{
++      common->ops = ops;
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_ops);
++
++void fsg_common_free_buffers(struct fsg_common *common)
++{
++      _fsg_common_free_buffers(common->buffhds, common->fsg_num_buffers);
++      common->buffhds = NULL;
++}
++EXPORT_SYMBOL_GPL(fsg_common_free_buffers);
++
++int fsg_common_set_cdev(struct fsg_common *common,
++                       struct usb_composite_dev *cdev, bool can_stall)
++{
++      struct usb_string *us;
++
++      common->gadget = cdev->gadget;
++      common->ep0 = cdev->gadget->ep0;
++      common->ep0req = cdev->req;
++      common->cdev = cdev;
++
++      us = usb_gstrings_attach(cdev, fsg_strings_array,
++                               ARRAY_SIZE(fsg_strings));
++      if (IS_ERR(us))
++              return PTR_ERR(us);
++
++      fsg_intf_desc.iInterface = us[FSG_STRING_INTERFACE].id;
+       /*
+        * Some peripheral controllers are known not to be able to
+        * halt bulk endpoints correctly.  If one of them is present,
+        * disable stalls.
+        */
+-      common->can_stall = cfg->can_stall &&
+-              !(gadget_is_at91(common->gadget));
++      common->can_stall = can_stall && !(gadget_is_at91(common->gadget));
+-      spin_lock_init(&common->lock);
+-      kref_init(&common->ref);
++      return 0;
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_cdev);
+-      /* Tell the thread to start working */
+-      common->thread_task =
+-              kthread_create(fsg_main_thread, common, "file-storage");
+-      if (IS_ERR(common->thread_task)) {
+-              rc = PTR_ERR(common->thread_task);
+-              goto error_release;
++static inline int fsg_common_add_sysfs(struct fsg_common *common,
++                                     struct fsg_lun *lun)
++{
++      int rc;
++
++      rc = device_register(&lun->dev);
++      if (rc) {
++              put_device(&lun->dev);
++              return rc;
+       }
+-      init_completion(&common->thread_notifier);
+-      init_waitqueue_head(&common->fsg_wait);
+-      /* Information */
+-      INFO(common, FSG_DRIVER_DESC ", version: " FSG_DRIVER_VERSION "\n");
+-      INFO(common, "Number of LUNs=%d\n", common->nluns);
++      rc = device_create_file(&lun->dev,
++                              lun->cdrom
++                            ? &dev_attr_ro_cdrom
++                            : &dev_attr_ro);
++      if (rc)
++              goto error;
++      rc = device_create_file(&lun->dev,
++                              lun->removable
++                            ? &dev_attr_file
++                            : &dev_attr_file_nonremovable);
++      if (rc)
++              goto error;
++      rc = device_create_file(&lun->dev, &dev_attr_nofua);
++      if (rc)
++              goto error;
++
++      return 0;
++
++error:
++      /* removing nonexistent files is a no-op */
++      fsg_common_remove_sysfs(lun);
++      device_unregister(&lun->dev);
++      return rc;
++}
++
++int fsg_common_create_lun(struct fsg_common *common, struct fsg_lun_config *cfg,
++                        unsigned int id, const char *name,
++                        const char **name_pfx)
++{
++      struct fsg_lun *lun;
++      char *pathbuf, *p;
++      int rc = -ENOMEM;
++
++      if (!common->nluns || !common->luns)
++              return -ENODEV;
++
++      if (common->luns[id])
++              return -EBUSY;
++
++      if (!cfg->filename && !cfg->removable) {
++              pr_err("no file given for LUN%d\n", id);
++              return -EINVAL;
++      }
++
++      lun = kzalloc(sizeof(*lun), GFP_KERNEL);
++      if (!lun)
++              return -ENOMEM;
++
++      lun->name_pfx = name_pfx;
++
++      lun->cdrom = !!cfg->cdrom;
++      lun->ro = cfg->cdrom || cfg->ro;
++      lun->initially_ro = lun->ro;
++      lun->removable = !!cfg->removable;
++
++      if (!common->sysfs) {
++              /* we DON'T own the name!*/
++              lun->name = name;
++      } else {
++              lun->dev.release = fsg_lun_release;
++              lun->dev.parent = &common->gadget->dev;
++              dev_set_drvdata(&lun->dev, &common->filesem);
++              dev_set_name(&lun->dev, name);
++              lun->name = dev_name(&lun->dev);
++
++              rc = fsg_common_add_sysfs(common, lun);
++              if (rc) {
++                      pr_info("failed to register LUN%d: %d\n", id, rc);
++                      goto error_sysfs;
++              }
++      }
++
++      common->luns[id] = lun;
++
++      if (cfg->filename) {
++              rc = fsg_lun_open(lun, cfg->filename);
++              if (rc)
++                      goto error_lun;
++      }
+       pathbuf = kmalloc(PATH_MAX, GFP_KERNEL);
+-      for (i = 0, nluns = common->nluns, curlun = common->luns;
+-           i < nluns;
+-           ++curlun, ++i) {
+-              char *p = "(no medium)";
+-              if (fsg_lun_is_open(curlun)) {
+-                      p = "(error)";
+-                      if (pathbuf) {
+-                              p = d_path(&curlun->filp->f_path,
+-                                         pathbuf, PATH_MAX);
+-                              if (IS_ERR(p))
+-                                      p = "(error)";
+-                      }
++      p = "(no medium)";
++      if (fsg_lun_is_open(lun)) {
++              p = "(error)";
++              if (pathbuf) {
++                      p = d_path(&lun->filp->f_path, pathbuf, PATH_MAX);
++                      if (IS_ERR(p))
++                              p = "(error)";
+               }
+-              LINFO(curlun, "LUN: %s%s%sfile: %s\n",
+-                    curlun->removable ? "removable " : "",
+-                    curlun->ro ? "read only " : "",
+-                    curlun->cdrom ? "CD-ROM " : "",
+-                    p);
+       }
++      pr_info("LUN: %s%s%sfile: %s\n",
++            lun->removable ? "removable " : "",
++            lun->ro ? "read only " : "",
++            lun->cdrom ? "CD-ROM " : "",
++            p);
+       kfree(pathbuf);
++      return 0;
++
++error_lun:
++      if (common->sysfs) {
++              fsg_common_remove_sysfs(lun);
++              device_unregister(&lun->dev);
++      }
++      fsg_lun_close(lun);
++      common->luns[id] = NULL;
++error_sysfs:
++      kfree(lun);
++      return rc;
++}
++EXPORT_SYMBOL_GPL(fsg_common_create_lun);
++
++int fsg_common_create_luns(struct fsg_common *common, struct fsg_config *cfg)
++{
++      char buf[8]; /* enough for 100000000 different numbers, decimal */
++      int i, rc;
++
++      for (i = 0; i < common->nluns; ++i) {
++              snprintf(buf, sizeof(buf), "lun%d", i);
++              rc = fsg_common_create_lun(common, &cfg->luns[i], i, buf, NULL);
++              if (rc)
++                      goto fail;
++      }
++
++      pr_info("Number of LUNs=%d\n", common->nluns);
++
++      return 0;
++
++fail:
++      _fsg_common_remove_luns(common, i);
++      return rc;
++}
++EXPORT_SYMBOL_GPL(fsg_common_create_luns);
++
++void fsg_common_set_inquiry_string(struct fsg_common *common, const char *vn,
++                                 const char *pn)
++{
++      int i;
++
++      /* Prepare inquiryString */
++      i = get_default_bcdDevice();
++      snprintf(common->inquiry_string, sizeof(common->inquiry_string),
++               "%-8s%-16s%04x", vn ?: "Linux",
++               /* Assume product name dependent on the first LUN */
++               pn ?: ((*common->luns)->cdrom
++                   ? "File-CD Gadget"
++                   : "File-Stor Gadget"),
++               i);
++}
++EXPORT_SYMBOL_GPL(fsg_common_set_inquiry_string);
++
++int fsg_common_run_thread(struct fsg_common *common)
++{
++      common->state = FSG_STATE_IDLE;
++      /* Tell the thread to start working */
++      common->thread_task =
++              kthread_create(fsg_main_thread, common, "file-storage");
++      if (IS_ERR(common->thread_task)) {
++              common->state = FSG_STATE_TERMINATED;
++              return PTR_ERR(common->thread_task);
++      }
++
+       DBG(common, "I/O thread pid: %d\n", task_pid_nr(common->thread_task));
+       wake_up_process(common->thread_task);
+-      return common;
+-
+-error_luns:
+-      common->nluns = i + 1;
+-error_release:
+-      common->state = FSG_STATE_TERMINATED;   /* The thread is dead */
+-      /* Call fsg_common_release() directly, ref might be not initialised. */
+-      fsg_common_release(&common->ref);
+-      return ERR_PTR(rc);
++      return 0;
+ }
++EXPORT_SYMBOL_GPL(fsg_common_run_thread);
+ static void fsg_common_release(struct kref *ref)
+ {
+@@ -2824,36 +3069,26 @@ static void fsg_common_release(struct kr
+       }
+       if (likely(common->luns)) {
+-              struct fsg_lun *lun = common->luns;
++              struct fsg_lun **lun_it = common->luns;
+               unsigned i = common->nluns;
+               /* In error recovery common->nluns may be zero. */
+-              for (; i; --i, ++lun) {
+-                      device_remove_file(&lun->dev, &dev_attr_nofua);
+-                      device_remove_file(&lun->dev,
+-                                         lun->cdrom
+-                                       ? &dev_attr_ro_cdrom
+-                                       : &dev_attr_ro);
+-                      device_remove_file(&lun->dev,
+-                                         lun->removable
+-                                       ? &dev_attr_file
+-                                       : &dev_attr_file_nonremovable);
++              for (; i; --i, ++lun_it) {
++                      struct fsg_lun *lun = *lun_it;
++                      if (!lun)
++                              continue;
++                      if (common->sysfs)
++                              fsg_common_remove_sysfs(lun);
+                       fsg_lun_close(lun);
+-                      device_unregister(&lun->dev);
++                      if (common->sysfs)
++                              device_unregister(&lun->dev);
++                      kfree(lun);
+               }
+               kfree(common->luns);
+       }
+-      {
+-              struct fsg_buffhd *bh = common->buffhds;
+-              unsigned i = fsg_num_buffers;
+-              do {
+-                      kfree(bh->buf);
+-              } while (++bh, --i);
+-      }
+-
+-      kfree(common->buffhds);
++      _fsg_common_free_buffers(common->buffhds, common->fsg_num_buffers);
+       if (common->free_storage_on_release)
+               kfree(common);
+ }
+@@ -2861,24 +3096,6 @@ static void fsg_common_release(struct kr
+ /*-------------------------------------------------------------------------*/
+-static void fsg_unbind(struct usb_configuration *c, struct usb_function *f)
+-{
+-      struct fsg_dev          *fsg = fsg_from_func(f);
+-      struct fsg_common       *common = fsg->common;
+-
+-      DBG(fsg, "unbind\n");
+-      if (fsg->common->fsg == fsg) {
+-              fsg->common->new_fsg = NULL;
+-              raise_exception(fsg->common, FSG_STATE_CONFIG_CHANGE);
+-              /* FIXME: make interruptible or killable somehow? */
+-              wait_event(common->fsg_wait, common->fsg != fsg);
+-      }
+-
+-      fsg_common_put(common);
+-      usb_free_all_descriptors(&fsg->function);
+-      kfree(fsg);
+-}
+-
+ static int fsg_bind(struct usb_configuration *c, struct usb_function *f)
+ {
+       struct fsg_dev          *fsg = fsg_from_func(f);
+@@ -2887,6 +3104,19 @@ static int fsg_bind(struct usb_configura
+       struct usb_ep           *ep;
+       unsigned                max_burst;
+       int                     ret;
++      struct fsg_opts         *opts;
++
++      opts = fsg_opts_from_func_inst(f->fi);
++      if (!opts->no_configfs) {
++              ret = fsg_common_set_cdev(fsg->common, c->cdev,
++                                        fsg->common->can_stall);
++              if (ret)
++                      return ret;
++              fsg_common_set_inquiry_string(fsg->common, 0, 0);
++              ret = fsg_common_run_thread(fsg->common);
++              if (ret)
++                      return ret;
++      }
+       fsg->gadget = gadget;
+@@ -2939,95 +3169,472 @@ autoconf_fail:
+       return -ENOTSUPP;
+ }
+-/****************************** ADD FUNCTION ******************************/
++/****************************** ALLOCATE FUNCTION *************************/
+-static struct usb_gadget_strings *fsg_strings_array[] = {
+-      &fsg_stringtab,
++static void fsg_unbind(struct usb_configuration *c, struct usb_function *f)
++{
++      struct fsg_dev          *fsg = fsg_from_func(f);
++      struct fsg_common       *common = fsg->common;
++
++      DBG(fsg, "unbind\n");
++      if (fsg->common->fsg == fsg) {
++              fsg->common->new_fsg = NULL;
++              raise_exception(fsg->common, FSG_STATE_CONFIG_CHANGE);
++              /* FIXME: make interruptible or killable somehow? */
++              wait_event(common->fsg_wait, common->fsg != fsg);
++      }
++
++      usb_free_all_descriptors(&fsg->function);
++}
++
++static inline struct fsg_lun_opts *to_fsg_lun_opts(struct config_item *item)
++{
++      return container_of(to_config_group(item), struct fsg_lun_opts, group);
++}
++
++static inline struct fsg_opts *to_fsg_opts(struct config_item *item)
++{
++      return container_of(to_config_group(item), struct fsg_opts,
++                          func_inst.group);
++}
++
++CONFIGFS_ATTR_STRUCT(fsg_lun_opts);
++CONFIGFS_ATTR_OPS(fsg_lun_opts);
++
++static void fsg_lun_attr_release(struct config_item *item)
++{
++      struct fsg_lun_opts *lun_opts;
++
++      lun_opts = to_fsg_lun_opts(item);
++      kfree(lun_opts);
++}
++
++static struct configfs_item_operations fsg_lun_item_ops = {
++      .release                = fsg_lun_attr_release,
++      .show_attribute         = fsg_lun_opts_attr_show,
++      .store_attribute        = fsg_lun_opts_attr_store,
++};
++
++static ssize_t fsg_lun_opts_file_show(struct fsg_lun_opts *opts, char *page)
++{
++      struct fsg_opts *fsg_opts;
++
++      fsg_opts = to_fsg_opts(opts->group.cg_item.ci_parent);
++
++      return fsg_show_file(opts->lun, &fsg_opts->common->filesem, page);
++}
++
++static ssize_t fsg_lun_opts_file_store(struct fsg_lun_opts *opts,
++                                     const char *page, size_t len)
++{
++      struct fsg_opts *fsg_opts;
++
++      fsg_opts = to_fsg_opts(opts->group.cg_item.ci_parent);
++
++      return fsg_store_file(opts->lun, &fsg_opts->common->filesem, page, len);
++}
++
++static struct fsg_lun_opts_attribute fsg_lun_opts_file =
++      __CONFIGFS_ATTR(file, S_IRUGO | S_IWUSR, fsg_lun_opts_file_show,
++                      fsg_lun_opts_file_store);
++
++static ssize_t fsg_lun_opts_ro_show(struct fsg_lun_opts *opts, char *page)
++{
++      return fsg_show_ro(opts->lun, page);
++}
++
++static ssize_t fsg_lun_opts_ro_store(struct fsg_lun_opts *opts,
++                                     const char *page, size_t len)
++{
++      struct fsg_opts *fsg_opts;
++
++      fsg_opts = to_fsg_opts(opts->group.cg_item.ci_parent);
++
++      return fsg_store_ro(opts->lun, &fsg_opts->common->filesem, page, len);
++}
++
++static struct fsg_lun_opts_attribute fsg_lun_opts_ro =
++      __CONFIGFS_ATTR(ro, S_IRUGO | S_IWUSR, fsg_lun_opts_ro_show,
++                      fsg_lun_opts_ro_store);
++
++static ssize_t fsg_lun_opts_removable_show(struct fsg_lun_opts *opts,
++                                         char *page)
++{
++      return fsg_show_removable(opts->lun, page);
++}
++
++static ssize_t fsg_lun_opts_removable_store(struct fsg_lun_opts *opts,
++                                     const char *page, size_t len)
++{
++      return fsg_store_removable(opts->lun, page, len);
++}
++
++static struct fsg_lun_opts_attribute fsg_lun_opts_removable =
++      __CONFIGFS_ATTR(removable, S_IRUGO | S_IWUSR,
++                      fsg_lun_opts_removable_show,
++                      fsg_lun_opts_removable_store);
++
++static ssize_t fsg_lun_opts_cdrom_show(struct fsg_lun_opts *opts, char *page)
++{
++      return fsg_show_cdrom(opts->lun, page);
++}
++
++static ssize_t fsg_lun_opts_cdrom_store(struct fsg_lun_opts *opts,
++                                     const char *page, size_t len)
++{
++      struct fsg_opts *fsg_opts;
++
++      fsg_opts = to_fsg_opts(opts->group.cg_item.ci_parent);
++
++      return fsg_store_cdrom(opts->lun, &fsg_opts->common->filesem, page,
++                             len);
++}
++
++static struct fsg_lun_opts_attribute fsg_lun_opts_cdrom =
++      __CONFIGFS_ATTR(cdrom, S_IRUGO | S_IWUSR, fsg_lun_opts_cdrom_show,
++                      fsg_lun_opts_cdrom_store);
++
++static ssize_t fsg_lun_opts_nofua_show(struct fsg_lun_opts *opts, char *page)
++{
++      return fsg_show_nofua(opts->lun, page);
++}
++
++static ssize_t fsg_lun_opts_nofua_store(struct fsg_lun_opts *opts,
++                                     const char *page, size_t len)
++{
++      return fsg_store_nofua(opts->lun, page, len);
++}
++
++static struct fsg_lun_opts_attribute fsg_lun_opts_nofua =
++      __CONFIGFS_ATTR(nofua, S_IRUGO | S_IWUSR, fsg_lun_opts_nofua_show,
++                      fsg_lun_opts_nofua_store);
++
++static struct configfs_attribute *fsg_lun_attrs[] = {
++      &fsg_lun_opts_file.attr,
++      &fsg_lun_opts_ro.attr,
++      &fsg_lun_opts_removable.attr,
++      &fsg_lun_opts_cdrom.attr,
++      &fsg_lun_opts_nofua.attr,
+       NULL,
+ };
+-static int fsg_bind_config(struct usb_composite_dev *cdev,
+-                         struct usb_configuration *c,
+-                         struct fsg_common *common)
++static struct config_item_type fsg_lun_type = {
++      .ct_item_ops    = &fsg_lun_item_ops,
++      .ct_attrs       = fsg_lun_attrs,
++      .ct_owner       = THIS_MODULE,
++};
++
++static struct config_group *fsg_lun_make(struct config_group *group,
++                                       const char *name)
+ {
+-      struct fsg_dev *fsg;
++      struct fsg_lun_opts *opts;
++      struct fsg_opts *fsg_opts;
++      struct fsg_lun_config config;
++      char *num_str;
++      u8 num;
++      int ret;
++
++      num_str = strchr(name, '.');
++      if (!num_str) {
++              pr_err("Unable to locate . in LUN.NUMBER\n");
++              return ERR_PTR(-EINVAL);
++      }
++      num_str++;
++
++      ret = kstrtou8(num_str, 0, &num);
++      if (ret)
++              return ERR_PTR(ret);
++
++      fsg_opts = to_fsg_opts(&group->cg_item);
++      if (num >= FSG_MAX_LUNS)
++              return ERR_PTR(-ERANGE);
++
++      mutex_lock(&fsg_opts->lock);
++      if (fsg_opts->refcnt || fsg_opts->common->luns[num]) {
++              ret = -EBUSY;
++              goto out;
++      }
++
++      opts = kzalloc(sizeof(*opts), GFP_KERNEL);
++      if (!opts) {
++              ret = -ENOMEM;
++              goto out;
++      }
++
++      memset(&config, 0, sizeof(config));
++      config.removable = true;
++
++      ret = fsg_common_create_lun(fsg_opts->common, &config, num, name,
++                                  (const char **)&group->cg_item.ci_name);
++      if (ret) {
++              kfree(opts);
++              goto out;
++      }
++      opts->lun = fsg_opts->common->luns[num];
++      opts->lun_id = num;
++      mutex_unlock(&fsg_opts->lock);
++
++      config_group_init_type_name(&opts->group, name, &fsg_lun_type);
++
++      return &opts->group;
++out:
++      mutex_unlock(&fsg_opts->lock);
++      return ERR_PTR(ret);
++}
++
++static void fsg_lun_drop(struct config_group *group, struct config_item *item)
++{
++      struct fsg_lun_opts *lun_opts;
++      struct fsg_opts *fsg_opts;
++
++      lun_opts = to_fsg_lun_opts(item);
++      fsg_opts = to_fsg_opts(&group->cg_item);
++
++      mutex_lock(&fsg_opts->lock);
++      if (fsg_opts->refcnt) {
++              struct config_item *gadget;
++
++              gadget = group->cg_item.ci_parent->ci_parent;
++              unregister_gadget_item(gadget);
++      }
++
++      fsg_common_remove_lun(lun_opts->lun, fsg_opts->common->sysfs);
++      fsg_opts->common->luns[lun_opts->lun_id] = NULL;
++      lun_opts->lun_id = 0;
++      mutex_unlock(&fsg_opts->lock);
++
++      config_item_put(item);
++}
++
++CONFIGFS_ATTR_STRUCT(fsg_opts);
++CONFIGFS_ATTR_OPS(fsg_opts);
++
++static void fsg_attr_release(struct config_item *item)
++{
++      struct fsg_opts *opts = to_fsg_opts(item);
++
++      usb_put_function_instance(&opts->func_inst);
++}
++
++static struct configfs_item_operations fsg_item_ops = {
++      .release                = fsg_attr_release,
++      .show_attribute         = fsg_opts_attr_show,
++      .store_attribute        = fsg_opts_attr_store,
++};
++
++static ssize_t fsg_opts_stall_show(struct fsg_opts *opts, char *page)
++{
++      int result;
++
++      mutex_lock(&opts->lock);
++      result = sprintf(page, "%d", opts->common->can_stall);
++      mutex_unlock(&opts->lock);
++
++      return result;
++}
++
++static ssize_t fsg_opts_stall_store(struct fsg_opts *opts, const char *page,
++                                  size_t len)
++{
++      int ret;
++      bool stall;
++
++      mutex_lock(&opts->lock);
++
++      if (opts->refcnt) {
++              mutex_unlock(&opts->lock);
++              return -EBUSY;
++      }
++
++      ret = strtobool(page, &stall);
++      if (!ret) {
++              opts->common->can_stall = stall;
++              ret = len;
++      }
++
++      mutex_unlock(&opts->lock);
++
++      return ret;
++}
++
++static struct fsg_opts_attribute fsg_opts_stall =
++      __CONFIGFS_ATTR(stall, S_IRUGO | S_IWUSR, fsg_opts_stall_show,
++                      fsg_opts_stall_store);
++
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++static ssize_t fsg_opts_num_buffers_show(struct fsg_opts *opts, char *page)
++{
++      int result;
++
++      mutex_lock(&opts->lock);
++      result = sprintf(page, "%d", opts->common->fsg_num_buffers);
++      mutex_unlock(&opts->lock);
++
++      return result;
++}
++
++static ssize_t fsg_opts_num_buffers_store(struct fsg_opts *opts,
++                                        const char *page, size_t len)
++{
++      int ret;
++      u8 num;
++
++      mutex_lock(&opts->lock);
++      if (opts->refcnt) {
++              ret = -EBUSY;
++              goto end;
++      }
++      ret = kstrtou8(page, 0, &num);
++      if (ret)
++              goto end;
++
++      ret = fsg_num_buffers_validate(num);
++      if (ret)
++              goto end;
++
++      fsg_common_set_num_buffers(opts->common, num);
++      ret = len;
++
++end:
++      mutex_unlock(&opts->lock);
++      return ret;
++}
++
++static struct fsg_opts_attribute fsg_opts_num_buffers =
++      __CONFIGFS_ATTR(num_buffers, S_IRUGO | S_IWUSR,
++                      fsg_opts_num_buffers_show,
++                      fsg_opts_num_buffers_store);
++
++#endif
++
++static struct configfs_attribute *fsg_attrs[] = {
++      &fsg_opts_stall.attr,
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++      &fsg_opts_num_buffers.attr,
++#endif
++      NULL,
++};
++
++static struct configfs_group_operations fsg_group_ops = {
++      .make_group     = fsg_lun_make,
++      .drop_item      = fsg_lun_drop,
++};
++
++static struct config_item_type fsg_func_type = {
++      .ct_item_ops    = &fsg_item_ops,
++      .ct_group_ops   = &fsg_group_ops,
++      .ct_attrs       = fsg_attrs,
++      .ct_owner       = THIS_MODULE,
++};
++
++static void fsg_free_inst(struct usb_function_instance *fi)
++{
++      struct fsg_opts *opts;
++
++      opts = fsg_opts_from_func_inst(fi);
++      fsg_common_put(opts->common);
++      kfree(opts);
++}
++
++static struct usb_function_instance *fsg_alloc_inst(void)
++{
++      struct fsg_opts *opts;
++      struct fsg_lun_config config;
+       int rc;
+-      fsg = kzalloc(sizeof *fsg, GFP_KERNEL);
++      opts = kzalloc(sizeof(*opts), GFP_KERNEL);
++      if (!opts)
++              return ERR_PTR(-ENOMEM);
++      mutex_init(&opts->lock);
++      opts->func_inst.free_func_inst = fsg_free_inst;
++      opts->common = fsg_common_setup(opts->common);
++      if (IS_ERR(opts->common)) {
++              rc = PTR_ERR(opts->common);
++              goto release_opts;
++      }
++      rc = fsg_common_set_nluns(opts->common, FSG_MAX_LUNS);
++      if (rc)
++              goto release_opts;
++
++      rc = fsg_common_set_num_buffers(opts->common,
++                                      CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS);
++      if (rc)
++              goto release_luns;
++
++      pr_info(FSG_DRIVER_DESC ", version: " FSG_DRIVER_VERSION "\n");
++
++      memset(&config, 0, sizeof(config));
++      config.removable = true;
++      rc = fsg_common_create_lun(opts->common, &config, 0, "lun.0",
++                      (const char **)&opts->func_inst.group.cg_item.ci_name);
++      opts->lun0.lun = opts->common->luns[0];
++      opts->lun0.lun_id = 0;
++      config_group_init_type_name(&opts->lun0.group, "lun.0", &fsg_lun_type);
++      opts->default_groups[0] = &opts->lun0.group;
++      opts->func_inst.group.default_groups = opts->default_groups;
++
++      config_group_init_type_name(&opts->func_inst.group, "", &fsg_func_type);
++
++      return &opts->func_inst;
++
++release_luns:
++      kfree(opts->common->luns);
++release_opts:
++      kfree(opts);
++      return ERR_PTR(rc);
++}
++
++static void fsg_free(struct usb_function *f)
++{
++      struct fsg_dev *fsg;
++      struct fsg_opts *opts;
++
++      fsg = container_of(f, struct fsg_dev, function);
++      opts = container_of(f->fi, struct fsg_opts, func_inst);
++
++      mutex_lock(&opts->lock);
++      opts->refcnt--;
++      mutex_unlock(&opts->lock);
++
++      kfree(fsg);
++}
++
++static struct usb_function *fsg_alloc(struct usb_function_instance *fi)
++{
++      struct fsg_opts *opts = fsg_opts_from_func_inst(fi);
++      struct fsg_common *common = opts->common;
++      struct fsg_dev *fsg;
++
++      fsg = kzalloc(sizeof(*fsg), GFP_KERNEL);
+       if (unlikely(!fsg))
+-              return -ENOMEM;
++              return ERR_PTR(-ENOMEM);
+-      fsg->function.name        = FSG_DRIVER_DESC;
+-      fsg->function.strings     = fsg_strings_array;
+-      fsg->function.bind        = fsg_bind;
+-      fsg->function.unbind      = fsg_unbind;
+-      fsg->function.setup       = fsg_setup;
+-      fsg->function.set_alt     = fsg_set_alt;
+-      fsg->function.disable     = fsg_disable;
++      mutex_lock(&opts->lock);
++      opts->refcnt++;
++      mutex_unlock(&opts->lock);
++      fsg->function.name      = FSG_DRIVER_DESC;
++      fsg->function.bind      = fsg_bind;
++      fsg->function.unbind    = fsg_unbind;
++      fsg->function.setup     = fsg_setup;
++      fsg->function.set_alt   = fsg_set_alt;
++      fsg->function.disable   = fsg_disable;
++      fsg->function.free_func = fsg_free;
+       fsg->common               = common;
+-      /*
+-       * Our caller holds a reference to common structure so we
+-       * don't have to be worry about it being freed until we return
+-       * from this function.  So instead of incrementing counter now
+-       * and decrement in error recovery we increment it only when
+-       * call to usb_add_function() was successful.
+-       */
+-      rc = usb_add_function(c, &fsg->function);
+-      if (unlikely(rc))
+-              kfree(fsg);
+-      else
+-              fsg_common_get(fsg->common);
+-      return rc;
++      return &fsg->function;
+ }
++DECLARE_USB_FUNCTION_INIT(mass_storage, fsg_alloc_inst, fsg_alloc);
++MODULE_LICENSE("GPL");
++MODULE_AUTHOR("Michal Nazarewicz");
+ /************************* Module parameters *************************/
+-struct fsg_module_parameters {
+-      char            *file[FSG_MAX_LUNS];
+-      bool            ro[FSG_MAX_LUNS];
+-      bool            removable[FSG_MAX_LUNS];
+-      bool            cdrom[FSG_MAX_LUNS];
+-      bool            nofua[FSG_MAX_LUNS];
+-
+-      unsigned int    file_count, ro_count, removable_count, cdrom_count;
+-      unsigned int    nofua_count;
+-      unsigned int    luns;   /* nluns */
+-      bool            stall;  /* can_stall */
+-};
+-#define _FSG_MODULE_PARAM_ARRAY(prefix, params, name, type, desc)     \
+-      module_param_array_named(prefix ## name, params.name, type,     \
+-                               &prefix ## params.name ## _count,      \
+-                               S_IRUGO);                              \
+-      MODULE_PARM_DESC(prefix ## name, desc)
+-
+-#define _FSG_MODULE_PARAM(prefix, params, name, type, desc)           \
+-      module_param_named(prefix ## name, params.name, type,           \
+-                         S_IRUGO);                                    \
+-      MODULE_PARM_DESC(prefix ## name, desc)
+-
+-#define FSG_MODULE_PARAMETERS(prefix, params)                         \
+-      _FSG_MODULE_PARAM_ARRAY(prefix, params, file, charp,            \
+-                              "names of backing files or devices");   \
+-      _FSG_MODULE_PARAM_ARRAY(prefix, params, ro, bool,               \
+-                              "true to force read-only");             \
+-      _FSG_MODULE_PARAM_ARRAY(prefix, params, removable, bool,        \
+-                              "true to simulate removable media");    \
+-      _FSG_MODULE_PARAM_ARRAY(prefix, params, cdrom, bool,            \
+-                              "true to simulate CD-ROM instead of disk"); \
+-      _FSG_MODULE_PARAM_ARRAY(prefix, params, nofua, bool,            \
+-                              "true to ignore SCSI WRITE(10,12) FUA bit"); \
+-      _FSG_MODULE_PARAM(prefix, params, luns, uint,                   \
+-                        "number of LUNs");                            \
+-      _FSG_MODULE_PARAM(prefix, params, stall, bool,                  \
+-                        "false to prevent bulk stalls")
+-
+-static void
+-fsg_config_from_params(struct fsg_config *cfg,
+-                     const struct fsg_module_parameters *params)
++void fsg_config_from_params(struct fsg_config *cfg,
++                     const struct fsg_module_parameters *params,
++                     unsigned int fsg_num_buffers)
+ {
+       struct fsg_lun_config *lun;
+       unsigned i;
+@@ -3055,19 +3662,7 @@ fsg_config_from_params(struct fsg_config
+       /* Finalise */
+       cfg->can_stall = params->stall;
++      cfg->fsg_num_buffers = fsg_num_buffers;
+ }
++EXPORT_SYMBOL_GPL(fsg_config_from_params);
+-static inline struct fsg_common *
+-fsg_common_from_params(struct fsg_common *common,
+-                     struct usb_composite_dev *cdev,
+-                     const struct fsg_module_parameters *params)
+-      __attribute__((unused));
+-static inline struct fsg_common *
+-fsg_common_from_params(struct fsg_common *common,
+-                     struct usb_composite_dev *cdev,
+-                     const struct fsg_module_parameters *params)
+-{
+-      struct fsg_config cfg;
+-      fsg_config_from_params(&cfg, params);
+-      return fsg_common_init(common, cdev, &cfg);
+-}
+--- /dev/null
++++ b/drivers/usb/gadget/f_mass_storage.h
+@@ -0,0 +1,166 @@
++#ifndef USB_F_MASS_STORAGE_H
++#define USB_F_MASS_STORAGE_H
++
++#include <linux/usb/composite.h>
++#include "storage_common.h"
++
++struct fsg_module_parameters {
++      char            *file[FSG_MAX_LUNS];
++      bool            ro[FSG_MAX_LUNS];
++      bool            removable[FSG_MAX_LUNS];
++      bool            cdrom[FSG_MAX_LUNS];
++      bool            nofua[FSG_MAX_LUNS];
++
++      unsigned int    file_count, ro_count, removable_count, cdrom_count;
++      unsigned int    nofua_count;
++      unsigned int    luns;   /* nluns */
++      bool            stall;  /* can_stall */
++};
++
++#define _FSG_MODULE_PARAM_ARRAY(prefix, params, name, type, desc)     \
++      module_param_array_named(prefix ## name, params.name, type,     \
++                               &prefix ## params.name ## _count,      \
++                               S_IRUGO);                              \
++      MODULE_PARM_DESC(prefix ## name, desc)
++
++#define _FSG_MODULE_PARAM(prefix, params, name, type, desc)           \
++      module_param_named(prefix ## name, params.name, type,           \
++                         S_IRUGO);                                    \
++      MODULE_PARM_DESC(prefix ## name, desc)
++
++#define __FSG_MODULE_PARAMETERS(prefix, params)                               \
++      _FSG_MODULE_PARAM_ARRAY(prefix, params, file, charp,            \
++                              "names of backing files or devices");   \
++      _FSG_MODULE_PARAM_ARRAY(prefix, params, ro, bool,               \
++                              "true to force read-only");             \
++      _FSG_MODULE_PARAM_ARRAY(prefix, params, removable, bool,        \
++                              "true to simulate removable media");    \
++      _FSG_MODULE_PARAM_ARRAY(prefix, params, cdrom, bool,            \
++                              "true to simulate CD-ROM instead of disk"); \
++      _FSG_MODULE_PARAM_ARRAY(prefix, params, nofua, bool,            \
++                              "true to ignore SCSI WRITE(10,12) FUA bit"); \
++      _FSG_MODULE_PARAM(prefix, params, luns, uint,                   \
++                        "number of LUNs");                            \
++      _FSG_MODULE_PARAM(prefix, params, stall, bool,                  \
++                        "false to prevent bulk stalls")
++
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++
++#define FSG_MODULE_PARAMETERS(prefix, params)                         \
++      __FSG_MODULE_PARAMETERS(prefix, params);                        \
++      module_param_named(num_buffers, fsg_num_buffers, uint, S_IRUGO);\
++      MODULE_PARM_DESC(num_buffers, "Number of pipeline buffers")
++#else
++
++#define FSG_MODULE_PARAMETERS(prefix, params)                         \
++      __FSG_MODULE_PARAMETERS(prefix, params)
++
++#endif
++
++struct fsg_common;
++
++/* FSF callback functions */
++struct fsg_operations {
++      /*
++       * Callback function to call when thread exits.  If no
++       * callback is set or it returns value lower then zero MSF
++       * will force eject all LUNs it operates on (including those
++       * marked as non-removable or with prevent_medium_removal flag
++       * set).
++       */
++      int (*thread_exits)(struct fsg_common *common);
++};
++
++struct fsg_lun_opts {
++      struct config_group group;
++      struct fsg_lun *lun;
++      int lun_id;
++};
++
++struct fsg_opts {
++      struct fsg_common *common;
++      struct usb_function_instance func_inst;
++      struct fsg_lun_opts lun0;
++      struct config_group *default_groups[2];
++      bool no_configfs; /* for legacy gadgets */
++
++      /*
++       * Read/write access to configfs attributes is handled by configfs.
++       *
++       * This is to protect the data from concurrent access by read/write
++       * and create symlink/remove symlink.
++       */
++      struct mutex                    lock;
++      int                             refcnt;
++};
++
++struct fsg_lun_config {
++      const char *filename;
++      char ro;
++      char removable;
++      char cdrom;
++      char nofua;
++};
++
++struct fsg_config {
++      unsigned nluns;
++      struct fsg_lun_config luns[FSG_MAX_LUNS];
++
++      /* Callback functions. */
++      const struct fsg_operations     *ops;
++      /* Gadget's private data. */
++      void                    *private_data;
++
++      const char *vendor_name;                /*  8 characters or less */
++      const char *product_name;               /* 16 characters or less */
++
++      char                    can_stall;
++      unsigned int            fsg_num_buffers;
++};
++
++static inline struct fsg_opts *
++fsg_opts_from_func_inst(const struct usb_function_instance *fi)
++{
++      return container_of(fi, struct fsg_opts, func_inst);
++}
++
++void fsg_common_get(struct fsg_common *common);
++
++void fsg_common_put(struct fsg_common *common);
++
++void fsg_common_set_sysfs(struct fsg_common *common, bool sysfs);
++
++int fsg_common_set_num_buffers(struct fsg_common *common, unsigned int n);
++
++void fsg_common_free_buffers(struct fsg_common *common);
++
++int fsg_common_set_cdev(struct fsg_common *common,
++                      struct usb_composite_dev *cdev, bool can_stall);
++
++void fsg_common_remove_lun(struct fsg_lun *lun, bool sysfs);
++
++void fsg_common_remove_luns(struct fsg_common *common);
++
++void fsg_common_free_luns(struct fsg_common *common);
++
++int fsg_common_set_nluns(struct fsg_common *common, int nluns);
++
++void fsg_common_set_ops(struct fsg_common *common,
++                      const struct fsg_operations *ops);
++
++int fsg_common_create_lun(struct fsg_common *common, struct fsg_lun_config *cfg,
++                        unsigned int id, const char *name,
++                        const char **name_pfx);
++
++int fsg_common_create_luns(struct fsg_common *common, struct fsg_config *cfg);
++
++void fsg_common_set_inquiry_string(struct fsg_common *common, const char *vn,
++                                 const char *pn);
++
++int fsg_common_run_thread(struct fsg_common *common);
++
++void fsg_config_from_params(struct fsg_config *cfg,
++                          const struct fsg_module_parameters *params,
++                          unsigned int fsg_num_buffers);
++
++#endif /* USB_F_MASS_STORAGE_H */
+--- a/drivers/usb/gadget/g_ffs.c
++++ b/drivers/usb/gadget/g_ffs.c
+@@ -76,7 +76,9 @@ struct gfs_ffs_obj {
+ USB_GADGET_COMPOSITE_OPTIONS();
++#if defined CONFIG_USB_FUNCTIONFS_ETH || defined CONFIG_USB_FUNCTIONFS_RNDIS
+ USB_ETHERNET_MODULE_PARAMETERS();
++#endif
+ static struct usb_device_descriptor gfs_dev_desc = {
+       .bLength                = sizeof gfs_dev_desc,
+--- a/drivers/usb/gadget/goku_udc.c
++++ b/drivers/usb/gadget/goku_udc.c
+@@ -1701,7 +1701,6 @@ static void goku_remove(struct pci_dev *
+       if (dev->enabled)
+               pci_disable_device(pdev);
+-      pci_set_drvdata(pdev, NULL);
+       dev->regs = NULL;
+       INFO(dev, "unbind\n");
+--- a/drivers/usb/gadget/Kconfig
++++ b/drivers/usb/gadget/Kconfig
+@@ -58,6 +58,20 @@ config USB_GADGET_DEBUG
+          trying to track down.  Never enable these messages for a
+          production build.
++config USB_GADGET_VERBOSE
++      bool "Verbose debugging Messages (DEVELOPMENT)"
++      depends on USB_GADGET_DEBUG
++      help
++         Many controller and gadget drivers will print verbose debugging
++         messages if you use this option to ask for those messages.
++
++         Avoid enabling these messages, even if you're actively
++         debugging such a driver.  Many drivers will emit so many
++         messages that the driver timings are affected, which will
++         either create new failure modes or remove the one you're
++         trying to track down.  Never enable these messages for a
++         production build.
++
+ config USB_GADGET_DEBUG_FILES
+       boolean "Debugging information files (DEVELOPMENT)"
+       depends on PROC_FS
+@@ -525,6 +539,9 @@ config USB_F_SUBSET
+ config USB_F_RNDIS
+       tristate
++config USB_F_MASS_STORAGE
++      tristate
++
+ choice
+       tristate "USB Gadget Drivers"
+       default USB_ETH
+@@ -662,6 +679,16 @@ config USB_CONFIGFS_PHONET
+       help
+         The Phonet protocol implementation for USB device.
++config USB_CONFIGFS_MASS_STORAGE
++      boolean "Mass storage"
++      depends on USB_CONFIGFS
++      select USB_F_MASS_STORAGE
++      help
++        The Mass Storage Gadget acts as a USB Mass Storage disk drive.
++        As its storage repository it can use a regular file or a block
++        device (in much the same way as the "loop" device driver),
++        specified as a module parameter or sysfs option.
++
+ config USB_ZERO
+       tristate "Gadget Zero (DEVELOPMENT)"
+       select USB_LIBCOMPOSITE
+@@ -878,6 +905,7 @@ config USB_MASS_STORAGE
+       tristate "Mass Storage Gadget"
+       depends on BLOCK
+       select USB_LIBCOMPOSITE
++      select USB_F_MASS_STORAGE
+       help
+         The Mass Storage Gadget acts as a USB Mass Storage disk drive.
+         As its storage repository it can use a regular file or a block
+@@ -1001,6 +1029,7 @@ config USB_G_ACM_MS
+       select USB_LIBCOMPOSITE
+       select USB_U_SERIAL
+       select USB_F_ACM
++      select USB_F_MASS_STORAGE
+       help
+         This driver provides two functions in one configuration:
+         a mass storage, and a CDC ACM (serial port) link.
+@@ -1015,8 +1044,8 @@ config USB_G_MULTI
+       select USB_LIBCOMPOSITE
+       select USB_U_SERIAL
+       select USB_U_ETHER
+-      select USB_U_RNDIS
+       select USB_F_ACM
++      select USB_F_MASS_STORAGE
+       help
+         The Multifunction Composite Gadget provides Ethernet (RNDIS
+         and/or CDC Ethernet), mass storage and ACM serial link
+@@ -1035,6 +1064,8 @@ config USB_G_MULTI
+ config USB_G_MULTI_RNDIS
+       bool "RNDIS + CDC Serial + Storage configuration"
+       depends on USB_G_MULTI
++      select USB_U_RNDIS
++      select USB_F_RNDIS
+       default y
+       help
+         This option enables a configuration with RNDIS, CDC Serial and
+@@ -1048,6 +1079,7 @@ config USB_G_MULTI_CDC
+       bool "CDC Ethernet + CDC Serial + Storage configuration"
+       depends on USB_G_MULTI
+       default n
++      select USB_F_ECM
+       help
+         This option enables a configuration with CDC Ethernet (ECM), CDC
+         Serial and Mass Storage functions available in the Multifunction
+--- a/drivers/usb/gadget/Makefile
++++ b/drivers/usb/gadget/Makefile
+@@ -1,7 +1,8 @@
+ #
+ # USB peripheral controller drivers
+ #
+-ccflags-$(CONFIG_USB_GADGET_DEBUG) := -DDEBUG
++ccflags-$(CONFIG_USB_GADGET_DEBUG)    := -DDEBUG
++ccflags-$(CONFIG_USB_GADGET_VERBOSE)  += -DVERBOSE_DEBUG
+ obj-$(CONFIG_USB_GADGET)      += udc-core.o
+ obj-$(CONFIG_USB_LIBCOMPOSITE)        += libcomposite.o
+@@ -60,6 +61,8 @@ usb_f_ecm_subset-y           := f_subset.o
+ obj-$(CONFIG_USB_F_SUBSET)    += usb_f_ecm_subset.o
+ usb_f_rndis-y                 := f_rndis.o
+ obj-$(CONFIG_USB_F_RNDIS)     += usb_f_rndis.o
++usb_f_mass_storage-y          := f_mass_storage.o storage_common.o
++obj-$(CONFIG_USB_F_MASS_STORAGE)+= usb_f_mass_storage.o
+ #
+ # USB gadget drivers
+--- a/drivers/usb/gadget/mass_storage.c
++++ b/drivers/usb/gadget/mass_storage.c
+@@ -37,16 +37,16 @@
+ #define DRIVER_DESC           "Mass Storage Gadget"
+ #define DRIVER_VERSION                "2009/09/11"
+-/*-------------------------------------------------------------------------*/
+-
+ /*
+- * kbuild is not very cooperative with respect to linking separately
+- * compiled library objects into one module.  So for now we won't use
+- * separate compilation ... ensuring init/exit sections work to shrink
+- * the runtime footprint, and giving us at least some parts of what
+- * a "gcc --combine ... part1.c part2.c part3.c ... " build would.
++ * Thanks to NetChip Technologies for donating this product ID.
++ *
++ * DO NOT REUSE THESE IDs with any other driver!!  Ever!!
++ * Instead:  allocate your own, using normal USB-IF procedures.
+  */
+-#include "f_mass_storage.c"
++#define FSG_VENDOR_ID 0x0525  /* NetChip */
++#define FSG_PRODUCT_ID        0xa4a5  /* Linux-USB File-backed Storage Gadget */
++
++#include "f_mass_storage.h"
+ /*-------------------------------------------------------------------------*/
+ USB_GADGET_COMPOSITE_OPTIONS();
+@@ -97,11 +97,28 @@ static struct usb_gadget_strings *dev_st
+       NULL,
+ };
++static struct usb_function_instance *fi_msg;
++static struct usb_function *f_msg;
++
+ /****************************** Configurations ******************************/
+ static struct fsg_module_parameters mod_data = {
+       .stall = 1
+ };
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++
++static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS;
++
++#else
++
++/*
++ * Number of buffers we will use.
++ * 2 is usually enough for good buffering pipeline
++ */
++#define fsg_num_buffers       CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS
++
++#endif /* CONFIG_USB_GADGET_DEBUG_FILES */
++
+ FSG_MODULE_PARAMETERS(/* no prefix */, mod_data);
+ static unsigned long msg_registered;
+@@ -115,13 +132,7 @@ static int msg_thread_exits(struct fsg_c
+ static int __init msg_do_config(struct usb_configuration *c)
+ {
+-      static const struct fsg_operations ops = {
+-              .thread_exits = msg_thread_exits,
+-      };
+-      static struct fsg_common common;
+-
+-      struct fsg_common *retp;
+-      struct fsg_config config;
++      struct fsg_opts *opts;
+       int ret;
+       if (gadget_is_otg(c->cdev->gadget)) {
+@@ -129,15 +140,24 @@ static int __init msg_do_config(struct u
+               c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
+       }
+-      fsg_config_from_params(&config, &mod_data);
+-      config.ops = &ops;
++      opts = fsg_opts_from_func_inst(fi_msg);
+-      retp = fsg_common_init(&common, c->cdev, &config);
+-      if (IS_ERR(retp))
+-              return PTR_ERR(retp);
++      f_msg = usb_get_function(fi_msg);
++      if (IS_ERR(f_msg))
++              return PTR_ERR(f_msg);
++
++      ret = fsg_common_run_thread(opts->common);
++      if (ret)
++              goto put_func;
++
++      ret = usb_add_function(c, f_msg);
++      if (ret)
++              goto put_func;
+-      ret = fsg_bind_config(c->cdev, c, &common);
+-      fsg_common_put(&common);
++      return 0;
++
++put_func:
++      usb_put_function(f_msg);
+       return ret;
+ }
+@@ -152,23 +172,79 @@ static struct usb_configuration msg_conf
+ static int __init msg_bind(struct usb_composite_dev *cdev)
+ {
++      static const struct fsg_operations ops = {
++              .thread_exits = msg_thread_exits,
++      };
++      struct fsg_opts *opts;
++      struct fsg_config config;
+       int status;
++      fi_msg = usb_get_function_instance("mass_storage");
++      if (IS_ERR(fi_msg))
++              return PTR_ERR(fi_msg);
++
++      fsg_config_from_params(&config, &mod_data, fsg_num_buffers);
++      opts = fsg_opts_from_func_inst(fi_msg);
++
++      opts->no_configfs = true;
++      status = fsg_common_set_num_buffers(opts->common, fsg_num_buffers);
++      if (status)
++              goto fail;
++
++      status = fsg_common_set_nluns(opts->common, config.nluns);
++      if (status)
++              goto fail_set_nluns;
++
++      fsg_common_set_ops(opts->common, &ops);
++
++      status = fsg_common_set_cdev(opts->common, cdev, config.can_stall);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_sysfs(opts->common, true);
++      status = fsg_common_create_luns(opts->common, &config);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_inquiry_string(opts->common, config.vendor_name,
++                                    config.product_name);
++
+       status = usb_string_ids_tab(cdev, strings_dev);
+       if (status < 0)
+-              return status;
++              goto fail_string_ids;
+       msg_device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
+       status = usb_add_config(cdev, &msg_config_driver, msg_do_config);
+       if (status < 0)
+-              return status;
++              goto fail_string_ids;
++
+       usb_composite_overwrite_options(cdev, &coverwrite);
+       dev_info(&cdev->gadget->dev,
+                DRIVER_DESC ", version: " DRIVER_VERSION "\n");
+       set_bit(0, &msg_registered);
+       return 0;
++
++fail_string_ids:
++      fsg_common_remove_luns(opts->common);
++fail_set_cdev:
++      fsg_common_free_luns(opts->common);
++fail_set_nluns:
++      fsg_common_free_buffers(opts->common);
++fail:
++      usb_put_function_instance(fi_msg);
++      return status;
+ }
++static int msg_unbind(struct usb_composite_dev *cdev)
++{
++      if (!IS_ERR(f_msg))
++              usb_put_function(f_msg);
++
++      if (!IS_ERR(fi_msg))
++              usb_put_function_instance(fi_msg);
++
++      return 0;
++}
+ /****************************** Some noise ******************************/
+@@ -179,6 +255,7 @@ static __refdata struct usb_composite_dr
+       .needs_serial   = 1,
+       .strings        = dev_strings,
+       .bind           = msg_bind,
++      .unbind         = msg_unbind,
+ };
+ MODULE_DESCRIPTION(DRIVER_DESC);
+--- a/drivers/usb/gadget/multi.c
++++ b/drivers/usb/gadget/multi.c
+@@ -15,6 +15,7 @@
+ #include <linux/kernel.h>
+ #include <linux/module.h>
++#include <linux/netdevice.h>
+ #include "u_serial.h"
+ #if defined USB_ETH_RNDIS
+@@ -32,22 +33,11 @@ MODULE_AUTHOR("Michal Nazarewicz");
+ MODULE_LICENSE("GPL");
+-/***************************** All the files... *****************************/
++#include "f_mass_storage.h"
+-/*
+- * kbuild is not very cooperative with respect to linking separately
+- * compiled library objects into one module.  So for now we won't use
+- * separate compilation ... ensuring init/exit sections work to shrink
+- * the runtime footprint, and giving us at least some parts of what
+- * a "gcc --combine ... part1.c part2.c part3.c ... " build would.
+- */
+-#include "f_mass_storage.c"
+-
+-#define USBF_ECM_INCLUDED
+-#include "f_ecm.c"
++#include "u_ecm.h"
+ #ifdef USB_ETH_RNDIS
+-#  define USB_FRNDIS_INCLUDED
+-#  include "f_rndis.c"
++#  include "u_rndis.h"
+ #  include "rndis.h"
+ #endif
+ #include "u_ether.h"
+@@ -132,22 +122,36 @@ static struct usb_gadget_strings *dev_st
+ /****************************** Configurations ******************************/
+ static struct fsg_module_parameters fsg_mod_data = { .stall = 1 };
+-FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data);
++#ifdef CONFIG_USB_GADGET_DEBUG_FILES
++
++static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS;
++
++#else
++
++/*
++ * Number of buffers we will use.
++ * 2 is usually enough for good buffering pipeline
++ */
++#define fsg_num_buffers       CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS
+-static struct fsg_common fsg_common;
++#endif /* CONFIG_USB_DEBUG */
+-static u8 host_mac[ETH_ALEN];
++FSG_MODULE_PARAMETERS(/* no prefix */, fsg_mod_data);
+ static struct usb_function_instance *fi_acm;
+-static struct eth_dev *the_dev;
++static struct usb_function_instance *fi_msg;
+ /********** RNDIS **********/
+ #ifdef USB_ETH_RNDIS
++static struct usb_function_instance *fi_rndis;
+ static struct usb_function *f_acm_rndis;
++static struct usb_function *f_rndis;
++static struct usb_function *f_msg_rndis;
+ static __init int rndis_do_config(struct usb_configuration *c)
+ {
++      struct fsg_opts *fsg_opts;
+       int ret;
+       if (gadget_is_otg(c->cdev->gadget)) {
+@@ -155,27 +159,50 @@ static __init int rndis_do_config(struct
+               c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
+       }
+-      ret = rndis_bind_config(c, host_mac, the_dev);
++      f_rndis = usb_get_function(fi_rndis);
++      if (IS_ERR(f_rndis))
++              return PTR_ERR(f_rndis);
++
++      ret = usb_add_function(c, f_rndis);
+       if (ret < 0)
+-              return ret;
++              goto err_func_rndis;
+       f_acm_rndis = usb_get_function(fi_acm);
+-      if (IS_ERR(f_acm_rndis))
+-              return PTR_ERR(f_acm_rndis);
++      if (IS_ERR(f_acm_rndis)) {
++              ret = PTR_ERR(f_acm_rndis);
++              goto err_func_acm;
++      }
+       ret = usb_add_function(c, f_acm_rndis);
+       if (ret)
+               goto err_conf;
+-      ret = fsg_bind_config(c->cdev, c, &fsg_common);
+-      if (ret < 0)
++      f_msg_rndis = usb_get_function(fi_msg);
++      if (IS_ERR(f_msg_rndis)) {
++              ret = PTR_ERR(f_msg_rndis);
+               goto err_fsg;
++      }
++
++      fsg_opts = fsg_opts_from_func_inst(fi_msg);
++      ret = fsg_common_run_thread(fsg_opts->common);
++      if (ret)
++              goto err_run;
++
++      ret = usb_add_function(c, f_msg_rndis);
++      if (ret)
++              goto err_run;
+       return 0;
++err_run:
++      usb_put_function(f_msg_rndis);
+ err_fsg:
+       usb_remove_function(c, f_acm_rndis);
+ err_conf:
+       usb_put_function(f_acm_rndis);
++err_func_acm:
++      usb_remove_function(c, f_rndis);
++err_func_rndis:
++      usb_put_function(f_rndis);
+       return ret;
+ }
+@@ -205,10 +232,14 @@ static __ref int rndis_config_register(s
+ /********** CDC ECM **********/
+ #ifdef CONFIG_USB_G_MULTI_CDC
++static struct usb_function_instance *fi_ecm;
+ static struct usb_function *f_acm_multi;
++static struct usb_function *f_ecm;
++static struct usb_function *f_msg_multi;
+ static __init int cdc_do_config(struct usb_configuration *c)
+ {
++      struct fsg_opts *fsg_opts;
+       int ret;
+       if (gadget_is_otg(c->cdev->gadget)) {
+@@ -216,28 +247,51 @@ static __init int cdc_do_config(struct u
+               c->bmAttributes |= USB_CONFIG_ATT_WAKEUP;
+       }
+-      ret = ecm_bind_config(c, host_mac, the_dev);
++      f_ecm = usb_get_function(fi_ecm);
++      if (IS_ERR(f_ecm))
++              return PTR_ERR(f_ecm);
++
++      ret = usb_add_function(c, f_ecm);
+       if (ret < 0)
+-              return ret;
++              goto err_func_ecm;
+       /* implicit port_num is zero */
+       f_acm_multi = usb_get_function(fi_acm);
+-      if (IS_ERR(f_acm_multi))
+-              return PTR_ERR(f_acm_multi);
++      if (IS_ERR(f_acm_multi)) {
++              ret = PTR_ERR(f_acm_multi);
++              goto err_func_acm;
++      }
+       ret = usb_add_function(c, f_acm_multi);
+       if (ret)
+               goto err_conf;
+-      ret = fsg_bind_config(c->cdev, c, &fsg_common);
+-      if (ret < 0)
++      f_msg_multi = usb_get_function(fi_msg);
++      if (IS_ERR(f_msg_multi)) {
++              ret = PTR_ERR(f_msg_multi);
+               goto err_fsg;
++      }
++
++      fsg_opts = fsg_opts_from_func_inst(fi_msg);
++      ret = fsg_common_run_thread(fsg_opts->common);
++      if (ret)
++              goto err_run;
++
++      ret = usb_add_function(c, f_msg_multi);
++      if (ret)
++              goto err_run;
+       return 0;
++err_run:
++      usb_put_function(f_msg_multi);
+ err_fsg:
+       usb_remove_function(c, f_acm_multi);
+ err_conf:
+       usb_put_function(f_acm_multi);
++err_func_acm:
++      usb_remove_function(c, f_ecm);
++err_func_ecm:
++      usb_put_function(f_ecm);
+       return ret;
+ }
+@@ -270,19 +324,67 @@ static __ref int cdc_config_register(str
+ static int __ref multi_bind(struct usb_composite_dev *cdev)
+ {
+       struct usb_gadget *gadget = cdev->gadget;
++#ifdef CONFIG_USB_G_MULTI_CDC
++      struct f_ecm_opts *ecm_opts;
++#endif
++#ifdef USB_ETH_RNDIS
++      struct f_rndis_opts *rndis_opts;
++#endif
++      struct fsg_opts *fsg_opts;
++      struct fsg_config config;
+       int status;
+       if (!can_support_ecm(cdev->gadget)) {
+               dev_err(&gadget->dev, "controller '%s' not usable\n",
+-                      gadget->name);
++                      gadget->name);
+               return -EINVAL;
+       }
+-      /* set up network link layer */
+-      the_dev = gether_setup(cdev->gadget, dev_addr, host_addr, host_mac,
+-                             qmult);
+-      if (IS_ERR(the_dev))
+-              return PTR_ERR(the_dev);
++#ifdef CONFIG_USB_G_MULTI_CDC
++      fi_ecm = usb_get_function_instance("ecm");
++      if (IS_ERR(fi_ecm))
++              return PTR_ERR(fi_ecm);
++
++      ecm_opts = container_of(fi_ecm, struct f_ecm_opts, func_inst);
++
++      gether_set_qmult(ecm_opts->net, qmult);
++      if (!gether_set_host_addr(ecm_opts->net, host_addr))
++              pr_info("using host ethernet address: %s", host_addr);
++      if (!gether_set_dev_addr(ecm_opts->net, dev_addr))
++              pr_info("using self ethernet address: %s", dev_addr);
++#endif
++
++#ifdef USB_ETH_RNDIS
++      fi_rndis = usb_get_function_instance("rndis");
++      if (IS_ERR(fi_rndis)) {
++              status = PTR_ERR(fi_rndis);
++              goto fail;
++      }
++
++      rndis_opts = container_of(fi_rndis, struct f_rndis_opts, func_inst);
++
++      gether_set_qmult(rndis_opts->net, qmult);
++      if (!gether_set_host_addr(rndis_opts->net, host_addr))
++              pr_info("using host ethernet address: %s", host_addr);
++      if (!gether_set_dev_addr(rndis_opts->net, dev_addr))
++              pr_info("using self ethernet address: %s", dev_addr);
++#endif
++
++#if (defined CONFIG_USB_G_MULTI_CDC && defined USB_ETH_RNDIS)
++      /*
++       * If both ecm and rndis are selected then:
++       *      1) rndis borrows the net interface from ecm
++       *      2) since the interface is shared it must not be bound
++       *      twice - in ecm's _and_ rndis' binds, so do it here.
++       */
++      gether_set_gadget(ecm_opts->net, cdev->gadget);
++      status = gether_register_netdev(ecm_opts->net);
++      if (status)
++              goto fail0;
++
++      rndis_borrow_net(fi_rndis, ecm_opts->net);
++      ecm_opts->bound = true;
++#endif
+       /* set up serial link layer */
+       fi_acm = usb_get_function_instance("acm");
+@@ -292,57 +394,102 @@ static int __ref multi_bind(struct usb_c
+       }
+       /* set up mass storage function */
+-      {
+-              void *retp;
+-              retp = fsg_common_from_params(&fsg_common, cdev, &fsg_mod_data);
+-              if (IS_ERR(retp)) {
+-                      status = PTR_ERR(retp);
+-                      goto fail1;
+-              }
++      fi_msg = usb_get_function_instance("mass_storage");
++      if (IS_ERR(fi_msg)) {
++              status = PTR_ERR(fi_msg);
++              goto fail1;
+       }
++      fsg_config_from_params(&config, &fsg_mod_data, fsg_num_buffers);
++      fsg_opts = fsg_opts_from_func_inst(fi_msg);
++
++      fsg_opts->no_configfs = true;
++      status = fsg_common_set_num_buffers(fsg_opts->common, fsg_num_buffers);
++      if (status)
++              goto fail2;
++
++      status = fsg_common_set_nluns(fsg_opts->common, config.nluns);
++      if (status)
++              goto fail_set_nluns;
++
++      status = fsg_common_set_cdev(fsg_opts->common, cdev, config.can_stall);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_sysfs(fsg_opts->common, true);
++      status = fsg_common_create_luns(fsg_opts->common, &config);
++      if (status)
++              goto fail_set_cdev;
++
++      fsg_common_set_inquiry_string(fsg_opts->common, config.vendor_name,
++                                    config.product_name);
+       /* allocate string IDs */
+       status = usb_string_ids_tab(cdev, strings_dev);
+       if (unlikely(status < 0))
+-              goto fail2;
++              goto fail_string_ids;
+       device_desc.iProduct = strings_dev[USB_GADGET_PRODUCT_IDX].id;
+       /* register configurations */
+       status = rndis_config_register(cdev);
+       if (unlikely(status < 0))
+-              goto fail2;
++              goto fail_string_ids;
+       status = cdc_config_register(cdev);
+       if (unlikely(status < 0))
+-              goto fail2;
++              goto fail_string_ids;
+       usb_composite_overwrite_options(cdev, &coverwrite);
+       /* we're done */
+       dev_info(&gadget->dev, DRIVER_DESC "\n");
+-      fsg_common_put(&fsg_common);
+       return 0;
+       /* error recovery */
++fail_string_ids:
++      fsg_common_remove_luns(fsg_opts->common);
++fail_set_cdev:
++      fsg_common_free_luns(fsg_opts->common);
++fail_set_nluns:
++      fsg_common_free_buffers(fsg_opts->common);
+ fail2:
+-      fsg_common_put(&fsg_common);
++      usb_put_function_instance(fi_msg);
+ fail1:
+       usb_put_function_instance(fi_acm);
+ fail0:
+-      gether_cleanup(the_dev);
++#ifdef USB_ETH_RNDIS
++      usb_put_function_instance(fi_rndis);
++fail:
++#endif
++#ifdef CONFIG_USB_G_MULTI_CDC
++      usb_put_function_instance(fi_ecm);
++#endif
+       return status;
+ }
+ static int __exit multi_unbind(struct usb_composite_dev *cdev)
+ {
+ #ifdef CONFIG_USB_G_MULTI_CDC
++      usb_put_function(f_msg_multi);
++#endif
++#ifdef USB_ETH_RNDIS
++      usb_put_function(f_msg_rndis);
++#endif
++      usb_put_function_instance(fi_msg);
++#ifdef CONFIG_USB_G_MULTI_CDC
+       usb_put_function(f_acm_multi);
+ #endif
+ #ifdef USB_ETH_RNDIS
+       usb_put_function(f_acm_rndis);
+ #endif
+       usb_put_function_instance(fi_acm);
+-      gether_cleanup(the_dev);
++#ifdef USB_ETH_RNDIS
++      usb_put_function(f_rndis);
++      usb_put_function_instance(fi_rndis);
++#endif
++#ifdef CONFIG_USB_G_MULTI_CDC
++      usb_put_function(f_ecm);
++      usb_put_function_instance(fi_ecm);
++#endif
+       return 0;
+ }
+--- a/drivers/usb/gadget/mv_u3d_core.c
++++ b/drivers/usb/gadget/mv_u3d_core.c
+@@ -310,6 +310,7 @@ static struct mv_u3d_trb *mv_u3d_build_t
+        */
+       trb_hw = dma_pool_alloc(u3d->trb_pool, GFP_ATOMIC, dma);
+       if (!trb_hw) {
++              kfree(trb);
+               dev_err(u3d->dev,
+                       "%s, dma_pool_alloc fail\n", __func__);
+               return NULL;
+@@ -454,6 +455,7 @@ static int mv_u3d_req_to_trb(struct mv_u
+               trb_hw = kcalloc(trb_num, sizeof(*trb_hw), GFP_ATOMIC);
+               if (!trb_hw) {
++                      kfree(trb);
+                       dev_err(u3d->dev,
+                                       "%s, trb_hw alloc fail\n", __func__);
+                       return -ENOMEM;
+@@ -1936,7 +1938,7 @@ static int mv_u3d_probe(struct platform_
+       }
+       u3d->irq = r->start;
+       if (request_irq(u3d->irq, mv_u3d_irq,
+-              IRQF_DISABLED | IRQF_SHARED, driver_name, u3d)) {
++              IRQF_SHARED, driver_name, u3d)) {
+               u3d->irq = 0;
+               dev_err(&dev->dev, "Request irq %d for u3d failed\n",
+                       u3d->irq);
+--- a/drivers/usb/gadget/net2280.c
++++ b/drivers/usb/gadget/net2280.c
+@@ -2680,7 +2680,6 @@ static void net2280_remove (struct pci_d
+       if (dev->enabled)
+               pci_disable_device (pdev);
+       device_remove_file (&pdev->dev, &dev_attr_registers);
+-      pci_set_drvdata (pdev, NULL);
+       INFO (dev, "unbind\n");
+ }
+--- a/drivers/usb/gadget/pch_udc.c
++++ b/drivers/usb/gadget/pch_udc.c
+@@ -3080,7 +3080,6 @@ static void pch_udc_remove(struct pci_de
+       if (dev->active)
+               pci_disable_device(pdev);
+       kfree(dev);
+-      pci_set_drvdata(pdev, NULL);
+ }
+ #ifdef CONFIG_PM
+--- a/drivers/usb/gadget/s3c-hsotg.c
++++ b/drivers/usb/gadget/s3c-hsotg.c
+@@ -83,9 +83,12 @@ struct s3c_hsotg_req;
+  * @dir_in: Set to true if this endpoint is of the IN direction, which
+  *        means that it is sending data to the Host.
+  * @index: The index for the endpoint registers.
++ * @mc: Multi Count - number of transactions per microframe
++ * @interval - Interval for periodic endpoints
+  * @name: The name array passed to the USB core.
+  * @halted: Set if the endpoint has been halted.
+  * @periodic: Set if this is a periodic ep, such as Interrupt
++ * @isochronous: Set if this is a isochronous ep
+  * @sent_zlp: Set if we've sent a zero-length packet.
+  * @total_data: The total number of data bytes done.
+  * @fifo_size: The size of the FIFO (for periodic IN endpoints)
+@@ -121,9 +124,12 @@ struct s3c_hsotg_ep {
+       unsigned char           dir_in;
+       unsigned char           index;
++      unsigned char           mc;
++      unsigned char           interval;
+       unsigned int            halted:1;
+       unsigned int            periodic:1;
++      unsigned int            isochronous:1;
+       unsigned int            sent_zlp:1;
+       char                    name[10];
+@@ -468,6 +474,7 @@ static int s3c_hsotg_write_fifo(struct s
+       void *data;
+       int can_write;
+       int pkt_round;
++      int max_transfer;
+       to_write -= (buf_pos - hs_ep->last_load);
+@@ -535,8 +542,10 @@ static int s3c_hsotg_write_fifo(struct s
+               can_write *= 4; /* fifo size is in 32bit quantities. */
+       }
+-      dev_dbg(hsotg->dev, "%s: GNPTXSTS=%08x, can=%d, to=%d, mps %d\n",
+-               __func__, gnptxsts, can_write, to_write, hs_ep->ep.maxpacket);
++      max_transfer = hs_ep->ep.maxpacket * hs_ep->mc;
++
++      dev_dbg(hsotg->dev, "%s: GNPTXSTS=%08x, can=%d, to=%d, max_transfer %d\n",
++               __func__, gnptxsts, can_write, to_write, max_transfer);
+       /*
+        * limit to 512 bytes of data, it seems at least on the non-periodic
+@@ -551,19 +560,21 @@ static int s3c_hsotg_write_fifo(struct s
+        * the transfer to return that it did not run out of fifo space
+        * doing it.
+        */
+-      if (to_write > hs_ep->ep.maxpacket) {
+-              to_write = hs_ep->ep.maxpacket;
++      if (to_write > max_transfer) {
++              to_write = max_transfer;
+-              s3c_hsotg_en_gsint(hsotg,
+-                                 periodic ? GINTSTS_PTxFEmp :
+-                                 GINTSTS_NPTxFEmp);
++              /* it's needed only when we do not use dedicated fifos */
++              if (!hsotg->dedicated_fifos)
++                      s3c_hsotg_en_gsint(hsotg,
++                                         periodic ? GINTSTS_PTxFEmp :
++                                         GINTSTS_NPTxFEmp);
+       }
+       /* see if we can write data */
+       if (to_write > can_write) {
+               to_write = can_write;
+-              pkt_round = to_write % hs_ep->ep.maxpacket;
++              pkt_round = to_write % max_transfer;
+               /*
+                * Round the write down to an
+@@ -581,9 +592,11 @@ static int s3c_hsotg_write_fifo(struct s
+                * is more room left.
+                */
+-              s3c_hsotg_en_gsint(hsotg,
+-                                 periodic ? GINTSTS_PTxFEmp :
+-                                 GINTSTS_NPTxFEmp);
++              /* it's needed only when we do not use dedicated fifos */
++              if (!hsotg->dedicated_fifos)
++                      s3c_hsotg_en_gsint(hsotg,
++                                         periodic ? GINTSTS_PTxFEmp :
++                                         GINTSTS_NPTxFEmp);
+       }
+       dev_dbg(hsotg->dev, "write %d/%d, can_write %d, done %d\n",
+@@ -727,8 +740,16 @@ static void s3c_hsotg_start_req(struct s
+       else
+               packets = 1;    /* send one packet if length is zero. */
++      if (hs_ep->isochronous && length > (hs_ep->mc * hs_ep->ep.maxpacket)) {
++              dev_err(hsotg->dev, "req length > maxpacket*mc\n");
++              return;
++      }
++
+       if (dir_in && index != 0)
+-              epsize = DxEPTSIZ_MC(1);
++              if (hs_ep->isochronous)
++                      epsize = DxEPTSIZ_MC(packets);
++              else
++                      epsize = DxEPTSIZ_MC(1);
+       else
+               epsize = 0;
+@@ -820,6 +841,9 @@ static void s3c_hsotg_start_req(struct s
+       dev_dbg(hsotg->dev, "%s: DxEPCTL=0x%08x\n",
+               __func__, readl(hsotg->regs + epctrl_reg));
++
++      /* enable ep interrupts */
++      s3c_hsotg_ctrl_epint(hsotg, hs_ep->index, hs_ep->dir_in, 1);
+ }
+ /**
+@@ -1091,6 +1115,7 @@ static int s3c_hsotg_process_req_feature
+       bool set = (ctrl->bRequest == USB_REQ_SET_FEATURE);
+       struct s3c_hsotg_ep *ep;
+       int ret;
++      bool halted;
+       dev_dbg(hsotg->dev, "%s: %s_FEATURE\n",
+               __func__, set ? "SET" : "CLEAR");
+@@ -1105,6 +1130,8 @@ static int s3c_hsotg_process_req_feature
+               switch (le16_to_cpu(ctrl->wValue)) {
+               case USB_ENDPOINT_HALT:
++                      halted = ep->halted;
++
+                       s3c_hsotg_ep_sethalt(&ep->ep, set);
+                       ret = s3c_hsotg_send_reply(hsotg, ep0, NULL, 0);
+@@ -1114,7 +1141,12 @@ static int s3c_hsotg_process_req_feature
+                               return ret;
+                       }
+-                      if (!set) {
++                      /*
++                       * we have to complete all requests for ep if it was
++                       * halted, and the halt was cleared by CLEAR_FEATURE
++                       */
++
++                      if (!set && halted) {
+                               /*
+                                * If we have request in progress,
+                                * then complete it
+@@ -1147,6 +1179,8 @@ static int s3c_hsotg_process_req_feature
+       return 1;
+ }
++static void s3c_hsotg_enqueue_setup(struct s3c_hsotg *hsotg);
++
+ /**
+  * s3c_hsotg_process_control - process a control request
+  * @hsotg: The device state
+@@ -1246,11 +1280,15 @@ static void s3c_hsotg_process_control(st
+                * don't believe we need to anything more to get the EP
+                * to reply with a STALL packet
+                */
++
++               /*
++                * complete won't be called, so we enqueue
++                * setup request here
++                */
++               s3c_hsotg_enqueue_setup(hsotg);
+       }
+ }
+-static void s3c_hsotg_enqueue_setup(struct s3c_hsotg *hsotg);
+-
+ /**
+  * s3c_hsotg_complete_setup - completion of a setup transfer
+  * @ep: The endpoint the request was on.
+@@ -1698,6 +1736,7 @@ static void s3c_hsotg_set_ep_maxpacket(s
+       struct s3c_hsotg_ep *hs_ep = &hsotg->eps[ep];
+       void __iomem *regs = hsotg->regs;
+       u32 mpsval;
++      u32 mcval;
+       u32 reg;
+       if (ep == 0) {
+@@ -1705,15 +1744,19 @@ static void s3c_hsotg_set_ep_maxpacket(s
+               mpsval = s3c_hsotg_ep0_mps(mps);
+               if (mpsval > 3)
+                       goto bad_mps;
++              hs_ep->ep.maxpacket = mps;
++              hs_ep->mc = 1;
+       } else {
+-              if (mps >= DxEPCTL_MPS_LIMIT+1)
++              mpsval = mps & DxEPCTL_MPS_MASK;
++              if (mpsval > 1024)
+                       goto bad_mps;
+-
+-              mpsval = mps;
++              mcval = ((mps >> 11) & 0x3) + 1;
++              hs_ep->mc = mcval;
++              if (mcval > 3)
++                      goto bad_mps;
++              hs_ep->ep.maxpacket = mpsval;
+       }
+-      hs_ep->ep.maxpacket = mps;
+-
+       /*
+        * update both the in and out endpoint controldir_ registers, even
+        * if one of the directions may not be in use.
+@@ -1782,8 +1825,16 @@ static int s3c_hsotg_trytx(struct s3c_hs
+ {
+       struct s3c_hsotg_req *hs_req = hs_ep->req;
+-      if (!hs_ep->dir_in || !hs_req)
++      if (!hs_ep->dir_in || !hs_req) {
++              /**
++               * if request is not enqueued, we disable interrupts
++               * for endpoints, excepting ep0
++               */
++              if (hs_ep->index != 0)
++                      s3c_hsotg_ctrl_epint(hsotg, hs_ep->index,
++                                           hs_ep->dir_in, 0);
+               return 0;
++      }
+       if (hs_req->req.actual < hs_req->req.length) {
+               dev_dbg(hsotg->dev, "trying to write more for ep%d\n",
+@@ -1887,8 +1938,10 @@ static void s3c_hsotg_epint(struct s3c_h
+       u32 epctl_reg = dir_in ? DIEPCTL(idx) : DOEPCTL(idx);
+       u32 epsiz_reg = dir_in ? DIEPTSIZ(idx) : DOEPTSIZ(idx);
+       u32 ints;
++      u32 ctrl;
+       ints = readl(hsotg->regs + epint_reg);
++      ctrl = readl(hsotg->regs + epctl_reg);
+       /* Clear endpoint interrupts */
+       writel(ints, hsotg->regs + epint_reg);
+@@ -1897,6 +1950,14 @@ static void s3c_hsotg_epint(struct s3c_h
+               __func__, idx, dir_in ? "in" : "out", ints);
+       if (ints & DxEPINT_XferCompl) {
++              if (hs_ep->isochronous && hs_ep->interval == 1) {
++                      if (ctrl & DxEPCTL_EOFrNum)
++                              ctrl |= DxEPCTL_SetEvenFr;
++                      else
++                              ctrl |= DxEPCTL_SetOddFr;
++                      writel(ctrl, hsotg->regs + epctl_reg);
++              }
++
+               dev_dbg(hsotg->dev,
+                       "%s: XferCompl: DxEPCTL=0x%08x, DxEPTSIZ=%08x\n",
+                       __func__, readl(hsotg->regs + epctl_reg),
+@@ -1963,7 +2024,7 @@ static void s3c_hsotg_epint(struct s3c_h
+       if (ints & DxEPINT_Back2BackSetup)
+               dev_dbg(hsotg->dev, "%s: B2BSetup/INEPNakEff\n", __func__);
+-      if (dir_in) {
++      if (dir_in && !hs_ep->isochronous) {
+               /* not sure if this is important, but we'll clear it anyway */
+               if (ints & DIEPMSK_INTknTXFEmpMsk) {
+                       dev_dbg(hsotg->dev, "%s: ep%d: INTknTXFEmpMsk\n",
+@@ -2092,12 +2153,14 @@ static void kill_all_requests(struct s3c
+ }
+ #define call_gadget(_hs, _entry) \
++do { \
+       if ((_hs)->gadget.speed != USB_SPEED_UNKNOWN && \
+           (_hs)->driver && (_hs)->driver->_entry) { \
+               spin_unlock(&_hs->lock); \
+               (_hs)->driver->_entry(&(_hs)->gadget); \
+               spin_lock(&_hs->lock); \
+-              }
++      } \
++} while (0)
+ /**
+  * s3c_hsotg_disconnect - disconnect service
+@@ -2241,15 +2304,19 @@ static void s3c_hsotg_core_init(struct s
+                      GAHBCFG_HBstLen_Incr4,
+                      hsotg->regs + GAHBCFG);
+       else
+-              writel(GAHBCFG_GlblIntrEn, hsotg->regs + GAHBCFG);
++              writel(((hsotg->dedicated_fifos) ? (GAHBCFG_NPTxFEmpLvl |
++                                                  GAHBCFG_PTxFEmpLvl) : 0) |
++                     GAHBCFG_GlblIntrEn,
++                     hsotg->regs + GAHBCFG);
+       /*
+-       * Enabling INTknTXFEmpMsk here seems to be a big mistake, we end
+-       * up being flooded with interrupts if the host is polling the
+-       * endpoint to try and read data.
++       * If INTknTXFEmpMsk is enabled, it's important to disable ep interrupts
++       * when we have no data to transfer. Otherwise we get being flooded by
++       * interrupts.
+        */
+-      writel(((hsotg->dedicated_fifos) ? DIEPMSK_TxFIFOEmpty : 0) |
++      writel(((hsotg->dedicated_fifos) ? DIEPMSK_TxFIFOEmpty |
++             DIEPMSK_INTknTXFEmpMsk : 0) |
+              DIEPMSK_EPDisbldMsk | DIEPMSK_XferComplMsk |
+              DIEPMSK_TimeOUTMsk | DIEPMSK_AHBErrMsk |
+              DIEPMSK_INTknEPMisMsk,
+@@ -2378,10 +2445,14 @@ irq_retry:
+       if (gintsts & (GINTSTS_OEPInt | GINTSTS_IEPInt)) {
+               u32 daint = readl(hsotg->regs + DAINT);
+-              u32 daint_out = daint >> DAINT_OutEP_SHIFT;
+-              u32 daint_in = daint & ~(daint_out << DAINT_OutEP_SHIFT);
++              u32 daintmsk = readl(hsotg->regs + DAINTMSK);
++              u32 daint_out, daint_in;
+               int ep;
++              daint &= daintmsk;
++              daint_out = daint >> DAINT_OutEP_SHIFT;
++              daint_in = daint & ~(daint_out << DAINT_OutEP_SHIFT);
++
+               dev_dbg(hsotg->dev, "%s: daint=%08x\n", __func__, daint);
+               for (ep = 0; ep < 15 && daint_out; ep++, daint_out >>= 1) {
+@@ -2577,16 +2648,25 @@ static int s3c_hsotg_ep_enable(struct us
+       epctrl |= DxEPCTL_SNAK;
+       /* update the endpoint state */
+-      hs_ep->ep.maxpacket = mps;
++      s3c_hsotg_set_ep_maxpacket(hsotg, hs_ep->index, mps);
+       /* default, set to non-periodic */
++      hs_ep->isochronous = 0;
+       hs_ep->periodic = 0;
++      hs_ep->halted = 0;
++      hs_ep->interval = desc->bInterval;
++
++      if (hs_ep->interval > 1 && hs_ep->mc > 1)
++              dev_err(hsotg->dev, "MC > 1 when interval is not 1\n");
+       switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
+       case USB_ENDPOINT_XFER_ISOC:
+-              dev_err(hsotg->dev, "no current ISOC support\n");
+-              ret = -EINVAL;
+-              goto out;
++              epctrl |= DxEPCTL_EPType_Iso;
++              epctrl |= DxEPCTL_SetEvenFr;
++              hs_ep->isochronous = 1;
++              if (dir_in)
++                      hs_ep->periodic = 1;
++              break;
+       case USB_ENDPOINT_XFER_BULK:
+               epctrl |= DxEPCTL_EPType_Bulk;
+@@ -2634,7 +2714,6 @@ static int s3c_hsotg_ep_enable(struct us
+       /* enable the endpoint interrupt */
+       s3c_hsotg_ctrl_epint(hsotg, index, dir_in, 1);
+-out:
+       spin_unlock_irqrestore(&hsotg->lock, flags);
+       return ret;
+ }
+@@ -2776,6 +2855,8 @@ static int s3c_hsotg_ep_sethalt(struct u
+       writel(epctl, hs->regs + epreg);
++      hs_ep->halted = value;
++
+       return 0;
+ }
+@@ -2903,7 +2984,7 @@ static int s3c_hsotg_udc_start(struct us
+       int ret;
+       if (!hsotg) {
+-              printk(KERN_ERR "%s: called with no device\n", __func__);
++              pr_err("%s: called with no device\n", __func__);
+               return -ENODEV;
+       }
+@@ -3066,7 +3147,7 @@ static void s3c_hsotg_initep(struct s3c_
+       hs_ep->parent = hsotg;
+       hs_ep->ep.name = hs_ep->name;
+-      hs_ep->ep.maxpacket = epnum ? 512 : EP0_MPS_LIMIT;
++      hs_ep->ep.maxpacket = epnum ? 1024 : EP0_MPS_LIMIT;
+       hs_ep->ep.ops = &s3c_hsotg_ep_ops;
+       /*
+@@ -3200,7 +3281,7 @@ static int state_show(struct seq_file *s
+                  readl(regs + GNPTXSTS),
+                  readl(regs + GRXSTSR));
+-      seq_printf(seq, "\nEndpoint status:\n");
++      seq_puts(seq, "\nEndpoint status:\n");
+       for (idx = 0; idx < 15; idx++) {
+               u32 in, out;
+@@ -3217,7 +3298,7 @@ static int state_show(struct seq_file *s
+               seq_printf(seq, ", DIEPTSIZ=0x%08x, DOEPTSIZ=0x%08x",
+                          in, out);
+-              seq_printf(seq, "\n");
++              seq_puts(seq, "\n");
+       }
+       return 0;
+@@ -3251,7 +3332,7 @@ static int fifo_show(struct seq_file *se
+       u32 val;
+       int idx;
+-      seq_printf(seq, "Non-periodic FIFOs:\n");
++      seq_puts(seq, "Non-periodic FIFOs:\n");
+       seq_printf(seq, "RXFIFO: Size %d\n", readl(regs + GRXFSIZ));
+       val = readl(regs + GNPTXFSIZ);
+@@ -3259,7 +3340,7 @@ static int fifo_show(struct seq_file *se
+                  val >> GNPTXFSIZ_NPTxFDep_SHIFT,
+                  val & GNPTXFSIZ_NPTxFStAddr_MASK);
+-      seq_printf(seq, "\nPeriodic TXFIFOs:\n");
++      seq_puts(seq, "\nPeriodic TXFIFOs:\n");
+       for (idx = 1; idx <= 15; idx++) {
+               val = readl(regs + DPTXFSIZn(idx));
+@@ -3330,7 +3411,7 @@ static int ep_show(struct seq_file *seq,
+                  readl(regs + DIEPTSIZ(index)),
+                  readl(regs + DOEPTSIZ(index)));
+-      seq_printf(seq, "\n");
++      seq_puts(seq, "\n");
+       seq_printf(seq, "mps %d\n", ep->ep.maxpacket);
+       seq_printf(seq, "total_data=%ld\n", ep->total_data);
+@@ -3341,7 +3422,7 @@ static int ep_show(struct seq_file *seq,
+       list_for_each_entry(req, &ep->queue, queue) {
+               if (--show_limit < 0) {
+-                      seq_printf(seq, "not showing more requests...\n");
++                      seq_puts(seq, "not showing more requests...\n");
+                       break;
+               }
+--- a/drivers/usb/gadget/storage_common.c
++++ b/drivers/usb/gadget/storage_common.c
+@@ -23,242 +23,17 @@
+  * The valid range of num_buffers is: num >= 2 && num <= 4.
+  */
++#include <linux/module.h>
++#include <linux/blkdev.h>
++#include <linux/file.h>
++#include <linux/fs.h>
++#include <linux/usb/composite.h>
+-#include <linux/usb/storage.h>
+-#include <scsi/scsi.h>
+-#include <asm/unaligned.h>
+-
+-
+-/*
+- * Thanks to NetChip Technologies for donating this product ID.
+- *
+- * DO NOT REUSE THESE IDs with any other driver!!  Ever!!
+- * Instead:  allocate your own, using normal USB-IF procedures.
+- */
+-#define FSG_VENDOR_ID 0x0525  /* NetChip */
+-#define FSG_PRODUCT_ID        0xa4a5  /* Linux-USB File-backed Storage Gadget */
+-
+-
+-/*-------------------------------------------------------------------------*/
+-
+-
+-#ifndef DEBUG
+-#undef VERBOSE_DEBUG
+-#undef DUMP_MSGS
+-#endif /* !DEBUG */
+-
+-#ifdef VERBOSE_DEBUG
+-#define VLDBG LDBG
+-#else
+-#define VLDBG(lun, fmt, args...) do { } while (0)
+-#endif /* VERBOSE_DEBUG */
+-
+-#define LDBG(lun, fmt, args...)   dev_dbg (&(lun)->dev, fmt, ## args)
+-#define LERROR(lun, fmt, args...) dev_err (&(lun)->dev, fmt, ## args)
+-#define LWARN(lun, fmt, args...)  dev_warn(&(lun)->dev, fmt, ## args)
+-#define LINFO(lun, fmt, args...)  dev_info(&(lun)->dev, fmt, ## args)
+-
+-
+-#ifdef DUMP_MSGS
+-
+-#  define dump_msg(fsg, /* const char * */ label,                     \
+-                 /* const u8 * */ buf, /* unsigned */ length) do {    \
+-      if (length < 512) {                                             \
+-              DBG(fsg, "%s, length %u:\n", label, length);            \
+-              print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET,      \
+-                             16, 1, buf, length, 0);                  \
+-      }                                                               \
+-} while (0)
+-
+-#  define dump_cdb(fsg) do { } while (0)
+-
+-#else
+-
+-#  define dump_msg(fsg, /* const char * */ label, \
+-                 /* const u8 * */ buf, /* unsigned */ length) do { } while (0)
+-
+-#  ifdef VERBOSE_DEBUG
+-
+-#    define dump_cdb(fsg)                                             \
+-      print_hex_dump(KERN_DEBUG, "SCSI CDB: ", DUMP_PREFIX_NONE,      \
+-                     16, 1, (fsg)->cmnd, (fsg)->cmnd_size, 0)         \
+-
+-#  else
+-
+-#    define dump_cdb(fsg) do { } while (0)
+-
+-#  endif /* VERBOSE_DEBUG */
+-
+-#endif /* DUMP_MSGS */
+-
+-/*-------------------------------------------------------------------------*/
+-
+-/* Length of a SCSI Command Data Block */
+-#define MAX_COMMAND_SIZE      16
+-
+-/* SCSI Sense Key/Additional Sense Code/ASC Qualifier values */
+-#define SS_NO_SENSE                           0
+-#define SS_COMMUNICATION_FAILURE              0x040800
+-#define SS_INVALID_COMMAND                    0x052000
+-#define SS_INVALID_FIELD_IN_CDB                       0x052400
+-#define SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE 0x052100
+-#define SS_LOGICAL_UNIT_NOT_SUPPORTED         0x052500
+-#define SS_MEDIUM_NOT_PRESENT                 0x023a00
+-#define SS_MEDIUM_REMOVAL_PREVENTED           0x055302
+-#define SS_NOT_READY_TO_READY_TRANSITION      0x062800
+-#define SS_RESET_OCCURRED                     0x062900
+-#define SS_SAVING_PARAMETERS_NOT_SUPPORTED    0x053900
+-#define SS_UNRECOVERED_READ_ERROR             0x031100
+-#define SS_WRITE_ERROR                                0x030c02
+-#define SS_WRITE_PROTECTED                    0x072700
+-
+-#define SK(x)         ((u8) ((x) >> 16))      /* Sense Key byte, etc. */
+-#define ASC(x)                ((u8) ((x) >> 8))
+-#define ASCQ(x)               ((u8) (x))
+-
+-
+-/*-------------------------------------------------------------------------*/
+-
+-
+-struct fsg_lun {
+-      struct file     *filp;
+-      loff_t          file_length;
+-      loff_t          num_sectors;
+-
+-      unsigned int    initially_ro:1;
+-      unsigned int    ro:1;
+-      unsigned int    removable:1;
+-      unsigned int    cdrom:1;
+-      unsigned int    prevent_medium_removal:1;
+-      unsigned int    registered:1;
+-      unsigned int    info_valid:1;
+-      unsigned int    nofua:1;
+-
+-      u32             sense_data;
+-      u32             sense_data_info;
+-      u32             unit_attention_data;
+-
+-      unsigned int    blkbits;        /* Bits of logical block size of bound block device */
+-      unsigned int    blksize;        /* logical block size of bound block device */
+-      struct device   dev;
+-};
+-
+-static inline bool fsg_lun_is_open(struct fsg_lun *curlun)
+-{
+-      return curlun->filp != NULL;
+-}
+-
+-static inline struct fsg_lun *fsg_lun_from_dev(struct device *dev)
+-{
+-      return container_of(dev, struct fsg_lun, dev);
+-}
+-
+-
+-/* Big enough to hold our biggest descriptor */
+-#define EP0_BUFSIZE   256
+-#define DELAYED_STATUS        (EP0_BUFSIZE + 999)     /* An impossibly large value */
+-
+-#ifdef CONFIG_USB_GADGET_DEBUG_FILES
+-
+-static unsigned int fsg_num_buffers = CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS;
+-module_param_named(num_buffers, fsg_num_buffers, uint, S_IRUGO);
+-MODULE_PARM_DESC(num_buffers, "Number of pipeline buffers");
+-
+-#else
+-
+-/*
+- * Number of buffers we will use.
+- * 2 is usually enough for good buffering pipeline
+- */
+-#define fsg_num_buffers       CONFIG_USB_GADGET_STORAGE_NUM_BUFFERS
+-
+-#endif /* CONFIG_USB_GADGET_DEBUG_FILES */
+-
+-/* check if fsg_num_buffers is within a valid range */
+-static inline int fsg_num_buffers_validate(void)
+-{
+-      if (fsg_num_buffers >= 2 && fsg_num_buffers <= 4)
+-              return 0;
+-      pr_err("fsg_num_buffers %u is out of range (%d to %d)\n",
+-             fsg_num_buffers, 2 ,4);
+-      return -EINVAL;
+-}
+-
+-/* Default size of buffer length. */
+-#define FSG_BUFLEN    ((u32)16384)
+-
+-/* Maximal number of LUNs supported in mass storage function */
+-#define FSG_MAX_LUNS  8
+-
+-enum fsg_buffer_state {
+-      BUF_STATE_EMPTY = 0,
+-      BUF_STATE_FULL,
+-      BUF_STATE_BUSY
+-};
+-
+-struct fsg_buffhd {
+-      void                            *buf;
+-      enum fsg_buffer_state           state;
+-      struct fsg_buffhd               *next;
+-
+-      /*
+-       * The NetChip 2280 is faster, and handles some protocol faults
+-       * better, if we don't submit any short bulk-out read requests.
+-       * So we will record the intended request length here.
+-       */
+-      unsigned int                    bulk_out_intended_length;
+-
+-      struct usb_request              *inreq;
+-      int                             inreq_busy;
+-      struct usb_request              *outreq;
+-      int                             outreq_busy;
+-};
+-
+-enum fsg_state {
+-      /* This one isn't used anywhere */
+-      FSG_STATE_COMMAND_PHASE = -10,
+-      FSG_STATE_DATA_PHASE,
+-      FSG_STATE_STATUS_PHASE,
+-
+-      FSG_STATE_IDLE = 0,
+-      FSG_STATE_ABORT_BULK_OUT,
+-      FSG_STATE_RESET,
+-      FSG_STATE_INTERFACE_CHANGE,
+-      FSG_STATE_CONFIG_CHANGE,
+-      FSG_STATE_DISCONNECT,
+-      FSG_STATE_EXIT,
+-      FSG_STATE_TERMINATED
+-};
+-
+-enum data_direction {
+-      DATA_DIR_UNKNOWN = 0,
+-      DATA_DIR_FROM_HOST,
+-      DATA_DIR_TO_HOST,
+-      DATA_DIR_NONE
+-};
+-
+-
+-/*-------------------------------------------------------------------------*/
+-
+-
+-static inline u32 get_unaligned_be24(u8 *buf)
+-{
+-      return 0xffffff & (u32) get_unaligned_be32(buf - 1);
+-}
+-
+-
+-/*-------------------------------------------------------------------------*/
+-
+-
+-enum {
+-      FSG_STRING_INTERFACE
+-};
+-
++#include "storage_common.h"
+ /* There is only one interface. */
+-static struct usb_interface_descriptor
+-fsg_intf_desc = {
++struct usb_interface_descriptor fsg_intf_desc = {
+       .bLength =              sizeof fsg_intf_desc,
+       .bDescriptorType =      USB_DT_INTERFACE,
+@@ -268,14 +43,14 @@ fsg_intf_desc = {
+       .bInterfaceProtocol =   USB_PR_BULK,    /* Adjusted during fsg_bind() */
+       .iInterface =           FSG_STRING_INTERFACE,
+ };
++EXPORT_SYMBOL(fsg_intf_desc);
+ /*
+  * Three full-speed endpoint descriptors: bulk-in, bulk-out, and
+  * interrupt-in.
+  */
+-static struct usb_endpoint_descriptor
+-fsg_fs_bulk_in_desc = {
++struct usb_endpoint_descriptor fsg_fs_bulk_in_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -283,9 +58,9 @@ fsg_fs_bulk_in_desc = {
+       .bmAttributes =         USB_ENDPOINT_XFER_BULK,
+       /* wMaxPacketSize set by autoconfiguration */
+ };
++EXPORT_SYMBOL(fsg_fs_bulk_in_desc);
+-static struct usb_endpoint_descriptor
+-fsg_fs_bulk_out_desc = {
++struct usb_endpoint_descriptor fsg_fs_bulk_out_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -293,13 +68,15 @@ fsg_fs_bulk_out_desc = {
+       .bmAttributes =         USB_ENDPOINT_XFER_BULK,
+       /* wMaxPacketSize set by autoconfiguration */
+ };
++EXPORT_SYMBOL(fsg_fs_bulk_out_desc);
+-static struct usb_descriptor_header *fsg_fs_function[] = {
++struct usb_descriptor_header *fsg_fs_function[] = {
+       (struct usb_descriptor_header *) &fsg_intf_desc,
+       (struct usb_descriptor_header *) &fsg_fs_bulk_in_desc,
+       (struct usb_descriptor_header *) &fsg_fs_bulk_out_desc,
+       NULL,
+ };
++EXPORT_SYMBOL(fsg_fs_function);
+ /*
+@@ -310,8 +87,7 @@ static struct usb_descriptor_header *fsg
+  * and a "device qualifier" ... plus more construction options
+  * for the configuration descriptor.
+  */
+-static struct usb_endpoint_descriptor
+-fsg_hs_bulk_in_desc = {
++struct usb_endpoint_descriptor fsg_hs_bulk_in_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -319,9 +95,9 @@ fsg_hs_bulk_in_desc = {
+       .bmAttributes =         USB_ENDPOINT_XFER_BULK,
+       .wMaxPacketSize =       cpu_to_le16(512),
+ };
++EXPORT_SYMBOL(fsg_hs_bulk_in_desc);
+-static struct usb_endpoint_descriptor
+-fsg_hs_bulk_out_desc = {
++struct usb_endpoint_descriptor fsg_hs_bulk_out_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -330,17 +106,18 @@ fsg_hs_bulk_out_desc = {
+       .wMaxPacketSize =       cpu_to_le16(512),
+       .bInterval =            1,      /* NAK every 1 uframe */
+ };
++EXPORT_SYMBOL(fsg_hs_bulk_out_desc);
+-static struct usb_descriptor_header *fsg_hs_function[] = {
++struct usb_descriptor_header *fsg_hs_function[] = {
+       (struct usb_descriptor_header *) &fsg_intf_desc,
+       (struct usb_descriptor_header *) &fsg_hs_bulk_in_desc,
+       (struct usb_descriptor_header *) &fsg_hs_bulk_out_desc,
+       NULL,
+ };
++EXPORT_SYMBOL(fsg_hs_function);
+-static struct usb_endpoint_descriptor
+-fsg_ss_bulk_in_desc = {
++struct usb_endpoint_descriptor fsg_ss_bulk_in_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -348,16 +125,17 @@ fsg_ss_bulk_in_desc = {
+       .bmAttributes =         USB_ENDPOINT_XFER_BULK,
+       .wMaxPacketSize =       cpu_to_le16(1024),
+ };
++EXPORT_SYMBOL(fsg_ss_bulk_in_desc);
+-static struct usb_ss_ep_comp_descriptor fsg_ss_bulk_in_comp_desc = {
++struct usb_ss_ep_comp_descriptor fsg_ss_bulk_in_comp_desc = {
+       .bLength =              sizeof(fsg_ss_bulk_in_comp_desc),
+       .bDescriptorType =      USB_DT_SS_ENDPOINT_COMP,
+       /*.bMaxBurst =          DYNAMIC, */
+ };
++EXPORT_SYMBOL(fsg_ss_bulk_in_comp_desc);
+-static struct usb_endpoint_descriptor
+-fsg_ss_bulk_out_desc = {
++struct usb_endpoint_descriptor fsg_ss_bulk_out_desc = {
+       .bLength =              USB_DT_ENDPOINT_SIZE,
+       .bDescriptorType =      USB_DT_ENDPOINT,
+@@ -365,15 +143,17 @@ fsg_ss_bulk_out_desc = {
+       .bmAttributes =         USB_ENDPOINT_XFER_BULK,
+       .wMaxPacketSize =       cpu_to_le16(1024),
+ };
++EXPORT_SYMBOL(fsg_ss_bulk_out_desc);
+-static struct usb_ss_ep_comp_descriptor fsg_ss_bulk_out_comp_desc = {
++struct usb_ss_ep_comp_descriptor fsg_ss_bulk_out_comp_desc = {
+       .bLength =              sizeof(fsg_ss_bulk_in_comp_desc),
+       .bDescriptorType =      USB_DT_SS_ENDPOINT_COMP,
+       /*.bMaxBurst =          DYNAMIC, */
+ };
++EXPORT_SYMBOL(fsg_ss_bulk_out_comp_desc);
+-static struct usb_descriptor_header *fsg_ss_function[] = {
++struct usb_descriptor_header *fsg_ss_function[] = {
+       (struct usb_descriptor_header *) &fsg_intf_desc,
+       (struct usb_descriptor_header *) &fsg_ss_bulk_in_desc,
+       (struct usb_descriptor_header *) &fsg_ss_bulk_in_comp_desc,
+@@ -381,17 +161,7 @@ static struct usb_descriptor_header *fsg
+       (struct usb_descriptor_header *) &fsg_ss_bulk_out_comp_desc,
+       NULL,
+ };
+-
+-/* Static strings, in UTF-8 (for simplicity we use only ASCII characters) */
+-static struct usb_string              fsg_strings[] = {
+-      {FSG_STRING_INTERFACE,          fsg_string_interface},
+-      {}
+-};
+-
+-static struct usb_gadget_strings      fsg_stringtab = {
+-      .language       = 0x0409,               /* en-us */
+-      .strings        = fsg_strings,
+-};
++EXPORT_SYMBOL(fsg_ss_function);
+  /*-------------------------------------------------------------------------*/
+@@ -401,7 +171,7 @@ static struct usb_gadget_strings   fsg_str
+  * the caller must own fsg->filesem for writing.
+  */
+-static void fsg_lun_close(struct fsg_lun *curlun)
++void fsg_lun_close(struct fsg_lun *curlun)
+ {
+       if (curlun->filp) {
+               LDBG(curlun, "close backing file\n");
+@@ -409,9 +179,9 @@ static void fsg_lun_close(struct fsg_lun
+               curlun->filp = NULL;
+       }
+ }
++EXPORT_SYMBOL(fsg_lun_close);
+-
+-static int fsg_lun_open(struct fsg_lun *curlun, const char *filename)
++int fsg_lun_open(struct fsg_lun *curlun, const char *filename)
+ {
+       int                             ro;
+       struct file                     *filp = NULL;
+@@ -508,6 +278,7 @@ out:
+       fput(filp);
+       return rc;
+ }
++EXPORT_SYMBOL(fsg_lun_open);
+ /*-------------------------------------------------------------------------*/
+@@ -516,7 +287,7 @@ out:
+  * Sync the file data, don't bother with the metadata.
+  * This code was copied from fs/buffer.c:sys_fdatasync().
+  */
+-static int fsg_lun_fsync_sub(struct fsg_lun *curlun)
++int fsg_lun_fsync_sub(struct fsg_lun *curlun)
+ {
+       struct file     *filp = curlun->filp;
+@@ -524,8 +295,9 @@ static int fsg_lun_fsync_sub(struct fsg_
+               return 0;
+       return vfs_fsync(filp, 1);
+ }
++EXPORT_SYMBOL(fsg_lun_fsync_sub);
+-static void store_cdrom_address(u8 *dest, int msf, u32 addr)
++void store_cdrom_address(u8 *dest, int msf, u32 addr)
+ {
+       if (msf) {
+               /* Convert to Minutes-Seconds-Frames */
+@@ -542,34 +314,28 @@ static void store_cdrom_address(u8 *dest
+               put_unaligned_be32(addr, dest);
+       }
+ }
+-
++EXPORT_SYMBOL(store_cdrom_address);
+ /*-------------------------------------------------------------------------*/
+-static ssize_t ro_show(struct device *dev, struct device_attribute *attr,
+-                     char *buf)
++ssize_t fsg_show_ro(struct fsg_lun *curlun, char *buf)
+ {
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-
+       return sprintf(buf, "%d\n", fsg_lun_is_open(curlun)
+                                 ? curlun->ro
+                                 : curlun->initially_ro);
+ }
++EXPORT_SYMBOL(fsg_show_ro);
+-static ssize_t nofua_show(struct device *dev, struct device_attribute *attr,
+-                        char *buf)
++ssize_t fsg_show_nofua(struct fsg_lun *curlun, char *buf)
+ {
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-
+       return sprintf(buf, "%u\n", curlun->nofua);
+ }
++EXPORT_SYMBOL(fsg_show_nofua);
+-static ssize_t file_show(struct device *dev, struct device_attribute *attr,
+-                       char *buf)
++ssize_t fsg_show_file(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                    char *buf)
+ {
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
+       char            *p;
+       ssize_t         rc;
+@@ -591,17 +357,44 @@ static ssize_t file_show(struct device *
+       up_read(filesem);
+       return rc;
+ }
++EXPORT_SYMBOL(fsg_show_file);
++ssize_t fsg_show_cdrom(struct fsg_lun *curlun, char *buf)
++{
++      return sprintf(buf, "%u\n", curlun->cdrom);
++}
++EXPORT_SYMBOL(fsg_show_cdrom);
+-static ssize_t ro_store(struct device *dev, struct device_attribute *attr,
+-                      const char *buf, size_t count)
++ssize_t fsg_show_removable(struct fsg_lun *curlun, char *buf)
++{
++      return sprintf(buf, "%u\n", curlun->removable);
++}
++EXPORT_SYMBOL(fsg_show_removable);
++
++/*
++ * The caller must hold fsg->filesem for reading when calling this function.
++ */
++static ssize_t _fsg_store_ro(struct fsg_lun *curlun, bool ro)
++{
++      if (fsg_lun_is_open(curlun)) {
++              LDBG(curlun, "read-only status change prevented\n");
++              return -EBUSY;
++      }
++
++      curlun->ro = ro;
++      curlun->initially_ro = ro;
++      LDBG(curlun, "read-only status set to %d\n", curlun->ro);
++
++      return 0;
++}
++
++ssize_t fsg_store_ro(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                   const char *buf, size_t count)
+ {
+       ssize_t         rc;
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
+-      unsigned        ro;
++      bool            ro;
+-      rc = kstrtouint(buf, 2, &ro);
++      rc = strtobool(buf, &ro);
+       if (rc)
+               return rc;
+@@ -610,27 +403,21 @@ static ssize_t ro_store(struct device *d
+        * backing file is closed.
+        */
+       down_read(filesem);
+-      if (fsg_lun_is_open(curlun)) {
+-              LDBG(curlun, "read-only status change prevented\n");
+-              rc = -EBUSY;
+-      } else {
+-              curlun->ro = ro;
+-              curlun->initially_ro = ro;
+-              LDBG(curlun, "read-only status set to %d\n", curlun->ro);
++      rc = _fsg_store_ro(curlun, ro);
++      if (!rc)
+               rc = count;
+-      }
+       up_read(filesem);
++
+       return rc;
+ }
++EXPORT_SYMBOL(fsg_store_ro);
+-static ssize_t nofua_store(struct device *dev, struct device_attribute *attr,
+-                         const char *buf, size_t count)
++ssize_t fsg_store_nofua(struct fsg_lun *curlun, const char *buf, size_t count)
+ {
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-      unsigned        nofua;
++      bool            nofua;
+       int             ret;
+-      ret = kstrtouint(buf, 2, &nofua);
++      ret = strtobool(buf, &nofua);
+       if (ret)
+               return ret;
+@@ -642,12 +429,11 @@ static ssize_t nofua_store(struct device
+       return count;
+ }
++EXPORT_SYMBOL(fsg_store_nofua);
+-static ssize_t file_store(struct device *dev, struct device_attribute *attr,
+-                        const char *buf, size_t count)
++ssize_t fsg_store_file(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                     const char *buf, size_t count)
+ {
+-      struct fsg_lun  *curlun = fsg_lun_from_dev(dev);
+-      struct rw_semaphore     *filesem = dev_get_drvdata(dev);
+       int             rc = 0;
+       if (curlun->prevent_medium_removal && fsg_lun_is_open(curlun)) {
+@@ -674,3 +460,45 @@ static ssize_t file_store(struct device
+       up_write(filesem);
+       return (rc < 0 ? rc : count);
+ }
++EXPORT_SYMBOL(fsg_store_file);
++
++ssize_t fsg_store_cdrom(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                      const char *buf, size_t count)
++{
++      bool            cdrom;
++      int             ret;
++
++      ret = strtobool(buf, &cdrom);
++      if (ret)
++              return ret;
++
++      down_read(filesem);
++      ret = cdrom ? _fsg_store_ro(curlun, true) : 0;
++
++      if (!ret) {
++              curlun->cdrom = cdrom;
++              ret = count;
++      }
++      up_read(filesem);
++
++      return ret;
++}
++EXPORT_SYMBOL(fsg_store_cdrom);
++
++ssize_t fsg_store_removable(struct fsg_lun *curlun, const char *buf,
++                          size_t count)
++{
++      bool            removable;
++      int             ret;
++
++      ret = strtobool(buf, &removable);
++      if (ret)
++              return ret;
++
++      curlun->removable = removable;
++
++      return count;
++}
++EXPORT_SYMBOL(fsg_store_removable);
++
++MODULE_LICENSE("GPL");
+--- /dev/null
++++ b/drivers/usb/gadget/storage_common.h
+@@ -0,0 +1,229 @@
++#ifndef USB_STORAGE_COMMON_H
++#define USB_STORAGE_COMMON_H
++
++#include <linux/device.h>
++#include <linux/usb/storage.h>
++#include <scsi/scsi.h>
++#include <asm/unaligned.h>
++
++#ifndef DEBUG
++#undef VERBOSE_DEBUG
++#undef DUMP_MSGS
++#endif /* !DEBUG */
++
++#ifdef VERBOSE_DEBUG
++#define VLDBG LDBG
++#else
++#define VLDBG(lun, fmt, args...) do { } while (0)
++#endif /* VERBOSE_DEBUG */
++
++#define _LMSG(func, lun, fmt, args...)                                        \
++      do {                                                            \
++              if ((lun)->name_pfx && *(lun)->name_pfx)                \
++                      func("%s/%s: " fmt, *(lun)->name_pfx,           \
++                               (lun)->name, ## args);                 \
++              else                                                    \
++                      func("%s: " fmt, (lun)->name, ## args);         \
++      } while (0)
++
++#define LDBG(lun, fmt, args...)               _LMSG(pr_debug, lun, fmt, ## args)
++#define LERROR(lun, fmt, args...)     _LMSG(pr_err, lun, fmt, ## args)
++#define LWARN(lun, fmt, args...)      _LMSG(pr_warn, lun, fmt, ## args)
++#define LINFO(lun, fmt, args...)      _LMSG(pr_info, lun, fmt, ## args)
++
++
++#ifdef DUMP_MSGS
++
++#  define dump_msg(fsg, /* const char * */ label,                     \
++                 /* const u8 * */ buf, /* unsigned */ length)         \
++do {                                                                  \
++      if (length < 512) {                                             \
++              DBG(fsg, "%s, length %u:\n", label, length);            \
++              print_hex_dump(KERN_DEBUG, "", DUMP_PREFIX_OFFSET,      \
++                             16, 1, buf, length, 0);                  \
++      }                                                               \
++} while (0)
++
++#  define dump_cdb(fsg) do { } while (0)
++
++#else
++
++#  define dump_msg(fsg, /* const char * */ label, \
++                 /* const u8 * */ buf, /* unsigned */ length) do { } while (0)
++
++#  ifdef VERBOSE_DEBUG
++
++#    define dump_cdb(fsg)                                             \
++      print_hex_dump(KERN_DEBUG, "SCSI CDB: ", DUMP_PREFIX_NONE,      \
++                     16, 1, (fsg)->cmnd, (fsg)->cmnd_size, 0)         \
++
++#  else
++
++#    define dump_cdb(fsg) do { } while (0)
++
++#  endif /* VERBOSE_DEBUG */
++
++#endif /* DUMP_MSGS */
++
++/* Length of a SCSI Command Data Block */
++#define MAX_COMMAND_SIZE      16
++
++/* SCSI Sense Key/Additional Sense Code/ASC Qualifier values */
++#define SS_NO_SENSE                           0
++#define SS_COMMUNICATION_FAILURE              0x040800
++#define SS_INVALID_COMMAND                    0x052000
++#define SS_INVALID_FIELD_IN_CDB                       0x052400
++#define SS_LOGICAL_BLOCK_ADDRESS_OUT_OF_RANGE 0x052100
++#define SS_LOGICAL_UNIT_NOT_SUPPORTED         0x052500
++#define SS_MEDIUM_NOT_PRESENT                 0x023a00
++#define SS_MEDIUM_REMOVAL_PREVENTED           0x055302
++#define SS_NOT_READY_TO_READY_TRANSITION      0x062800
++#define SS_RESET_OCCURRED                     0x062900
++#define SS_SAVING_PARAMETERS_NOT_SUPPORTED    0x053900
++#define SS_UNRECOVERED_READ_ERROR             0x031100
++#define SS_WRITE_ERROR                                0x030c02
++#define SS_WRITE_PROTECTED                    0x072700
++
++#define SK(x)         ((u8) ((x) >> 16))      /* Sense Key byte, etc. */
++#define ASC(x)                ((u8) ((x) >> 8))
++#define ASCQ(x)               ((u8) (x))
++
++struct fsg_lun {
++      struct file     *filp;
++      loff_t          file_length;
++      loff_t          num_sectors;
++
++      unsigned int    initially_ro:1;
++      unsigned int    ro:1;
++      unsigned int    removable:1;
++      unsigned int    cdrom:1;
++      unsigned int    prevent_medium_removal:1;
++      unsigned int    registered:1;
++      unsigned int    info_valid:1;
++      unsigned int    nofua:1;
++
++      u32             sense_data;
++      u32             sense_data_info;
++      u32             unit_attention_data;
++
++      unsigned int    blkbits; /* Bits of logical block size
++                                                     of bound block device */
++      unsigned int    blksize; /* logical block size of bound block device */
++      struct device   dev;
++      const char      *name;          /* "lun.name" */
++      const char      **name_pfx;     /* "function.name" */
++};
++
++static inline bool fsg_lun_is_open(struct fsg_lun *curlun)
++{
++      return curlun->filp != NULL;
++}
++
++/* Big enough to hold our biggest descriptor */
++#define EP0_BUFSIZE   256
++#define DELAYED_STATUS        (EP0_BUFSIZE + 999)     /* An impossibly large value */
++
++/* Default size of buffer length. */
++#define FSG_BUFLEN    ((u32)16384)
++
++/* Maximal number of LUNs supported in mass storage function */
++#define FSG_MAX_LUNS  8
++
++enum fsg_buffer_state {
++      BUF_STATE_EMPTY = 0,
++      BUF_STATE_FULL,
++      BUF_STATE_BUSY
++};
++
++struct fsg_buffhd {
++      void                            *buf;
++      enum fsg_buffer_state           state;
++      struct fsg_buffhd               *next;
++
++      /*
++       * The NetChip 2280 is faster, and handles some protocol faults
++       * better, if we don't submit any short bulk-out read requests.
++       * So we will record the intended request length here.
++       */
++      unsigned int                    bulk_out_intended_length;
++
++      struct usb_request              *inreq;
++      int                             inreq_busy;
++      struct usb_request              *outreq;
++      int                             outreq_busy;
++};
++
++enum fsg_state {
++      /* This one isn't used anywhere */
++      FSG_STATE_COMMAND_PHASE = -10,
++      FSG_STATE_DATA_PHASE,
++      FSG_STATE_STATUS_PHASE,
++
++      FSG_STATE_IDLE = 0,
++      FSG_STATE_ABORT_BULK_OUT,
++      FSG_STATE_RESET,
++      FSG_STATE_INTERFACE_CHANGE,
++      FSG_STATE_CONFIG_CHANGE,
++      FSG_STATE_DISCONNECT,
++      FSG_STATE_EXIT,
++      FSG_STATE_TERMINATED
++};
++
++enum data_direction {
++      DATA_DIR_UNKNOWN = 0,
++      DATA_DIR_FROM_HOST,
++      DATA_DIR_TO_HOST,
++      DATA_DIR_NONE
++};
++
++static inline u32 get_unaligned_be24(u8 *buf)
++{
++      return 0xffffff & (u32) get_unaligned_be32(buf - 1);
++}
++
++static inline struct fsg_lun *fsg_lun_from_dev(struct device *dev)
++{
++      return container_of(dev, struct fsg_lun, dev);
++}
++
++enum {
++      FSG_STRING_INTERFACE
++};
++
++extern struct usb_interface_descriptor fsg_intf_desc;
++
++extern struct usb_endpoint_descriptor fsg_fs_bulk_in_desc;
++extern struct usb_endpoint_descriptor fsg_fs_bulk_out_desc;
++extern struct usb_descriptor_header *fsg_fs_function[];
++
++extern struct usb_endpoint_descriptor fsg_hs_bulk_in_desc;
++extern struct usb_endpoint_descriptor fsg_hs_bulk_out_desc;
++extern struct usb_descriptor_header *fsg_hs_function[];
++
++extern struct usb_endpoint_descriptor fsg_ss_bulk_in_desc;
++extern struct usb_ss_ep_comp_descriptor fsg_ss_bulk_in_comp_desc;
++extern struct usb_endpoint_descriptor fsg_ss_bulk_out_desc;
++extern struct usb_ss_ep_comp_descriptor fsg_ss_bulk_out_comp_desc;
++extern struct usb_descriptor_header *fsg_ss_function[];
++
++void fsg_lun_close(struct fsg_lun *curlun);
++int fsg_lun_open(struct fsg_lun *curlun, const char *filename);
++int fsg_lun_fsync_sub(struct fsg_lun *curlun);
++void store_cdrom_address(u8 *dest, int msf, u32 addr);
++ssize_t fsg_show_ro(struct fsg_lun *curlun, char *buf);
++ssize_t fsg_show_nofua(struct fsg_lun *curlun, char *buf);
++ssize_t fsg_show_file(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                    char *buf);
++ssize_t fsg_show_cdrom(struct fsg_lun *curlun, char *buf);
++ssize_t fsg_show_removable(struct fsg_lun *curlun, char *buf);
++ssize_t fsg_store_ro(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                   const char *buf, size_t count);
++ssize_t fsg_store_nofua(struct fsg_lun *curlun, const char *buf, size_t count);
++ssize_t fsg_store_file(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                     const char *buf, size_t count);
++ssize_t fsg_store_cdrom(struct fsg_lun *curlun, struct rw_semaphore *filesem,
++                      const char *buf, size_t count);
++ssize_t fsg_store_removable(struct fsg_lun *curlun, const char *buf,
++                          size_t count);
++
++#endif /* USB_STORAGE_COMMON_H */
+--- a/drivers/usb/gadget/udc-core.c
++++ b/drivers/usb/gadget/udc-core.c
+@@ -356,7 +356,8 @@ static int udc_bind_to_driver(struct usb
+       kobject_uevent(&udc->dev.kobj, KOBJ_CHANGE);
+       return 0;
+ err1:
+-      dev_err(&udc->dev, "failed to start %s: %d\n",
++      if (ret != -EISNAM)
++              dev_err(&udc->dev, "failed to start %s: %d\n",
+                       udc->driver->function, ret);
+       udc->driver = NULL;
+       udc->dev.driver = NULL;
+--- a/drivers/usb/gadget/zero.c
++++ b/drivers/usb/gadget/zero.c
+@@ -95,6 +95,18 @@ unsigned autoresume = DEFAULT_AUTORESUME
+ module_param(autoresume, uint, S_IRUGO);
+ MODULE_PARM_DESC(autoresume, "zero, or seconds before remote wakeup");
++/* Maximum Autoresume time */
++unsigned max_autoresume;
++module_param(max_autoresume, uint, S_IRUGO);
++MODULE_PARM_DESC(max_autoresume, "maximum seconds before remote wakeup");
++
++/* Interval between two remote wakeups */
++unsigned autoresume_interval_ms;
++module_param(autoresume_interval_ms, uint, S_IRUGO);
++MODULE_PARM_DESC(autoresume_interval_ms,
++              "milliseconds to increase successive wakeup delays");
++
++static unsigned autoresume_step_ms;
+ /*-------------------------------------------------------------------------*/
+ static struct usb_device_descriptor device_desc = {
+@@ -183,8 +195,16 @@ static void zero_suspend(struct usb_comp
+               return;
+       if (autoresume) {
+-              mod_timer(&autoresume_timer, jiffies + (HZ * autoresume));
+-              DBG(cdev, "suspend, wakeup in %d seconds\n", autoresume);
++              if (max_autoresume &&
++                      (autoresume_step_ms > max_autoresume * 1000))
++                              autoresume_step_ms = autoresume * 1000;
++
++              mod_timer(&autoresume_timer, jiffies +
++                      msecs_to_jiffies(autoresume_step_ms));
++              DBG(cdev, "suspend, wakeup in %d milliseconds\n",
++                      autoresume_step_ms);
++
++              autoresume_step_ms += autoresume_interval_ms;
+       } else
+               DBG(cdev, "%s\n", __func__);
+ }
+@@ -316,6 +336,7 @@ static int __init zero_bind(struct usb_c
+       if (autoresume) {
+               sourcesink_driver.bmAttributes |= USB_CONFIG_ATT_WAKEUP;
+               loopback_driver.bmAttributes |= USB_CONFIG_ATT_WAKEUP;
++              autoresume_step_ms = autoresume * 1000;
+       }
+       /* support OTG systems */
+--- a/drivers/usb/misc/usbtest.c
++++ b/drivers/usb/misc/usbtest.c
+@@ -120,7 +120,7 @@ get_endpoints(struct usbtest_dev *dev, s
+                       struct usb_host_endpoint        *e;
+                       e = alt->endpoint + ep;
+-                      switch (e->desc.bmAttributes) {
++                      switch (usb_endpoint_type(&e->desc)) {
+                       case USB_ENDPOINT_XFER_BULK:
+                               break;
+                       case USB_ENDPOINT_XFER_ISOC:
+--- a/drivers/usb/musb/am35x.c
++++ b/drivers/usb/musb/am35x.c
+@@ -89,7 +89,6 @@ struct am35x_glue {
+       struct clk              *phy_clk;
+       struct clk              *clk;
+ };
+-#define glue_to_musb(g)               platform_get_drvdata(g->musb)
+ /*
+  * am35x_musb_enable - enable interrupts
+@@ -452,14 +451,18 @@ static const struct musb_platform_ops am
+       .set_vbus       = am35x_musb_set_vbus,
+ };
+-static u64 am35x_dmamask = DMA_BIT_MASK(32);
++static const struct platform_device_info am35x_dev_info = {
++      .name           = "musb-hdrc",
++      .id             = PLATFORM_DEVID_AUTO,
++      .dma_mask       = DMA_BIT_MASK(32),
++};
+ static int am35x_probe(struct platform_device *pdev)
+ {
+       struct musb_hdrc_platform_data  *pdata = dev_get_platdata(&pdev->dev);
+       struct platform_device          *musb;
+       struct am35x_glue               *glue;
+-
++      struct platform_device_info     pinfo;
+       struct clk                      *phy_clk;
+       struct clk                      *clk;
+@@ -471,12 +474,6 @@ static int am35x_probe(struct platform_d
+               goto err0;
+       }
+-      musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
+-      if (!musb) {
+-              dev_err(&pdev->dev, "failed to allocate musb device\n");
+-              goto err1;
+-      }
+-
+       phy_clk = clk_get(&pdev->dev, "fck");
+       if (IS_ERR(phy_clk)) {
+               dev_err(&pdev->dev, "failed to get PHY clock\n");
+@@ -503,12 +500,7 @@ static int am35x_probe(struct platform_d
+               goto err6;
+       }
+-      musb->dev.parent                = &pdev->dev;
+-      musb->dev.dma_mask              = &am35x_dmamask;
+-      musb->dev.coherent_dma_mask     = am35x_dmamask;
+-
+       glue->dev                       = &pdev->dev;
+-      glue->musb                      = musb;
+       glue->phy_clk                   = phy_clk;
+       glue->clk                       = clk;
+@@ -516,22 +508,17 @@ static int am35x_probe(struct platform_d
+       platform_set_drvdata(pdev, glue);
+-      ret = platform_device_add_resources(musb, pdev->resource,
+-                      pdev->num_resources);
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add resources\n");
+-              goto err7;
+-      }
+-
+-      ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add platform_data\n");
+-              goto err7;
+-      }
+-
+-      ret = platform_device_add(musb);
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to register musb device\n");
++      pinfo = am35x_dev_info;
++      pinfo.parent = &pdev->dev;
++      pinfo.res = pdev->resource;
++      pinfo.num_res = pdev->num_resources;
++      pinfo.data = pdata;
++      pinfo.size_data = sizeof(*pdata);
++
++      glue->musb = musb = platform_device_register_full(&pinfo);
++      if (IS_ERR(musb)) {
++              ret = PTR_ERR(musb);
++              dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
+               goto err7;
+       }
+@@ -550,9 +537,6 @@ err4:
+       clk_put(phy_clk);
+ err3:
+-      platform_device_put(musb);
+-
+-err1:
+       kfree(glue);
+ err0:
+@@ -615,23 +599,16 @@ static int am35x_resume(struct device *d
+       return 0;
+ }
+-
+-static struct dev_pm_ops am35x_pm_ops = {
+-      .suspend        = am35x_suspend,
+-      .resume         = am35x_resume,
+-};
+-
+-#define DEV_PM_OPS    &am35x_pm_ops
+-#else
+-#define DEV_PM_OPS    NULL
+ #endif
++static SIMPLE_DEV_PM_OPS(am35x_pm_ops, am35x_suspend, am35x_resume);
++
+ static struct platform_driver am35x_driver = {
+       .probe          = am35x_probe,
+       .remove         = am35x_remove,
+       .driver         = {
+               .name   = "musb-am35x",
+-              .pm     = DEV_PM_OPS,
++              .pm     = &am35x_pm_ops,
+       },
+ };
+--- a/drivers/usb/musb/blackfin.c
++++ b/drivers/usb/musb/blackfin.c
+@@ -561,23 +561,16 @@ static int bfin_resume(struct device *de
+       return 0;
+ }
+-
+-static struct dev_pm_ops bfin_pm_ops = {
+-      .suspend        = bfin_suspend,
+-      .resume         = bfin_resume,
+-};
+-
+-#define DEV_PM_OPS    &bfin_pm_ops
+-#else
+-#define DEV_PM_OPS    NULL
+ #endif
++static SIMPLE_DEV_PM_OPS(bfin_pm_ops, bfin_suspend, bfin_resume);
++
+ static struct platform_driver bfin_driver = {
+       .probe          = bfin_probe,
+       .remove         = __exit_p(bfin_remove),
+       .driver         = {
+               .name   = "musb-blackfin",
+-              .pm     = DEV_PM_OPS,
++              .pm     = &bfin_pm_ops,
+       },
+ };
+--- a/drivers/usb/musb/da8xx.c
++++ b/drivers/usb/musb/da8xx.c
+@@ -472,7 +472,11 @@ static const struct musb_platform_ops da
+       .set_vbus       = da8xx_musb_set_vbus,
+ };
+-static u64 da8xx_dmamask = DMA_BIT_MASK(32);
++static const struct platform_device_info da8xx_dev_info = {
++      .name           = "musb-hdrc",
++      .id             = PLATFORM_DEVID_AUTO,
++      .dma_mask       = DMA_BIT_MASK(32),
++};
+ static int da8xx_probe(struct platform_device *pdev)
+ {
+@@ -480,7 +484,7 @@ static int da8xx_probe(struct platform_d
+       struct musb_hdrc_platform_data  *pdata = dev_get_platdata(&pdev->dev);
+       struct platform_device          *musb;
+       struct da8xx_glue               *glue;
+-
++      struct platform_device_info     pinfo;
+       struct clk                      *clk;
+       int                             ret = -ENOMEM;
+@@ -491,12 +495,6 @@ static int da8xx_probe(struct platform_d
+               goto err0;
+       }
+-      musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
+-      if (!musb) {
+-              dev_err(&pdev->dev, "failed to allocate musb device\n");
+-              goto err1;
+-      }
+-
+       clk = clk_get(&pdev->dev, "usb20");
+       if (IS_ERR(clk)) {
+               dev_err(&pdev->dev, "failed to get clock\n");
+@@ -510,12 +508,7 @@ static int da8xx_probe(struct platform_d
+               goto err4;
+       }
+-      musb->dev.parent                = &pdev->dev;
+-      musb->dev.dma_mask              = &da8xx_dmamask;
+-      musb->dev.coherent_dma_mask     = da8xx_dmamask;
+-
+       glue->dev                       = &pdev->dev;
+-      glue->musb                      = musb;
+       glue->clk                       = clk;
+       pdata->platform_ops             = &da8xx_ops;
+@@ -535,22 +528,17 @@ static int da8xx_probe(struct platform_d
+       musb_resources[1].end = pdev->resource[1].end;
+       musb_resources[1].flags = pdev->resource[1].flags;
+-      ret = platform_device_add_resources(musb, musb_resources,
+-                      ARRAY_SIZE(musb_resources));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add resources\n");
+-              goto err5;
+-      }
+-
+-      ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add platform_data\n");
+-              goto err5;
+-      }
+-
+-      ret = platform_device_add(musb);
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to register musb device\n");
++      pinfo = da8xx_dev_info;
++      pinfo.parent = &pdev->dev;
++      pinfo.res = musb_resources;
++      pinfo.num_res = ARRAY_SIZE(musb_resources);
++      pinfo.data = pdata;
++      pinfo.size_data = sizeof(*pdata);
++
++      glue->musb = musb = platform_device_register_full(&pinfo);
++      if (IS_ERR(musb)) {
++              ret = PTR_ERR(musb);
++              dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
+               goto err5;
+       }
+@@ -563,9 +551,6 @@ err4:
+       clk_put(clk);
+ err3:
+-      platform_device_put(musb);
+-
+-err1:
+       kfree(glue);
+ err0:
+--- a/drivers/usb/musb/davinci.c
++++ b/drivers/usb/musb/davinci.c
+@@ -505,14 +505,19 @@ static const struct musb_platform_ops da
+       .set_vbus       = davinci_musb_set_vbus,
+ };
+-static u64 davinci_dmamask = DMA_BIT_MASK(32);
++static const struct platform_device_info davinci_dev_info = {
++      .name           = "musb-hdrc",
++      .id             = PLATFORM_DEVID_AUTO,
++      .dma_mask       = DMA_BIT_MASK(32),
++};
+ static int davinci_probe(struct platform_device *pdev)
+ {
+-      struct resource musb_resources[2];
++      struct resource                 musb_resources[3];
+       struct musb_hdrc_platform_data  *pdata = dev_get_platdata(&pdev->dev);
+       struct platform_device          *musb;
+       struct davinci_glue             *glue;
++      struct platform_device_info     pinfo;
+       struct clk                      *clk;
+       int                             ret = -ENOMEM;
+@@ -523,12 +528,6 @@ static int davinci_probe(struct platform
+               goto err0;
+       }
+-      musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
+-      if (!musb) {
+-              dev_err(&pdev->dev, "failed to allocate musb device\n");
+-              goto err1;
+-      }
+-
+       clk = clk_get(&pdev->dev, "usb");
+       if (IS_ERR(clk)) {
+               dev_err(&pdev->dev, "failed to get clock\n");
+@@ -542,12 +541,7 @@ static int davinci_probe(struct platform
+               goto err4;
+       }
+-      musb->dev.parent                = &pdev->dev;
+-      musb->dev.dma_mask              = &davinci_dmamask;
+-      musb->dev.coherent_dma_mask     = davinci_dmamask;
+-
+       glue->dev                       = &pdev->dev;
+-      glue->musb                      = musb;
+       glue->clk                       = clk;
+       pdata->platform_ops             = &davinci_ops;
+@@ -567,22 +561,26 @@ static int davinci_probe(struct platform
+       musb_resources[1].end = pdev->resource[1].end;
+       musb_resources[1].flags = pdev->resource[1].flags;
+-      ret = platform_device_add_resources(musb, musb_resources,
+-                      ARRAY_SIZE(musb_resources));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add resources\n");
+-              goto err5;
+-      }
+-
+-      ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add platform_data\n");
+-              goto err5;
+-      }
+-
+-      ret = platform_device_add(musb);
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to register musb device\n");
++      /*
++       * For DM6467 3 resources are passed. A placeholder for the 3rd
++       * resource is always there, so it's safe to always copy it...
++       */
++      musb_resources[2].name = pdev->resource[2].name;
++      musb_resources[2].start = pdev->resource[2].start;
++      musb_resources[2].end = pdev->resource[2].end;
++      musb_resources[2].flags = pdev->resource[2].flags;
++
++      pinfo = davinci_dev_info;
++      pinfo.parent = &pdev->dev;
++      pinfo.res = musb_resources;
++      pinfo.num_res = ARRAY_SIZE(musb_resources);
++      pinfo.data = pdata;
++      pinfo.size_data = sizeof(*pdata);
++
++      glue->musb = musb = platform_device_register_full(&pinfo);
++      if (IS_ERR(musb)) {
++              ret = PTR_ERR(musb);
++              dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
+               goto err5;
+       }
+@@ -595,9 +593,6 @@ err4:
+       clk_put(clk);
+ err3:
+-      platform_device_put(musb);
+-
+-err1:
+       kfree(glue);
+ err0:
+--- a/drivers/usb/musb/Kconfig
++++ b/drivers/usb/musb/Kconfig
+@@ -75,6 +75,7 @@ config USB_MUSB_TUSB6010
+ config USB_MUSB_OMAP2PLUS
+       tristate "OMAP2430 and onwards"
+       depends on ARCH_OMAP2PLUS
++      select GENERIC_PHY
+ config USB_MUSB_AM35X
+       tristate "AM35x"
+@@ -90,7 +91,7 @@ config USB_MUSB_BLACKFIN
+       depends on (BF54x && !BF544) || (BF52x && ! BF522 && !BF523)
+ config USB_MUSB_UX500
+-      tristate "U8500 and U5500"
++      tristate "Ux500 platforms"
+ endchoice
+@@ -112,7 +113,7 @@ choice
+         allow using DMA on multiplatform kernels.
+ config USB_UX500_DMA
+-      bool 'ST Ericsson U8500 and U5500'
++      bool 'ST Ericsson Ux500'
+       depends on USB_MUSB_UX500
+       help
+         Enable DMA transfers on UX500 platforms.
+--- a/drivers/usb/musb/musb_am335x.c
++++ b/drivers/usb/musb/musb_am335x.c
+@@ -46,7 +46,7 @@ static struct platform_driver am335x_chi
+       .remove         = am335x_child_remove,
+       .driver         = {
+               .name   = "am335x-usb-childs",
+-              .of_match_table = of_match_ptr(am335x_child_of_match),
++              .of_match_table = am335x_child_of_match,
+       },
+ };
+--- a/drivers/usb/musb/musb_core.c
++++ b/drivers/usb/musb/musb_core.c
+@@ -94,6 +94,7 @@
+ #include <linux/sched.h>
+ #include <linux/slab.h>
+ #include <linux/init.h>
++#include <linux/idr.h>
+ #include <linux/list.h>
+ #include <linux/kobject.h>
+ #include <linux/prefetch.h>
+@@ -120,7 +121,7 @@ MODULE_DESCRIPTION(DRIVER_INFO);
+ MODULE_AUTHOR(DRIVER_AUTHOR);
+ MODULE_LICENSE("GPL");
+ MODULE_ALIAS("platform:" MUSB_DRIVER_NAME);
+-
++static DEFINE_IDA(musb_ida);
+ /*-------------------------------------------------------------------------*/
+@@ -131,6 +132,35 @@ static inline struct musb *dev_to_musb(s
+ /*-------------------------------------------------------------------------*/
++int musb_get_id(struct device *dev, gfp_t gfp_mask)
++{
++      int ret;
++      int id;
++
++      ret = ida_pre_get(&musb_ida, gfp_mask);
++      if (!ret) {
++              dev_err(dev, "failed to reserve resource for id\n");
++              return -ENOMEM;
++      }
++
++      ret = ida_get_new(&musb_ida, &id);
++      if (ret < 0) {
++              dev_err(dev, "failed to allocate a new id\n");
++              return ret;
++              }
++
++      return id;
++}
++EXPORT_SYMBOL_GPL(musb_get_id);
++
++void musb_put_id(struct device *dev, int id)
++{
++
++      dev_dbg(dev, "removing id %d\n", id);
++      ida_remove(&musb_ida, id);
++}
++EXPORT_SYMBOL_GPL(musb_put_id);
++
+ #ifndef CONFIG_BLACKFIN
+ static int musb_ulpi_read(struct usb_phy *phy, u32 offset)
+ {
+@@ -1809,8 +1839,7 @@ static void musb_free(struct musb *musb)
+                       disable_irq_wake(musb->nIrq);
+               free_irq(musb->nIrq, musb);
+       }
+-      if (musb->dma_controller)
+-              dma_controller_destroy(musb->dma_controller);
++      cancel_work_sync(&musb->irq_work);
+       musb_host_free(musb);
+ }
+@@ -1885,8 +1914,13 @@ musb_init_controller(struct device *dev,
+       pm_runtime_get_sync(musb->controller);
+-      if (use_dma && dev->dma_mask)
++      if (use_dma && dev->dma_mask) {
+               musb->dma_controller = dma_controller_create(musb, musb->mregs);
++              if (IS_ERR(musb->dma_controller)) {
++                      status = PTR_ERR(musb->dma_controller);
++                      goto fail2_5;
++              }
++      }
+       /* be sure interrupts are disabled before connecting ISR */
+       musb_platform_disable(musb);
+@@ -1937,15 +1971,26 @@ musb_init_controller(struct device *dev,
+       switch (musb->port_mode) {
+       case MUSB_PORT_MODE_HOST:
+               status = musb_host_setup(musb, plat->power);
++              if (status < 0)
++                      goto fail3;
++              status = musb_platform_set_mode(musb, MUSB_HOST);
+               break;
+       case MUSB_PORT_MODE_GADGET:
+               status = musb_gadget_setup(musb);
++              if (status < 0)
++                      goto fail3;
++              status = musb_platform_set_mode(musb, MUSB_PERIPHERAL);
+               break;
+       case MUSB_PORT_MODE_DUAL_ROLE:
+               status = musb_host_setup(musb, plat->power);
+               if (status < 0)
+                       goto fail3;
+               status = musb_gadget_setup(musb);
++              if (status) {
++                      musb_host_cleanup(musb);
++                      goto fail3;
++              }
++              status = musb_platform_set_mode(musb, MUSB_OTG);
+               break;
+       default:
+               dev_err(dev, "unsupported port mode %d\n", musb->port_mode);
+@@ -1972,10 +2017,12 @@ fail5:
+ fail4:
+       musb_gadget_cleanup(musb);
++      musb_host_cleanup(musb);
+ fail3:
+       if (musb->dma_controller)
+               dma_controller_destroy(musb->dma_controller);
++fail2_5:
+       pm_runtime_put_sync(musb->controller);
+ fail2:
+@@ -2032,6 +2079,9 @@ static int musb_remove(struct platform_d
+       musb_exit_debugfs(musb);
+       musb_shutdown(pdev);
++      if (musb->dma_controller)
++              dma_controller_destroy(musb->dma_controller);
++
+       musb_free(musb);
+       device_init_wakeup(dev, 0);
+       return 0;
+--- a/drivers/usb/musb/musb_core.h
++++ b/drivers/usb/musb/musb_core.h
+@@ -46,6 +46,7 @@
+ #include <linux/usb.h>
+ #include <linux/usb/otg.h>
+ #include <linux/usb/musb.h>
++#include <linux/phy/phy.h>
+ struct musb;
+ struct musb_hw_ep;
+@@ -341,6 +342,7 @@ struct musb {
+       u16                     int_tx;
+       struct usb_phy          *xceiv;
++      struct phy              *phy;
+       int nIrq;
+       unsigned                irq_wake:1;
+@@ -505,6 +507,9 @@ extern const char musb_driver_name[];
+ extern void musb_stop(struct musb *musb);
+ extern void musb_start(struct musb *musb);
++extern int musb_get_id(struct device *dev, gfp_t gfp_mask);
++extern void musb_put_id(struct device *dev, int id);
++
+ extern void musb_write_fifo(struct musb_hw_ep *ep, u16 len, const u8 *src);
+ extern void musb_read_fifo(struct musb_hw_ep *ep, u16 len, u8 *dst);
+--- a/drivers/usb/musb/musb_cppi41.c
++++ b/drivers/usb/musb/musb_cppi41.c
+@@ -484,6 +484,7 @@ static int cppi41_dma_controller_start(s
+               if (ret)
+                       goto err;
++              ret = -EINVAL;
+               if (port > MUSB_DMA_NUM_CHANNELS || !port)
+                       goto err;
+               if (is_tx)
+@@ -503,6 +504,7 @@ static int cppi41_dma_controller_start(s
+               dc = dma_request_slave_channel(dev, str);
+               if (!dc) {
+                       dev_err(dev, "Falied to request %s.\n", str);
++                      ret = -EPROBE_DEFER;
+                       goto err;
+               }
+               cppi41_channel->dc = dc;
+@@ -510,7 +512,7 @@ static int cppi41_dma_controller_start(s
+       return 0;
+ err:
+       cppi41_release_all_dma_chans(controller);
+-      return -EINVAL;
++      return ret;
+ }
+ void dma_controller_destroy(struct dma_controller *c)
+@@ -526,7 +528,7 @@ struct dma_controller *dma_controller_cr
+                                       void __iomem *base)
+ {
+       struct cppi41_dma_controller *controller;
+-      int ret;
++      int ret = 0;
+       if (!musb->controller->of_node) {
+               dev_err(musb->controller, "Need DT for the DMA engine.\n");
+@@ -553,5 +555,7 @@ struct dma_controller *dma_controller_cr
+ plat_get_fail:
+       kfree(controller);
+ kzalloc_fail:
++      if (ret == -EPROBE_DEFER)
++              return ERR_PTR(ret);
+       return NULL;
+ }
+--- a/drivers/usb/musb/musb_dsps.c
++++ b/drivers/usb/musb/musb_dsps.c
+@@ -106,6 +106,7 @@ struct dsps_musb_wrapper {
+       /* bit positions for mode */
+       unsigned        iddig:5;
++      unsigned        iddig_mux:5;
+       /* miscellaneous stuff */
+       u8              poll_seconds;
+ };
+@@ -121,6 +122,43 @@ struct dsps_glue {
+       unsigned long last_timer;    /* last timer data for each instance */
+ };
++static void dsps_musb_try_idle(struct musb *musb, unsigned long timeout)
++{
++      struct device *dev = musb->controller;
++      struct dsps_glue *glue = dev_get_drvdata(dev->parent);
++
++      if (timeout == 0)
++              timeout = jiffies + msecs_to_jiffies(3);
++
++      /* Never idle if active, or when VBUS timeout is not set as host */
++      if (musb->is_active || (musb->a_wait_bcon == 0 &&
++                              musb->xceiv->state == OTG_STATE_A_WAIT_BCON)) {
++              dev_dbg(musb->controller, "%s active, deleting timer\n",
++                              usb_otg_state_string(musb->xceiv->state));
++              del_timer(&glue->timer);
++              glue->last_timer = jiffies;
++              return;
++      }
++      if (musb->port_mode != MUSB_PORT_MODE_DUAL_ROLE)
++              return;
++
++      if (!musb->g.dev.driver)
++              return;
++
++      if (time_after(glue->last_timer, timeout) &&
++                              timer_pending(&glue->timer)) {
++              dev_dbg(musb->controller,
++                      "Longer idle timer already pending, ignoring...\n");
++              return;
++      }
++      glue->last_timer = timeout;
++
++      dev_dbg(musb->controller, "%s inactive, starting idle timer for %u ms\n",
++              usb_otg_state_string(musb->xceiv->state),
++                      jiffies_to_msecs(timeout - jiffies));
++      mod_timer(&glue->timer, timeout);
++}
++
+ /**
+  * dsps_musb_enable - enable interrupts
+  */
+@@ -143,6 +181,7 @@ static void dsps_musb_enable(struct musb
+       /* Force the DRVVBUS IRQ so we can start polling for ID change. */
+       dsps_writel(reg_base, wrp->coreintr_set,
+                   (1 << wrp->drvvbus) << wrp->usb_shift);
++      dsps_musb_try_idle(musb, 0);
+ }
+ /**
+@@ -171,6 +210,7 @@ static void otg_timer(unsigned long _mus
+       const struct dsps_musb_wrapper *wrp = glue->wrp;
+       u8 devctl;
+       unsigned long flags;
++      int skip_session = 0;
+       /*
+        * We poll because DSPS IP's won't expose several OTG-critical
+@@ -183,10 +223,12 @@ static void otg_timer(unsigned long _mus
+       spin_lock_irqsave(&musb->lock, flags);
+       switch (musb->xceiv->state) {
+       case OTG_STATE_A_WAIT_BCON:
+-              devctl &= ~MUSB_DEVCTL_SESSION;
+-              dsps_writeb(musb->mregs, MUSB_DEVCTL, devctl);
++              dsps_writeb(musb->mregs, MUSB_DEVCTL, 0);
++              skip_session = 1;
++              /* fall */
+-              devctl = dsps_readb(musb->mregs, MUSB_DEVCTL);
++      case OTG_STATE_A_IDLE:
++      case OTG_STATE_B_IDLE:
+               if (devctl & MUSB_DEVCTL_BDEVICE) {
+                       musb->xceiv->state = OTG_STATE_B_IDLE;
+                       MUSB_DEV_MODE(musb);
+@@ -194,60 +236,21 @@ static void otg_timer(unsigned long _mus
+                       musb->xceiv->state = OTG_STATE_A_IDLE;
+                       MUSB_HST_MODE(musb);
+               }
++              if (!(devctl & MUSB_DEVCTL_SESSION) && !skip_session)
++                      dsps_writeb(mregs, MUSB_DEVCTL, MUSB_DEVCTL_SESSION);
++              mod_timer(&glue->timer, jiffies + wrp->poll_seconds * HZ);
+               break;
+       case OTG_STATE_A_WAIT_VFALL:
+               musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
+               dsps_writel(musb->ctrl_base, wrp->coreintr_set,
+                           MUSB_INTR_VBUSERROR << wrp->usb_shift);
+               break;
+-      case OTG_STATE_B_IDLE:
+-              devctl = dsps_readb(mregs, MUSB_DEVCTL);
+-              if (devctl & MUSB_DEVCTL_BDEVICE)
+-                      mod_timer(&glue->timer,
+-                                      jiffies + wrp->poll_seconds * HZ);
+-              else
+-                      musb->xceiv->state = OTG_STATE_A_IDLE;
+-              break;
+       default:
+               break;
+       }
+       spin_unlock_irqrestore(&musb->lock, flags);
+ }
+-static void dsps_musb_try_idle(struct musb *musb, unsigned long timeout)
+-{
+-      struct device *dev = musb->controller;
+-      struct dsps_glue *glue = dev_get_drvdata(dev->parent);
+-
+-      if (timeout == 0)
+-              timeout = jiffies + msecs_to_jiffies(3);
+-
+-      /* Never idle if active, or when VBUS timeout is not set as host */
+-      if (musb->is_active || (musb->a_wait_bcon == 0 &&
+-                              musb->xceiv->state == OTG_STATE_A_WAIT_BCON)) {
+-              dev_dbg(musb->controller, "%s active, deleting timer\n",
+-                              usb_otg_state_string(musb->xceiv->state));
+-              del_timer(&glue->timer);
+-              glue->last_timer = jiffies;
+-              return;
+-      }
+-      if (musb->port_mode == MUSB_PORT_MODE_HOST)
+-              return;
+-
+-      if (time_after(glue->last_timer, timeout) &&
+-                              timer_pending(&glue->timer)) {
+-              dev_dbg(musb->controller,
+-                      "Longer idle timer already pending, ignoring...\n");
+-              return;
+-      }
+-      glue->last_timer = timeout;
+-
+-      dev_dbg(musb->controller, "%s inactive, starting idle timer for %u ms\n",
+-              usb_otg_state_string(musb->xceiv->state),
+-                      jiffies_to_msecs(timeout - jiffies));
+-      mod_timer(&glue->timer, timeout);
+-}
+-
+ static irqreturn_t dsps_interrupt(int irq, void *hci)
+ {
+       struct musb  *musb = hci;
+@@ -404,6 +407,54 @@ static int dsps_musb_exit(struct musb *m
+       return 0;
+ }
++static int dsps_musb_set_mode(struct musb *musb, u8 mode)
++{
++      struct device *dev = musb->controller;
++      struct dsps_glue *glue = dev_get_drvdata(dev->parent);
++      const struct dsps_musb_wrapper *wrp = glue->wrp;
++      void __iomem *ctrl_base = musb->ctrl_base;
++      void __iomem *base = musb->mregs;
++      u32 reg;
++
++      reg = dsps_readl(base, wrp->mode);
++
++      switch (mode) {
++      case MUSB_HOST:
++              reg &= ~(1 << wrp->iddig);
++
++              /*
++               * if we're setting mode to host-only or device-only, we're
++               * going to ignore whatever the PHY sends us and just force
++               * ID pin status by SW
++               */
++              reg |= (1 << wrp->iddig_mux);
++
++              dsps_writel(base, wrp->mode, reg);
++              dsps_writel(ctrl_base, wrp->phy_utmi, 0x02);
++              break;
++      case MUSB_PERIPHERAL:
++              reg |= (1 << wrp->iddig);
++
++              /*
++               * if we're setting mode to host-only or device-only, we're
++               * going to ignore whatever the PHY sends us and just force
++               * ID pin status by SW
++               */
++              reg |= (1 << wrp->iddig_mux);
++
++              dsps_writel(base, wrp->mode, reg);
++              break;
++      case MUSB_OTG:
++              dsps_writel(base, wrp->phy_utmi, 0x02);
++              break;
++      default:
++              dev_err(glue->dev, "unsupported mode %d\n", mode);
++              return -EINVAL;
++      }
++
++      return 0;
++}
++
+ static struct musb_platform_ops dsps_ops = {
+       .init           = dsps_musb_init,
+       .exit           = dsps_musb_exit,
+@@ -412,6 +463,7 @@ static struct musb_platform_ops dsps_ops
+       .disable        = dsps_musb_disable,
+       .try_idle       = dsps_musb_try_idle,
++      .set_mode       = dsps_musb_set_mode,
+ };
+ static u64 musb_dmamask = DMA_BIT_MASK(32);
+@@ -606,6 +658,7 @@ static const struct dsps_musb_wrapper am
+       .reset                  = 0,
+       .otg_disable            = 21,
+       .iddig                  = 8,
++      .iddig_mux              = 7,
+       .usb_shift              = 0,
+       .usb_mask               = 0x1ff,
+       .usb_bitmap             = (0x1ff << 0),
+@@ -631,7 +684,7 @@ static struct platform_driver dsps_usbss
+       .remove         = dsps_remove,
+       .driver         = {
+               .name   = "musb-dsps",
+-              .of_match_table = of_match_ptr(musb_dsps_of_match),
++              .of_match_table = musb_dsps_of_match,
+       },
+ };
+--- a/drivers/usb/musb/musb_virthub.c
++++ b/drivers/usb/musb/musb_virthub.c
+@@ -220,6 +220,23 @@ int musb_hub_status_data(struct usb_hcd
+       return retval;
+ }
++static int musb_has_gadget(struct musb *musb)
++{
++      /*
++       * In host-only mode we start a connection right away. In OTG mode
++       * we have to wait until we loaded a gadget. We don't really need a
++       * gadget if we operate as a host but we should not start a session
++       * as a device without a gadget or else we explode.
++       */
++#ifdef CONFIG_USB_MUSB_HOST
++      return 1;
++#else
++      if (musb->port_mode == MUSB_PORT_MODE_HOST)
++              return 1;
++      return musb->g.dev.driver != NULL;
++#endif
++}
++
+ int musb_hub_control(
+       struct usb_hcd  *hcd,
+       u16             typeReq,
+@@ -362,7 +379,7 @@ int musb_hub_control(
+                        * initialization logic, e.g. for OTG, or change any
+                        * logic relating to VBUS power-up.
+                        */
+-                      if (!hcd->self.is_b_host)
++                      if (!hcd->self.is_b_host && musb_has_gadget(musb))
+                               musb_start(musb);
+                       break;
+               case USB_PORT_FEAT_RESET:
+--- a/drivers/usb/musb/omap2430.c
++++ b/drivers/usb/musb/omap2430.c
+@@ -37,7 +37,8 @@
+ #include <linux/err.h>
+ #include <linux/delay.h>
+ #include <linux/usb/musb-omap.h>
+-#include <linux/usb/omap_control_usb.h>
++#include <linux/phy/omap_control_phy.h>
++#include <linux/of_platform.h>
+ #include "musb_core.h"
+ #include "omap2430.h"
+@@ -305,6 +306,9 @@ static void omap_musb_set_mailbox(struct
+       default:
+               dev_dbg(dev, "ID float\n");
+       }
++
++      atomic_notifier_call_chain(&musb->xceiv->notifier,
++                      musb->xceiv->last_event, NULL);
+ }
+@@ -348,11 +352,21 @@ static int omap2430_musb_init(struct mus
+        * up through ULPI.  TWL4030-family PMICs include one,
+        * which needs a driver, drivers aren't always needed.
+        */
+-      if (dev->parent->of_node)
++      if (dev->parent->of_node) {
++              musb->phy = devm_phy_get(dev->parent, "usb2-phy");
++
++              /* We can't totally remove musb->xceiv as of now because
++               * musb core uses xceiv.state and xceiv.otg. Once we have
++               * a separate state machine to handle otg, these can be moved
++               * out of xceiv and then we can start using the generic PHY
++               * framework
++               */
+               musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent,
+                   "usb-phy", 0);
+-      else
++      } else {
+               musb->xceiv = devm_usb_get_phy_dev(dev, 0);
++              musb->phy = devm_phy_get(dev, "usb");
++      }
+       if (IS_ERR(musb->xceiv)) {
+               status = PTR_ERR(musb->xceiv);
+@@ -364,6 +378,10 @@ static int omap2430_musb_init(struct mus
+               return -EPROBE_DEFER;
+       }
++      if (IS_ERR(musb->phy)) {
++              pr_err("HS USB OTG: no PHY configured\n");
++              return PTR_ERR(musb->phy);
++      }
+       musb->isr = omap2430_musb_interrupt;
+       status = pm_runtime_get_sync(dev);
+@@ -397,7 +415,7 @@ static int omap2430_musb_init(struct mus
+       if (glue->status != OMAP_MUSB_UNKNOWN)
+               omap_musb_set_mailbox(glue);
+-      usb_phy_init(musb->xceiv);
++      phy_init(musb->phy);
+       pm_runtime_put_noidle(musb->controller);
+       return 0;
+@@ -460,6 +478,7 @@ static int omap2430_musb_exit(struct mus
+       del_timer_sync(&musb_idle_timer);
+       omap2430_low_level_exit(musb);
++      phy_exit(musb->phy);
+       return 0;
+ }
+@@ -489,6 +508,7 @@ static int omap2430_probe(struct platfor
+       struct device_node              *np = pdev->dev.of_node;
+       struct musb_hdrc_config         *config;
+       int                             ret = -ENOMEM;
++      int                             musbid;
+       glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
+       if (!glue) {
+@@ -496,10 +516,18 @@ static int omap2430_probe(struct platfor
+               goto err0;
+       }
+-      musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
++      /* get the musb id */
++      musbid = musb_get_id(&pdev->dev, GFP_KERNEL);
++      if (musbid < 0) {
++              dev_err(&pdev->dev, "failed to allocate musb id\n");
++              ret = -ENOMEM;
++              goto err0;
++      }
++
++      musb = platform_device_alloc("musb-hdrc", musbid);
+       if (!musb) {
+               dev_err(&pdev->dev, "failed to allocate musb device\n");
+-              goto err0;
++              goto err1;
+       }
+       musb->dev.parent                = &pdev->dev;
+@@ -509,8 +537,12 @@ static int omap2430_probe(struct platfor
+       glue->dev                       = &pdev->dev;
+       glue->musb                      = musb;
+       glue->status                    = OMAP_MUSB_UNKNOWN;
++      glue->control_otghs = ERR_PTR(-ENODEV);
+       if (np) {
++              struct device_node *control_node;
++              struct platform_device *control_pdev;
++
+               pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
+               if (!pdata) {
+                       dev_err(&pdev->dev,
+@@ -539,22 +571,20 @@ static int omap2430_probe(struct platfor
+               of_property_read_u32(np, "ram-bits", (u32 *)&config->ram_bits);
+               of_property_read_u32(np, "power", (u32 *)&pdata->power);
+               config->multipoint = of_property_read_bool(np, "multipoint");
+-              pdata->has_mailbox = of_property_read_bool(np,
+-                  "ti,has-mailbox");
+               pdata->board_data       = data;
+               pdata->config           = config;
+-      }
+-      if (pdata->has_mailbox) {
+-              glue->control_otghs = omap_get_control_dev();
+-              if (IS_ERR(glue->control_otghs)) {
+-                      dev_vdbg(&pdev->dev, "Failed to get control device\n");
+-                      ret = PTR_ERR(glue->control_otghs);
+-                      goto err2;
++              control_node = of_parse_phandle(np, "ctrl-module", 0);
++              if (control_node) {
++                      control_pdev = of_find_device_by_node(control_node);
++                      if (!control_pdev) {
++                              dev_err(&pdev->dev, "Failed to get control device\n");
++                              ret = -EINVAL;
++                              goto err2;
++                      }
++                      glue->control_otghs = &control_pdev->dev;
+               }
+-      } else {
+-              glue->control_otghs = ERR_PTR(-ENODEV);
+       }
+       pdata->platform_ops             = &omap2430_ops;
+@@ -612,6 +642,9 @@ static int omap2430_probe(struct platfor
+ err2:
+       platform_device_put(musb);
++err1:
++      musb_put_id(&pdev->dev, musbid);
++
+ err0:
+       return ret;
+ }
+@@ -638,7 +671,7 @@ static int omap2430_runtime_suspend(stru
+                               OTG_INTERFSEL);
+               omap2430_low_level_exit(musb);
+-              usb_phy_set_suspend(musb->xceiv, 1);
++              phy_power_off(musb->phy);
+       }
+       return 0;
+@@ -653,8 +686,7 @@ static int omap2430_runtime_resume(struc
+               omap2430_low_level_init(musb);
+               musb_writel(musb->mregs, OTG_INTERFSEL,
+                               musb->context.otg_interfsel);
+-
+-              usb_phy_set_suspend(musb->xceiv, 0);
++              phy_power_on(musb->phy);
+       }
+       return 0;
+--- a/drivers/usb/musb/tusb6010.c
++++ b/drivers/usb/musb/tusb6010.c
+@@ -1152,7 +1152,11 @@ static const struct musb_platform_ops tu
+       .set_vbus       = tusb_musb_set_vbus,
+ };
+-static u64 tusb_dmamask = DMA_BIT_MASK(32);
++static const struct platform_device_info tusb_dev_info = {
++      .name           = "musb-hdrc",
++      .id             = PLATFORM_DEVID_AUTO,
++      .dma_mask       = DMA_BIT_MASK(32),
++};
+ static int tusb_probe(struct platform_device *pdev)
+ {
+@@ -1160,7 +1164,7 @@ static int tusb_probe(struct platform_de
+       struct musb_hdrc_platform_data  *pdata = dev_get_platdata(&pdev->dev);
+       struct platform_device          *musb;
+       struct tusb6010_glue            *glue;
+-
++      struct platform_device_info     pinfo;
+       int                             ret = -ENOMEM;
+       glue = kzalloc(sizeof(*glue), GFP_KERNEL);
+@@ -1169,18 +1173,7 @@ static int tusb_probe(struct platform_de
+               goto err0;
+       }
+-      musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
+-      if (!musb) {
+-              dev_err(&pdev->dev, "failed to allocate musb device\n");
+-              goto err1;
+-      }
+-
+-      musb->dev.parent                = &pdev->dev;
+-      musb->dev.dma_mask              = &tusb_dmamask;
+-      musb->dev.coherent_dma_mask     = tusb_dmamask;
+-
+       glue->dev                       = &pdev->dev;
+-      glue->musb                      = musb;
+       pdata->platform_ops             = &tusb_ops;
+@@ -1204,31 +1197,23 @@ static int tusb_probe(struct platform_de
+       musb_resources[2].end = pdev->resource[2].end;
+       musb_resources[2].flags = pdev->resource[2].flags;
+-      ret = platform_device_add_resources(musb, musb_resources,
+-                      ARRAY_SIZE(musb_resources));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add resources\n");
+-              goto err3;
+-      }
+-
+-      ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to add platform_data\n");
+-              goto err3;
+-      }
+-
+-      ret = platform_device_add(musb);
+-      if (ret) {
+-              dev_err(&pdev->dev, "failed to register musb device\n");
++      pinfo = tusb_dev_info;
++      pinfo.parent = &pdev->dev;
++      pinfo.res = musb_resources;
++      pinfo.num_res = ARRAY_SIZE(musb_resources);
++      pinfo.data = pdata;
++      pinfo.size_data = sizeof(*pdata);
++
++      glue->musb = musb = platform_device_register_full(&pinfo);
++      if (IS_ERR(musb)) {
++              ret = PTR_ERR(musb);
++              dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
+               goto err3;
+       }
+       return 0;
+ err3:
+-      platform_device_put(musb);
+-
+-err1:
+       kfree(glue);
+ err0:
+--- a/drivers/usb/musb/ux500.c
++++ b/drivers/usb/musb/ux500.c
+@@ -376,17 +376,10 @@ static int ux500_resume(struct device *d
+       return 0;
+ }
+-
+-static const struct dev_pm_ops ux500_pm_ops = {
+-      .suspend        = ux500_suspend,
+-      .resume         = ux500_resume,
+-};
+-
+-#define DEV_PM_OPS    (&ux500_pm_ops)
+-#else
+-#define DEV_PM_OPS    NULL
+ #endif
++static SIMPLE_DEV_PM_OPS(ux500_pm_ops, ux500_suspend, ux500_resume);
++
+ static const struct of_device_id ux500_match[] = {
+         { .compatible = "stericsson,db8500-musb", },
+         {}
+@@ -397,7 +390,7 @@ static struct platform_driver ux500_driv
+       .remove         = ux500_remove,
+       .driver         = {
+               .name   = "musb-ux500",
+-              .pm     = DEV_PM_OPS,
++              .pm     = &ux500_pm_ops,
+               .of_match_table = ux500_match,
+       },
+ };
+--- a/drivers/usb/phy/Kconfig
++++ b/drivers/usb/phy/Kconfig
+@@ -56,38 +56,6 @@ config NOP_USB_XCEIV
+         built-in with usb ip or which are autonomous and doesn't require any
+         phy programming such as ISP1x04 etc.
+-config OMAP_CONTROL_USB
+-      tristate "OMAP CONTROL USB Driver"
+-      depends on ARCH_OMAP2PLUS || COMPILE_TEST
+-      help
+-        Enable this to add support for the USB part present in the control
+-        module. This driver has API to power on the USB2 PHY and to write to
+-        the mailbox. The mailbox is present only in omap4 and the register to
+-        power on the USB2 PHY is present in OMAP4 and OMAP5. OMAP5 has an
+-        additional register to power on USB3 PHY.
+-
+-config OMAP_USB2
+-      tristate "OMAP USB2 PHY Driver"
+-      depends on ARCH_OMAP2PLUS
+-      select OMAP_CONTROL_USB
+-      select USB_PHY
+-      help
+-        Enable this to support the transceiver that is part of SOC. This
+-        driver takes care of all the PHY functionality apart from comparator.
+-        The USB OTG controller communicates with the comparator using this
+-        driver.
+-
+-config OMAP_USB3
+-      tristate "OMAP USB3 PHY Driver"
+-      depends on ARCH_OMAP2PLUS || COMPILE_TEST
+-      select OMAP_CONTROL_USB
+-      select USB_PHY
+-      help
+-        Enable this to support the USB3 PHY that is part of SOC. This
+-        driver takes care of all the PHY functionality apart from comparator.
+-        This driver interacts with the "OMAP Control USB Driver" to power
+-        on/off the PHY.
+-
+ config AM335X_CONTROL_USB
+       tristate
+@@ -123,16 +91,6 @@ config SAMSUNG_USB3PHY
+         Enable this to support Samsung USB 3.0 (Super Speed) phy controller
+         for samsung SoCs.
+-config TWL4030_USB
+-      tristate "TWL4030 USB Transceiver Driver"
+-      depends on TWL4030_CORE && REGULATOR_TWL4030 && USB_MUSB_OMAP2PLUS
+-      select USB_PHY
+-      help
+-        Enable this to support the USB OTG transceiver on TWL4030
+-        family chips (including the TWL5030 and TPS659x0 devices).
+-        This transceiver supports high and full speed devices plus,
+-        in host mode, low speed.
+-
+ config TWL6030_USB
+       tristate "TWL6030 USB Transceiver Driver"
+       depends on TWL4030_CORE && OMAP_USB2 && USB_MUSB_OMAP2PLUS
+@@ -214,6 +172,19 @@ config USB_RCAR_PHY
+         To compile this driver as a module, choose M here: the
+         module will be called phy-rcar-usb.
++config USB_RCAR_GEN2_PHY
++      tristate "Renesas R-Car Gen2 USB PHY support"
++      depends on ARCH_R8A7790 || ARCH_R8A7791 || COMPILE_TEST
++      select USB_PHY
++      help
++        Say Y here to add support for the Renesas R-Car Gen2 USB PHY driver.
++        It is typically used to control internal USB PHY for USBHS,
++        and to configure shared USB channels 0 and 2.
++        This driver supports R8A7790 and R8A7791.
++
++        To compile this driver as a module, choose M here: the
++        module will be called phy-rcar-gen2-usb.
++
+ config USB_ULPI
+       bool "Generic ULPI Transceiver Driver"
+       depends on ARM
+--- a/drivers/usb/phy/Makefile
++++ b/drivers/usb/phy/Makefile
+@@ -12,15 +12,11 @@ obj-$(CONFIG_FSL_USB2_OTG)         += phy-fsl-u
+ obj-$(CONFIG_ISP1301_OMAP)            += phy-isp1301-omap.o
+ obj-$(CONFIG_MV_U3D_PHY)              += phy-mv-u3d-usb.o
+ obj-$(CONFIG_NOP_USB_XCEIV)           += phy-generic.o
+-obj-$(CONFIG_OMAP_CONTROL_USB)                += phy-omap-control.o
+ obj-$(CONFIG_AM335X_CONTROL_USB)      += phy-am335x-control.o
+ obj-$(CONFIG_AM335X_PHY_USB)          += phy-am335x.o
+-obj-$(CONFIG_OMAP_USB2)                       += phy-omap-usb2.o
+-obj-$(CONFIG_OMAP_USB3)                       += phy-omap-usb3.o
+ obj-$(CONFIG_SAMSUNG_USBPHY)          += phy-samsung-usb.o
+ obj-$(CONFIG_SAMSUNG_USB2PHY)         += phy-samsung-usb2.o
+ obj-$(CONFIG_SAMSUNG_USB3PHY)         += phy-samsung-usb3.o
+-obj-$(CONFIG_TWL4030_USB)             += phy-twl4030-usb.o
+ obj-$(CONFIG_TWL6030_USB)             += phy-twl6030-usb.o
+ obj-$(CONFIG_USB_EHCI_TEGRA)          += phy-tegra-usb.o
+ obj-$(CONFIG_USB_GPIO_VBUS)           += phy-gpio-vbus-usb.o
+@@ -29,5 +25,6 @@ obj-$(CONFIG_USB_MSM_OTG)            += phy-msm-us
+ obj-$(CONFIG_USB_MV_OTG)              += phy-mv-usb.o
+ obj-$(CONFIG_USB_MXS_PHY)             += phy-mxs-usb.o
+ obj-$(CONFIG_USB_RCAR_PHY)            += phy-rcar-usb.o
++obj-$(CONFIG_USB_RCAR_GEN2_PHY)               += phy-rcar-gen2-usb.o
+ obj-$(CONFIG_USB_ULPI)                        += phy-ulpi.o
+ obj-$(CONFIG_USB_ULPI_VIEWPORT)               += phy-ulpi-viewport.o
+--- a/drivers/usb/phy/phy-am335x.c
++++ b/drivers/usb/phy/phy-am335x.c
+@@ -52,23 +52,19 @@ static int am335x_phy_probe(struct platf
+               return am_phy->id;
+       }
+-      ret = usb_phy_gen_create_phy(dev, &am_phy->usb_phy_gen,
+-                      USB_PHY_TYPE_USB2, 0, false, false);
++      ret = usb_phy_gen_create_phy(dev, &am_phy->usb_phy_gen, NULL);
+       if (ret)
+               return ret;
+       ret = usb_add_phy_dev(&am_phy->usb_phy_gen.phy);
+       if (ret)
+-              goto err_add;
++              return ret;
+       am_phy->usb_phy_gen.phy.init = am335x_init;
+       am_phy->usb_phy_gen.phy.shutdown = am335x_shutdown;
+       platform_set_drvdata(pdev, am_phy);
+-      return 0;
+-err_add:
+-      usb_phy_gen_cleanup_phy(&am_phy->usb_phy_gen);
+-      return ret;
++      return 0;
+ }
+ static int am335x_phy_remove(struct platform_device *pdev)
+@@ -79,6 +75,40 @@ static int am335x_phy_remove(struct plat
+       return 0;
+ }
++#ifdef CONFIG_PM_RUNTIME
++
++static int am335x_phy_runtime_suspend(struct device *dev)
++{
++      struct platform_device  *pdev = to_platform_device(dev);
++      struct am335x_phy *am_phy = platform_get_drvdata(pdev);
++
++      if (device_may_wakeup(dev))
++              phy_ctrl_wkup(am_phy->phy_ctrl, am_phy->id, true);
++      phy_ctrl_power(am_phy->phy_ctrl, am_phy->id, false);
++      return 0;
++}
++
++static int am335x_phy_runtime_resume(struct device *dev)
++{
++      struct platform_device  *pdev = to_platform_device(dev);
++      struct am335x_phy       *am_phy = platform_get_drvdata(pdev);
++
++      phy_ctrl_power(am_phy->phy_ctrl, am_phy->id, true);
++      if (device_may_wakeup(dev))
++              phy_ctrl_wkup(am_phy->phy_ctrl, am_phy->id, false);
++      return 0;
++}
++
++static const struct dev_pm_ops am335x_pm_ops = {
++      SET_RUNTIME_PM_OPS(am335x_phy_runtime_suspend,
++                      am335x_phy_runtime_resume, NULL)
++};
++
++#define DEV_PM_OPS    (&am335x_pm_ops)
++#else
++#define DEV_PM_OPS    NULL
++#endif
++
+ static const struct of_device_id am335x_phy_ids[] = {
+       { .compatible = "ti,am335x-usb-phy" },
+       { }
+@@ -91,7 +121,8 @@ static struct platform_driver am335x_phy
+       .driver         = {
+               .name   = "am335x-phy-driver",
+               .owner  = THIS_MODULE,
+-              .of_match_table = of_match_ptr(am335x_phy_ids),
++              .pm = DEV_PM_OPS,
++              .of_match_table = am335x_phy_ids,
+       },
+ };
+--- a/drivers/usb/phy/phy-am335x-control.c
++++ b/drivers/usb/phy/phy-am335x-control.c
+@@ -26,6 +26,41 @@ struct am335x_control_usb {
+ #define USBPHY_OTGVDET_EN     (1 << 19)
+ #define USBPHY_OTGSESSEND_EN  (1 << 20)
++#define AM335X_PHY0_WK_EN     (1 << 0)
++#define AM335X_PHY1_WK_EN     (1 << 8)
++
++static void am335x_phy_wkup(struct  phy_control *phy_ctrl, u32 id, bool on)
++{
++      struct am335x_control_usb *usb_ctrl;
++      u32 val;
++      u32 reg;
++
++      usb_ctrl = container_of(phy_ctrl, struct am335x_control_usb, phy_ctrl);
++
++      switch (id) {
++      case 0:
++              reg = AM335X_PHY0_WK_EN;
++              break;
++      case 1:
++              reg = AM335X_PHY1_WK_EN;
++              break;
++      default:
++              WARN_ON(1);
++              return;
++      }
++
++      spin_lock(&usb_ctrl->lock);
++      val = readl(usb_ctrl->wkup);
++
++      if (on)
++              val |= reg;
++      else
++              val &= ~reg;
++
++      writel(val, usb_ctrl->wkup);
++      spin_unlock(&usb_ctrl->lock);
++}
++
+ static void am335x_phy_power(struct phy_control *phy_ctrl, u32 id, bool on)
+ {
+       struct am335x_control_usb *usb_ctrl;
+@@ -59,6 +94,7 @@ static void am335x_phy_power(struct phy_
+ static const struct phy_control ctrl_am335x = {
+       .phy_power = am335x_phy_power,
++      .phy_wkup = am335x_phy_wkup,
+ };
+ static const struct of_device_id omap_control_usb_id_table[] = {
+@@ -117,6 +153,12 @@ static int am335x_control_usb_probe(stru
+       ctrl_usb->phy_reg = devm_ioremap_resource(&pdev->dev, res);
+       if (IS_ERR(ctrl_usb->phy_reg))
+               return PTR_ERR(ctrl_usb->phy_reg);
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "wakeup");
++      ctrl_usb->wkup = devm_ioremap_resource(&pdev->dev, res);
++      if (IS_ERR(ctrl_usb->wkup))
++              return PTR_ERR(ctrl_usb->wkup);
++
+       spin_lock_init(&ctrl_usb->lock);
+       ctrl_usb->phy_ctrl = *phy_ctrl;
+@@ -129,7 +171,7 @@ static struct platform_driver am335x_con
+       .driver         = {
+               .name   = "am335x-control-usb",
+               .owner  = THIS_MODULE,
+-              .of_match_table = of_match_ptr(omap_control_usb_id_table),
++              .of_match_table = omap_control_usb_id_table,
+       },
+ };
+--- a/drivers/usb/phy/phy.c
++++ b/drivers/usb/phy/phy.c
+@@ -98,7 +98,7 @@ struct usb_phy *devm_usb_get_phy(struct
+       ptr = devres_alloc(devm_usb_phy_release, sizeof(*ptr), GFP_KERNEL);
+       if (!ptr)
+-              return NULL;
++              return ERR_PTR(-ENOMEM);
+       phy = usb_get_phy(type);
+       if (!IS_ERR(phy)) {
+--- a/drivers/usb/phy/phy-fsl-usb.c
++++ b/drivers/usb/phy/phy-fsl-usb.c
+@@ -134,7 +134,7 @@ int write_ulpi(u8 addr, u8 data)
+ /* Operations that will be called from OTG Finite State Machine */
+ /* Charge vbus for vbus pulsing in SRP */
+-void fsl_otg_chrg_vbus(int on)
++void fsl_otg_chrg_vbus(struct otg_fsm *fsm, int on)
+ {
+       u32 tmp;
+@@ -170,7 +170,7 @@ void fsl_otg_dischrg_vbus(int on)
+ }
+ /* A-device driver vbus, controlled through PP bit in PORTSC */
+-void fsl_otg_drv_vbus(int on)
++void fsl_otg_drv_vbus(struct otg_fsm *fsm, int on)
+ {
+       u32 tmp;
+@@ -188,7 +188,7 @@ void fsl_otg_drv_vbus(int on)
+  * Pull-up D+, signalling connect by periperal. Also used in
+  * data-line pulsing in SRP
+  */
+-void fsl_otg_loc_conn(int on)
++void fsl_otg_loc_conn(struct otg_fsm *fsm, int on)
+ {
+       u32 tmp;
+@@ -207,7 +207,7 @@ void fsl_otg_loc_conn(int on)
+  * port.  In host mode, controller will automatically send SOF.
+  * Suspend will block the data on the port.
+  */
+-void fsl_otg_loc_sof(int on)
++void fsl_otg_loc_sof(struct otg_fsm *fsm, int on)
+ {
+       u32 tmp;
+@@ -222,7 +222,7 @@ void fsl_otg_loc_sof(int on)
+ }
+ /* Start SRP pulsing by data-line pulsing, followed with v-bus pulsing. */
+-void fsl_otg_start_pulse(void)
++void fsl_otg_start_pulse(struct otg_fsm *fsm)
+ {
+       u32 tmp;
+@@ -235,7 +235,7 @@ void fsl_otg_start_pulse(void)
+       fsl_otg_loc_conn(1);
+ #endif
+-      fsl_otg_add_timer(b_data_pulse_tmr);
++      fsl_otg_add_timer(fsm, b_data_pulse_tmr);
+ }
+ void b_data_pulse_end(unsigned long foo)
+@@ -252,14 +252,14 @@ void b_data_pulse_end(unsigned long foo)
+ void fsl_otg_pulse_vbus(void)
+ {
+       srp_wait_done = 0;
+-      fsl_otg_chrg_vbus(1);
++      fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 1);
+       /* start the timer to end vbus charge */
+-      fsl_otg_add_timer(b_vbus_pulse_tmr);
++      fsl_otg_add_timer(&fsl_otg_dev->fsm, b_vbus_pulse_tmr);
+ }
+ void b_vbus_pulse_end(unsigned long foo)
+ {
+-      fsl_otg_chrg_vbus(0);
++      fsl_otg_chrg_vbus(&fsl_otg_dev->fsm, 0);
+       /*
+        * As USB3300 using the same a_sess_vld and b_sess_vld voltage
+@@ -267,7 +267,7 @@ void b_vbus_pulse_end(unsigned long foo)
+        * residual voltage of vbus pulsing and A device pull up
+        */
+       fsl_otg_dischrg_vbus(1);
+-      fsl_otg_add_timer(b_srp_wait_tmr);
++      fsl_otg_add_timer(&fsl_otg_dev->fsm, b_srp_wait_tmr);
+ }
+ void b_srp_end(unsigned long foo)
+@@ -289,7 +289,7 @@ void a_wait_enum(unsigned long foo)
+ {
+       VDBG("a_wait_enum timeout\n");
+       if (!fsl_otg_dev->phy.otg->host->b_hnp_enable)
+-              fsl_otg_add_timer(a_wait_enum_tmr);
++              fsl_otg_add_timer(&fsl_otg_dev->fsm, a_wait_enum_tmr);
+       else
+               otg_statemachine(&fsl_otg_dev->fsm);
+ }
+@@ -375,8 +375,42 @@ void fsl_otg_uninit_timers(void)
+       kfree(b_vbus_pulse_tmr);
+ }
++static struct fsl_otg_timer *fsl_otg_get_timer(enum otg_fsm_timer t)
++{
++      struct fsl_otg_timer *timer;
++
++      /* REVISIT: use array of pointers to timers instead */
++      switch (t) {
++      case A_WAIT_VRISE:
++              timer = a_wait_vrise_tmr;
++              break;
++      case A_WAIT_BCON:
++              timer = a_wait_vrise_tmr;
++              break;
++      case A_AIDL_BDIS:
++              timer = a_wait_vrise_tmr;
++              break;
++      case B_ASE0_BRST:
++              timer = a_wait_vrise_tmr;
++              break;
++      case B_SE0_SRP:
++              timer = a_wait_vrise_tmr;
++              break;
++      case B_SRP_FAIL:
++              timer = a_wait_vrise_tmr;
++              break;
++      case A_WAIT_ENUM:
++              timer = a_wait_vrise_tmr;
++              break;
++      default:
++              timer = NULL;
++      }
++
++      return timer;
++}
++
+ /* Add timer to timer list */
+-void fsl_otg_add_timer(void *gtimer)
++void fsl_otg_add_timer(struct otg_fsm *fsm, void *gtimer)
+ {
+       struct fsl_otg_timer *timer = gtimer;
+       struct fsl_otg_timer *tmp_timer;
+@@ -394,8 +428,19 @@ void fsl_otg_add_timer(void *gtimer)
+       list_add_tail(&timer->list, &active_timers);
+ }
++static void fsl_otg_fsm_add_timer(struct otg_fsm *fsm, enum otg_fsm_timer t)
++{
++      struct fsl_otg_timer *timer;
++
++      timer = fsl_otg_get_timer(t);
++      if (!timer)
++              return;
++
++      fsl_otg_add_timer(fsm, timer);
++}
++
+ /* Remove timer from the timer list; clear timeout status */
+-void fsl_otg_del_timer(void *gtimer)
++void fsl_otg_del_timer(struct otg_fsm *fsm, void *gtimer)
+ {
+       struct fsl_otg_timer *timer = gtimer;
+       struct fsl_otg_timer *tmp_timer, *del_tmp;
+@@ -405,6 +450,17 @@ void fsl_otg_del_timer(void *gtimer)
+                       list_del(&timer->list);
+ }
++static void fsl_otg_fsm_del_timer(struct otg_fsm *fsm, enum otg_fsm_timer t)
++{
++      struct fsl_otg_timer *timer;
++
++      timer = fsl_otg_get_timer(t);
++      if (!timer)
++              return;
++
++      fsl_otg_del_timer(fsm, timer);
++}
++
+ /*
+  * Reduce timer count by 1, and find timeout conditions.
+  * Called by fsl_otg 1ms timer interrupt
+@@ -468,7 +524,7 @@ int fsl_otg_start_host(struct otg_fsm *f
+                               retval = dev->driver->pm->resume(dev);
+                               if (fsm->id) {
+                                       /* default-b */
+-                                      fsl_otg_drv_vbus(1);
++                                      fsl_otg_drv_vbus(fsm, 1);
+                                       /*
+                                        * Workaround: b_host can't driver
+                                        * vbus, but PP in PORTSC needs to
+@@ -493,7 +549,7 @@ int fsl_otg_start_host(struct otg_fsm *f
+                                       retval = dev->driver->pm->suspend(dev);
+                               if (fsm->id)
+                                       /* default-b */
+-                                      fsl_otg_drv_vbus(0);
++                                      fsl_otg_drv_vbus(fsm, 0);
+                       }
+                       otg_dev->host_working = 0;
+               }
+@@ -757,8 +813,8 @@ static struct otg_fsm_ops fsl_otg_ops =
+       .loc_sof = fsl_otg_loc_sof,
+       .start_pulse = fsl_otg_start_pulse,
+-      .add_timer = fsl_otg_add_timer,
+-      .del_timer = fsl_otg_del_timer,
++      .add_timer = fsl_otg_fsm_add_timer,
++      .del_timer = fsl_otg_fsm_del_timer,
+       .start_host = fsl_otg_start_host,
+       .start_gadget = fsl_otg_start_gadget,
+@@ -1011,7 +1067,7 @@ static int show_fsl_usb2_otg_state(struc
+                       "b_bus_suspend: %d\n"
+                       "b_conn: %d\n"
+                       "b_se0_srp: %d\n"
+-                      "b_sess_end: %d\n"
++                      "b_ssend_srp: %d\n"
+                       "b_sess_vld: %d\n"
+                       "id: %d\n",
+                       fsm->a_bus_req,
+@@ -1026,7 +1082,7 @@ static int show_fsl_usb2_otg_state(struc
+                       fsm->b_bus_suspend,
+                       fsm->b_conn,
+                       fsm->b_se0_srp,
+-                      fsm->b_sess_end,
++                      fsm->b_ssend_srp,
+                       fsm->b_sess_vld,
+                       fsm->id);
+       size -= t;
+@@ -1057,7 +1113,7 @@ static long fsl_otg_ioctl(struct file *f
+               break;
+       case SET_A_SUSPEND_REQ:
+-              fsl_otg_dev->fsm.a_suspend_req = arg;
++              fsl_otg_dev->fsm.a_suspend_req_inf = arg;
+               break;
+       case SET_A_BUS_DROP:
+--- a/drivers/usb/phy/phy-fsl-usb.h
++++ b/drivers/usb/phy/phy-fsl-usb.h
+@@ -401,6 +401,6 @@ struct fsl_otg_config {
+ #define GET_A_BUS_REQ         _IOR(OTG_IOCTL_MAGIC, 8, int)
+ #define GET_B_BUS_REQ         _IOR(OTG_IOCTL_MAGIC, 9, int)
+-void fsl_otg_add_timer(void *timer);
+-void fsl_otg_del_timer(void *timer);
++void fsl_otg_add_timer(struct otg_fsm *fsm, void *timer);
++void fsl_otg_del_timer(struct otg_fsm *fsm, void *timer);
+ void fsl_otg_pulse_vbus(void);
+--- a/drivers/usb/phy/phy-fsm-usb.c
++++ b/drivers/usb/phy/phy-fsm-usb.c
+@@ -41,17 +41,17 @@ static int otg_set_protocol(struct otg_f
+                       fsm->protocol, protocol);
+               /* stop old protocol */
+               if (fsm->protocol == PROTO_HOST)
+-                      ret = fsm->ops->start_host(fsm, 0);
++                      ret = otg_start_host(fsm, 0);
+               else if (fsm->protocol == PROTO_GADGET)
+-                      ret = fsm->ops->start_gadget(fsm, 0);
++                      ret = otg_start_gadget(fsm, 0);
+               if (ret)
+                       return ret;
+               /* start new protocol */
+               if (protocol == PROTO_HOST)
+-                      ret = fsm->ops->start_host(fsm, 1);
++                      ret = otg_start_host(fsm, 1);
+               else if (protocol == PROTO_GADGET)
+-                      ret = fsm->ops->start_gadget(fsm, 1);
++                      ret = otg_start_gadget(fsm, 1);
+               if (ret)
+                       return ret;
+@@ -69,42 +69,50 @@ void otg_leave_state(struct otg_fsm *fsm
+ {
+       switch (old_state) {
+       case OTG_STATE_B_IDLE:
+-              otg_del_timer(fsm, b_se0_srp_tmr);
++              otg_del_timer(fsm, B_SE0_SRP);
+               fsm->b_se0_srp = 0;
++              fsm->adp_sns = 0;
++              fsm->adp_prb = 0;
+               break;
+       case OTG_STATE_B_SRP_INIT:
++              fsm->data_pulse = 0;
+               fsm->b_srp_done = 0;
+               break;
+       case OTG_STATE_B_PERIPHERAL:
+               break;
+       case OTG_STATE_B_WAIT_ACON:
+-              otg_del_timer(fsm, b_ase0_brst_tmr);
++              otg_del_timer(fsm, B_ASE0_BRST);
+               fsm->b_ase0_brst_tmout = 0;
+               break;
+       case OTG_STATE_B_HOST:
+               break;
+       case OTG_STATE_A_IDLE:
++              fsm->adp_prb = 0;
+               break;
+       case OTG_STATE_A_WAIT_VRISE:
+-              otg_del_timer(fsm, a_wait_vrise_tmr);
++              otg_del_timer(fsm, A_WAIT_VRISE);
+               fsm->a_wait_vrise_tmout = 0;
+               break;
+       case OTG_STATE_A_WAIT_BCON:
+-              otg_del_timer(fsm, a_wait_bcon_tmr);
++              otg_del_timer(fsm, A_WAIT_BCON);
+               fsm->a_wait_bcon_tmout = 0;
+               break;
+       case OTG_STATE_A_HOST:
+-              otg_del_timer(fsm, a_wait_enum_tmr);
++              otg_del_timer(fsm, A_WAIT_ENUM);
+               break;
+       case OTG_STATE_A_SUSPEND:
+-              otg_del_timer(fsm, a_aidl_bdis_tmr);
++              otg_del_timer(fsm, A_AIDL_BDIS);
+               fsm->a_aidl_bdis_tmout = 0;
+-              fsm->a_suspend_req = 0;
++              fsm->a_suspend_req_inf = 0;
+               break;
+       case OTG_STATE_A_PERIPHERAL:
++              otg_del_timer(fsm, A_BIDL_ADIS);
++              fsm->a_bidl_adis_tmout = 0;
+               break;
+       case OTG_STATE_A_WAIT_VFALL:
+-              otg_del_timer(fsm, a_wait_vrise_tmr);
++              otg_del_timer(fsm, A_WAIT_VFALL);
++              fsm->a_wait_vfall_tmout = 0;
++              otg_del_timer(fsm, A_WAIT_VRISE);
+               break;
+       case OTG_STATE_A_VBUS_ERR:
+               break;
+@@ -127,14 +135,19 @@ int otg_set_state(struct otg_fsm *fsm, e
+               otg_chrg_vbus(fsm, 0);
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
++              /*
++               * Driver is responsible for starting ADP probing
++               * if ADP sensing times out.
++               */
++              otg_start_adp_sns(fsm);
+               otg_set_protocol(fsm, PROTO_UNDEF);
+-              otg_add_timer(fsm, b_se0_srp_tmr);
++              otg_add_timer(fsm, B_SE0_SRP);
+               break;
+       case OTG_STATE_B_SRP_INIT:
+               otg_start_pulse(fsm);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_UNDEF);
+-              otg_add_timer(fsm, b_srp_fail_tmr);
++              otg_add_timer(fsm, B_SRP_FAIL);
+               break;
+       case OTG_STATE_B_PERIPHERAL:
+               otg_chrg_vbus(fsm, 0);
+@@ -147,7 +160,7 @@ int otg_set_state(struct otg_fsm *fsm, e
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_HOST);
+-              otg_add_timer(fsm, b_ase0_brst_tmr);
++              otg_add_timer(fsm, B_ASE0_BRST);
+               fsm->a_bus_suspend = 0;
+               break;
+       case OTG_STATE_B_HOST:
+@@ -163,6 +176,7 @@ int otg_set_state(struct otg_fsm *fsm, e
+               otg_chrg_vbus(fsm, 0);
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
++              otg_start_adp_prb(fsm);
+               otg_set_protocol(fsm, PROTO_HOST);
+               break;
+       case OTG_STATE_A_WAIT_VRISE:
+@@ -170,14 +184,14 @@ int otg_set_state(struct otg_fsm *fsm, e
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_HOST);
+-              otg_add_timer(fsm, a_wait_vrise_tmr);
++              otg_add_timer(fsm, A_WAIT_VRISE);
+               break;
+       case OTG_STATE_A_WAIT_BCON:
+               otg_drv_vbus(fsm, 1);
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_HOST);
+-              otg_add_timer(fsm, a_wait_bcon_tmr);
++              otg_add_timer(fsm, A_WAIT_BCON);
+               break;
+       case OTG_STATE_A_HOST:
+               otg_drv_vbus(fsm, 1);
+@@ -188,15 +202,15 @@ int otg_set_state(struct otg_fsm *fsm, e
+                * When HNP is triggered while a_bus_req = 0, a_host will
+                * suspend too fast to complete a_set_b_hnp_en
+                */
+-              if (!fsm->a_bus_req || fsm->a_suspend_req)
+-                      otg_add_timer(fsm, a_wait_enum_tmr);
++              if (!fsm->a_bus_req || fsm->a_suspend_req_inf)
++                      otg_add_timer(fsm, A_WAIT_ENUM);
+               break;
+       case OTG_STATE_A_SUSPEND:
+               otg_drv_vbus(fsm, 1);
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_HOST);
+-              otg_add_timer(fsm, a_aidl_bdis_tmr);
++              otg_add_timer(fsm, A_AIDL_BDIS);
+               break;
+       case OTG_STATE_A_PERIPHERAL:
+@@ -204,12 +218,14 @@ int otg_set_state(struct otg_fsm *fsm, e
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_GADGET);
+               otg_drv_vbus(fsm, 1);
++              otg_add_timer(fsm, A_BIDL_ADIS);
+               break;
+       case OTG_STATE_A_WAIT_VFALL:
+               otg_drv_vbus(fsm, 0);
+               otg_loc_conn(fsm, 0);
+               otg_loc_sof(fsm, 0);
+               otg_set_protocol(fsm, PROTO_HOST);
++              otg_add_timer(fsm, A_WAIT_VFALL);
+               break;
+       case OTG_STATE_A_VBUS_ERR:
+               otg_drv_vbus(fsm, 0);
+@@ -250,7 +266,8 @@ int otg_statemachine(struct otg_fsm *fsm
+                       otg_set_state(fsm, OTG_STATE_A_IDLE);
+               else if (fsm->b_sess_vld && fsm->otg->gadget)
+                       otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
+-              else if (fsm->b_bus_req && fsm->b_sess_end && fsm->b_se0_srp)
++              else if ((fsm->b_bus_req || fsm->adp_change || fsm->power_up) &&
++                              fsm->b_ssend_srp && fsm->b_se0_srp)
+                       otg_set_state(fsm, OTG_STATE_B_SRP_INIT);
+               break;
+       case OTG_STATE_B_SRP_INIT:
+@@ -277,13 +294,14 @@ int otg_statemachine(struct otg_fsm *fsm
+       case OTG_STATE_B_HOST:
+               if (!fsm->id || !fsm->b_sess_vld)
+                       otg_set_state(fsm, OTG_STATE_B_IDLE);
+-              else if (!fsm->b_bus_req || !fsm->a_conn)
++              else if (!fsm->b_bus_req || !fsm->a_conn || fsm->test_device)
+                       otg_set_state(fsm, OTG_STATE_B_PERIPHERAL);
+               break;
+       case OTG_STATE_A_IDLE:
+               if (fsm->id)
+                       otg_set_state(fsm, OTG_STATE_B_IDLE);
+-              else if (!fsm->a_bus_drop && (fsm->a_bus_req || fsm->a_srp_det))
++              else if (!fsm->a_bus_drop && (fsm->a_bus_req ||
++                        fsm->a_srp_det || fsm->adp_change || fsm->power_up))
+                       otg_set_state(fsm, OTG_STATE_A_WAIT_VRISE);
+               break;
+       case OTG_STATE_A_WAIT_VRISE:
+@@ -301,7 +319,7 @@ int otg_statemachine(struct otg_fsm *fsm
+                       otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
+               break;
+       case OTG_STATE_A_HOST:
+-              if ((!fsm->a_bus_req || fsm->a_suspend_req) &&
++              if ((!fsm->a_bus_req || fsm->a_suspend_req_inf) &&
+                               fsm->otg->host->b_hnp_enable)
+                       otg_set_state(fsm, OTG_STATE_A_SUSPEND);
+               else if (fsm->id || !fsm->b_conn || fsm->a_bus_drop)
+@@ -324,14 +342,14 @@ int otg_statemachine(struct otg_fsm *fsm
+       case OTG_STATE_A_PERIPHERAL:
+               if (fsm->id || fsm->a_bus_drop)
+                       otg_set_state(fsm, OTG_STATE_A_WAIT_VFALL);
+-              else if (fsm->b_bus_suspend)
++              else if (fsm->a_bidl_adis_tmout || fsm->b_bus_suspend)
+                       otg_set_state(fsm, OTG_STATE_A_WAIT_BCON);
+               else if (!fsm->a_vbus_vld)
+                       otg_set_state(fsm, OTG_STATE_A_VBUS_ERR);
+               break;
+       case OTG_STATE_A_WAIT_VFALL:
+-              if (fsm->id || fsm->a_bus_req || (!fsm->a_sess_vld &&
+-                                      !fsm->b_conn))
++              if (fsm->a_wait_vfall_tmout || fsm->id || fsm->a_bus_req ||
++                              (!fsm->a_sess_vld && !fsm->b_conn))
+                       otg_set_state(fsm, OTG_STATE_A_IDLE);
+               break;
+       case OTG_STATE_A_VBUS_ERR:
+--- a/drivers/usb/phy/phy-fsm-usb.h
++++ b/drivers/usb/phy/phy-fsm-usb.h
+@@ -34,45 +34,76 @@
+ #define PROTO_HOST    (1)
+ #define PROTO_GADGET  (2)
++enum otg_fsm_timer {
++      /* Standard OTG timers */
++      A_WAIT_VRISE,
++      A_WAIT_VFALL,
++      A_WAIT_BCON,
++      A_AIDL_BDIS,
++      B_ASE0_BRST,
++      A_BIDL_ADIS,
++
++      /* Auxiliary timers */
++      B_SE0_SRP,
++      B_SRP_FAIL,
++      A_WAIT_ENUM,
++
++      NUM_OTG_FSM_TIMERS,
++};
++
+ /* OTG state machine according to the OTG spec */
+ struct otg_fsm {
+       /* Input */
++      int id;
++      int adp_change;
++      int power_up;
++      int test_device;
++      int a_bus_drop;
++      int a_bus_req;
++      int a_srp_det;
++      int a_vbus_vld;
++      int b_conn;
+       int a_bus_resume;
+       int a_bus_suspend;
+       int a_conn;
++      int b_bus_req;
++      int b_se0_srp;
++      int b_ssend_srp;
++      int b_sess_vld;
++      /* Auxilary inputs */
+       int a_sess_vld;
+-      int a_srp_det;
+-      int a_vbus_vld;
+       int b_bus_resume;
+       int b_bus_suspend;
+-      int b_conn;
+-      int b_se0_srp;
+-      int b_sess_end;
+-      int b_sess_vld;
+-      int id;
++
++      /* Output */
++      int data_pulse;
++      int drv_vbus;
++      int loc_conn;
++      int loc_sof;
++      int adp_prb;
++      int adp_sns;
+       /* Internal variables */
+       int a_set_b_hnp_en;
+       int b_srp_done;
+       int b_hnp_enable;
++      int a_clr_err;
++
++      /* Informative variables */
++      int a_bus_drop_inf;
++      int a_bus_req_inf;
++      int a_clr_err_inf;
++      int b_bus_req_inf;
++      /* Auxilary informative variables */
++      int a_suspend_req_inf;
+       /* Timeout indicator for timers */
+       int a_wait_vrise_tmout;
++      int a_wait_vfall_tmout;
+       int a_wait_bcon_tmout;
+       int a_aidl_bdis_tmout;
+       int b_ase0_brst_tmout;
+-
+-      /* Informative variables */
+-      int a_bus_drop;
+-      int a_bus_req;
+-      int a_clr_err;
+-      int a_suspend_req;
+-      int b_bus_req;
+-
+-      /* Output */
+-      int drv_vbus;
+-      int loc_conn;
+-      int loc_sof;
++      int a_bidl_adis_tmout;
+       struct otg_fsm_ops *ops;
+       struct usb_otg *otg;
+@@ -83,65 +114,123 @@ struct otg_fsm {
+ };
+ struct otg_fsm_ops {
+-      void    (*chrg_vbus)(int on);
+-      void    (*drv_vbus)(int on);
+-      void    (*loc_conn)(int on);
+-      void    (*loc_sof)(int on);
+-      void    (*start_pulse)(void);
+-      void    (*add_timer)(void *timer);
+-      void    (*del_timer)(void *timer);
++      void    (*chrg_vbus)(struct otg_fsm *fsm, int on);
++      void    (*drv_vbus)(struct otg_fsm *fsm, int on);
++      void    (*loc_conn)(struct otg_fsm *fsm, int on);
++      void    (*loc_sof)(struct otg_fsm *fsm, int on);
++      void    (*start_pulse)(struct otg_fsm *fsm);
++      void    (*start_adp_prb)(struct otg_fsm *fsm);
++      void    (*start_adp_sns)(struct otg_fsm *fsm);
++      void    (*add_timer)(struct otg_fsm *fsm, enum otg_fsm_timer timer);
++      void    (*del_timer)(struct otg_fsm *fsm, enum otg_fsm_timer timer);
+       int     (*start_host)(struct otg_fsm *fsm, int on);
+       int     (*start_gadget)(struct otg_fsm *fsm, int on);
+ };
+-static inline void otg_chrg_vbus(struct otg_fsm *fsm, int on)
++static inline int otg_chrg_vbus(struct otg_fsm *fsm, int on)
+ {
+-      fsm->ops->chrg_vbus(on);
++      if (!fsm->ops->chrg_vbus)
++              return -EOPNOTSUPP;
++      fsm->ops->chrg_vbus(fsm, on);
++      return 0;
+ }
+-static inline void otg_drv_vbus(struct otg_fsm *fsm, int on)
++static inline int otg_drv_vbus(struct otg_fsm *fsm, int on)
+ {
++      if (!fsm->ops->drv_vbus)
++              return -EOPNOTSUPP;
+       if (fsm->drv_vbus != on) {
+               fsm->drv_vbus = on;
+-              fsm->ops->drv_vbus(on);
++              fsm->ops->drv_vbus(fsm, on);
+       }
++      return 0;
+ }
+-static inline void otg_loc_conn(struct otg_fsm *fsm, int on)
++static inline int otg_loc_conn(struct otg_fsm *fsm, int on)
+ {
++      if (!fsm->ops->loc_conn)
++              return -EOPNOTSUPP;
+       if (fsm->loc_conn != on) {
+               fsm->loc_conn = on;
+-              fsm->ops->loc_conn(on);
++              fsm->ops->loc_conn(fsm, on);
+       }
++      return 0;
+ }
+-static inline void otg_loc_sof(struct otg_fsm *fsm, int on)
++static inline int otg_loc_sof(struct otg_fsm *fsm, int on)
+ {
++      if (!fsm->ops->loc_sof)
++              return -EOPNOTSUPP;
+       if (fsm->loc_sof != on) {
+               fsm->loc_sof = on;
+-              fsm->ops->loc_sof(on);
++              fsm->ops->loc_sof(fsm, on);
++      }
++      return 0;
++}
++
++static inline int otg_start_pulse(struct otg_fsm *fsm)
++{
++      if (!fsm->ops->start_pulse)
++              return -EOPNOTSUPP;
++      if (!fsm->data_pulse) {
++              fsm->data_pulse = 1;
++              fsm->ops->start_pulse(fsm);
+       }
++      return 0;
+ }
+-static inline void otg_start_pulse(struct otg_fsm *fsm)
++static inline int otg_start_adp_prb(struct otg_fsm *fsm)
+ {
+-      fsm->ops->start_pulse();
++      if (!fsm->ops->start_adp_prb)
++              return -EOPNOTSUPP;
++      if (!fsm->adp_prb) {
++              fsm->adp_sns = 0;
++              fsm->adp_prb = 1;
++              fsm->ops->start_adp_prb(fsm);
++      }
++      return 0;
+ }
+-static inline void otg_add_timer(struct otg_fsm *fsm, void *timer)
++static inline int otg_start_adp_sns(struct otg_fsm *fsm)
+ {
+-      fsm->ops->add_timer(timer);
++      if (!fsm->ops->start_adp_sns)
++              return -EOPNOTSUPP;
++      if (!fsm->adp_sns) {
++              fsm->adp_sns = 1;
++              fsm->ops->start_adp_sns(fsm);
++      }
++      return 0;
+ }
+-static inline void otg_del_timer(struct otg_fsm *fsm, void *timer)
++static inline int otg_add_timer(struct otg_fsm *fsm, enum otg_fsm_timer timer)
+ {
+-      fsm->ops->del_timer(timer);
++      if (!fsm->ops->add_timer)
++              return -EOPNOTSUPP;
++      fsm->ops->add_timer(fsm, timer);
++      return 0;
+ }
+-int otg_statemachine(struct otg_fsm *fsm);
++static inline int otg_del_timer(struct otg_fsm *fsm, enum otg_fsm_timer timer)
++{
++      if (!fsm->ops->del_timer)
++              return -EOPNOTSUPP;
++      fsm->ops->del_timer(fsm, timer);
++      return 0;
++}
+-/* Defined by device specific driver, for different timer implementation */
+-extern struct fsl_otg_timer *a_wait_vrise_tmr, *a_wait_bcon_tmr,
+-      *a_aidl_bdis_tmr, *b_ase0_brst_tmr, *b_se0_srp_tmr, *b_srp_fail_tmr,
+-      *a_wait_enum_tmr;
++static inline int otg_start_host(struct otg_fsm *fsm, int on)
++{
++      if (!fsm->ops->start_host)
++              return -EOPNOTSUPP;
++      return fsm->ops->start_host(fsm, on);
++}
++
++static inline int otg_start_gadget(struct otg_fsm *fsm, int on)
++{
++      if (!fsm->ops->start_gadget)
++              return -EOPNOTSUPP;
++      return fsm->ops->start_gadget(fsm, on);
++}
++
++int otg_statemachine(struct otg_fsm *fsm);
+--- a/drivers/usb/phy/phy-generic.c
++++ b/drivers/usb/phy/phy-generic.c
+@@ -35,6 +35,9 @@
+ #include <linux/clk.h>
+ #include <linux/regulator/consumer.h>
+ #include <linux/of.h>
++#include <linux/of_gpio.h>
++#include <linux/gpio.h>
++#include <linux/delay.h>
+ #include "phy-generic.h"
+@@ -64,6 +67,23 @@ static int nop_set_suspend(struct usb_ph
+       return 0;
+ }
++static void nop_reset_set(struct usb_phy_gen_xceiv *nop, int asserted)
++{
++      int value;
++
++      if (!gpio_is_valid(nop->gpio_reset))
++              return;
++
++      value = asserted;
++      if (nop->reset_active_low)
++              value = !value;
++
++      gpio_set_value_cansleep(nop->gpio_reset, value);
++
++      if (!asserted)
++              usleep_range(10000, 20000);
++}
++
+ int usb_gen_phy_init(struct usb_phy *phy)
+ {
+       struct usb_phy_gen_xceiv *nop = dev_get_drvdata(phy->dev);
+@@ -74,13 +94,10 @@ int usb_gen_phy_init(struct usb_phy *phy
+       }
+       if (!IS_ERR(nop->clk))
+-              clk_enable(nop->clk);
++              clk_prepare_enable(nop->clk);
+-      if (!IS_ERR(nop->reset)) {
+-              /* De-assert RESET */
+-              if (regulator_enable(nop->reset))
+-                      dev_err(phy->dev, "Failed to de-assert reset\n");
+-      }
++      /* De-assert RESET */
++      nop_reset_set(nop, 0);
+       return 0;
+ }
+@@ -90,14 +107,11 @@ void usb_gen_phy_shutdown(struct usb_phy
+ {
+       struct usb_phy_gen_xceiv *nop = dev_get_drvdata(phy->dev);
+-      if (!IS_ERR(nop->reset)) {
+-              /* Assert RESET */
+-              if (regulator_disable(nop->reset))
+-                      dev_err(phy->dev, "Failed to assert reset\n");
+-      }
++      /* Assert RESET */
++      nop_reset_set(nop, 1);
+       if (!IS_ERR(nop->clk))
+-              clk_disable(nop->clk);
++              clk_disable_unprepare(nop->clk);
+       if (!IS_ERR(nop->vcc)) {
+               if (regulator_disable(nop->vcc))
+@@ -136,11 +150,38 @@ static int nop_set_host(struct usb_otg *
+ }
+ int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop,
+-              enum usb_phy_type type, u32 clk_rate, bool needs_vcc,
+-              bool needs_reset)
++              struct usb_phy_gen_xceiv_platform_data *pdata)
+ {
++      enum usb_phy_type type = USB_PHY_TYPE_USB2;
+       int err;
++      u32 clk_rate = 0;
++      bool needs_vcc = false;
++
++      nop->reset_active_low = true;   /* default behaviour */
++
++      if (dev->of_node) {
++              struct device_node *node = dev->of_node;
++              enum of_gpio_flags flags;
++
++              if (of_property_read_u32(node, "clock-frequency", &clk_rate))
++                      clk_rate = 0;
++
++              needs_vcc = of_property_read_bool(node, "vcc-supply");
++              nop->gpio_reset = of_get_named_gpio_flags(node, "reset-gpios",
++                                                              0, &flags);
++              if (nop->gpio_reset == -EPROBE_DEFER)
++                      return -EPROBE_DEFER;
++
++              nop->reset_active_low = flags & OF_GPIO_ACTIVE_LOW;
++
++      } else if (pdata) {
++              type = pdata->type;
++              clk_rate = pdata->clk_rate;
++              needs_vcc = pdata->needs_vcc;
++              nop->gpio_reset = pdata->gpio_reset;
++      }
++
+       nop->phy.otg = devm_kzalloc(dev, sizeof(*nop->phy.otg),
+                       GFP_KERNEL);
+       if (!nop->phy.otg)
+@@ -160,14 +201,6 @@ int usb_phy_gen_create_phy(struct device
+               }
+       }
+-      if (!IS_ERR(nop->clk)) {
+-              err = clk_prepare(nop->clk);
+-              if (err) {
+-                      dev_err(dev, "Error preparing clock\n");
+-                      return err;
+-              }
+-      }
+-
+       nop->vcc = devm_regulator_get(dev, "vcc");
+       if (IS_ERR(nop->vcc)) {
+               dev_dbg(dev, "Error getting vcc regulator: %ld\n",
+@@ -176,12 +209,22 @@ int usb_phy_gen_create_phy(struct device
+                       return -EPROBE_DEFER;
+       }
+-      nop->reset = devm_regulator_get(dev, "reset");
+-      if (IS_ERR(nop->reset)) {
+-              dev_dbg(dev, "Error getting reset regulator: %ld\n",
+-                                      PTR_ERR(nop->reset));
+-              if (needs_reset)
+-                      return -EPROBE_DEFER;
++      if (gpio_is_valid(nop->gpio_reset)) {
++              unsigned long gpio_flags;
++
++              /* Assert RESET */
++              if (nop->reset_active_low)
++                      gpio_flags = GPIOF_OUT_INIT_LOW;
++              else
++                      gpio_flags = GPIOF_OUT_INIT_HIGH;
++
++              err = devm_gpio_request_one(dev, nop->gpio_reset,
++                                              gpio_flags, dev_name(dev));
++              if (err) {
++                      dev_err(dev, "Error requesting RESET GPIO %d\n",
++                                      nop->gpio_reset);
++                      return err;
++              }
+       }
+       nop->dev                = dev;
+@@ -200,48 +243,17 @@ int usb_phy_gen_create_phy(struct device
+ }
+ EXPORT_SYMBOL_GPL(usb_phy_gen_create_phy);
+-void usb_phy_gen_cleanup_phy(struct usb_phy_gen_xceiv *nop)
+-{
+-      if (!IS_ERR(nop->clk))
+-              clk_unprepare(nop->clk);
+-}
+-EXPORT_SYMBOL_GPL(usb_phy_gen_cleanup_phy);
+-
+ static int usb_phy_gen_xceiv_probe(struct platform_device *pdev)
+ {
+       struct device *dev = &pdev->dev;
+-      struct usb_phy_gen_xceiv_platform_data *pdata =
+-                      dev_get_platdata(&pdev->dev);
+       struct usb_phy_gen_xceiv        *nop;
+-      enum usb_phy_type       type = USB_PHY_TYPE_USB2;
+       int err;
+-      u32 clk_rate = 0;
+-      bool needs_vcc = false;
+-      bool needs_reset = false;
+-
+-      if (dev->of_node) {
+-              struct device_node *node = dev->of_node;
+-
+-              if (of_property_read_u32(node, "clock-frequency", &clk_rate))
+-                      clk_rate = 0;
+-
+-              needs_vcc = of_property_read_bool(node, "vcc-supply");
+-              needs_reset = of_property_read_bool(node, "reset-supply");
+-
+-      } else if (pdata) {
+-              type = pdata->type;
+-              clk_rate = pdata->clk_rate;
+-              needs_vcc = pdata->needs_vcc;
+-              needs_reset = pdata->needs_reset;
+-      }
+       nop = devm_kzalloc(dev, sizeof(*nop), GFP_KERNEL);
+       if (!nop)
+               return -ENOMEM;
+-
+-      err = usb_phy_gen_create_phy(dev, nop, type, clk_rate, needs_vcc,
+-                      needs_reset);
++      err = usb_phy_gen_create_phy(dev, nop, dev_get_platdata(&pdev->dev));
+       if (err)
+               return err;
+@@ -252,23 +264,18 @@ static int usb_phy_gen_xceiv_probe(struc
+       if (err) {
+               dev_err(&pdev->dev, "can't register transceiver, err: %d\n",
+                       err);
+-              goto err_add;
++              return err;
+       }
+       platform_set_drvdata(pdev, nop);
+       return 0;
+-
+-err_add:
+-      usb_phy_gen_cleanup_phy(nop);
+-      return err;
+ }
+ static int usb_phy_gen_xceiv_remove(struct platform_device *pdev)
+ {
+       struct usb_phy_gen_xceiv *nop = platform_get_drvdata(pdev);
+-      usb_phy_gen_cleanup_phy(nop);
+       usb_remove_phy(&nop->phy);
+       return 0;
+--- a/drivers/usb/phy/phy-generic.h
++++ b/drivers/usb/phy/phy-generic.h
+@@ -1,20 +1,21 @@
+ #ifndef _PHY_GENERIC_H_
+ #define _PHY_GENERIC_H_
++#include <linux/usb/usb_phy_gen_xceiv.h>
++
+ struct usb_phy_gen_xceiv {
+       struct usb_phy phy;
+       struct device *dev;
+       struct clk *clk;
+       struct regulator *vcc;
+-      struct regulator *reset;
++      int gpio_reset;
++      bool reset_active_low;
+ };
+ int usb_gen_phy_init(struct usb_phy *phy);
+ void usb_gen_phy_shutdown(struct usb_phy *phy);
+ int usb_phy_gen_create_phy(struct device *dev, struct usb_phy_gen_xceiv *nop,
+-              enum usb_phy_type type, u32 clk_rate, bool needs_vcc,
+-              bool needs_reset);
+-void usb_phy_gen_cleanup_phy(struct usb_phy_gen_xceiv *nop);
++              struct usb_phy_gen_xceiv_platform_data *pdata);
+ #endif
+--- a/drivers/usb/phy/phy-omap-control.c
++++ /dev/null
+@@ -1,290 +0,0 @@
+-/*
+- * omap-control-usb.c - The USB part of control module.
+- *
+- * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
+- * 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.
+- *
+- * Author: Kishon Vijay Abraham I <kishon@ti.com>
+- *
+- * 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.
+- *
+- */
+-
+-#include <linux/module.h>
+-#include <linux/platform_device.h>
+-#include <linux/slab.h>
+-#include <linux/of.h>
+-#include <linux/err.h>
+-#include <linux/io.h>
+-#include <linux/clk.h>
+-#include <linux/usb/omap_control_usb.h>
+-
+-static struct omap_control_usb *control_usb;
+-
+-/**
+- * omap_get_control_dev - returns the device pointer for this control device
+- *
+- * This API should be called to get the device pointer for this control
+- * module device. This device pointer should be used for called other
+- * exported API's in this driver.
+- *
+- * To be used by PHY driver and glue driver.
+- */
+-struct device *omap_get_control_dev(void)
+-{
+-      if (!control_usb)
+-              return ERR_PTR(-ENODEV);
+-
+-      return control_usb->dev;
+-}
+-EXPORT_SYMBOL_GPL(omap_get_control_dev);
+-
+-/**
+- * omap_control_usb3_phy_power - power on/off the serializer using control
+- *    module
+- * @dev: the control module device
+- * @on: 0 to off and 1 to on based on powering on or off the PHY
+- *
+- * usb3 PHY driver should call this API to power on or off the PHY.
+- */
+-void omap_control_usb3_phy_power(struct device *dev, bool on)
+-{
+-      u32 val;
+-      unsigned long rate;
+-      struct omap_control_usb *control_usb = dev_get_drvdata(dev);
+-
+-      if (control_usb->type != OMAP_CTRL_DEV_TYPE2)
+-              return;
+-
+-      rate = clk_get_rate(control_usb->sys_clk);
+-      rate = rate/1000000;
+-
+-      val = readl(control_usb->phy_power);
+-
+-      if (on) {
+-              val &= ~(OMAP_CTRL_USB_PWRCTL_CLK_CMD_MASK |
+-                      OMAP_CTRL_USB_PWRCTL_CLK_FREQ_MASK);
+-              val |= OMAP_CTRL_USB3_PHY_TX_RX_POWERON <<
+-                      OMAP_CTRL_USB_PWRCTL_CLK_CMD_SHIFT;
+-              val |= rate << OMAP_CTRL_USB_PWRCTL_CLK_FREQ_SHIFT;
+-      } else {
+-              val &= ~OMAP_CTRL_USB_PWRCTL_CLK_CMD_MASK;
+-              val |= OMAP_CTRL_USB3_PHY_TX_RX_POWEROFF <<
+-                      OMAP_CTRL_USB_PWRCTL_CLK_CMD_SHIFT;
+-      }
+-
+-      writel(val, control_usb->phy_power);
+-}
+-EXPORT_SYMBOL_GPL(omap_control_usb3_phy_power);
+-
+-/**
+- * omap_control_usb_phy_power - power on/off the phy using control module reg
+- * @dev: the control module device
+- * @on: 0 or 1, based on powering on or off the PHY
+- */
+-void omap_control_usb_phy_power(struct device *dev, int on)
+-{
+-      u32 val;
+-      struct omap_control_usb *control_usb = dev_get_drvdata(dev);
+-
+-      val = readl(control_usb->dev_conf);
+-
+-      if (on)
+-              val &= ~OMAP_CTRL_DEV_PHY_PD;
+-      else
+-              val |= OMAP_CTRL_DEV_PHY_PD;
+-
+-      writel(val, control_usb->dev_conf);
+-}
+-EXPORT_SYMBOL_GPL(omap_control_usb_phy_power);
+-
+-/**
+- * omap_control_usb_host_mode - set AVALID, VBUSVALID and ID pin in grounded
+- * @ctrl_usb: struct omap_control_usb *
+- *
+- * Writes to the mailbox register to notify the usb core that a usb
+- * device has been connected.
+- */
+-static void omap_control_usb_host_mode(struct omap_control_usb *ctrl_usb)
+-{
+-      u32 val;
+-
+-      val = readl(ctrl_usb->otghs_control);
+-      val &= ~(OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND);
+-      val |= OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID;
+-      writel(val, ctrl_usb->otghs_control);
+-}
+-
+-/**
+- * omap_control_usb_device_mode - set AVALID, VBUSVALID and ID pin in high
+- * impedance
+- * @ctrl_usb: struct omap_control_usb *
+- *
+- * Writes to the mailbox register to notify the usb core that it has been
+- * connected to a usb host.
+- */
+-static void omap_control_usb_device_mode(struct omap_control_usb *ctrl_usb)
+-{
+-      u32 val;
+-
+-      val = readl(ctrl_usb->otghs_control);
+-      val &= ~OMAP_CTRL_DEV_SESSEND;
+-      val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_AVALID |
+-              OMAP_CTRL_DEV_VBUSVALID;
+-      writel(val, ctrl_usb->otghs_control);
+-}
+-
+-/**
+- * omap_control_usb_set_sessionend - Enable SESSIONEND and IDIG to high
+- * impedance
+- * @ctrl_usb: struct omap_control_usb *
+- *
+- * Writes to the mailbox register to notify the usb core it's now in
+- * disconnected state.
+- */
+-static void omap_control_usb_set_sessionend(struct omap_control_usb *ctrl_usb)
+-{
+-      u32 val;
+-
+-      val = readl(ctrl_usb->otghs_control);
+-      val &= ~(OMAP_CTRL_DEV_AVALID | OMAP_CTRL_DEV_VBUSVALID);
+-      val |= OMAP_CTRL_DEV_IDDIG | OMAP_CTRL_DEV_SESSEND;
+-      writel(val, ctrl_usb->otghs_control);
+-}
+-
+-/**
+- * omap_control_usb_set_mode - Calls to functions to set USB in one of host mode
+- * or device mode or to denote disconnected state
+- * @dev: the control module device
+- * @mode: The mode to which usb should be configured
+- *
+- * This is an API to write to the mailbox register to notify the usb core that
+- * a usb device has been connected.
+- */
+-void omap_control_usb_set_mode(struct device *dev,
+-      enum omap_control_usb_mode mode)
+-{
+-      struct omap_control_usb *ctrl_usb;
+-
+-      if (IS_ERR(dev) || control_usb->type != OMAP_CTRL_DEV_TYPE1)
+-              return;
+-
+-      ctrl_usb = dev_get_drvdata(dev);
+-
+-      switch (mode) {
+-      case USB_MODE_HOST:
+-              omap_control_usb_host_mode(ctrl_usb);
+-              break;
+-      case USB_MODE_DEVICE:
+-              omap_control_usb_device_mode(ctrl_usb);
+-              break;
+-      case USB_MODE_DISCONNECT:
+-              omap_control_usb_set_sessionend(ctrl_usb);
+-              break;
+-      default:
+-              dev_vdbg(dev, "invalid omap control usb mode\n");
+-      }
+-}
+-EXPORT_SYMBOL_GPL(omap_control_usb_set_mode);
+-
+-static int omap_control_usb_probe(struct platform_device *pdev)
+-{
+-      struct resource *res;
+-      struct device_node *np = pdev->dev.of_node;
+-      struct omap_control_usb_platform_data *pdata =
+-                      dev_get_platdata(&pdev->dev);
+-
+-      control_usb = devm_kzalloc(&pdev->dev, sizeof(*control_usb),
+-              GFP_KERNEL);
+-      if (!control_usb) {
+-              dev_err(&pdev->dev, "unable to alloc memory for control usb\n");
+-              return -ENOMEM;
+-      }
+-
+-      if (np) {
+-              of_property_read_u32(np, "ti,type", &control_usb->type);
+-      } else if (pdata) {
+-              control_usb->type = pdata->type;
+-      } else {
+-              dev_err(&pdev->dev, "no pdata present\n");
+-              return -EINVAL;
+-      }
+-
+-      control_usb->dev        = &pdev->dev;
+-
+-      res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
+-              "control_dev_conf");
+-      control_usb->dev_conf = devm_ioremap_resource(&pdev->dev, res);
+-      if (IS_ERR(control_usb->dev_conf))
+-              return PTR_ERR(control_usb->dev_conf);
+-
+-      if (control_usb->type == OMAP_CTRL_DEV_TYPE1) {
+-              res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
+-                      "otghs_control");
+-              control_usb->otghs_control = devm_ioremap_resource(
+-                      &pdev->dev, res);
+-              if (IS_ERR(control_usb->otghs_control))
+-                      return PTR_ERR(control_usb->otghs_control);
+-      }
+-
+-      if (control_usb->type == OMAP_CTRL_DEV_TYPE2) {
+-              res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
+-                      "phy_power_usb");
+-              control_usb->phy_power = devm_ioremap_resource(
+-                      &pdev->dev, res);
+-              if (IS_ERR(control_usb->phy_power))
+-                      return PTR_ERR(control_usb->phy_power);
+-
+-              control_usb->sys_clk = devm_clk_get(control_usb->dev,
+-                      "sys_clkin");
+-              if (IS_ERR(control_usb->sys_clk)) {
+-                      pr_err("%s: unable to get sys_clkin\n", __func__);
+-                      return -EINVAL;
+-              }
+-      }
+-
+-
+-      dev_set_drvdata(control_usb->dev, control_usb);
+-
+-      return 0;
+-}
+-
+-#ifdef CONFIG_OF
+-static const struct of_device_id omap_control_usb_id_table[] = {
+-      { .compatible = "ti,omap-control-usb" },
+-      {}
+-};
+-MODULE_DEVICE_TABLE(of, omap_control_usb_id_table);
+-#endif
+-
+-static struct platform_driver omap_control_usb_driver = {
+-      .probe          = omap_control_usb_probe,
+-      .driver         = {
+-              .name   = "omap-control-usb",
+-              .owner  = THIS_MODULE,
+-              .of_match_table = of_match_ptr(omap_control_usb_id_table),
+-      },
+-};
+-
+-static int __init omap_control_usb_init(void)
+-{
+-      return platform_driver_register(&omap_control_usb_driver);
+-}
+-subsys_initcall(omap_control_usb_init);
+-
+-static void __exit omap_control_usb_exit(void)
+-{
+-      platform_driver_unregister(&omap_control_usb_driver);
+-}
+-module_exit(omap_control_usb_exit);
+-
+-MODULE_ALIAS("platform: omap_control_usb");
+-MODULE_AUTHOR("Texas Instruments Inc.");
+-MODULE_DESCRIPTION("OMAP Control Module USB Driver");
+-MODULE_LICENSE("GPL v2");
+--- a/drivers/usb/phy/phy-omap-usb2.c
++++ /dev/null
+@@ -1,272 +0,0 @@
+-/*
+- * omap-usb2.c - USB PHY, talking to musb controller in OMAP.
+- *
+- * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
+- * 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.
+- *
+- * Author: Kishon Vijay Abraham I <kishon@ti.com>
+- *
+- * 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.
+- *
+- */
+-
+-#include <linux/module.h>
+-#include <linux/platform_device.h>
+-#include <linux/slab.h>
+-#include <linux/of.h>
+-#include <linux/io.h>
+-#include <linux/usb/omap_usb.h>
+-#include <linux/usb/phy_companion.h>
+-#include <linux/clk.h>
+-#include <linux/err.h>
+-#include <linux/pm_runtime.h>
+-#include <linux/delay.h>
+-#include <linux/usb/omap_control_usb.h>
+-
+-/**
+- * omap_usb2_set_comparator - links the comparator present in the sytem with
+- *    this phy
+- * @comparator - the companion phy(comparator) for this phy
+- *
+- * The phy companion driver should call this API passing the phy_companion
+- * filled with set_vbus and start_srp to be used by usb phy.
+- *
+- * For use by phy companion driver
+- */
+-int omap_usb2_set_comparator(struct phy_companion *comparator)
+-{
+-      struct omap_usb *phy;
+-      struct usb_phy  *x = usb_get_phy(USB_PHY_TYPE_USB2);
+-
+-      if (IS_ERR(x))
+-              return -ENODEV;
+-
+-      phy = phy_to_omapusb(x);
+-      phy->comparator = comparator;
+-      return 0;
+-}
+-EXPORT_SYMBOL_GPL(omap_usb2_set_comparator);
+-
+-static int omap_usb_set_vbus(struct usb_otg *otg, bool enabled)
+-{
+-      struct omap_usb *phy = phy_to_omapusb(otg->phy);
+-
+-      if (!phy->comparator)
+-              return -ENODEV;
+-
+-      return phy->comparator->set_vbus(phy->comparator, enabled);
+-}
+-
+-static int omap_usb_start_srp(struct usb_otg *otg)
+-{
+-      struct omap_usb *phy = phy_to_omapusb(otg->phy);
+-
+-      if (!phy->comparator)
+-              return -ENODEV;
+-
+-      return phy->comparator->start_srp(phy->comparator);
+-}
+-
+-static int omap_usb_set_host(struct usb_otg *otg, struct usb_bus *host)
+-{
+-      struct usb_phy  *phy = otg->phy;
+-
+-      otg->host = host;
+-      if (!host)
+-              phy->state = OTG_STATE_UNDEFINED;
+-
+-      return 0;
+-}
+-
+-static int omap_usb_set_peripheral(struct usb_otg *otg,
+-              struct usb_gadget *gadget)
+-{
+-      struct usb_phy  *phy = otg->phy;
+-
+-      otg->gadget = gadget;
+-      if (!gadget)
+-              phy->state = OTG_STATE_UNDEFINED;
+-
+-      return 0;
+-}
+-
+-static int omap_usb2_suspend(struct usb_phy *x, int suspend)
+-{
+-      struct omap_usb *phy = phy_to_omapusb(x);
+-      int ret;
+-
+-      if (suspend && !phy->is_suspended) {
+-              omap_control_usb_phy_power(phy->control_dev, 0);
+-              pm_runtime_put_sync(phy->dev);
+-              phy->is_suspended = 1;
+-      } else if (!suspend && phy->is_suspended) {
+-              ret = pm_runtime_get_sync(phy->dev);
+-              if (ret < 0) {
+-                      dev_err(phy->dev, "get_sync failed with err %d\n", ret);
+-                      return ret;
+-              }
+-              omap_control_usb_phy_power(phy->control_dev, 1);
+-              phy->is_suspended = 0;
+-      }
+-
+-      return 0;
+-}
+-
+-static int omap_usb2_probe(struct platform_device *pdev)
+-{
+-      struct omap_usb                 *phy;
+-      struct usb_otg                  *otg;
+-
+-      phy = devm_kzalloc(&pdev->dev, sizeof(*phy), GFP_KERNEL);
+-      if (!phy) {
+-              dev_err(&pdev->dev, "unable to allocate memory for USB2 PHY\n");
+-              return -ENOMEM;
+-      }
+-
+-      otg = devm_kzalloc(&pdev->dev, sizeof(*otg), GFP_KERNEL);
+-      if (!otg) {
+-              dev_err(&pdev->dev, "unable to allocate memory for USB OTG\n");
+-              return -ENOMEM;
+-      }
+-
+-      phy->dev                = &pdev->dev;
+-
+-      phy->phy.dev            = phy->dev;
+-      phy->phy.label          = "omap-usb2";
+-      phy->phy.set_suspend    = omap_usb2_suspend;
+-      phy->phy.otg            = otg;
+-      phy->phy.type           = USB_PHY_TYPE_USB2;
+-
+-      phy->control_dev = omap_get_control_dev();
+-      if (IS_ERR(phy->control_dev)) {
+-              dev_dbg(&pdev->dev, "Failed to get control device\n");
+-              return -ENODEV;
+-      }
+-
+-      phy->is_suspended       = 1;
+-      omap_control_usb_phy_power(phy->control_dev, 0);
+-
+-      otg->set_host           = omap_usb_set_host;
+-      otg->set_peripheral     = omap_usb_set_peripheral;
+-      otg->set_vbus           = omap_usb_set_vbus;
+-      otg->start_srp          = omap_usb_start_srp;
+-      otg->phy                = &phy->phy;
+-
+-      phy->wkupclk = devm_clk_get(phy->dev, "usb_phy_cm_clk32k");
+-      if (IS_ERR(phy->wkupclk)) {
+-              dev_err(&pdev->dev, "unable to get usb_phy_cm_clk32k\n");
+-              return PTR_ERR(phy->wkupclk);
+-      }
+-      clk_prepare(phy->wkupclk);
+-
+-      phy->optclk = devm_clk_get(phy->dev, "usb_otg_ss_refclk960m");
+-      if (IS_ERR(phy->optclk))
+-              dev_vdbg(&pdev->dev, "unable to get refclk960m\n");
+-      else
+-              clk_prepare(phy->optclk);
+-
+-      usb_add_phy_dev(&phy->phy);
+-
+-      platform_set_drvdata(pdev, phy);
+-
+-      pm_runtime_enable(phy->dev);
+-
+-      return 0;
+-}
+-
+-static int omap_usb2_remove(struct platform_device *pdev)
+-{
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-
+-      clk_unprepare(phy->wkupclk);
+-      if (!IS_ERR(phy->optclk))
+-              clk_unprepare(phy->optclk);
+-      usb_remove_phy(&phy->phy);
+-
+-      return 0;
+-}
+-
+-#ifdef CONFIG_PM_RUNTIME
+-
+-static int omap_usb2_runtime_suspend(struct device *dev)
+-{
+-      struct platform_device  *pdev = to_platform_device(dev);
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-
+-      clk_disable(phy->wkupclk);
+-      if (!IS_ERR(phy->optclk))
+-              clk_disable(phy->optclk);
+-
+-      return 0;
+-}
+-
+-static int omap_usb2_runtime_resume(struct device *dev)
+-{
+-      struct platform_device  *pdev = to_platform_device(dev);
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-      int ret;
+-
+-      ret = clk_enable(phy->wkupclk);
+-      if (ret < 0) {
+-              dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
+-              goto err0;
+-      }
+-
+-      if (!IS_ERR(phy->optclk)) {
+-              ret = clk_enable(phy->optclk);
+-              if (ret < 0) {
+-                      dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
+-                      goto err1;
+-              }
+-      }
+-
+-      return 0;
+-
+-err1:
+-      clk_disable(phy->wkupclk);
+-
+-err0:
+-      return ret;
+-}
+-
+-static const struct dev_pm_ops omap_usb2_pm_ops = {
+-      SET_RUNTIME_PM_OPS(omap_usb2_runtime_suspend, omap_usb2_runtime_resume,
+-              NULL)
+-};
+-
+-#define DEV_PM_OPS     (&omap_usb2_pm_ops)
+-#else
+-#define DEV_PM_OPS     NULL
+-#endif
+-
+-#ifdef CONFIG_OF
+-static const struct of_device_id omap_usb2_id_table[] = {
+-      { .compatible = "ti,omap-usb2" },
+-      {}
+-};
+-MODULE_DEVICE_TABLE(of, omap_usb2_id_table);
+-#endif
+-
+-static struct platform_driver omap_usb2_driver = {
+-      .probe          = omap_usb2_probe,
+-      .remove         = omap_usb2_remove,
+-      .driver         = {
+-              .name   = "omap-usb2",
+-              .owner  = THIS_MODULE,
+-              .pm     = DEV_PM_OPS,
+-              .of_match_table = of_match_ptr(omap_usb2_id_table),
+-      },
+-};
+-
+-module_platform_driver(omap_usb2_driver);
+-
+-MODULE_ALIAS("platform: omap_usb2");
+-MODULE_AUTHOR("Texas Instruments Inc.");
+-MODULE_DESCRIPTION("OMAP USB2 phy driver");
+-MODULE_LICENSE("GPL v2");
+--- a/drivers/usb/phy/phy-omap-usb3.c
++++ /dev/null
+@@ -1,347 +0,0 @@
+-/*
+- * omap-usb3 - USB PHY, talking to dwc3 controller in OMAP.
+- *
+- * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
+- * 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.
+- *
+- * Author: Kishon Vijay Abraham I <kishon@ti.com>
+- *
+- * 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.
+- *
+- */
+-
+-#include <linux/module.h>
+-#include <linux/platform_device.h>
+-#include <linux/slab.h>
+-#include <linux/usb/omap_usb.h>
+-#include <linux/of.h>
+-#include <linux/clk.h>
+-#include <linux/err.h>
+-#include <linux/pm_runtime.h>
+-#include <linux/delay.h>
+-#include <linux/usb/omap_control_usb.h>
+-
+-#define       PLL_STATUS              0x00000004
+-#define       PLL_GO                  0x00000008
+-#define       PLL_CONFIGURATION1      0x0000000C
+-#define       PLL_CONFIGURATION2      0x00000010
+-#define       PLL_CONFIGURATION3      0x00000014
+-#define       PLL_CONFIGURATION4      0x00000020
+-
+-#define       PLL_REGM_MASK           0x001FFE00
+-#define       PLL_REGM_SHIFT          0x9
+-#define       PLL_REGM_F_MASK         0x0003FFFF
+-#define       PLL_REGM_F_SHIFT        0x0
+-#define       PLL_REGN_MASK           0x000001FE
+-#define       PLL_REGN_SHIFT          0x1
+-#define       PLL_SELFREQDCO_MASK     0x0000000E
+-#define       PLL_SELFREQDCO_SHIFT    0x1
+-#define       PLL_SD_MASK             0x0003FC00
+-#define       PLL_SD_SHIFT            0x9
+-#define       SET_PLL_GO              0x1
+-#define       PLL_TICOPWDN            0x10000
+-#define       PLL_LOCK                0x2
+-#define       PLL_IDLE                0x1
+-
+-/*
+- * This is an Empirical value that works, need to confirm the actual
+- * value required for the USB3PHY_PLL_CONFIGURATION2.PLL_IDLE status
+- * to be correctly reflected in the USB3PHY_PLL_STATUS register.
+- */
+-# define PLL_IDLE_TIME  100;
+-
+-struct usb_dpll_map {
+-      unsigned long rate;
+-      struct usb_dpll_params params;
+-};
+-
+-static struct usb_dpll_map dpll_map[] = {
+-      {12000000, {1250, 5, 4, 20, 0} },       /* 12 MHz */
+-      {16800000, {3125, 20, 4, 20, 0} },      /* 16.8 MHz */
+-      {19200000, {1172, 8, 4, 20, 65537} },   /* 19.2 MHz */
+-      {20000000, {1000, 7, 4, 10, 0} },       /* 20 MHz */
+-      {26000000, {1250, 12, 4, 20, 0} },      /* 26 MHz */
+-      {38400000, {3125, 47, 4, 20, 92843} },  /* 38.4 MHz */
+-};
+-
+-static struct usb_dpll_params *omap_usb3_get_dpll_params(unsigned long rate)
+-{
+-      int i;
+-
+-      for (i = 0; i < ARRAY_SIZE(dpll_map); i++) {
+-              if (rate == dpll_map[i].rate)
+-                      return &dpll_map[i].params;
+-      }
+-
+-      return NULL;
+-}
+-
+-static int omap_usb3_suspend(struct usb_phy *x, int suspend)
+-{
+-      struct omap_usb *phy = phy_to_omapusb(x);
+-      int     val;
+-      int timeout = PLL_IDLE_TIME;
+-
+-      if (suspend && !phy->is_suspended) {
+-              val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
+-              val |= PLL_IDLE;
+-              omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
+-
+-              do {
+-                      val = omap_usb_readl(phy->pll_ctrl_base, PLL_STATUS);
+-                      if (val & PLL_TICOPWDN)
+-                              break;
+-                      udelay(1);
+-              } while (--timeout);
+-
+-              omap_control_usb3_phy_power(phy->control_dev, 0);
+-
+-              phy->is_suspended       = 1;
+-      } else if (!suspend && phy->is_suspended) {
+-              phy->is_suspended       = 0;
+-
+-              val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
+-              val &= ~PLL_IDLE;
+-              omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
+-
+-              do {
+-                      val = omap_usb_readl(phy->pll_ctrl_base, PLL_STATUS);
+-                      if (!(val & PLL_TICOPWDN))
+-                              break;
+-                      udelay(1);
+-              } while (--timeout);
+-      }
+-
+-      return 0;
+-}
+-
+-static void omap_usb_dpll_relock(struct omap_usb *phy)
+-{
+-      u32             val;
+-      unsigned long   timeout;
+-
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_GO, SET_PLL_GO);
+-
+-      timeout = jiffies + msecs_to_jiffies(20);
+-      do {
+-              val = omap_usb_readl(phy->pll_ctrl_base, PLL_STATUS);
+-              if (val & PLL_LOCK)
+-                      break;
+-      } while (!WARN_ON(time_after(jiffies, timeout)));
+-}
+-
+-static int omap_usb_dpll_lock(struct omap_usb *phy)
+-{
+-      u32                     val;
+-      unsigned long           rate;
+-      struct usb_dpll_params *dpll_params;
+-
+-      rate = clk_get_rate(phy->sys_clk);
+-      dpll_params = omap_usb3_get_dpll_params(rate);
+-      if (!dpll_params) {
+-              dev_err(phy->dev,
+-                        "No DPLL configuration for %lu Hz SYS CLK\n", rate);
+-              return -EINVAL;
+-      }
+-
+-      val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
+-      val &= ~PLL_REGN_MASK;
+-      val |= dpll_params->n << PLL_REGN_SHIFT;
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
+-
+-      val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION2);
+-      val &= ~PLL_SELFREQDCO_MASK;
+-      val |= dpll_params->freq << PLL_SELFREQDCO_SHIFT;
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION2, val);
+-
+-      val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION1);
+-      val &= ~PLL_REGM_MASK;
+-      val |= dpll_params->m << PLL_REGM_SHIFT;
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION1, val);
+-
+-      val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION4);
+-      val &= ~PLL_REGM_F_MASK;
+-      val |= dpll_params->mf << PLL_REGM_F_SHIFT;
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION4, val);
+-
+-      val = omap_usb_readl(phy->pll_ctrl_base, PLL_CONFIGURATION3);
+-      val &= ~PLL_SD_MASK;
+-      val |= dpll_params->sd << PLL_SD_SHIFT;
+-      omap_usb_writel(phy->pll_ctrl_base, PLL_CONFIGURATION3, val);
+-
+-      omap_usb_dpll_relock(phy);
+-
+-      return 0;
+-}
+-
+-static int omap_usb3_init(struct usb_phy *x)
+-{
+-      struct omap_usb *phy = phy_to_omapusb(x);
+-      int ret;
+-
+-      ret = omap_usb_dpll_lock(phy);
+-      if (ret)
+-              return ret;
+-
+-      omap_control_usb3_phy_power(phy->control_dev, 1);
+-
+-      return 0;
+-}
+-
+-static int omap_usb3_probe(struct platform_device *pdev)
+-{
+-      struct omap_usb                 *phy;
+-      struct resource                 *res;
+-
+-      phy = devm_kzalloc(&pdev->dev, sizeof(*phy), GFP_KERNEL);
+-      if (!phy) {
+-              dev_err(&pdev->dev, "unable to alloc mem for OMAP USB3 PHY\n");
+-              return -ENOMEM;
+-      }
+-
+-      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pll_ctrl");
+-      phy->pll_ctrl_base = devm_ioremap_resource(&pdev->dev, res);
+-      if (IS_ERR(phy->pll_ctrl_base))
+-              return PTR_ERR(phy->pll_ctrl_base);
+-
+-      phy->dev                = &pdev->dev;
+-
+-      phy->phy.dev            = phy->dev;
+-      phy->phy.label          = "omap-usb3";
+-      phy->phy.init           = omap_usb3_init;
+-      phy->phy.set_suspend    = omap_usb3_suspend;
+-      phy->phy.type           = USB_PHY_TYPE_USB3;
+-
+-      phy->is_suspended       = 1;
+-      phy->wkupclk = devm_clk_get(phy->dev, "usb_phy_cm_clk32k");
+-      if (IS_ERR(phy->wkupclk)) {
+-              dev_err(&pdev->dev, "unable to get usb_phy_cm_clk32k\n");
+-              return PTR_ERR(phy->wkupclk);
+-      }
+-      clk_prepare(phy->wkupclk);
+-
+-      phy->optclk = devm_clk_get(phy->dev, "usb_otg_ss_refclk960m");
+-      if (IS_ERR(phy->optclk)) {
+-              dev_err(&pdev->dev, "unable to get usb_otg_ss_refclk960m\n");
+-              return PTR_ERR(phy->optclk);
+-      }
+-      clk_prepare(phy->optclk);
+-
+-      phy->sys_clk = devm_clk_get(phy->dev, "sys_clkin");
+-      if (IS_ERR(phy->sys_clk)) {
+-              pr_err("%s: unable to get sys_clkin\n", __func__);
+-              return -EINVAL;
+-      }
+-
+-      phy->control_dev = omap_get_control_dev();
+-      if (IS_ERR(phy->control_dev)) {
+-              dev_dbg(&pdev->dev, "Failed to get control device\n");
+-              return -ENODEV;
+-      }
+-
+-      omap_control_usb3_phy_power(phy->control_dev, 0);
+-      usb_add_phy_dev(&phy->phy);
+-
+-      platform_set_drvdata(pdev, phy);
+-
+-      pm_runtime_enable(phy->dev);
+-      pm_runtime_get(&pdev->dev);
+-
+-      return 0;
+-}
+-
+-static int omap_usb3_remove(struct platform_device *pdev)
+-{
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-
+-      clk_unprepare(phy->wkupclk);
+-      clk_unprepare(phy->optclk);
+-      usb_remove_phy(&phy->phy);
+-      if (!pm_runtime_suspended(&pdev->dev))
+-              pm_runtime_put(&pdev->dev);
+-      pm_runtime_disable(&pdev->dev);
+-
+-      return 0;
+-}
+-
+-#ifdef CONFIG_PM_RUNTIME
+-
+-static int omap_usb3_runtime_suspend(struct device *dev)
+-{
+-      struct platform_device  *pdev = to_platform_device(dev);
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-
+-      clk_disable(phy->wkupclk);
+-      clk_disable(phy->optclk);
+-
+-      return 0;
+-}
+-
+-static int omap_usb3_runtime_resume(struct device *dev)
+-{
+-      u32 ret = 0;
+-      struct platform_device  *pdev = to_platform_device(dev);
+-      struct omap_usb *phy = platform_get_drvdata(pdev);
+-
+-      ret = clk_enable(phy->optclk);
+-      if (ret) {
+-              dev_err(phy->dev, "Failed to enable optclk %d\n", ret);
+-              goto err1;
+-      }
+-
+-      ret = clk_enable(phy->wkupclk);
+-      if (ret) {
+-              dev_err(phy->dev, "Failed to enable wkupclk %d\n", ret);
+-              goto err2;
+-      }
+-
+-      return 0;
+-
+-err2:
+-      clk_disable(phy->optclk);
+-
+-err1:
+-      return ret;
+-}
+-
+-static const struct dev_pm_ops omap_usb3_pm_ops = {
+-      SET_RUNTIME_PM_OPS(omap_usb3_runtime_suspend, omap_usb3_runtime_resume,
+-              NULL)
+-};
+-
+-#define DEV_PM_OPS     (&omap_usb3_pm_ops)
+-#else
+-#define DEV_PM_OPS     NULL
+-#endif
+-
+-#ifdef CONFIG_OF
+-static const struct of_device_id omap_usb3_id_table[] = {
+-      { .compatible = "ti,omap-usb3" },
+-      {}
+-};
+-MODULE_DEVICE_TABLE(of, omap_usb3_id_table);
+-#endif
+-
+-static struct platform_driver omap_usb3_driver = {
+-      .probe          = omap_usb3_probe,
+-      .remove         = omap_usb3_remove,
+-      .driver         = {
+-              .name   = "omap-usb3",
+-              .owner  = THIS_MODULE,
+-              .pm     = DEV_PM_OPS,
+-              .of_match_table = of_match_ptr(omap_usb3_id_table),
+-      },
+-};
+-
+-module_platform_driver(omap_usb3_driver);
+-
+-MODULE_ALIAS("platform: omap_usb3");
+-MODULE_AUTHOR("Texas Instruments Inc.");
+-MODULE_DESCRIPTION("OMAP USB3 phy driver");
+-MODULE_LICENSE("GPL v2");
+--- /dev/null
++++ b/drivers/usb/phy/phy-rcar-gen2-usb.c
+@@ -0,0 +1,248 @@
++/*
++ * Renesas R-Car Gen2 USB phy driver
++ *
++ * Copyright (C) 2013 Renesas Solutions Corp.
++ * Copyright (C) 2013 Cogent Embedded, Inc.
++ *
++ * 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.
++ */
++
++#include <linux/clk.h>
++#include <linux/delay.h>
++#include <linux/io.h>
++#include <linux/module.h>
++#include <linux/platform_data/usb-rcar-gen2-phy.h>
++#include <linux/platform_device.h>
++#include <linux/spinlock.h>
++#include <linux/usb/otg.h>
++
++struct rcar_gen2_usb_phy_priv {
++      struct usb_phy phy;
++      void __iomem *base;
++      struct clk *clk;
++      spinlock_t lock;
++      int usecount;
++      u32 ugctrl2;
++};
++
++#define usb_phy_to_priv(p) container_of(p, struct rcar_gen2_usb_phy_priv, phy)
++
++/* Low Power Status register */
++#define USBHS_LPSTS_REG                       0x02
++#define USBHS_LPSTS_SUSPM             (1 << 14)
++
++/* USB General control register */
++#define USBHS_UGCTRL_REG              0x80
++#define USBHS_UGCTRL_CONNECT          (1 << 2)
++#define USBHS_UGCTRL_PLLRESET         (1 << 0)
++
++/* USB General control register 2 */
++#define USBHS_UGCTRL2_REG             0x84
++#define USBHS_UGCTRL2_USB0_PCI                (1 << 4)
++#define USBHS_UGCTRL2_USB0_HS         (3 << 4)
++#define USBHS_UGCTRL2_USB2_PCI                (0 << 31)
++#define USBHS_UGCTRL2_USB2_SS         (1 << 31)
++
++/* USB General status register */
++#define USBHS_UGSTS_REG                       0x88
++#define USBHS_UGSTS_LOCK              (3 << 8)
++
++/* Enable USBHS internal phy */
++static int __rcar_gen2_usbhs_phy_enable(void __iomem *base)
++{
++      u32 val;
++      int i;
++
++      /* USBHS PHY power on */
++      val = ioread32(base + USBHS_UGCTRL_REG);
++      val &= ~USBHS_UGCTRL_PLLRESET;
++      iowrite32(val, base + USBHS_UGCTRL_REG);
++
++      val = ioread16(base + USBHS_LPSTS_REG);
++      val |= USBHS_LPSTS_SUSPM;
++      iowrite16(val, base + USBHS_LPSTS_REG);
++
++      for (i = 0; i < 20; i++) {
++              val = ioread32(base + USBHS_UGSTS_REG);
++              if ((val & USBHS_UGSTS_LOCK) == USBHS_UGSTS_LOCK) {
++                      val = ioread32(base + USBHS_UGCTRL_REG);
++                      val |= USBHS_UGCTRL_CONNECT;
++                      iowrite32(val, base + USBHS_UGCTRL_REG);
++                      return 0;
++              }
++              udelay(1);
++      }
++
++      /* Timed out waiting for the PLL lock */
++      return -ETIMEDOUT;
++}
++
++/* Disable USBHS internal phy */
++static int __rcar_gen2_usbhs_phy_disable(void __iomem *base)
++{
++      u32 val;
++
++      /* USBHS PHY power off */
++      val = ioread32(base + USBHS_UGCTRL_REG);
++      val &= ~USBHS_UGCTRL_CONNECT;
++      iowrite32(val, base + USBHS_UGCTRL_REG);
++
++      val = ioread16(base + USBHS_LPSTS_REG);
++      val &= ~USBHS_LPSTS_SUSPM;
++      iowrite16(val, base + USBHS_LPSTS_REG);
++
++      val = ioread32(base + USBHS_UGCTRL_REG);
++      val |= USBHS_UGCTRL_PLLRESET;
++      iowrite32(val, base + USBHS_UGCTRL_REG);
++      return 0;
++}
++
++/* Setup USB channels */
++static void __rcar_gen2_usb_phy_init(struct rcar_gen2_usb_phy_priv *priv)
++{
++      u32 val;
++
++      clk_prepare_enable(priv->clk);
++
++      /* Set USB channels in the USBHS UGCTRL2 register */
++      val = ioread32(priv->base);
++      val &= ~(USBHS_UGCTRL2_USB0_HS | USBHS_UGCTRL2_USB2_SS);
++      val |= priv->ugctrl2;
++      iowrite32(val, priv->base);
++}
++
++/* Shutdown USB channels */
++static void __rcar_gen2_usb_phy_shutdown(struct rcar_gen2_usb_phy_priv *priv)
++{
++      __rcar_gen2_usbhs_phy_disable(priv->base);
++      clk_disable_unprepare(priv->clk);
++}
++
++static int rcar_gen2_usb_phy_set_suspend(struct usb_phy *phy, int suspend)
++{
++      struct rcar_gen2_usb_phy_priv *priv = usb_phy_to_priv(phy);
++      unsigned long flags;
++      int retval;
++
++      spin_lock_irqsave(&priv->lock, flags);
++      retval = suspend ? __rcar_gen2_usbhs_phy_disable(priv->base) :
++                         __rcar_gen2_usbhs_phy_enable(priv->base);
++      spin_unlock_irqrestore(&priv->lock, flags);
++      return retval;
++}
++
++static int rcar_gen2_usb_phy_init(struct usb_phy *phy)
++{
++      struct rcar_gen2_usb_phy_priv *priv = usb_phy_to_priv(phy);
++      unsigned long flags;
++
++      spin_lock_irqsave(&priv->lock, flags);
++      /*
++       * Enable the clock and setup USB channels
++       * if it's the first user
++       */
++      if (!priv->usecount++)
++              __rcar_gen2_usb_phy_init(priv);
++      spin_unlock_irqrestore(&priv->lock, flags);
++      return 0;
++}
++
++static void rcar_gen2_usb_phy_shutdown(struct usb_phy *phy)
++{
++      struct rcar_gen2_usb_phy_priv *priv = usb_phy_to_priv(phy);
++      unsigned long flags;
++
++      spin_lock_irqsave(&priv->lock, flags);
++      if (!priv->usecount) {
++              dev_warn(phy->dev, "Trying to disable phy with 0 usecount\n");
++              goto out;
++      }
++
++      /* Disable everything if it's the last user */
++      if (!--priv->usecount)
++              __rcar_gen2_usb_phy_shutdown(priv);
++out:
++      spin_unlock_irqrestore(&priv->lock, flags);
++}
++
++static int rcar_gen2_usb_phy_probe(struct platform_device *pdev)
++{
++      struct device *dev = &pdev->dev;
++      struct rcar_gen2_phy_platform_data *pdata;
++      struct rcar_gen2_usb_phy_priv *priv;
++      struct resource *res;
++      void __iomem *base;
++      struct clk *clk;
++      int retval;
++
++      pdata = dev_get_platdata(&pdev->dev);
++      if (!pdata) {
++              dev_err(dev, "No platform data\n");
++              return -EINVAL;
++      }
++
++      clk = devm_clk_get(&pdev->dev, "usbhs");
++      if (IS_ERR(clk)) {
++              dev_err(&pdev->dev, "Can't get the clock\n");
++              return PTR_ERR(clk);
++      }
++
++      res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      base = devm_ioremap_resource(dev, res);
++      if (IS_ERR(base))
++              return PTR_ERR(base);
++
++      priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
++      if (!priv) {
++              dev_err(dev, "Memory allocation failed\n");
++              return -ENOMEM;
++      }
++
++      spin_lock_init(&priv->lock);
++      priv->clk = clk;
++      priv->base = base;
++      priv->ugctrl2 = pdata->chan0_pci ?
++                      USBHS_UGCTRL2_USB0_PCI : USBHS_UGCTRL2_USB0_HS;
++      priv->ugctrl2 |= pdata->chan2_pci ?
++                      USBHS_UGCTRL2_USB2_PCI : USBHS_UGCTRL2_USB2_SS;
++      priv->phy.dev = dev;
++      priv->phy.label = dev_name(dev);
++      priv->phy.init = rcar_gen2_usb_phy_init;
++      priv->phy.shutdown = rcar_gen2_usb_phy_shutdown;
++      priv->phy.set_suspend = rcar_gen2_usb_phy_set_suspend;
++
++      retval = usb_add_phy(&priv->phy, USB_PHY_TYPE_USB2);
++      if (retval < 0) {
++              dev_err(dev, "Failed to add USB phy\n");
++              return retval;
++      }
++
++      platform_set_drvdata(pdev, priv);
++
++      return retval;
++}
++
++static int rcar_gen2_usb_phy_remove(struct platform_device *pdev)
++{
++      struct rcar_gen2_usb_phy_priv *priv = platform_get_drvdata(pdev);
++
++      usb_remove_phy(&priv->phy);
++
++      return 0;
++}
++
++static struct platform_driver rcar_gen2_usb_phy_driver = {
++      .driver = {
++              .name = "usb_phy_rcar_gen2",
++      },
++      .probe = rcar_gen2_usb_phy_probe,
++      .remove = rcar_gen2_usb_phy_remove,
++};
++
++module_platform_driver(rcar_gen2_usb_phy_driver);
++
++MODULE_LICENSE("GPL v2");
++MODULE_DESCRIPTION("Renesas R-Car Gen2 USB phy");
++MODULE_AUTHOR("Valentine Barshak <valentine.barshak@cogentembedded.com>");
+--- a/drivers/usb/phy/phy-tegra-usb.c
++++ b/drivers/usb/phy/phy-tegra-usb.c
+@@ -1090,7 +1090,7 @@ static struct platform_driver tegra_usb_
+       .driver         = {
+               .name   = "tegra-phy",
+               .owner  = THIS_MODULE,
+-              .of_match_table = of_match_ptr(tegra_usb_phy_id_table),
++              .of_match_table = tegra_usb_phy_id_table,
+       },
+ };
+ module_platform_driver(tegra_usb_phy_driver);
+--- a/drivers/usb/phy/phy-twl4030-usb.c
++++ /dev/null
+@@ -1,794 +0,0 @@
+-/*
+- * twl4030_usb - TWL4030 USB transceiver, talking to OMAP OTG controller
+- *
+- * Copyright (C) 2004-2007 Texas Instruments
+- * Copyright (C) 2008 Nokia Corporation
+- * Contact: Felipe Balbi <felipe.balbi@nokia.com>
+- *
+- * 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+- *
+- * Current status:
+- *    - HS USB ULPI mode works.
+- *    - 3-pin mode support may be added in future.
+- */
+-
+-#include <linux/module.h>
+-#include <linux/init.h>
+-#include <linux/interrupt.h>
+-#include <linux/platform_device.h>
+-#include <linux/spinlock.h>
+-#include <linux/workqueue.h>
+-#include <linux/io.h>
+-#include <linux/delay.h>
+-#include <linux/usb/otg.h>
+-#include <linux/usb/musb-omap.h>
+-#include <linux/usb/ulpi.h>
+-#include <linux/i2c/twl.h>
+-#include <linux/regulator/consumer.h>
+-#include <linux/err.h>
+-#include <linux/slab.h>
+-
+-/* Register defines */
+-
+-#define MCPC_CTRL                     0x30
+-#define MCPC_CTRL_RTSOL                       (1 << 7)
+-#define MCPC_CTRL_EXTSWR              (1 << 6)
+-#define MCPC_CTRL_EXTSWC              (1 << 5)
+-#define MCPC_CTRL_VOICESW             (1 << 4)
+-#define MCPC_CTRL_OUT64K              (1 << 3)
+-#define MCPC_CTRL_RTSCTSSW            (1 << 2)
+-#define MCPC_CTRL_HS_UART             (1 << 0)
+-
+-#define MCPC_IO_CTRL                  0x33
+-#define MCPC_IO_CTRL_MICBIASEN                (1 << 5)
+-#define MCPC_IO_CTRL_CTS_NPU          (1 << 4)
+-#define MCPC_IO_CTRL_RXD_PU           (1 << 3)
+-#define MCPC_IO_CTRL_TXDTYP           (1 << 2)
+-#define MCPC_IO_CTRL_CTSTYP           (1 << 1)
+-#define MCPC_IO_CTRL_RTSTYP           (1 << 0)
+-
+-#define MCPC_CTRL2                    0x36
+-#define MCPC_CTRL2_MCPC_CK_EN         (1 << 0)
+-
+-#define OTHER_FUNC_CTRL                       0x80
+-#define OTHER_FUNC_CTRL_BDIS_ACON_EN  (1 << 4)
+-#define OTHER_FUNC_CTRL_FIVEWIRE_MODE (1 << 2)
+-
+-#define OTHER_IFC_CTRL                        0x83
+-#define OTHER_IFC_CTRL_OE_INT_EN      (1 << 6)
+-#define OTHER_IFC_CTRL_CEA2011_MODE   (1 << 5)
+-#define OTHER_IFC_CTRL_FSLSSERIALMODE_4PIN    (1 << 4)
+-#define OTHER_IFC_CTRL_HIZ_ULPI_60MHZ_OUT     (1 << 3)
+-#define OTHER_IFC_CTRL_HIZ_ULPI               (1 << 2)
+-#define OTHER_IFC_CTRL_ALT_INT_REROUTE        (1 << 0)
+-
+-#define OTHER_INT_EN_RISE             0x86
+-#define OTHER_INT_EN_FALL             0x89
+-#define OTHER_INT_STS                 0x8C
+-#define OTHER_INT_LATCH                       0x8D
+-#define OTHER_INT_VB_SESS_VLD         (1 << 7)
+-#define OTHER_INT_DM_HI                       (1 << 6) /* not valid for "latch" reg */
+-#define OTHER_INT_DP_HI                       (1 << 5) /* not valid for "latch" reg */
+-#define OTHER_INT_BDIS_ACON           (1 << 3) /* not valid for "fall" regs */
+-#define OTHER_INT_MANU                        (1 << 1)
+-#define OTHER_INT_ABNORMAL_STRESS     (1 << 0)
+-
+-#define ID_STATUS                     0x96
+-#define ID_RES_FLOAT                  (1 << 4)
+-#define ID_RES_440K                   (1 << 3)
+-#define ID_RES_200K                   (1 << 2)
+-#define ID_RES_102K                   (1 << 1)
+-#define ID_RES_GND                    (1 << 0)
+-
+-#define POWER_CTRL                    0xAC
+-#define POWER_CTRL_OTG_ENAB           (1 << 5)
+-
+-#define OTHER_IFC_CTRL2                       0xAF
+-#define OTHER_IFC_CTRL2_ULPI_STP_LOW  (1 << 4)
+-#define OTHER_IFC_CTRL2_ULPI_TXEN_POL (1 << 3)
+-#define OTHER_IFC_CTRL2_ULPI_4PIN_2430        (1 << 2)
+-#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_MASK   (3 << 0) /* bits 0 and 1 */
+-#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_INT1N  (0 << 0)
+-#define OTHER_IFC_CTRL2_USB_INT_OUTSEL_INT2N  (1 << 0)
+-
+-#define REG_CTRL_EN                   0xB2
+-#define REG_CTRL_ERROR                        0xB5
+-#define ULPI_I2C_CONFLICT_INTEN               (1 << 0)
+-
+-#define OTHER_FUNC_CTRL2              0xB8
+-#define OTHER_FUNC_CTRL2_VBAT_TIMER_EN        (1 << 0)
+-
+-/* following registers do not have separate _clr and _set registers */
+-#define VBUS_DEBOUNCE                 0xC0
+-#define ID_DEBOUNCE                   0xC1
+-#define VBAT_TIMER                    0xD3
+-#define PHY_PWR_CTRL                  0xFD
+-#define PHY_PWR_PHYPWD                        (1 << 0)
+-#define PHY_CLK_CTRL                  0xFE
+-#define PHY_CLK_CTRL_CLOCKGATING_EN   (1 << 2)
+-#define PHY_CLK_CTRL_CLK32K_EN                (1 << 1)
+-#define REQ_PHY_DPLL_CLK              (1 << 0)
+-#define PHY_CLK_CTRL_STS              0xFF
+-#define PHY_DPLL_CLK                  (1 << 0)
+-
+-/* In module TWL_MODULE_PM_MASTER */
+-#define STS_HW_CONDITIONS             0x0F
+-
+-/* In module TWL_MODULE_PM_RECEIVER */
+-#define VUSB_DEDICATED1                       0x7D
+-#define VUSB_DEDICATED2                       0x7E
+-#define VUSB1V5_DEV_GRP                       0x71
+-#define VUSB1V5_TYPE                  0x72
+-#define VUSB1V5_REMAP                 0x73
+-#define VUSB1V8_DEV_GRP                       0x74
+-#define VUSB1V8_TYPE                  0x75
+-#define VUSB1V8_REMAP                 0x76
+-#define VUSB3V1_DEV_GRP                       0x77
+-#define VUSB3V1_TYPE                  0x78
+-#define VUSB3V1_REMAP                 0x79
+-
+-/* In module TWL4030_MODULE_INTBR */
+-#define PMBR1                         0x0D
+-#define GPIO_USB_4PIN_ULPI_2430C      (3 << 0)
+-
+-struct twl4030_usb {
+-      struct usb_phy          phy;
+-      struct device           *dev;
+-
+-      /* TWL4030 internal USB regulator supplies */
+-      struct regulator        *usb1v5;
+-      struct regulator        *usb1v8;
+-      struct regulator        *usb3v1;
+-
+-      /* for vbus reporting with irqs disabled */
+-      spinlock_t              lock;
+-
+-      /* pin configuration */
+-      enum twl4030_usb_mode   usb_mode;
+-
+-      int                     irq;
+-      enum omap_musb_vbus_id_status linkstat;
+-      bool                    vbus_supplied;
+-      u8                      asleep;
+-      bool                    irq_enabled;
+-
+-      struct delayed_work     id_workaround_work;
+-};
+-
+-/* internal define on top of container_of */
+-#define phy_to_twl(x)         container_of((x), struct twl4030_usb, phy)
+-
+-/*-------------------------------------------------------------------------*/
+-
+-static int twl4030_i2c_write_u8_verify(struct twl4030_usb *twl,
+-              u8 module, u8 data, u8 address)
+-{
+-      u8 check;
+-
+-      if ((twl_i2c_write_u8(module, data, address) >= 0) &&
+-          (twl_i2c_read_u8(module, &check, address) >= 0) &&
+-                                              (check == data))
+-              return 0;
+-      dev_dbg(twl->dev, "Write%d[%d,0x%x] wrote %02x but read %02x\n",
+-                      1, module, address, check, data);
+-
+-      /* Failed once: Try again */
+-      if ((twl_i2c_write_u8(module, data, address) >= 0) &&
+-          (twl_i2c_read_u8(module, &check, address) >= 0) &&
+-                                              (check == data))
+-              return 0;
+-      dev_dbg(twl->dev, "Write%d[%d,0x%x] wrote %02x but read %02x\n",
+-                      2, module, address, check, data);
+-
+-      /* Failed again: Return error */
+-      return -EBUSY;
+-}
+-
+-#define twl4030_usb_write_verify(twl, address, data)  \
+-      twl4030_i2c_write_u8_verify(twl, TWL_MODULE_USB, (data), (address))
+-
+-static inline int twl4030_usb_write(struct twl4030_usb *twl,
+-              u8 address, u8 data)
+-{
+-      int ret = 0;
+-
+-      ret = twl_i2c_write_u8(TWL_MODULE_USB, data, address);
+-      if (ret < 0)
+-              dev_dbg(twl->dev,
+-                      "TWL4030:USB:Write[0x%x] Error %d\n", address, ret);
+-      return ret;
+-}
+-
+-static inline int twl4030_readb(struct twl4030_usb *twl, u8 module, u8 address)
+-{
+-      u8 data;
+-      int ret = 0;
+-
+-      ret = twl_i2c_read_u8(module, &data, address);
+-      if (ret >= 0)
+-              ret = data;
+-      else
+-              dev_dbg(twl->dev,
+-                      "TWL4030:readb[0x%x,0x%x] Error %d\n",
+-                                      module, address, ret);
+-
+-      return ret;
+-}
+-
+-static inline int twl4030_usb_read(struct twl4030_usb *twl, u8 address)
+-{
+-      return twl4030_readb(twl, TWL_MODULE_USB, address);
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-static inline int
+-twl4030_usb_set_bits(struct twl4030_usb *twl, u8 reg, u8 bits)
+-{
+-      return twl4030_usb_write(twl, ULPI_SET(reg), bits);
+-}
+-
+-static inline int
+-twl4030_usb_clear_bits(struct twl4030_usb *twl, u8 reg, u8 bits)
+-{
+-      return twl4030_usb_write(twl, ULPI_CLR(reg), bits);
+-}
+-
+-/*-------------------------------------------------------------------------*/
+-
+-static bool twl4030_is_driving_vbus(struct twl4030_usb *twl)
+-{
+-      int ret;
+-
+-      ret = twl4030_usb_read(twl, PHY_CLK_CTRL_STS);
+-      if (ret < 0 || !(ret & PHY_DPLL_CLK))
+-              /*
+-               * if clocks are off, registers are not updated,
+-               * but we can assume we don't drive VBUS in this case
+-               */
+-              return false;
+-
+-      ret = twl4030_usb_read(twl, ULPI_OTG_CTRL);
+-      if (ret < 0)
+-              return false;
+-
+-      return (ret & (ULPI_OTG_DRVVBUS | ULPI_OTG_CHRGVBUS)) ? true : false;
+-}
+-
+-static enum omap_musb_vbus_id_status
+-      twl4030_usb_linkstat(struct twl4030_usb *twl)
+-{
+-      int     status;
+-      enum omap_musb_vbus_id_status linkstat = OMAP_MUSB_UNKNOWN;
+-
+-      twl->vbus_supplied = false;
+-
+-      /*
+-       * For ID/VBUS sensing, see manual section 15.4.8 ...
+-       * except when using only battery backup power, two
+-       * comparators produce VBUS_PRES and ID_PRES signals,
+-       * which don't match docs elsewhere.  But ... BIT(7)
+-       * and BIT(2) of STS_HW_CONDITIONS, respectively, do
+-       * seem to match up.  If either is true the USB_PRES
+-       * signal is active, the OTG module is activated, and
+-       * its interrupt may be raised (may wake the system).
+-       */
+-      status = twl4030_readb(twl, TWL_MODULE_PM_MASTER, STS_HW_CONDITIONS);
+-      if (status < 0)
+-              dev_err(twl->dev, "USB link status err %d\n", status);
+-      else if (status & (BIT(7) | BIT(2))) {
+-              if (status & BIT(7)) {
+-                      if (twl4030_is_driving_vbus(twl))
+-                              status &= ~BIT(7);
+-                      else
+-                              twl->vbus_supplied = true;
+-              }
+-
+-              if (status & BIT(2))
+-                      linkstat = OMAP_MUSB_ID_GROUND;
+-              else if (status & BIT(7))
+-                      linkstat = OMAP_MUSB_VBUS_VALID;
+-              else
+-                      linkstat = OMAP_MUSB_VBUS_OFF;
+-      } else {
+-              if (twl->linkstat != OMAP_MUSB_UNKNOWN)
+-                      linkstat = OMAP_MUSB_VBUS_OFF;
+-      }
+-
+-      dev_dbg(twl->dev, "HW_CONDITIONS 0x%02x/%d; link %d\n",
+-                      status, status, linkstat);
+-
+-      /* REVISIT this assumes host and peripheral controllers
+-       * are registered, and that both are active...
+-       */
+-
+-      return linkstat;
+-}
+-
+-static void twl4030_usb_set_mode(struct twl4030_usb *twl, int mode)
+-{
+-      twl->usb_mode = mode;
+-
+-      switch (mode) {
+-      case T2_USB_MODE_ULPI:
+-              twl4030_usb_clear_bits(twl, ULPI_IFC_CTRL,
+-                                      ULPI_IFC_CTRL_CARKITMODE);
+-              twl4030_usb_set_bits(twl, POWER_CTRL, POWER_CTRL_OTG_ENAB);
+-              twl4030_usb_clear_bits(twl, ULPI_FUNC_CTRL,
+-                                      ULPI_FUNC_CTRL_XCVRSEL_MASK |
+-                                      ULPI_FUNC_CTRL_OPMODE_MASK);
+-              break;
+-      case -1:
+-              /* FIXME: power on defaults */
+-              break;
+-      default:
+-              dev_err(twl->dev, "unsupported T2 transceiver mode %d\n",
+-                              mode);
+-              break;
+-      };
+-}
+-
+-static void twl4030_i2c_access(struct twl4030_usb *twl, int on)
+-{
+-      unsigned long timeout;
+-      int val = twl4030_usb_read(twl, PHY_CLK_CTRL);
+-
+-      if (val >= 0) {
+-              if (on) {
+-                      /* enable DPLL to access PHY registers over I2C */
+-                      val |= REQ_PHY_DPLL_CLK;
+-                      WARN_ON(twl4030_usb_write_verify(twl, PHY_CLK_CTRL,
+-                                              (u8)val) < 0);
+-
+-                      timeout = jiffies + HZ;
+-                      while (!(twl4030_usb_read(twl, PHY_CLK_CTRL_STS) &
+-                                                      PHY_DPLL_CLK)
+-                              && time_before(jiffies, timeout))
+-                                      udelay(10);
+-                      if (!(twl4030_usb_read(twl, PHY_CLK_CTRL_STS) &
+-                                                      PHY_DPLL_CLK))
+-                              dev_err(twl->dev, "Timeout setting T2 HSUSB "
+-                                              "PHY DPLL clock\n");
+-              } else {
+-                      /* let ULPI control the DPLL clock */
+-                      val &= ~REQ_PHY_DPLL_CLK;
+-                      WARN_ON(twl4030_usb_write_verify(twl, PHY_CLK_CTRL,
+-                                              (u8)val) < 0);
+-              }
+-      }
+-}
+-
+-static void __twl4030_phy_power(struct twl4030_usb *twl, int on)
+-{
+-      u8 pwr = twl4030_usb_read(twl, PHY_PWR_CTRL);
+-
+-      if (on)
+-              pwr &= ~PHY_PWR_PHYPWD;
+-      else
+-              pwr |= PHY_PWR_PHYPWD;
+-
+-      WARN_ON(twl4030_usb_write_verify(twl, PHY_PWR_CTRL, pwr) < 0);
+-}
+-
+-static void twl4030_phy_power(struct twl4030_usb *twl, int on)
+-{
+-      int ret;
+-
+-      if (on) {
+-              ret = regulator_enable(twl->usb3v1);
+-              if (ret)
+-                      dev_err(twl->dev, "Failed to enable usb3v1\n");
+-
+-              ret = regulator_enable(twl->usb1v8);
+-              if (ret)
+-                      dev_err(twl->dev, "Failed to enable usb1v8\n");
+-
+-              /*
+-               * Disabling usb3v1 regulator (= writing 0 to VUSB3V1_DEV_GRP
+-               * in twl4030) resets the VUSB_DEDICATED2 register. This reset
+-               * enables VUSB3V1_SLEEP bit that remaps usb3v1 ACTIVE state to
+-               * SLEEP. We work around this by clearing the bit after usv3v1
+-               * is re-activated. This ensures that VUSB3V1 is really active.
+-               */
+-              twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB_DEDICATED2);
+-
+-              ret = regulator_enable(twl->usb1v5);
+-              if (ret)
+-                      dev_err(twl->dev, "Failed to enable usb1v5\n");
+-
+-              __twl4030_phy_power(twl, 1);
+-              twl4030_usb_write(twl, PHY_CLK_CTRL,
+-                                twl4030_usb_read(twl, PHY_CLK_CTRL) |
+-                                      (PHY_CLK_CTRL_CLOCKGATING_EN |
+-                                              PHY_CLK_CTRL_CLK32K_EN));
+-      } else {
+-              __twl4030_phy_power(twl, 0);
+-              regulator_disable(twl->usb1v5);
+-              regulator_disable(twl->usb1v8);
+-              regulator_disable(twl->usb3v1);
+-      }
+-}
+-
+-static void twl4030_phy_suspend(struct twl4030_usb *twl, int controller_off)
+-{
+-      if (twl->asleep)
+-              return;
+-
+-      twl4030_phy_power(twl, 0);
+-      twl->asleep = 1;
+-      dev_dbg(twl->dev, "%s\n", __func__);
+-}
+-
+-static void __twl4030_phy_resume(struct twl4030_usb *twl)
+-{
+-      twl4030_phy_power(twl, 1);
+-      twl4030_i2c_access(twl, 1);
+-      twl4030_usb_set_mode(twl, twl->usb_mode);
+-      if (twl->usb_mode == T2_USB_MODE_ULPI)
+-              twl4030_i2c_access(twl, 0);
+-}
+-
+-static void twl4030_phy_resume(struct twl4030_usb *twl)
+-{
+-      if (!twl->asleep)
+-              return;
+-      __twl4030_phy_resume(twl);
+-      twl->asleep = 0;
+-      dev_dbg(twl->dev, "%s\n", __func__);
+-
+-      /*
+-       * XXX When VBUS gets driven after musb goes to A mode,
+-       * ID_PRES related interrupts no longer arrive, why?
+-       * Register itself is updated fine though, so we must poll.
+-       */
+-      if (twl->linkstat == OMAP_MUSB_ID_GROUND) {
+-              cancel_delayed_work(&twl->id_workaround_work);
+-              schedule_delayed_work(&twl->id_workaround_work, HZ);
+-      }
+-}
+-
+-static int twl4030_usb_ldo_init(struct twl4030_usb *twl)
+-{
+-      /* Enable writing to power configuration registers */
+-      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG1,
+-                       TWL4030_PM_MASTER_PROTECT_KEY);
+-
+-      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG2,
+-                       TWL4030_PM_MASTER_PROTECT_KEY);
+-
+-      /* Keep VUSB3V1 LDO in sleep state until VBUS/ID change detected*/
+-      /*twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB_DEDICATED2);*/
+-
+-      /* input to VUSB3V1 LDO is from VBAT, not VBUS */
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0x14, VUSB_DEDICATED1);
+-
+-      /* Initialize 3.1V regulator */
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB3V1_DEV_GRP);
+-
+-      twl->usb3v1 = devm_regulator_get(twl->dev, "usb3v1");
+-      if (IS_ERR(twl->usb3v1))
+-              return -ENODEV;
+-
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB3V1_TYPE);
+-
+-      /* Initialize 1.5V regulator */
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V5_DEV_GRP);
+-
+-      twl->usb1v5 = devm_regulator_get(twl->dev, "usb1v5");
+-      if (IS_ERR(twl->usb1v5))
+-              return -ENODEV;
+-
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V5_TYPE);
+-
+-      /* Initialize 1.8V regulator */
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V8_DEV_GRP);
+-
+-      twl->usb1v8 = devm_regulator_get(twl->dev, "usb1v8");
+-      if (IS_ERR(twl->usb1v8))
+-              return -ENODEV;
+-
+-      twl_i2c_write_u8(TWL_MODULE_PM_RECEIVER, 0, VUSB1V8_TYPE);
+-
+-      /* disable access to power configuration registers */
+-      twl_i2c_write_u8(TWL_MODULE_PM_MASTER, 0,
+-                       TWL4030_PM_MASTER_PROTECT_KEY);
+-
+-      return 0;
+-}
+-
+-static ssize_t twl4030_usb_vbus_show(struct device *dev,
+-              struct device_attribute *attr, char *buf)
+-{
+-      struct twl4030_usb *twl = dev_get_drvdata(dev);
+-      unsigned long flags;
+-      int ret = -EINVAL;
+-
+-      spin_lock_irqsave(&twl->lock, flags);
+-      ret = sprintf(buf, "%s\n",
+-                      twl->vbus_supplied ? "on" : "off");
+-      spin_unlock_irqrestore(&twl->lock, flags);
+-
+-      return ret;
+-}
+-static DEVICE_ATTR(vbus, 0444, twl4030_usb_vbus_show, NULL);
+-
+-static irqreturn_t twl4030_usb_irq(int irq, void *_twl)
+-{
+-      struct twl4030_usb *twl = _twl;
+-      enum omap_musb_vbus_id_status status;
+-      bool status_changed = false;
+-
+-      status = twl4030_usb_linkstat(twl);
+-
+-      spin_lock_irq(&twl->lock);
+-      if (status >= 0 && status != twl->linkstat) {
+-              twl->linkstat = status;
+-              status_changed = true;
+-      }
+-      spin_unlock_irq(&twl->lock);
+-
+-      if (status_changed) {
+-              /* FIXME add a set_power() method so that B-devices can
+-               * configure the charger appropriately.  It's not always
+-               * correct to consume VBUS power, and how much current to
+-               * consume is a function of the USB configuration chosen
+-               * by the host.
+-               *
+-               * REVISIT usb_gadget_vbus_connect(...) as needed, ditto
+-               * its disconnect() sibling, when changing to/from the
+-               * USB_LINK_VBUS state.  musb_hdrc won't care until it
+-               * starts to handle softconnect right.
+-               */
+-              omap_musb_mailbox(status);
+-      }
+-      sysfs_notify(&twl->dev->kobj, NULL, "vbus");
+-
+-      return IRQ_HANDLED;
+-}
+-
+-static void twl4030_id_workaround_work(struct work_struct *work)
+-{
+-      struct twl4030_usb *twl = container_of(work, struct twl4030_usb,
+-              id_workaround_work.work);
+-      enum omap_musb_vbus_id_status status;
+-      bool status_changed = false;
+-
+-      status = twl4030_usb_linkstat(twl);
+-
+-      spin_lock_irq(&twl->lock);
+-      if (status >= 0 && status != twl->linkstat) {
+-              twl->linkstat = status;
+-              status_changed = true;
+-      }
+-      spin_unlock_irq(&twl->lock);
+-
+-      if (status_changed) {
+-              dev_dbg(twl->dev, "handle missing status change to %d\n",
+-                              status);
+-              omap_musb_mailbox(status);
+-      }
+-
+-      /* don't schedule during sleep - irq works right then */
+-      if (status == OMAP_MUSB_ID_GROUND && !twl->asleep) {
+-              cancel_delayed_work(&twl->id_workaround_work);
+-              schedule_delayed_work(&twl->id_workaround_work, HZ);
+-      }
+-}
+-
+-static int twl4030_usb_phy_init(struct usb_phy *phy)
+-{
+-      struct twl4030_usb *twl = phy_to_twl(phy);
+-      enum omap_musb_vbus_id_status status;
+-
+-      /*
+-       * Start in sleep state, we'll get called through set_suspend()
+-       * callback when musb is runtime resumed and it's time to start.
+-       */
+-      __twl4030_phy_power(twl, 0);
+-      twl->asleep = 1;
+-
+-      status = twl4030_usb_linkstat(twl);
+-      twl->linkstat = status;
+-
+-      if (status == OMAP_MUSB_ID_GROUND || status == OMAP_MUSB_VBUS_VALID)
+-              omap_musb_mailbox(twl->linkstat);
+-
+-      sysfs_notify(&twl->dev->kobj, NULL, "vbus");
+-      return 0;
+-}
+-
+-static int twl4030_set_suspend(struct usb_phy *x, int suspend)
+-{
+-      struct twl4030_usb *twl = phy_to_twl(x);
+-
+-      if (suspend)
+-              twl4030_phy_suspend(twl, 1);
+-      else
+-              twl4030_phy_resume(twl);
+-
+-      return 0;
+-}
+-
+-static int twl4030_set_peripheral(struct usb_otg *otg,
+-                                      struct usb_gadget *gadget)
+-{
+-      if (!otg)
+-              return -ENODEV;
+-
+-      otg->gadget = gadget;
+-      if (!gadget)
+-              otg->phy->state = OTG_STATE_UNDEFINED;
+-
+-      return 0;
+-}
+-
+-static int twl4030_set_host(struct usb_otg *otg, struct usb_bus *host)
+-{
+-      if (!otg)
+-              return -ENODEV;
+-
+-      otg->host = host;
+-      if (!host)
+-              otg->phy->state = OTG_STATE_UNDEFINED;
+-
+-      return 0;
+-}
+-
+-static int twl4030_usb_probe(struct platform_device *pdev)
+-{
+-      struct twl4030_usb_data *pdata = dev_get_platdata(&pdev->dev);
+-      struct twl4030_usb      *twl;
+-      int                     status, err;
+-      struct usb_otg          *otg;
+-      struct device_node      *np = pdev->dev.of_node;
+-
+-      twl = devm_kzalloc(&pdev->dev, sizeof *twl, GFP_KERNEL);
+-      if (!twl)
+-              return -ENOMEM;
+-
+-      if (np)
+-              of_property_read_u32(np, "usb_mode",
+-                              (enum twl4030_usb_mode *)&twl->usb_mode);
+-      else if (pdata)
+-              twl->usb_mode = pdata->usb_mode;
+-      else {
+-              dev_err(&pdev->dev, "twl4030 initialized without pdata\n");
+-              return -EINVAL;
+-      }
+-
+-      otg = devm_kzalloc(&pdev->dev, sizeof *otg, GFP_KERNEL);
+-      if (!otg)
+-              return -ENOMEM;
+-
+-      twl->dev                = &pdev->dev;
+-      twl->irq                = platform_get_irq(pdev, 0);
+-      twl->vbus_supplied      = false;
+-      twl->asleep             = 1;
+-      twl->linkstat           = OMAP_MUSB_UNKNOWN;
+-
+-      twl->phy.dev            = twl->dev;
+-      twl->phy.label          = "twl4030";
+-      twl->phy.otg            = otg;
+-      twl->phy.type           = USB_PHY_TYPE_USB2;
+-      twl->phy.set_suspend    = twl4030_set_suspend;
+-      twl->phy.init           = twl4030_usb_phy_init;
+-
+-      otg->phy                = &twl->phy;
+-      otg->set_host           = twl4030_set_host;
+-      otg->set_peripheral     = twl4030_set_peripheral;
+-
+-      /* init spinlock for workqueue */
+-      spin_lock_init(&twl->lock);
+-
+-      INIT_DELAYED_WORK(&twl->id_workaround_work, twl4030_id_workaround_work);
+-
+-      err = twl4030_usb_ldo_init(twl);
+-      if (err) {
+-              dev_err(&pdev->dev, "ldo init failed\n");
+-              return err;
+-      }
+-      usb_add_phy_dev(&twl->phy);
+-
+-      platform_set_drvdata(pdev, twl);
+-      if (device_create_file(&pdev->dev, &dev_attr_vbus))
+-              dev_warn(&pdev->dev, "could not create sysfs file\n");
+-
+-      /* Our job is to use irqs and status from the power module
+-       * to keep the transceiver disabled when nothing's connected.
+-       *
+-       * FIXME we actually shouldn't start enabling it until the
+-       * USB controller drivers have said they're ready, by calling
+-       * set_host() and/or set_peripheral() ... OTG_capable boards
+-       * need both handles, otherwise just one suffices.
+-       */
+-      twl->irq_enabled = true;
+-      status = devm_request_threaded_irq(twl->dev, twl->irq, NULL,
+-                      twl4030_usb_irq, IRQF_TRIGGER_FALLING |
+-                      IRQF_TRIGGER_RISING | IRQF_ONESHOT, "twl4030_usb", twl);
+-      if (status < 0) {
+-              dev_dbg(&pdev->dev, "can't get IRQ %d, err %d\n",
+-                      twl->irq, status);
+-              return status;
+-      }
+-
+-      dev_info(&pdev->dev, "Initialized TWL4030 USB module\n");
+-      return 0;
+-}
+-
+-static int twl4030_usb_remove(struct platform_device *pdev)
+-{
+-      struct twl4030_usb *twl = platform_get_drvdata(pdev);
+-      int val;
+-
+-      cancel_delayed_work(&twl->id_workaround_work);
+-      device_remove_file(twl->dev, &dev_attr_vbus);
+-
+-      /* set transceiver mode to power on defaults */
+-      twl4030_usb_set_mode(twl, -1);
+-
+-      /* autogate 60MHz ULPI clock,
+-       * clear dpll clock request for i2c access,
+-       * disable 32KHz
+-       */
+-      val = twl4030_usb_read(twl, PHY_CLK_CTRL);
+-      if (val >= 0) {
+-              val |= PHY_CLK_CTRL_CLOCKGATING_EN;
+-              val &= ~(PHY_CLK_CTRL_CLK32K_EN | REQ_PHY_DPLL_CLK);
+-              twl4030_usb_write(twl, PHY_CLK_CTRL, (u8)val);
+-      }
+-
+-      /* disable complete OTG block */
+-      twl4030_usb_clear_bits(twl, POWER_CTRL, POWER_CTRL_OTG_ENAB);
+-
+-      if (!twl->asleep)
+-              twl4030_phy_power(twl, 0);
+-
+-      return 0;
+-}
+-
+-#ifdef CONFIG_OF
+-static const struct of_device_id twl4030_usb_id_table[] = {
+-      { .compatible = "ti,twl4030-usb" },
+-      {}
+-};
+-MODULE_DEVICE_TABLE(of, twl4030_usb_id_table);
+-#endif
+-
+-static struct platform_driver twl4030_usb_driver = {
+-      .probe          = twl4030_usb_probe,
+-      .remove         = twl4030_usb_remove,
+-      .driver         = {
+-              .name   = "twl4030_usb",
+-              .owner  = THIS_MODULE,
+-              .of_match_table = of_match_ptr(twl4030_usb_id_table),
+-      },
+-};
+-
+-static int __init twl4030_usb_init(void)
+-{
+-      return platform_driver_register(&twl4030_usb_driver);
+-}
+-subsys_initcall(twl4030_usb_init);
+-
+-static void __exit twl4030_usb_exit(void)
+-{
+-      platform_driver_unregister(&twl4030_usb_driver);
+-}
+-module_exit(twl4030_usb_exit);
+-
+-MODULE_ALIAS("platform:twl4030_usb");
+-MODULE_AUTHOR("Texas Instruments, Inc, Nokia Corporation");
+-MODULE_DESCRIPTION("TWL4030 USB transceiver driver");
+-MODULE_LICENSE("GPL");
+--- a/drivers/usb/phy/phy-twl6030-usb.c
++++ b/drivers/usb/phy/phy-twl6030-usb.c
+@@ -26,13 +26,14 @@
+ #include <linux/platform_device.h>
+ #include <linux/io.h>
+ #include <linux/usb/musb-omap.h>
++#include <linux/phy/omap_usb.h>
+ #include <linux/usb/phy_companion.h>
+-#include <linux/usb/omap_usb.h>
+ #include <linux/i2c/twl.h>
+ #include <linux/regulator/consumer.h>
+ #include <linux/err.h>
+ #include <linux/slab.h>
+ #include <linux/delay.h>
++#include <linux/of.h>
+ /* usb register definitions */
+ #define USB_VENDOR_ID_LSB             0x00
+--- a/drivers/video/da8xx-fb.c
++++ b/drivers/video/da8xx-fb.c
+@@ -19,6 +19,9 @@
+  * along with this program; if not, write to the Free Software
+  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+  */
++
++#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
++
+ #include <linux/module.h>
+ #include <linux/kernel.h>
+ #include <linux/fb.h>
+@@ -36,9 +39,16 @@
+ #include <linux/slab.h>
+ #include <linux/delay.h>
+ #include <linux/lcm.h>
++#include <video/of_display_timing.h>
+ #include <video/da8xx-fb.h>
++
++#ifdef CONFIG_FB_DA8XX_TDA998X
++#include <video/da8xx-tda998x-hdmi.h>
++#endif
++
+ #include <asm/div64.h>
++
+ #define DRIVER_NAME "da8xx_lcdc"
+ #define LCD_VERSION_1 1
+@@ -141,6 +151,32 @@ static irq_handler_t lcdc_irq_handler;
+ static wait_queue_head_t frame_done_wq;
+ static int frame_done_flag;
++static LIST_HEAD(encoder_modules);
++
++void da8xx_register_encoder(struct da8xx_encoder *encoder)
++{
++      INIT_LIST_HEAD(&encoder->list);
++      list_add(&encoder->list, &encoder_modules);
++}
++EXPORT_SYMBOL(da8xx_register_encoder);
++
++void da8xx_unregister_encoder(struct da8xx_encoder *encoder)
++{
++      list_del(&encoder->list);
++}
++EXPORT_SYMBOL(da8xx_unregister_encoder);
++
++
++struct da8xx_encoder *da8xx_get_encoder_from_phandle(struct device_node *node)
++{
++      struct da8xx_encoder *entry;
++      list_for_each_entry(entry, &encoder_modules, list)
++              if (entry->node == node)
++                      return entry;
++
++      return 0;
++}
++
+ static unsigned int lcdc_read(unsigned int addr)
+ {
+       return (unsigned int)__raw_readl(da8xx_fb_reg_base + (addr));
+@@ -161,6 +197,7 @@ struct da8xx_fb_par {
+       unsigned int            dma_start;
+       unsigned int            dma_end;
+       struct clk *lcdc_clk;
++      struct clk *disp_clk;
+       int irq;
+       unsigned int palette_sz;
+       int blank;
+@@ -182,6 +219,7 @@ struct da8xx_fb_par {
+       u32 pseudo_palette[16];
+       struct fb_videomode     mode;
+       struct lcd_ctrl_config  cfg;
++      struct device_node *hdmi_node;
+ };
+ static struct fb_var_screeninfo da8xx_fb_var;
+@@ -197,6 +235,9 @@ static struct fb_fix_screeninfo da8xx_fb
+       .accel = FB_ACCEL_NONE
+ };
++static vsync_callback_t vsync_cb_handler;
++static void *vsync_cb_arg;
++
+ static struct fb_videomode known_lcd_panels[] = {
+       /* Sharp LCD035Q3DG01 */
+       [0] = {
+@@ -730,8 +771,8 @@ static int da8xx_fb_config_clk_divider(s
+ }
+ static unsigned int da8xx_fb_calc_clk_divider(struct da8xx_fb_par *par,
+-                                            unsigned pixclock,
+-                                            unsigned *lcdc_clk_rate)
++                            unsigned pixclock,
++                            unsigned *lcdc_clk_rate)
+ {
+       unsigned lcdc_clk_div;
+@@ -765,7 +806,7 @@ static int da8xx_fb_calc_config_clk_divi
+ }
+ static unsigned da8xx_fb_round_clk(struct da8xx_fb_par *par,
+-                                        unsigned pixclock)
++                                unsigned pixclock)
+ {
+       unsigned lcdc_clk_div, lcdc_clk_rate;
+@@ -778,11 +819,53 @@ static int lcd_init(struct da8xx_fb_par
+ {
+       u32 bpp;
+       int ret = 0;
++      struct da8xx_encoder *enc = 0;
+-      ret = da8xx_fb_calc_config_clk_divider(par, panel);
+-      if (IS_ERR_VALUE(ret)) {
+-              dev_err(par->dev, "unable to configure clock\n");
+-              return ret;
++      if (IS_ENABLED(CONFIG_FB_DA8XX_TDA998X) && par->hdmi_node) {
++              unsigned int div = 0;
++              unsigned long pixclock = 0;
++
++              pr_debug("pixclock from panel %d\n", panel->pixclock);
++              pixclock = PICOS2KHZ(panel->pixclock) * 1000;
++              pr_debug("pixclock converted to hz %ld\n", pixclock);
++              /* remove any rounding errors as this seems to mess up clk */
++              pixclock = (pixclock/10000)*10000;
++              pr_debug("rounded clock rate %ld\n",
++                      clk_round_rate(par->lcdc_clk, pixclock*2));
++              /* in raster mode, minimum divisor is 2: */
++              ret = clk_set_rate(par->disp_clk, pixclock * 2);
++              if (IS_ERR_VALUE(ret)) {
++                      dev_err(par->dev, "failed to set display clock rate to: %ld\n",
++                              pixclock);
++                      return ret;
++              }
++
++              par->lcdc_clk_rate = clk_get_rate(par->lcdc_clk);
++              div = par->lcdc_clk_rate / pixclock;
++
++              pr_debug("lcd_clk=%u, mode clock=%ld, div=%u\n",
++                      par->lcdc_clk_rate, pixclock, div);
++              pr_debug("fck=%lu, dpll_disp_ck=%lu\n",
++                      clk_get_rate(par->lcdc_clk),
++                      clk_get_rate(par->disp_clk));
++
++              /* Configure the LCD clock divisor. */
++              lcdc_write(LCD_CLK_DIVISOR(div) |
++                      (LCD_RASTER_MODE & 0x1), LCD_CTRL_REG);
++
++              if (lcd_revision == LCD_VERSION_2)
++                      lcdc_write(LCD_V2_DMA_CLK_EN | LCD_V2_LIDD_CLK_EN |
++                              LCD_V2_CORE_CLK_EN, LCD_CLK_ENABLE_REG);
++      } else {
++              /*
++               * Not using external encoder, using old and more inaccurate
++               * method of setting the clocks.
++               */
++              ret = da8xx_fb_calc_config_clk_divider(par, panel);
++              if (IS_ERR_VALUE(ret)) {
++                      dev_err(par->dev, "unable to configure clock\n");
++                      return ret;
++              }
+       }
+       if (panel->sync & FB_SYNC_CLK_INVERT)
+@@ -822,9 +905,45 @@ static int lcd_init(struct da8xx_fb_par
+       lcdc_write((lcdc_read(LCD_RASTER_CTRL_REG) & 0xfff00fff) |
+                      (cfg->fdd << 12), LCD_RASTER_CTRL_REG);
++      if (IS_ENABLED(CONFIG_FB_DA8XX_TDA998X) && par->hdmi_node) {
++              /*
++               * keep doing this lookup, because there is a posibility that
++               * somebody went and unloaded the encoder driver from out
++               * beneath us
++               */
++              enc = da8xx_get_encoder_from_phandle(par->hdmi_node);
++              if (enc)
++                      enc->set_mode(enc, panel);
++      }
+       return 0;
+ }
++int register_vsync_cb(vsync_callback_t handler, void *arg, int idx)
++{
++      if ((vsync_cb_handler == NULL) && (vsync_cb_arg == NULL)) {
++              vsync_cb_arg = arg;
++              vsync_cb_handler = handler;
++      } else {
++              return -EEXIST;
++      }
++
++      return 0;
++}
++EXPORT_SYMBOL(register_vsync_cb);
++
++int unregister_vsync_cb(vsync_callback_t handler, void *arg, int idx)
++{
++      if ((vsync_cb_handler == handler) && (vsync_cb_arg == arg)) {
++              vsync_cb_handler = NULL;
++              vsync_cb_arg = NULL;
++      } else {
++              return -ENXIO;
++      }
++
++      return 0;
++}
++EXPORT_SYMBOL(unregister_vsync_cb);
++
+ /* IRQ handler for version 2 of LCDC */
+ static irqreturn_t lcdc_irq_handler_rev02(int irq, void *arg)
+ {
+@@ -862,6 +981,8 @@ static irqreturn_t lcdc_irq_handler_rev0
+                                  LCD_DMA_FRM_BUF_CEILING_ADDR_0_REG);
+                       par->vsync_flag = 1;
+                       wake_up_interruptible(&par->vsync_wait);
++                      if (vsync_cb_handler)
++                              vsync_cb_handler(vsync_cb_arg);
+               }
+               if (stat & LCD_END_OF_FRAME1) {
+@@ -872,6 +993,8 @@ static irqreturn_t lcdc_irq_handler_rev0
+                                  LCD_DMA_FRM_BUF_CEILING_ADDR_1_REG);
+                       par->vsync_flag = 1;
+                       wake_up_interruptible(&par->vsync_wait);
++                      if (vsync_cb_handler)
++                              vsync_cb_handler(vsync_cb_arg);
+               }
+               /* Set only when controller is disabled and at the end of
+@@ -1032,7 +1155,13 @@ static int fb_check_var(struct fb_var_sc
+       if (var->yres + var->yoffset > var->yres_virtual)
+               var->yoffset = var->yres_virtual - var->yres;
+-      var->pixclock = da8xx_fb_round_clk(par, var->pixclock);
++      /*
++       * if we don't have an encoder attached, use the legacy
++       * clock setting code that works on da8xx but is a bit
++       * inaccurate for the encoders on AM335x
++       */
++      if (!IS_ENABLED(CONFIG_FB_DA8XX_TDA998X) || (par->hdmi_node == 0))
++              var->pixclock = da8xx_fb_round_clk(par, var->pixclock);
+       return err;
+ }
+@@ -1312,12 +1441,54 @@ static struct fb_ops da8xx_fb_ops = {
+       .fb_blank = cfb_blank,
+ };
++static struct lcd_ctrl_config *da8xx_fb_create_cfg(struct platform_device *dev)
++{
++      struct lcd_ctrl_config *cfg;
++
++      cfg = devm_kzalloc(&dev->dev, sizeof(struct fb_videomode), GFP_KERNEL);
++      if (!cfg)
++              return NULL;
++
++      /* default values */
++
++      if (lcd_revision == LCD_VERSION_1)
++              cfg->bpp = 16;
++      else
++              cfg->bpp = 32;
++
++      /*
++       * For panels so far used with this LCDC, below statement is sufficient.
++       * For new panels, if required, struct lcd_ctrl_cfg fields to be updated
++       * with additional/modified values. Those values would have to be then
++       * obtained from dt(requiring new dt bindings).
++       */
++
++      cfg->panel_shade = COLOR_ACTIVE;
++
++      return cfg;
++}
++
+ static struct fb_videomode *da8xx_fb_get_videomode(struct platform_device *dev)
+ {
+       struct da8xx_lcdc_platform_data *fb_pdata = dev->dev.platform_data;
+       struct fb_videomode *lcdc_info;
++      struct device_node *np = dev->dev.of_node;
+       int i;
++      if (np) {
++              lcdc_info = devm_kzalloc(&dev->dev,
++                                       sizeof(struct fb_videomode),
++                                       GFP_KERNEL);
++              if (!lcdc_info)
++                      return NULL;
++
++              if (of_get_fb_videomode(np, lcdc_info, OF_USE_NATIVE_MODE)) {
++                      dev_err(&dev->dev, "timings not available in DT\n");
++                      return NULL;
++              }
++              return lcdc_info;
++      }
++
+       for (i = 0, lcdc_info = known_lcd_panels;
+               i < ARRAY_SIZE(known_lcd_panels); i++, lcdc_info++) {
+               if (strcmp(fb_pdata->type, lcdc_info->name) == 0)
+@@ -1342,15 +1513,28 @@ static int fb_probe(struct platform_devi
+       struct fb_videomode *lcdc_info;
+       struct fb_info *da8xx_fb_info;
+       struct da8xx_fb_par *par;
+-      struct clk *tmp_lcdc_clk;
++      struct clk *tmp_lcdc_clk, *tmp_disp_clk;
+       int ret;
+       unsigned long ulcm;
++      struct device_node *hdmi_node = NULL;
++
+-      if (fb_pdata == NULL) {
++      if (fb_pdata == NULL && !device->dev.of_node) {
+               dev_err(&device->dev, "Can not get platform data\n");
+               return -ENOENT;
+       }
++      if (device->dev.of_node) {
++              hdmi_node = of_parse_phandle(device->dev.of_node,
++                                      "hdmi", 0);
++              if (hdmi_node &&
++                      (da8xx_get_encoder_from_phandle(hdmi_node) == 0)) {
++                      /* i2c encoder has not initialized yet, defer */
++                      of_node_put(hdmi_node);
++                      return -EPROBE_DEFER;
++              }
++      }
++
+       lcdc_info = da8xx_fb_get_videomode(device);
+       if (lcdc_info == NULL)
+               return -ENODEV;
+@@ -1366,6 +1550,12 @@ static int fb_probe(struct platform_devi
+               return PTR_ERR(tmp_lcdc_clk);
+       }
++      tmp_disp_clk = devm_clk_get(&device->dev, "dpll_disp_ck");
++      if (IS_ERR(tmp_disp_clk)) {
++              /* we can live if dpll_disp_ck is not available */
++              tmp_disp_clk = 0;
++      }
++
+       pm_runtime_enable(&device->dev);
+       pm_runtime_get_sync(&device->dev);
+@@ -1386,7 +1576,10 @@ static int fb_probe(struct platform_devi
+               break;
+       }
+-      lcd_cfg = (struct lcd_ctrl_config *)fb_pdata->controller_data;
++      if (device->dev.of_node)
++              lcd_cfg = da8xx_fb_create_cfg(device);
++      else
++              lcd_cfg = fb_pdata->controller_data;
+       if (!lcd_cfg) {
+               ret = -EINVAL;
+@@ -1405,11 +1598,16 @@ static int fb_probe(struct platform_devi
+       par->dev = &device->dev;
+       par->lcdc_clk = tmp_lcdc_clk;
+       par->lcdc_clk_rate = clk_get_rate(par->lcdc_clk);
+-      if (fb_pdata->panel_power_ctrl) {
++      par->disp_clk = tmp_disp_clk;
++
++      if (fb_pdata && fb_pdata->panel_power_ctrl) {
+               par->panel_power_ctrl = fb_pdata->panel_power_ctrl;
+               par->panel_power_ctrl(1);
+       }
++      if (device->dev.of_node)
++              par->hdmi_node = hdmi_node;
++
+       fb_videomode_to_var(&da8xx_fb_var, lcdc_info);
+       par->cfg = *lcd_cfg;
+@@ -1653,6 +1851,19 @@ static int fb_resume(struct platform_dev
+ #define fb_resume NULL
+ #endif
++#if IS_ENABLED(CONFIG_OF)
++static const struct of_device_id da8xx_fb_of_match[] = {
++      /*
++       * this driver supports version 1 and version 2 of the
++       * Texas Instruments lcd controller (lcdc) hardware block
++       */
++      {.compatible = "ti,da8xx-tilcdc", },
++      {.compatible = "ti,am33xx-tilcdc", },
++      {},
++};
++MODULE_DEVICE_TABLE(of, da8xx_fb_of_match);
++#endif
++
+ static struct platform_driver da8xx_fb_driver = {
+       .probe = fb_probe,
+       .remove = fb_remove,
+@@ -1661,6 +1872,7 @@ static struct platform_driver da8xx_fb_d
+       .driver = {
+                  .name = DRIVER_NAME,
+                  .owner = THIS_MODULE,
++                 .of_match_table = of_match_ptr(da8xx_fb_of_match),
+                  },
+ };
+--- /dev/null
++++ b/drivers/video/da8xx-tda998x-hdmi.c
+@@ -0,0 +1,840 @@
++/*
++ * Copyright (C) 2012 Texas Instruments
++ * Author: Rob Clark <robdclark@gmail.com>
++ * Author: Darren Etheridge <detheridge@ti.com>
++ *
++ * 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 pr_fmt(fmt) KBUILD_MODNAME ": " fmt
++
++
++#include <linux/module.h>
++#include <linux/i2c.h>
++#include <linux/slab.h>
++#include <linux/delay.h>
++#include <video/da8xx-fb.h>
++#include <video/da8xx-tda998x-hdmi.h>
++
++#define TDA998X_DEBUG
++
++#ifdef TDA998X_DEBUG
++#define DBG(fmt, ...) printk(KERN_DEBUG "%s: " fmt, __func__, ##__VA_ARGS__)
++#else
++#define DBG(fmt, ...)
++#endif
++
++
++#define tda998x_encoder da8xx_encoder
++
++struct tda998x_priv {
++      struct i2c_client *cec;
++      uint16_t rev;
++      uint8_t current_page;
++      int dpms;
++      bool is_hdmi_sink;
++      u8 vip_cntrl_0;
++      u8 vip_cntrl_1;
++      u8 vip_cntrl_2;
++      struct tda998x_encoder_params params;
++};
++
++#define to_tda998x_priv(x)  ((struct tda998x_priv *)x->priv)
++#define tda998x_i2c_encoder_get_client(x) ((struct i2c_client *)x->client)
++
++/* The TDA9988 series of devices use a paged register scheme.. to simplify
++ * things we encode the page # in upper bits of the register #.  To read/
++ * write a given register, we need to make sure CURPAGE register is set
++ * appropriately.  Which implies reads/writes are not atomic.  Fun!
++ */
++
++#define REG(page, addr) (((page) << 8) | (addr))
++#define REG2ADDR(reg)   ((reg) & 0xff)
++#define REG2PAGE(reg)   (((reg) >> 8) & 0xff)
++
++#define REG_CURPAGE               0xff                /* write */
++
++
++/* Page 00h: General Control */
++#define REG_VERSION_LSB           REG(0x00, 0x00)     /* read */
++#define REG_MAIN_CNTRL0           REG(0x00, 0x01)     /* read/write */
++# define MAIN_CNTRL0_SR           (1 << 0)
++# define MAIN_CNTRL0_DECS         (1 << 1)
++# define MAIN_CNTRL0_DEHS         (1 << 2)
++# define MAIN_CNTRL0_CECS         (1 << 3)
++# define MAIN_CNTRL0_CEHS         (1 << 4)
++# define MAIN_CNTRL0_SCALER       (1 << 7)
++#define REG_VERSION_MSB           REG(0x00, 0x02)     /* read */
++#define REG_SOFTRESET             REG(0x00, 0x0a)     /* write */
++# define SOFTRESET_AUDIO          (1 << 0)
++# define SOFTRESET_I2C_MASTER     (1 << 1)
++#define REG_DDC_DISABLE           REG(0x00, 0x0b)     /* read/write */
++#define REG_CCLK_ON               REG(0x00, 0x0c)     /* read/write */
++#define REG_I2C_MASTER            REG(0x00, 0x0d)     /* read/write */
++# define I2C_MASTER_DIS_MM        (1 << 0)
++# define I2C_MASTER_DIS_FILT      (1 << 1)
++# define I2C_MASTER_APP_STRT_LAT  (1 << 2)
++#define REG_FEAT_POWERDOWN        REG(0x00, 0x0e)     /* read/write */
++# define FEAT_POWERDOWN_SPDIF     (1 << 3)
++#define REG_INT_FLAGS_0           REG(0x00, 0x0f)     /* read/write */
++#define REG_INT_FLAGS_1           REG(0x00, 0x10)     /* read/write */
++#define REG_INT_FLAGS_2           REG(0x00, 0x11)     /* read/write */
++# define INT_FLAGS_2_EDID_BLK_RD  (1 << 1)
++#define REG_ENA_ACLK              REG(0x00, 0x16)     /* read/write */
++#define REG_ENA_VP_0              REG(0x00, 0x18)     /* read/write */
++#define REG_ENA_VP_1              REG(0x00, 0x19)     /* read/write */
++#define REG_ENA_VP_2              REG(0x00, 0x1a)     /* read/write */
++#define REG_ENA_AP                REG(0x00, 0x1e)     /* read/write */
++#define REG_VIP_CNTRL_0           REG(0x00, 0x20)     /* write */
++# define VIP_CNTRL_0_MIRR_A       (1 << 7)
++# define VIP_CNTRL_0_SWAP_A(x)    (((x) & 7) << 4)
++# define VIP_CNTRL_0_MIRR_B       (1 << 3)
++# define VIP_CNTRL_0_SWAP_B(x)    (((x) & 7) << 0)
++#define REG_VIP_CNTRL_1           REG(0x00, 0x21)     /* write */
++# define VIP_CNTRL_1_MIRR_C       (1 << 7)
++# define VIP_CNTRL_1_SWAP_C(x)    (((x) & 7) << 4)
++# define VIP_CNTRL_1_MIRR_D       (1 << 3)
++# define VIP_CNTRL_1_SWAP_D(x)    (((x) & 7) << 0)
++#define REG_VIP_CNTRL_2           REG(0x00, 0x22)     /* write */
++# define VIP_CNTRL_2_MIRR_E       (1 << 7)
++# define VIP_CNTRL_2_SWAP_E(x)    (((x) & 7) << 4)
++# define VIP_CNTRL_2_MIRR_F       (1 << 3)
++# define VIP_CNTRL_2_SWAP_F(x)    (((x) & 7) << 0)
++#define REG_VIP_CNTRL_3           REG(0x00, 0x23)     /* write */
++# define VIP_CNTRL_3_X_TGL        (1 << 0)
++# define VIP_CNTRL_3_H_TGL        (1 << 1)
++# define VIP_CNTRL_3_V_TGL        (1 << 2)
++# define VIP_CNTRL_3_EMB          (1 << 3)
++# define VIP_CNTRL_3_SYNC_DE      (1 << 4)
++# define VIP_CNTRL_3_SYNC_HS      (1 << 5)
++# define VIP_CNTRL_3_DE_INT       (1 << 6)
++# define VIP_CNTRL_3_EDGE         (1 << 7)
++#define REG_VIP_CNTRL_4           REG(0x00, 0x24)     /* write */
++# define VIP_CNTRL_4_BLC(x)       (((x) & 3) << 0)
++# define VIP_CNTRL_4_BLANKIT(x)   (((x) & 3) << 2)
++# define VIP_CNTRL_4_CCIR656      (1 << 4)
++# define VIP_CNTRL_4_656_ALT      (1 << 5)
++# define VIP_CNTRL_4_TST_656      (1 << 6)
++# define VIP_CNTRL_4_TST_PAT      (1 << 7)
++#define REG_VIP_CNTRL_5           REG(0x00, 0x25)     /* write */
++# define VIP_CNTRL_5_CKCASE       (1 << 0)
++# define VIP_CNTRL_5_SP_CNT(x)    (((x) & 3) << 1)
++#define REG_MUX_AP                REG(0x00, 0x26)     /* read/write */
++#define REG_MUX_VP_VIP_OUT        REG(0x00, 0x27)     /* read/write */
++#define REG_MAT_CONTRL            REG(0x00, 0x80)     /* write */
++# define MAT_CONTRL_MAT_SC(x)     (((x) & 3) << 0)
++# define MAT_CONTRL_MAT_BP        (1 << 2)
++#define REG_VIDFORMAT             REG(0x00, 0xa0)     /* write */
++#define REG_REFPIX_MSB            REG(0x00, 0xa1)     /* write */
++#define REG_REFPIX_LSB            REG(0x00, 0xa2)     /* write */
++#define REG_REFLINE_MSB           REG(0x00, 0xa3)     /* write */
++#define REG_REFLINE_LSB           REG(0x00, 0xa4)     /* write */
++#define REG_NPIX_MSB              REG(0x00, 0xa5)     /* write */
++#define REG_NPIX_LSB              REG(0x00, 0xa6)     /* write */
++#define REG_NLINE_MSB             REG(0x00, 0xa7)     /* write */
++#define REG_NLINE_LSB             REG(0x00, 0xa8)     /* write */
++#define REG_VS_LINE_STRT_1_MSB    REG(0x00, 0xa9)     /* write */
++#define REG_VS_LINE_STRT_1_LSB    REG(0x00, 0xaa)     /* write */
++#define REG_VS_PIX_STRT_1_MSB     REG(0x00, 0xab)     /* write */
++#define REG_VS_PIX_STRT_1_LSB     REG(0x00, 0xac)     /* write */
++#define REG_VS_LINE_END_1_MSB     REG(0x00, 0xad)     /* write */
++#define REG_VS_LINE_END_1_LSB     REG(0x00, 0xae)     /* write */
++#define REG_VS_PIX_END_1_MSB      REG(0x00, 0xaf)     /* write */
++#define REG_VS_PIX_END_1_LSB      REG(0x00, 0xb0)     /* write */
++#define REG_VS_LINE_STRT_2_MSB    REG(0x00, 0xb1)     /* write */
++#define REG_VS_LINE_STRT_2_LSB    REG(0x00, 0xb2)     /* write */
++#define REG_VS_PIX_STRT_2_MSB     REG(0x00, 0xb3)     /* write */
++#define REG_VS_PIX_STRT_2_LSB     REG(0x00, 0xb4)     /* write */
++#define REG_VS_LINE_END_2_MSB     REG(0x00, 0xb5)     /* write */
++#define REG_VS_LINE_END_2_LSB     REG(0x00, 0xb6)     /* write */
++#define REG_VS_PIX_END_2_MSB      REG(0x00, 0xb7)     /* write */
++#define REG_VS_PIX_END_2_LSB      REG(0x00, 0xb8)     /* write */
++#define REG_HS_PIX_START_MSB      REG(0x00, 0xb9)     /* write */
++#define REG_HS_PIX_START_LSB      REG(0x00, 0xba)     /* write */
++#define REG_HS_PIX_STOP_MSB       REG(0x00, 0xbb)     /* write */
++#define REG_HS_PIX_STOP_LSB       REG(0x00, 0xbc)     /* write */
++#define REG_VWIN_START_1_MSB      REG(0x00, 0xbd)     /* write */
++#define REG_VWIN_START_1_LSB      REG(0x00, 0xbe)     /* write */
++#define REG_VWIN_END_1_MSB        REG(0x00, 0xbf)     /* write */
++#define REG_VWIN_END_1_LSB        REG(0x00, 0xc0)     /* write */
++#define REG_VWIN_START_2_MSB      REG(0x00, 0xc1)     /* write */
++#define REG_VWIN_START_2_LSB      REG(0x00, 0xc2)     /* write */
++#define REG_VWIN_END_2_MSB        REG(0x00, 0xc3)     /* write */
++#define REG_VWIN_END_2_LSB        REG(0x00, 0xc4)     /* write */
++#define REG_DE_START_MSB          REG(0x00, 0xc5)     /* write */
++#define REG_DE_START_LSB          REG(0x00, 0xc6)     /* write */
++#define REG_DE_STOP_MSB           REG(0x00, 0xc7)     /* write */
++#define REG_DE_STOP_LSB           REG(0x00, 0xc8)     /* write */
++#define REG_TBG_CNTRL_0           REG(0x00, 0xca)     /* write */
++# define TBG_CNTRL_0_TOP_TGL      (1 << 0)
++# define TBG_CNTRL_0_TOP_SEL      (1 << 1)
++# define TBG_CNTRL_0_DE_EXT       (1 << 2)
++# define TBG_CNTRL_0_TOP_EXT      (1 << 3)
++# define TBG_CNTRL_0_FRAME_DIS    (1 << 5)
++# define TBG_CNTRL_0_SYNC_MTHD    (1 << 6)
++# define TBG_CNTRL_0_SYNC_ONCE    (1 << 7)
++#define REG_TBG_CNTRL_1           REG(0x00, 0xcb)     /* write */
++# define TBG_CNTRL_1_H_TGL        (1 << 0)
++# define TBG_CNTRL_1_V_TGL        (1 << 1)
++# define TBG_CNTRL_1_TGL_EN       (1 << 2)
++# define TBG_CNTRL_1_X_EXT        (1 << 3)
++# define TBG_CNTRL_1_H_EXT        (1 << 4)
++# define TBG_CNTRL_1_V_EXT        (1 << 5)
++# define TBG_CNTRL_1_DWIN_DIS     (1 << 6)
++#define REG_ENABLE_SPACE          REG(0x00, 0xd6)     /* write */
++#define REG_HVF_CNTRL_0           REG(0x00, 0xe4)     /* write */
++# define HVF_CNTRL_0_SM           (1 << 7)
++# define HVF_CNTRL_0_RWB          (1 << 6)
++# define HVF_CNTRL_0_PREFIL(x)    (((x) & 3) << 2)
++# define HVF_CNTRL_0_INTPOL(x)    (((x) & 3) << 0)
++#define REG_HVF_CNTRL_1           REG(0x00, 0xe5)     /* write */
++# define HVF_CNTRL_1_FOR          (1 << 0)
++# define HVF_CNTRL_1_YUVBLK       (1 << 1)
++# define HVF_CNTRL_1_VQR(x)       (((x) & 3) << 2)
++# define HVF_CNTRL_1_PAD(x)       (((x) & 3) << 4)
++# define HVF_CNTRL_1_SEMI_PLANAR  (1 << 6)
++#define REG_RPT_CNTRL             REG(0x00, 0xf0)     /* write */
++#define REG_I2S_FORMAT            REG(0x00, 0xfc)     /* read/write */
++# define I2S_FORMAT(x)            (((x) & 3) << 0)
++#define REG_AIP_CLKSEL            REG(0x00, 0xfd)     /* write */
++# define AIP_CLKSEL_FS(x)         (((x) & 3) << 0)
++# define AIP_CLKSEL_CLK_POL(x)    (((x) & 1) << 2)
++# define AIP_CLKSEL_AIP(x)        (((x) & 7) << 3)
++
++
++/* Page 02h: PLL settings */
++#define REG_PLL_SERIAL_1          REG(0x02, 0x00)     /* read/write */
++# define PLL_SERIAL_1_SRL_FDN     (1 << 0)
++# define PLL_SERIAL_1_SRL_IZ(x)   (((x) & 3) << 1)
++# define PLL_SERIAL_1_SRL_MAN_IZ  (1 << 6)
++#define REG_PLL_SERIAL_2          REG(0x02, 0x01)     /* read/write */
++# define PLL_SERIAL_2_SRL_NOSC(x) (((x) & 3) << 0)
++# define PLL_SERIAL_2_SRL_PR(x)   (((x) & 0xf) << 4)
++#define REG_PLL_SERIAL_3          REG(0x02, 0x02)     /* read/write */
++# define PLL_SERIAL_3_SRL_CCIR    (1 << 0)
++# define PLL_SERIAL_3_SRL_DE      (1 << 2)
++# define PLL_SERIAL_3_SRL_PXIN_SEL (1 << 4)
++#define REG_SERIALIZER            REG(0x02, 0x03)     /* read/write */
++#define REG_BUFFER_OUT            REG(0x02, 0x04)     /* read/write */
++#define REG_PLL_SCG1              REG(0x02, 0x05)     /* read/write */
++#define REG_PLL_SCG2              REG(0x02, 0x06)     /* read/write */
++#define REG_PLL_SCGN1             REG(0x02, 0x07)     /* read/write */
++#define REG_PLL_SCGN2             REG(0x02, 0x08)     /* read/write */
++#define REG_PLL_SCGR1             REG(0x02, 0x09)     /* read/write */
++#define REG_PLL_SCGR2             REG(0x02, 0x0a)     /* read/write */
++#define REG_AUDIO_DIV             REG(0x02, 0x0e)     /* read/write */
++#define REG_SEL_CLK               REG(0x02, 0x11)     /* read/write */
++# define SEL_CLK_SEL_CLK1         (1 << 0)
++# define SEL_CLK_SEL_VRF_CLK(x)   (((x) & 3) << 1)
++# define SEL_CLK_ENA_SC_CLK       (1 << 3)
++#define REG_ANA_GENERAL           REG(0x02, 0x12)     /* read/write */
++
++
++/* Page 09h: EDID Control */
++#define REG_EDID_DATA_0           REG(0x09, 0x00)     /* read */
++/* next 127 successive registers are the EDID block */
++#define REG_EDID_CTRL             REG(0x09, 0xfa)     /* read/write */
++#define REG_DDC_ADDR              REG(0x09, 0xfb)     /* read/write */
++#define REG_DDC_OFFS              REG(0x09, 0xfc)     /* read/write */
++#define REG_DDC_SEGM_ADDR         REG(0x09, 0xfd)     /* read/write */
++#define REG_DDC_SEGM              REG(0x09, 0xfe)     /* read/write */
++
++
++/* Page 10h: information frames and packets */
++#define REG_IF1_HB0               REG(0x10, 0x20)     /* read/write */
++#define REG_IF2_HB0               REG(0x10, 0x40)     /* read/write */
++#define REG_IF3_HB0               REG(0x10, 0x60)     /* read/write */
++#define REG_IF4_HB0               REG(0x10, 0x80)     /* read/write */
++#define REG_IF5_HB0               REG(0x10, 0xa0)     /* read/write */
++
++
++/* Page 11h: audio settings and content info packets */
++#define REG_AIP_CNTRL_0           REG(0x11, 0x00)     /* read/write */
++# define AIP_CNTRL_0_RST_FIFO     (1 << 0)
++# define AIP_CNTRL_0_SWAP         (1 << 1)
++# define AIP_CNTRL_0_LAYOUT       (1 << 2)
++# define AIP_CNTRL_0_ACR_MAN      (1 << 5)
++# define AIP_CNTRL_0_RST_CTS      (1 << 6)
++#define REG_CA_I2S                REG(0x11, 0x01)     /* read/write */
++# define CA_I2S_CA_I2S(x)         (((x) & 31) << 0)
++# define CA_I2S_HBR_CHSTAT        (1 << 6)
++#define REG_LATENCY_RD            REG(0x11, 0x04)     /* read/write */
++#define REG_ACR_CTS_0             REG(0x11, 0x05)     /* read/write */
++#define REG_ACR_CTS_1             REG(0x11, 0x06)     /* read/write */
++#define REG_ACR_CTS_2             REG(0x11, 0x07)     /* read/write */
++#define REG_ACR_N_0               REG(0x11, 0x08)     /* read/write */
++#define REG_ACR_N_1               REG(0x11, 0x09)     /* read/write */
++#define REG_ACR_N_2               REG(0x11, 0x0a)     /* read/write */
++#define REG_CTS_N                 REG(0x11, 0x0c)     /* read/write */
++# define CTS_N_K(x)               (((x) & 7) << 0)
++# define CTS_N_M(x)               (((x) & 3) << 4)
++#define REG_ENC_CNTRL             REG(0x11, 0x0d)     /* read/write */
++# define ENC_CNTRL_RST_ENC        (1 << 0)
++# define ENC_CNTRL_RST_SEL        (1 << 1)
++# define ENC_CNTRL_CTL_CODE(x)    (((x) & 3) << 2)
++#define REG_DIP_FLAGS             REG(0x11, 0x0e)     /* read/write */
++# define DIP_FLAGS_ACR            (1 << 0)
++# define DIP_FLAGS_GC             (1 << 1)
++#define REG_DIP_IF_FLAGS          REG(0x11, 0x0f)     /* read/write */
++# define DIP_IF_FLAGS_IF1         (1 << 1)
++# define DIP_IF_FLAGS_IF2         (1 << 2)
++# define DIP_IF_FLAGS_IF3         (1 << 3)
++# define DIP_IF_FLAGS_IF4         (1 << 4)
++# define DIP_IF_FLAGS_IF5         (1 << 5)
++#define REG_CH_STAT_B(x)          REG(0x11, 0x14 + (x)) /* read/write */
++
++
++/* Page 12h: HDCP and OTP */
++#define REG_TX3                   REG(0x12, 0x9a)     /* read/write */
++#define REG_TX4                   REG(0x12, 0x9b)     /* read/write */
++# define TX4_PD_RAM               (1 << 1)
++#define REG_TX33                  REG(0x12, 0xb8)     /* read/write */
++# define TX33_HDMI                (1 << 1)
++
++
++/* Page 13h: Gamut related metadata packets */
++
++
++
++/* CEC registers: (not paged)
++ */
++#define REG_CEC_FRO_IM_CLK_CTRL   0xfb                /* read/write */
++# define CEC_FRO_IM_CLK_CTRL_GHOST_DIS (1 << 7)
++# define CEC_FRO_IM_CLK_CTRL_ENA_OTP   (1 << 6)
++# define CEC_FRO_IM_CLK_CTRL_IMCLK_SEL (1 << 1)
++# define CEC_FRO_IM_CLK_CTRL_FRO_DIV   (1 << 0)
++#define REG_CEC_RXSHPDLEV         0xfe                /* read */
++# define CEC_RXSHPDLEV_RXSENS     (1 << 0)
++# define CEC_RXSHPDLEV_HPD        (1 << 1)
++
++#define REG_CEC_ENAMODS           0xff                /* read/write */
++# define CEC_ENAMODS_DIS_FRO      (1 << 6)
++# define CEC_ENAMODS_DIS_CCLK     (1 << 5)
++# define CEC_ENAMODS_EN_RXSENS    (1 << 2)
++# define CEC_ENAMODS_EN_HDMI      (1 << 1)
++# define CEC_ENAMODS_EN_CEC       (1 << 0)
++
++
++/* Device versions: */
++#define TDA9989N2                 0x0101
++#define TDA19989                  0x0201
++#define TDA19989N2                0x0202
++#define TDA19988                  0x0301
++
++static void
++cec_write(struct tda998x_encoder *encoder, uint16_t addr, uint8_t val)
++{
++      struct i2c_client *client = to_tda998x_priv(encoder)->cec;
++      uint8_t buf[] = {addr, val};
++      int ret;
++
++      ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
++      if (ret < 0)
++              dev_err(&client->dev, "Error %d writing to cec:0x%x\n",
++                      ret, addr);
++}
++
++static void
++set_page(struct tda998x_encoder *encoder, uint16_t reg)
++{
++      struct tda998x_priv *priv = to_tda998x_priv(encoder);
++
++      if (REG2PAGE(reg) != priv->current_page) {
++              struct i2c_client *client =
++                      tda998x_i2c_encoder_get_client(encoder);
++              uint8_t buf[] = {
++                              REG_CURPAGE, REG2PAGE(reg)
++              };
++              int ret = i2c_master_send(client, buf, sizeof(buf));
++              if (ret < 0)
++                      dev_err(&client->dev,
++                              "Error %d writing to REG_CURPAGE\n", ret);
++
++              priv->current_page = REG2PAGE(reg);
++      }
++}
++
++static int
++reg_read_range(struct tda998x_encoder *encoder,
++      uint16_t reg, char *buf, int cnt)
++{
++      struct i2c_client *client = tda998x_i2c_encoder_get_client(encoder);
++      uint8_t addr = REG2ADDR(reg);
++      int ret;
++
++      set_page(encoder, reg);
++
++      ret = i2c_master_send(client, &addr, sizeof(addr));
++      if (ret < 0)
++              goto fail;
++
++      ret = i2c_master_recv(client, buf, cnt);
++      if (ret < 0)
++              goto fail;
++
++      return ret;
++
++fail:
++      dev_err(&client->dev, "Error %d reading from 0x%x\n", ret, reg);
++      return ret;
++}
++
++static uint8_t
++reg_read(struct tda998x_encoder *encoder, uint16_t reg)
++{
++      uint8_t val = 0;
++      reg_read_range(encoder, reg, &val, sizeof(val));
++      return val;
++}
++
++static void
++reg_write(struct tda998x_encoder *encoder, uint16_t reg, uint8_t val)
++{
++      struct i2c_client *client = tda998x_i2c_encoder_get_client(encoder);
++      uint8_t buf[] = {REG2ADDR(reg), val};
++      int ret;
++
++      set_page(encoder, reg);
++
++      ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
++      if (ret < 0)
++              dev_err(&client->dev, "Error %d writing to 0x%x\n", ret, reg);
++}
++
++static void
++reg_write16(struct tda998x_encoder *encoder, uint16_t reg, uint16_t val)
++{
++      struct i2c_client *client = tda998x_i2c_encoder_get_client(encoder);
++      uint8_t buf[] = {REG2ADDR(reg), val >> 8, val};
++      int ret;
++
++      set_page(encoder, reg);
++
++      ret = i2c_master_send(client, buf, ARRAY_SIZE(buf));
++      if (ret < 0)
++              dev_err(&client->dev, "Error %d writing to 0x%x\n", ret, reg);
++}
++
++static void
++reg_set(struct tda998x_encoder *encoder, uint16_t reg, uint8_t val)
++{
++      reg_write(encoder, reg, reg_read(encoder, reg) | val);
++}
++
++static void
++reg_clear(struct tda998x_encoder *encoder, uint16_t reg, uint8_t val)
++{
++      reg_write(encoder, reg, reg_read(encoder, reg) & ~val);
++}
++
++static void
++tda998x_reset(struct tda998x_encoder *encoder)
++{
++      /* reset audio and i2c master: */
++      reg_set(encoder, REG_SOFTRESET, SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
++      msleep(50);
++      reg_clear(encoder, REG_SOFTRESET,
++              SOFTRESET_AUDIO | SOFTRESET_I2C_MASTER);
++      msleep(50);
++
++      /* reset transmitter: */
++      reg_set(encoder, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
++      reg_clear(encoder, REG_MAIN_CNTRL0, MAIN_CNTRL0_SR);
++
++      /* PLL registers common configuration */
++      reg_write(encoder, REG_PLL_SERIAL_1, 0x00);
++      reg_write(encoder, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(1));
++      reg_write(encoder, REG_PLL_SERIAL_3, 0x00);
++      reg_write(encoder, REG_SERIALIZER,   0x00);
++      reg_write(encoder, REG_BUFFER_OUT,   0x00);
++      reg_write(encoder, REG_PLL_SCG1,     0x00);
++      reg_write(encoder, REG_AUDIO_DIV,    0x03);
++      reg_write(encoder, REG_SEL_CLK,
++              SEL_CLK_SEL_CLK1 | SEL_CLK_ENA_SC_CLK);
++      reg_write(encoder, REG_PLL_SCGN1,    0xfa);
++      reg_write(encoder, REG_PLL_SCGN2,    0x00);
++      reg_write(encoder, REG_PLL_SCGR1,    0x5b);
++      reg_write(encoder, REG_PLL_SCGR2,    0x00);
++      reg_write(encoder, REG_PLL_SCG2,     0x10);
++}
++
++struct tda_mode {
++      uint32_t clock;
++      uint32_t vrefresh;
++      uint32_t hdisplay;
++      uint32_t hsync_start;
++      uint32_t hsync_end;
++      uint32_t htotal;
++      uint32_t vdisplay;
++      uint32_t vsync_start;
++      uint32_t vsync_end;
++      uint32_t vtotal;
++      uint32_t flags;
++      uint32_t hskew;
++};
++
++static void convert_to_display_mode(struct tda_mode *mode,
++                      struct fb_videomode *timing)
++{
++      mode->clock = (PICOS2KHZ(timing->pixclock)/10)*10;
++      mode->vrefresh = timing->refresh;
++
++      mode->hdisplay = timing->xres;
++      mode->hsync_start = mode->hdisplay + timing->right_margin;
++      mode->hsync_end = mode->hsync_start + timing->hsync_len;
++      mode->htotal = mode->hsync_end + timing->left_margin;
++
++      mode->vdisplay = timing->yres;
++      mode->vsync_start = mode->vdisplay + timing->lower_margin;
++      mode->vsync_end = mode->vsync_start + timing->vsync_len;
++      mode->vtotal = mode->vsync_end + timing->upper_margin;
++
++      mode->flags = timing->sync;
++
++
++
++      pr_debug("mode->htotal %d, mode->vtotal %d, mode->flags %x\n",
++              mode->htotal, mode->vtotal, mode->flags);
++      pr_debug("mode->clock %d\n", mode->clock);
++      pr_debug("mode->vrefresh %d\n", mode->vrefresh);
++      pr_debug("mode->hdisplay %d\n", mode->hdisplay);
++      pr_debug("mode->hsync_start %d\n", mode->hsync_start);
++      pr_debug("mode->hsync_end %d\n", mode->hsync_end);
++      pr_debug("mode->vdisplay %d\n", mode->vdisplay);
++      pr_debug("mode->vsync_start %d\n", mode->vsync_start);
++      pr_debug("mode->vsync_end %d\n", mode->vsync_end);
++
++      /*
++       * this is a workaround to fix up the mode so that the non-vesa
++       * compliant LCD controller can work with the NXP HDMI encoder
++       * we invert the horizontal sync pulse, and then add some hskew
++       * to move the picture to the right on the screen by a sync pulse
++       * worth of pixels
++       */
++      mode->hskew = mode->hsync_end - mode->hsync_start;
++      mode->flags ^= FB_SYNC_HOR_HIGH_ACT;
++
++      pr_debug("mode->hskew %d\n", mode->hskew);
++
++}
++
++
++void da8xx_tda998x_setmode(struct tda998x_encoder *encoder,
++                      struct fb_videomode *vid_mode)
++{
++      struct tda998x_priv *priv = to_tda998x_priv(encoder);
++      uint16_t ref_pix, ref_line, n_pix, n_line;
++      uint16_t hs_pix_s, hs_pix_e;
++      uint16_t vs1_pix_s, vs1_pix_e, vs1_line_s, vs1_line_e;
++      uint16_t vs2_pix_s, vs2_pix_e, vs2_line_s, vs2_line_e;
++      uint16_t vwin1_line_s, vwin1_line_e;
++      uint16_t vwin2_line_s, vwin2_line_e;
++      uint16_t de_pix_s, de_pix_e;
++      uint8_t reg, div, rep;
++      struct tda_mode tda_mode;
++      struct tda_mode *mode = &tda_mode;
++
++      convert_to_display_mode(mode, vid_mode);
++
++      /*
++       * Internally TDA998x is using ITU-R BT.656 style sync but
++       * we get VESA style sync. TDA998x is using a reference pixel
++       * relative to ITU to sync to the input frame and for output
++       * sync generation.
++       *
++       * Now there is some issues to take care of:
++       * - HDMI data islands require sync-before-active
++       * - TDA998x register values must be > 0 to be enabled
++       * - REFLINE needs an additional offset of +1
++       * - REFPIX needs an addtional offset of +1 for UYUV and +3 for RGB
++       *
++       * So we add +1 to all horizontal and vertical register values,
++       * plus an additional +3 for REFPIX as we are using RGB input only.
++       */
++      n_pix        = mode->htotal;
++      n_line       = mode->vtotal;
++
++      ref_pix      = 3 + mode->hsync_start - mode->hdisplay;
++
++      /*
++       * handle issue on TILCDC where it is outputing
++       * non-VESA compliant sync signals the workaround
++       * forces us to invert the HSYNC, so need to adjust display to
++       * the left by hskew pixels, provided by the tilcdc driver
++       */
++      ref_pix += mode->hskew;
++
++      de_pix_s     = mode->htotal - mode->hdisplay;
++      de_pix_e     = de_pix_s + mode->hdisplay;
++      hs_pix_s     = mode->hsync_start - mode->hdisplay;
++      hs_pix_e     = hs_pix_s + mode->hsync_end - mode->hsync_start;
++
++      ref_line     = 1 + mode->vsync_start - mode->vdisplay;
++      vwin1_line_s = mode->vtotal - mode->vdisplay - 1;
++      vwin1_line_e = vwin1_line_s + mode->vdisplay;
++      vs1_pix_s    = vs1_pix_e = hs_pix_s;
++      vs1_line_s   = mode->vsync_start - mode->vdisplay;
++
++      vs1_line_e   = vs1_line_s +
++              mode->vsync_end - mode->vsync_start;
++
++      vwin2_line_s = vwin2_line_e = 0;
++      vs2_pix_s    = vs2_pix_e  = 0;
++      vs2_line_s   = vs2_line_e = 0;
++
++      div = 148500 / mode->clock;
++
++      /* Setup the VIP mappings, enable audio and video ports */
++      reg_write(encoder, REG_ENA_AP, 0xff);
++      reg_write(encoder, REG_ENA_VP_0, 0xff);
++      reg_write(encoder, REG_ENA_VP_1, 0xff);
++      reg_write(encoder, REG_ENA_VP_2, 0xff);
++      /* set muxing after enabling ports: */
++      reg_write(encoder, REG_VIP_CNTRL_0,
++              VIP_CNTRL_0_SWAP_A(2) | VIP_CNTRL_0_SWAP_B(3));
++      reg_write(encoder, REG_VIP_CNTRL_1,
++              VIP_CNTRL_1_SWAP_C(4) | VIP_CNTRL_1_SWAP_D(5));
++      reg_write(encoder, REG_VIP_CNTRL_2,
++              VIP_CNTRL_2_SWAP_E(0) | VIP_CNTRL_2_SWAP_F(1));
++
++
++      /* mute the audio FIFO: */
++      reg_set(encoder, REG_AIP_CNTRL_0, AIP_CNTRL_0_RST_FIFO);
++
++      /* set HDMI HDCP mode off: */
++      reg_set(encoder, REG_TBG_CNTRL_1, TBG_CNTRL_1_DWIN_DIS);
++      reg_clear(encoder, REG_TX33, TX33_HDMI);
++
++      reg_write(encoder, REG_ENC_CNTRL, ENC_CNTRL_CTL_CODE(0));
++      /* no pre-filter or interpolator: */
++      reg_write(encoder, REG_HVF_CNTRL_0, HVF_CNTRL_0_PREFIL(0) |
++                      HVF_CNTRL_0_INTPOL(0));
++      reg_write(encoder, REG_VIP_CNTRL_5, VIP_CNTRL_5_SP_CNT(0));
++      reg_write(encoder, REG_VIP_CNTRL_4, VIP_CNTRL_4_BLANKIT(0) |
++                      VIP_CNTRL_4_BLC(0));
++      reg_clear(encoder, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_CCIR);
++
++      reg_clear(encoder, REG_PLL_SERIAL_1, PLL_SERIAL_1_SRL_MAN_IZ);
++      reg_clear(encoder, REG_PLL_SERIAL_3, PLL_SERIAL_3_SRL_DE);
++      reg_write(encoder, REG_SERIALIZER, 0);
++      reg_write(encoder, REG_HVF_CNTRL_1, HVF_CNTRL_1_VQR(0));
++
++      /* TODO enable pixel repeat for pixel rates less than 25Msamp/s */
++      rep = 0;
++      reg_write(encoder, REG_RPT_CNTRL, 0);
++      reg_write(encoder, REG_SEL_CLK, SEL_CLK_SEL_VRF_CLK(0) |
++                      SEL_CLK_SEL_CLK1 | SEL_CLK_ENA_SC_CLK);
++
++      reg_write(encoder, REG_PLL_SERIAL_2, PLL_SERIAL_2_SRL_NOSC(div) |
++                      PLL_SERIAL_2_SRL_PR(rep));
++
++      /* set color matrix bypass flag: */
++      reg_set(encoder, REG_MAT_CONTRL, MAT_CONTRL_MAT_BP);
++
++      /* set BIAS tmds value: */
++      reg_write(encoder, REG_ANA_GENERAL, 0x09);
++
++      reg_clear(encoder, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_MTHD);
++
++      /*
++       * Sync on rising HSYNC/VSYNC
++       */
++      reg_write(encoder, REG_VIP_CNTRL_3, 0);
++      reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_SYNC_HS);
++
++      /*
++       * TDA19988 requires high-active sync at input stage,
++       * so invert low-active sync provided by master encoder here
++       */
++      if ((mode->flags & FB_SYNC_HOR_HIGH_ACT) == 0)
++              reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_H_TGL);
++      if ((mode->flags & FB_SYNC_VERT_HIGH_ACT) == 0)
++              reg_set(encoder, REG_VIP_CNTRL_3, VIP_CNTRL_3_V_TGL);
++
++      /*
++       * Always generate sync polarity relative to input sync and
++       * revert input stage toggled sync at output stage
++       */
++      reg = TBG_CNTRL_1_TGL_EN;
++      if ((mode->flags & FB_SYNC_HOR_HIGH_ACT) == 0)
++              reg |= TBG_CNTRL_1_H_TGL;
++      if ((mode->flags & FB_SYNC_VERT_HIGH_ACT) == 0)
++              reg |= TBG_CNTRL_1_V_TGL;
++      reg_write(encoder, REG_TBG_CNTRL_1, reg);
++
++      reg_write(encoder, REG_VIDFORMAT, 0x00);
++      reg_write16(encoder, REG_REFPIX_MSB, ref_pix);
++      reg_write16(encoder, REG_REFLINE_MSB, ref_line);
++      reg_write16(encoder, REG_NPIX_MSB, n_pix);
++      reg_write16(encoder, REG_NLINE_MSB, n_line);
++      reg_write16(encoder, REG_VS_LINE_STRT_1_MSB, vs1_line_s);
++      reg_write16(encoder, REG_VS_PIX_STRT_1_MSB, vs1_pix_s);
++      reg_write16(encoder, REG_VS_LINE_END_1_MSB, vs1_line_e);
++      reg_write16(encoder, REG_VS_PIX_END_1_MSB, vs1_pix_e);
++      reg_write16(encoder, REG_VS_LINE_STRT_2_MSB, vs2_line_s);
++      reg_write16(encoder, REG_VS_PIX_STRT_2_MSB, vs2_pix_s);
++      reg_write16(encoder, REG_VS_LINE_END_2_MSB, vs2_line_e);
++      reg_write16(encoder, REG_VS_PIX_END_2_MSB, vs2_pix_e);
++      reg_write16(encoder, REG_HS_PIX_START_MSB, hs_pix_s);
++      reg_write16(encoder, REG_HS_PIX_STOP_MSB, hs_pix_e);
++      reg_write16(encoder, REG_VWIN_START_1_MSB, vwin1_line_s);
++      reg_write16(encoder, REG_VWIN_END_1_MSB, vwin1_line_e);
++      reg_write16(encoder, REG_VWIN_START_2_MSB, vwin2_line_s);
++      reg_write16(encoder, REG_VWIN_END_2_MSB, vwin2_line_e);
++      reg_write16(encoder, REG_DE_START_MSB, de_pix_s);
++      reg_write16(encoder, REG_DE_STOP_MSB, de_pix_e);
++
++      if (priv->rev == TDA19988) {
++              /* let incoming pixels fill the active space (if any) */
++              reg_write(encoder, REG_ENABLE_SPACE, 0x01);
++      }
++
++      /* must be last register set: */
++      reg_clear(encoder, REG_TBG_CNTRL_0, TBG_CNTRL_0_SYNC_ONCE);
++
++}
++
++/* I2C driver functions */
++static int
++da8xx_tda998x_probe(struct i2c_client *client, const struct i2c_device_id *id)
++{
++      struct tda998x_priv *priv;
++      struct da8xx_encoder *encoder;
++
++      priv = kzalloc(sizeof(*priv), GFP_KERNEL);
++      if (!priv)
++              return -ENOMEM;
++
++      priv->current_page = 0;
++
++      encoder = kzalloc(sizeof(*encoder), GFP_KERNEL);
++      if (!encoder) {
++              kfree(priv);
++              return -ENOMEM;
++      }
++
++      priv->cec = i2c_new_dummy(client->adapter, 0x34);
++
++      encoder->client = client;
++      encoder->priv = priv;
++      encoder->node = client->dev.of_node;
++      encoder->set_mode = da8xx_tda998x_setmode;
++
++
++      /* wake up the device: */
++      cec_write(encoder, REG_CEC_ENAMODS,
++                      CEC_ENAMODS_EN_RXSENS | CEC_ENAMODS_EN_HDMI);
++
++      tda998x_reset(encoder);
++
++      /* read version: */
++      priv->rev = reg_read(encoder, REG_VERSION_LSB) |
++                      reg_read(encoder, REG_VERSION_MSB) << 8;
++
++      /* mask off feature bits: */
++      priv->rev &= ~0x30; /* not-hdcp and not-scalar bit */
++
++      switch (priv->rev) {
++      case TDA9989N2:
++              dev_info(&client->dev, "found TDA9989 n2");
++              break;
++      case TDA19989:
++              dev_info(&client->dev, "found TDA19989");
++              break;
++      case TDA19989N2:
++              dev_info(&client->dev, "found TDA19989 n2");
++              break;
++      case TDA19988:
++              dev_info(&client->dev, "found TDA19988");
++              break;
++      default:
++              DBG("found unsupported device: %04x", priv->rev);
++              goto fail;
++      }
++
++      da8xx_register_encoder(encoder);
++
++      /* after reset, enable DDC: */
++      reg_write(encoder, REG_DDC_DISABLE, 0x00);
++
++      /* set clock on DDC channel: */
++      reg_write(encoder, REG_TX3, 39);
++
++      /* if necessary, disable multi-master: */
++      if (priv->rev == TDA19989)
++              reg_set(encoder, REG_I2C_MASTER, I2C_MASTER_DIS_MM);
++
++      cec_write(encoder, REG_CEC_FRO_IM_CLK_CTRL,
++                      CEC_FRO_IM_CLK_CTRL_GHOST_DIS |
++                              CEC_FRO_IM_CLK_CTRL_IMCLK_SEL);
++
++      i2c_set_clientdata(client, encoder);
++
++      return 0;
++
++fail:
++      /* if encoder_init fails, the encoder slave is never registered,
++       * so cleanup here:
++       */
++      if (priv->cec)
++              i2c_unregister_device(priv->cec);
++
++      kfree(priv);
++      kfree(encoder);
++      return -ENXIO;
++}
++
++static int
++da8xx_tda998x_remove(struct i2c_client *client)
++{
++      struct da8xx_encoder *da8xx_encoder;
++      struct tda998x_priv *priv;
++
++      da8xx_encoder = i2c_get_clientdata(client);
++      if (da8xx_encoder) {
++              da8xx_unregister_encoder(da8xx_encoder);
++              priv = to_tda998x_priv(da8xx_encoder);
++              if (priv->cec) {
++                      /* disable the device: */
++                      cec_write(da8xx_encoder, REG_CEC_ENAMODS, 0);
++                      i2c_unregister_device(priv->cec);
++              }
++              kfree(da8xx_encoder->priv);
++              kfree(da8xx_encoder);
++      }
++      return 0;
++}
++
++
++static struct i2c_device_id da8xx_tda998x_ids[] = {
++      { "tda998x", 0 },
++      { }
++};
++MODULE_DEVICE_TABLE(i2c, da8xx_tda998x_ids);
++
++static struct i2c_driver da8xx_tda998x_driver = {
++      .probe = da8xx_tda998x_probe,
++      .remove = da8xx_tda998x_remove,
++      .driver = {
++              .owner = THIS_MODULE,
++              .name = "tda998x",
++      },
++      .id_table = da8xx_tda998x_ids,
++};
++
++module_i2c_driver(da8xx_tda998x_driver);
++
++MODULE_DESCRIPTION("NXP TDA998x HDMI encoder driver for TI AM335x/DA8xx");
++MODULE_AUTHOR("Texas Instruments");
++MODULE_LICENSE("GPL");
+--- a/drivers/video/Kconfig
++++ b/drivers/video/Kconfig
+@@ -2234,6 +2234,14 @@ config FB_DA8XX
+         found on DA8xx/OMAP-L1xx/AM335x SoCs.
+         If unsure, say N.
++config FB_DA8XX_TDA998X
++       tristate "NXP TDA998x HDMI driver for BeagleBone Black"
++       depends on FB_DA8XX
++      ---help---
++        This is a driver for NXP TDA998X HDMI as used on the BeagleBone
++        Black.
++        If unsure, say N.
++
+ config FB_VIRTUAL
+       tristate "Virtual Frame Buffer support (ONLY FOR TESTING!)"
+       depends on FB
+--- a/drivers/video/Makefile
++++ b/drivers/video/Makefile
+@@ -164,6 +164,7 @@ obj-$(CONFIG_FB_BFIN_T350MCQB)       += bfin
+ obj-$(CONFIG_FB_BFIN_7393)        += bfin_adv7393fb.o
+ obj-$(CONFIG_FB_MX3)            += mx3fb.o
+ obj-$(CONFIG_FB_DA8XX)                  += da8xx-fb.o
++obj-$(CONFIG_FB_DA8XX_TDA998X)          += da8xx-tda998x-hdmi.o
+ obj-$(CONFIG_FB_MXS)            += mxsfb.o
+ obj-$(CONFIG_FB_SSD1307)        += ssd1307fb.o
+ obj-$(CONFIG_FB_SIMPLE)           += simplefb.o
+--- a/drivers/video/omap2/displays-new/connector-analog-tv.c
++++ b/drivers/video/omap2/displays-new/connector-analog-tv.c
+@@ -12,6 +12,7 @@
+ #include <linux/slab.h>
+ #include <linux/module.h>
+ #include <linux/platform_device.h>
++#include <linux/of.h>
+ #include <video/omapdss.h>
+ #include <video/omap-panel-data.h>
+@@ -42,6 +43,12 @@ static const struct omap_video_timings t
+       .interlace      = true,
+ };
++static const struct of_device_id tvc_of_match[];
++
++struct tvc_of_data {
++      enum omap_dss_venc_type connector_type;
++};
++
+ #define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev)
+ static int tvc_connect(struct omap_dss_device *dssdev)
+@@ -205,6 +212,36 @@ static int tvc_probe_pdata(struct platfo
+       return 0;
+ }
++static int tvc_probe_of(struct platform_device *pdev,
++              const struct tvc_of_data *data)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      ddata->connector_type = data->connector_type;
++
++      ddata->invert_polarity =
++              of_property_read_bool(node, "invert-polarity");
++
++      return 0;
++}
++
++
+ static int tvc_probe(struct platform_device *pdev)
+ {
+       struct panel_drv_data *ddata;
+@@ -222,6 +259,18 @@ static int tvc_probe(struct platform_dev
+               r = tvc_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              const struct of_device_id *match;
++
++              match = of_match_node(tvc_of_match, pdev->dev.of_node);
++              if (!match) {
++                      dev_err(&pdev->dev, "unsupported device\n");
++                      return -ENODEV;
++              }
++
++              r = tvc_probe_of(pdev, match->data);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -263,12 +312,33 @@ static int __exit tvc_remove(struct plat
+       return 0;
+ }
++static const struct tvc_of_data tv_svideo_data = {
++      .connector_type = OMAP_DSS_VENC_TYPE_SVIDEO,
++};
++
++static const struct tvc_of_data tv_composite_video_data = {
++      .connector_type = OMAP_DSS_VENC_TYPE_COMPOSITE,
++};
++
++static const struct of_device_id tvc_of_match[] = {
++      {
++              .compatible = "ti,svideo-connector",
++              .data = &tv_svideo_data,
++      },
++      {
++              .compatible = "ti,composite-video-connector",
++              .data = &tv_composite_video_data,
++      },
++      {},
++};
++
+ static struct platform_driver tvc_connector_driver = {
+       .probe  = tvc_probe,
+       .remove = __exit_p(tvc_remove),
+       .driver = {
+               .name   = "connector-analog-tv",
+               .owner  = THIS_MODULE,
++              .of_match_table = tvc_of_match,
+       },
+ };
+--- a/drivers/video/omap2/displays-new/connector-dvi.c
++++ b/drivers/video/omap2/displays-new/connector-dvi.c
+@@ -274,6 +274,42 @@ static int dvic_probe_pdata(struct platf
+       return 0;
+ }
++static int dvic_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      struct device_node *adapter_node;
++      struct i2c_adapter *adapter;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      adapter_node = of_parse_phandle(node, "i2c-bus", 0);
++      if (adapter_node) {
++              adapter = of_find_i2c_adapter_by_node(adapter_node);
++              if (adapter == NULL) {
++                      dev_err(&pdev->dev, "failed to parse i2c-bus\n");
++                      return -EPROBE_DEFER;
++              }
++
++              ddata->i2c_adapter = adapter;
++      }
++
++      return 0;
++}
++
+ static int dvic_probe(struct platform_device *pdev)
+ {
+       struct panel_drv_data *ddata;
+@@ -290,6 +326,10 @@ static int dvic_probe(struct platform_de
+               r = dvic_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = dvic_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -335,12 +375,20 @@ static int __exit dvic_remove(struct pla
+       return 0;
+ }
++static const struct of_device_id dvic_of_match[] = {
++      { .compatible = "ti,dvi_connector", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, dvic_of_match);
++
+ static struct platform_driver dvi_connector_driver = {
+       .probe  = dvic_probe,
+       .remove = __exit_p(dvic_remove),
+       .driver = {
+               .name   = "connector-dvi",
+               .owner  = THIS_MODULE,
++              .of_match_table = dvic_of_match,
+       },
+ };
+--- a/drivers/video/omap2/displays-new/connector-hdmi.c
++++ b/drivers/video/omap2/displays-new/connector-hdmi.c
+@@ -12,6 +12,7 @@
+ #include <linux/slab.h>
+ #include <linux/module.h>
+ #include <linux/platform_device.h>
++#include <linux/of.h>
+ #include <drm/drm_edid.h>
+@@ -301,6 +302,29 @@ static int hdmic_probe_pdata(struct plat
+       return 0;
+ }
++static int hdmic_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      return 0;
++}
++
+ static int hdmic_probe(struct platform_device *pdev)
+ {
+       struct panel_drv_data *ddata;
+@@ -318,6 +342,10 @@ static int hdmic_probe(struct platform_d
+               r = hdmic_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = hdmic_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -359,12 +387,20 @@ static int __exit hdmic_remove(struct pl
+       return 0;
+ }
++static const struct of_device_id hdmic_of_match[] = {
++      { .compatible = "ti,hdmi_connector", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, hdmic_of_match);
++
+ static struct platform_driver hdmi_connector_driver = {
+       .probe  = hdmic_probe,
+       .remove = __exit_p(hdmic_remove),
+       .driver = {
+               .name   = "connector-hdmi",
+               .owner  = THIS_MODULE,
++              .of_match_table = hdmic_of_match,
+       },
+ };
+--- /dev/null
++++ b/drivers/video/omap2/displays-new/dra-evm-encoder-tpd12s015.c
+@@ -0,0 +1,556 @@
++/*
++ * TPD12S015 HDMI ESD protection & level shifter chip driver
++ *
++ * Copyright (C) 2013 Texas Instruments
++ * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
++ *
++ * 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.
++ */
++
++#include <linux/delay.h>
++#include <linux/module.h>
++#include <linux/slab.h>
++#include <linux/gpio.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <linux/of_gpio.h>
++
++#include <video/omapdss.h>
++#include <video/omap-panel-data.h>
++
++#define CLK_BASE                      0x4a009000
++#define MCASP2_BASE                   0x48464000
++#define       CTRL_BASE                       0x4a003400
++#define       PINMUX_BASE                     0x4a003600
++
++#define CM_L4PER2_MCASP2_CLKCTRL      0x860
++#define       CM_L4PER2_CLKSTCTRL             0x8fc
++#define MCASP_PFUNC                   0x10
++#define MCASP_PDIR                    0x14
++#define MCASP_PDOUT                   0x18
++#define PAD_I2C2_SDA                  0x408
++#define PAD_I2C2_SCL                  0x40c
++
++#define SEL_I2C2      0
++#define SEL_HDMI      1
++
++struct panel_drv_data {
++      struct omap_dss_device dssdev;
++      struct omap_dss_device *in;
++
++      int ct_cp_hpd_gpio;
++      int ls_oe_gpio;
++      int hpd_gpio;
++
++      struct omap_video_timings timings;
++};
++
++static void config_sel_hdmi_i2c2(struct device *dev)
++{
++      void __iomem *clk_base = ioremap(CLK_BASE, SZ_4K);
++      void __iomem *mcasp2_base = ioremap(MCASP2_BASE, SZ_1K);
++      void __iomem *pmux_base = ioremap(PINMUX_BASE, SZ_1K);
++
++      if (!clk_base) {
++              dev_err(dev, "couldn't ioremap clock domain regs\n");
++              return;
++      }
++
++      if (!mcasp2_base) {
++              dev_err(dev, "couldn't ioremap MCASP2 regs\n");
++              goto mcasp_err;
++      }
++
++      if (!pmux_base) {
++              dev_err(dev, "couldn't ioremap PMUX regs\n");
++              goto pmux_err;
++      }
++
++      iowrite32(0x40000, pmux_base + 0xfc);
++
++      /* set CM_L4PER2_CLKSTCTRL to sw supervised wkup */
++      iowrite32(0x2, clk_base + CM_L4PER2_CLKSTCTRL);
++
++      /*
++       * Enable the MCASP8_AUX_GFCLK[22:23]: 0x0 - use default
++       * CM_L4PER2_MCASP8_CLKCTRL[1:0]: 0x2 - Enable explicitly
++      */
++      iowrite32(0x2, clk_base + CM_L4PER2_MCASP2_CLKCTRL);
++
++      dev_dbg(dev, "CM_L4PER2_CLKSTCTRL %08x\n",
++              ioread32(clk_base + CM_L4PER2_CLKSTCTRL));
++
++      /* let it propogate */
++
++      udelay(5);
++      /*
++       * make mcasp8_axr2 a gpio and set direction to high
++       */
++      iowrite32(1 << 29, mcasp2_base + MCASP_PFUNC);
++      iowrite32(1 << 29, mcasp2_base + MCASP_PDIR);
++
++      iounmap(pmux_base);
++pmux_err:
++      iounmap(mcasp2_base);
++mcasp_err:
++      iounmap(clk_base);
++}
++
++/*
++ * use I2C2 to configure pcf8575@26 to set/unset LS_OE and CT_HPD, use HDMI to
++ * read edid via the HDMI ddc lines, and recieve HPD events
++ */
++void config_demux(struct device *dev, int sel)
++{
++      void __iomem *mcasp2_base = ioremap(MCASP2_BASE, SZ_1K);
++      void __iomem *ctrl_base = ioremap(CTRL_BASE, SZ_1K);
++
++      if (!mcasp2_base) {
++              dev_err(dev, "couldn't ioremap MCASP8 regs\n");
++              return;
++      }
++
++      if (!ctrl_base) {
++              dev_err(dev, "couldn't ioremap CTRL base\n");
++              goto err_ctrl;
++      }
++
++      /*
++       * switch to I2C2 or HDMI DDC internal pinmux and drive MCASP8_PDOUT
++       * to low or high to select I2C2 or HDMI path respectively
++       */
++      if (sel == SEL_I2C2) {
++              iowrite32(0x0, mcasp2_base + MCASP_PDOUT);
++              iowrite32(0x60000, ctrl_base + PAD_I2C2_SDA);
++              iowrite32(0x60000, ctrl_base + PAD_I2C2_SCL);
++      } else {
++              iowrite32(1 << 29, mcasp2_base + MCASP_PDOUT);
++              iowrite32(0x60001, ctrl_base + PAD_I2C2_SDA);
++              iowrite32(0x60001, ctrl_base + PAD_I2C2_SCL);
++      }
++
++      /* let it propogate */
++      udelay(5);
++
++      dev_dbg(dev, "select %d, PDOUT %08x\n", sel,
++              ioread32(mcasp2_base + MCASP_PDOUT));
++
++      iounmap(ctrl_base);
++err_ctrl:
++      iounmap(mcasp2_base);
++}
++
++#define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev)
++
++static int tpd_connect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      bool hpd;
++      int r;
++
++      r = in->ops.hdmi->connect(in, dssdev);
++      if (r)
++              return r;
++
++      dst->src = dssdev;
++      dssdev->dst = dst;
++
++      config_demux(dssdev->dev, SEL_I2C2);
++
++      gpio_set_value_cansleep(ddata->ct_cp_hpd_gpio, 1);
++
++      config_demux(dssdev->dev, SEL_HDMI);
++
++      /* DC-DC converter needs at max 300us to get to 90% of 5V */
++      udelay(300);
++
++      /*
++       * If there's a cable connected, hpd will be up, turn the level shifters
++       * accordingly
++       */
++      hpd = gpio_get_value_cansleep(ddata->hpd_gpio);
++
++      config_demux(dssdev->dev, SEL_I2C2);
++
++      if (gpio_is_valid(ddata->ls_oe_gpio)) {
++              if (hpd)
++                      gpio_set_value_cansleep(ddata->ls_oe_gpio, 1);
++              else
++                      gpio_set_value_cansleep(ddata->ls_oe_gpio, 0);
++      }
++
++      config_demux(dssdev->dev, SEL_HDMI);
++
++      return 0;
++}
++
++static void tpd_disconnect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      WARN_ON(dst != dssdev->dst);
++
++      if (dst != dssdev->dst)
++              return;
++
++      config_demux(dssdev->dev, SEL_I2C2);
++
++      gpio_set_value_cansleep(ddata->ct_cp_hpd_gpio, 0);
++
++      config_demux(dssdev->dev, SEL_HDMI);
++
++      dst->src = NULL;
++      dssdev->dst = NULL;
++
++      in->ops.hdmi->disconnect(in, &ddata->dssdev);
++}
++
++static int tpd_enable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int r;
++
++      if (dssdev->state == OMAP_DSS_DISPLAY_ACTIVE)
++              return 0;
++
++      in->ops.hdmi->set_timings(in, &ddata->timings);
++
++      r = in->ops.hdmi->enable(in);
++      if (r)
++              return r;
++
++      dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
++
++      return r;
++}
++
++static void tpd_disable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      if (dssdev->state != OMAP_DSS_DISPLAY_ACTIVE)
++              return;
++
++      in->ops.hdmi->disable(in);
++
++      dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
++}
++
++static void tpd_set_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      ddata->timings = *timings;
++      dssdev->panel.timings = *timings;
++
++      in->ops.hdmi->set_timings(in, timings);
++}
++
++static void tpd_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++
++      *timings = ddata->timings;
++}
++
++static int tpd_check_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int r;
++
++      r = in->ops.hdmi->check_timings(in, timings);
++
++      return r;
++}
++
++static int tpd_read_edid(struct omap_dss_device *dssdev,
++              u8 *edid, int len)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      if (!gpio_get_value_cansleep(ddata->hpd_gpio))
++              return -ENODEV;
++
++      return in->ops.hdmi->read_edid(in, edid, len);
++}
++
++static bool tpd_detect(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++
++      return gpio_get_value_cansleep(ddata->hpd_gpio);
++}
++
++static int tpd_audio_enable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      return in->ops.hdmi->audio_enable(in);
++}
++
++static void tpd_audio_disable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      in->ops.hdmi->audio_disable(in);
++}
++
++static int tpd_audio_start(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      return in->ops.hdmi->audio_start(in);
++}
++
++static void tpd_audio_stop(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      in->ops.hdmi->audio_stop(in);
++}
++
++static bool tpd_audio_supported(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      return in->ops.hdmi->audio_supported(in);
++}
++
++static int tpd_audio_config(struct omap_dss_device *dssdev,
++              struct omap_dss_audio *audio)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      return in->ops.hdmi->audio_config(in, audio);
++}
++
++static const struct omapdss_hdmi_ops tpd_hdmi_ops = {
++      .connect                = tpd_connect,
++      .disconnect             = tpd_disconnect,
++
++      .enable                 = tpd_enable,
++      .disable                = tpd_disable,
++
++      .check_timings          = tpd_check_timings,
++      .set_timings            = tpd_set_timings,
++      .get_timings            = tpd_get_timings,
++
++      .read_edid              = tpd_read_edid,
++      .detect                 = tpd_detect,
++
++      .audio_enable           = tpd_audio_enable,
++      .audio_disable          = tpd_audio_disable,
++      .audio_start            = tpd_audio_start,
++      .audio_stop             = tpd_audio_stop,
++      .audio_supported        = tpd_audio_supported,
++      .audio_config           = tpd_audio_config,
++};
++
++static int tpd_probe_pdata(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct encoder_tpd12s015_platform_data *pdata;
++      struct omap_dss_device *dssdev, *in;
++
++      pdata = dev_get_platdata(&pdev->dev);
++
++      ddata->ct_cp_hpd_gpio = pdata->ct_cp_hpd_gpio;
++      ddata->ls_oe_gpio = pdata->ls_oe_gpio;
++      ddata->hpd_gpio = pdata->hpd_gpio;
++
++      in = omap_dss_find_output(pdata->source);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "Failed to find video source\n");
++              return -ENODEV;
++      }
++
++      ddata->in = in;
++
++      dssdev = &ddata->dssdev;
++      dssdev->name = pdata->name;
++
++      return 0;
++}
++
++static int tpd_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      int gpio;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      /* CT CP HPD GPIO */
++      gpio = of_get_gpio(node, 0);
++      if (!gpio_is_valid(gpio)) {
++              dev_err(&pdev->dev, "failed to parse CT CP HPD gpio\n");
++              return gpio;
++      }
++      ddata->ct_cp_hpd_gpio = gpio;
++
++      /* LS OE GPIO */
++      gpio = of_get_gpio(node, 1);
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->ls_oe_gpio = gpio;
++      } else {
++              dev_err(&pdev->dev, "failed to parse LS OE gpio\n");
++              return gpio;
++      }
++
++      /* HPD GPIO */
++      gpio = of_get_gpio(node, 2);
++      if (!gpio_is_valid(gpio)) {
++              dev_err(&pdev->dev, "failed to parse HPD gpio\n");
++              return gpio;
++      }
++      ddata->hpd_gpio = gpio;
++
++      return 0;
++}
++
++static int tpd_probe(struct platform_device *pdev)
++{
++      struct omap_dss_device *in, *dssdev;
++      struct panel_drv_data *ddata;
++      int r;
++
++      ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL);
++      if (!ddata)
++              return -ENOMEM;
++
++      platform_set_drvdata(pdev, ddata);
++
++      if (dev_get_platdata(&pdev->dev)) {
++              r = tpd_probe_pdata(pdev);
++              if (r)
++                      return r;
++      } else if (pdev->dev.of_node) {
++              r = tpd_probe_of(pdev);
++              if (r)
++                      return r;
++      } else {
++              return -ENODEV;
++      }
++
++      /* configure the SEL_HDMI_I2C2 line going to the demux */
++      config_sel_hdmi_i2c2(&pdev->dev);
++
++      config_demux(&pdev->dev, SEL_I2C2);
++
++      r = devm_gpio_request_one(&pdev->dev, ddata->ct_cp_hpd_gpio,
++                      GPIOF_OUT_INIT_LOW, "hdmi_ct_cp_hpd");
++      if (r)
++              goto err_gpio;
++
++      if (gpio_is_valid(ddata->ls_oe_gpio)) {
++              r = devm_gpio_request_one(&pdev->dev, ddata->ls_oe_gpio,
++                              GPIOF_OUT_INIT_LOW, "hdmi_ls_oe");
++              if (r)
++                      goto err_gpio;
++      }
++
++      r = devm_gpio_request_one(&pdev->dev, ddata->hpd_gpio,
++                      GPIOF_DIR_IN, "hdmi_hpd");
++      if (r)
++              goto err_gpio;
++
++      config_demux(&pdev->dev, SEL_HDMI);
++
++      dssdev = &ddata->dssdev;
++      dssdev->ops.hdmi = &tpd_hdmi_ops;
++      dssdev->dev = &pdev->dev;
++      dssdev->type = OMAP_DISPLAY_TYPE_HDMI;
++      dssdev->output_type = OMAP_DISPLAY_TYPE_HDMI;
++      dssdev->owner = THIS_MODULE;
++
++      in = ddata->in;
++
++      r = omapdss_register_output(dssdev);
++      if (r) {
++              dev_err(&pdev->dev, "Failed to register output\n");
++              goto err_reg;
++      }
++
++      return 0;
++err_reg:
++err_gpio:
++      omap_dss_put_device(ddata->in);
++      return r;
++}
++
++static int __exit tpd_remove(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct omap_dss_device *dssdev = &ddata->dssdev;
++      struct omap_dss_device *in = ddata->in;
++
++      omapdss_unregister_output(&ddata->dssdev);
++
++      WARN_ON(omapdss_device_is_enabled(dssdev));
++      if (omapdss_device_is_enabled(dssdev))
++              tpd_disable(dssdev);
++
++      WARN_ON(omapdss_device_is_connected(dssdev));
++      if (omapdss_device_is_connected(dssdev))
++              tpd_disconnect(dssdev, dssdev->dst);
++
++      omap_dss_put_device(in);
++
++      return 0;
++}
++
++static const struct of_device_id tpd_of_match[] = {
++      { .compatible = "ti,draevm-tpd12s015", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, tpd_of_match);
++
++static struct platform_driver tpd_driver = {
++      .probe  = tpd_probe,
++      .remove = __exit_p(tpd_remove),
++      .driver = {
++              .name   = "draevm-tpd12s015",
++              .owner  = THIS_MODULE,
++              .of_match_table = tpd_of_match,
++      },
++};
++
++module_platform_driver(tpd_driver);
++
++MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
++MODULE_DESCRIPTION("DRAEVM-TPD12S015 driver");
++MODULE_LICENSE("GPL");
+--- /dev/null
++++ b/drivers/video/omap2/displays-new/encoder-sil9022.c
+@@ -0,0 +1,880 @@
++/*
++ * Silicon image Sil9022 DPI-to-HDMI encoder driver
++ *
++ * Copyright (C) 2013 Texas Instruments
++ * Author: Sathya Prakash M R <sathyap@ti.com>
++ *
++ * This file is licensed under the terms of the GNU General Public License
++ * version 2. This program is licensed "as is" without any warranty of any
++ * kind, whether express or implied.
++ *
++ */
++
++#include <linux/module.h>
++#include <linux/kernel.h>
++#include <linux/errno.h>
++#include <linux/string.h>
++#include <linux/types.h>
++#include <linux/slab.h>
++#include <linux/io.h>
++#include <linux/init.h>
++#include <linux/interrupt.h>
++#include <linux/i2c.h>
++#include <linux/device.h>
++#include <linux/delay.h>
++#include <linux/gpio.h>
++#include <linux/platform_device.h>
++#include <linux/regmap.h>
++#include <linux/of_gpio.h>
++
++#include <video/omapdss.h>
++#include <video/omap-panel-data.h>
++#include "encoder-sil9022.h"
++
++struct panel_drv_data {
++      struct omap_dss_device dssdev;
++      struct omap_dss_device *in;
++      struct i2c_client *i2c_client;
++      int reset_gpio;
++      int data_lines;
++      struct regmap *regmap;
++      struct omap_video_timings timings;
++};
++
++#define to_panel_data(x) container_of(x, struct panel_drv_data, dssdev)
++
++static int sil9022_blockwrite_reg(struct i2c_client *client,
++                                u8 reg, u16 alength, u8 *val, u16 *out_len)
++{
++      int err = 0, i;
++      struct i2c_msg msg[1];
++      u8 data[2];
++
++      if (!client->adapter) {
++              dev_err(&client->dev, "ERROR: No HDMI Device\n");
++              return -ENODEV;
++      }
++
++      msg->addr = client->addr;
++      msg->flags = 0;
++      msg->len = 2;
++      msg->buf = data;
++
++      /* high byte goes out first */
++      data[0] = reg >> 8;
++
++      for (i = 0; i < alength - 1; i++) {
++              data[1] = val[i];
++              err = i2c_transfer(client->adapter, msg, 1);
++              udelay(50);
++              dev_dbg(&client->dev, "i2c Block write at 0x%x, "
++                                    "*val=%d flags=%d byte[%d] err=%d\n",
++                      data[0], data[1], msg->flags, i, err);
++              if (err < 0)
++                      break;
++      }
++      /* set the number of bytes written*/
++      *out_len = i;
++
++      if (err < 0) {
++              dev_err(&client->dev, "ERROR:  i2c Block Write at 0x%x, "
++                                    "*val=%d flags=%d bytes written=%d "
++                                    "err=%d\n",
++                      data[0], data[1], msg->flags, i, err);
++              return err;
++      }
++      return 0;
++}
++
++static int sil9022_blockread_reg(struct i2c_client *client,
++                    u16 data_length, u16 alength,
++                    u8 reg, u8 *val, u16 *out_len)
++{
++      int err = 0, i;
++      struct i2c_msg msg[1];
++      u8 data[2];
++
++      if (!client->adapter) {
++              dev_err(&client->dev, "ERROR: No HDMI Device\n");
++              return -ENODEV;
++      }
++
++      msg->addr = client->addr;
++      msg->flags = 0;
++      msg->len = 1;
++      msg->buf = data;
++
++      /* High byte goes out first */
++      data[0] = reg;
++      err = i2c_transfer(client->adapter, msg, 1);
++      dev_dbg(&client->dev, "Block Read1 at 0x%x, "
++                             "*val=%d flags=%d err=%d\n",
++               data[0], data[1], msg->flags, err);
++
++      for (i = 0; i < alength; i++) {
++              if (err >= 0) {
++                      mdelay(3);
++                      msg->flags = I2C_M_RD;
++                      msg->len = data_length;
++                      err = i2c_transfer(client->adapter, msg, 1);
++              } else {
++                      break;
++              }
++              if (err >= 0) {
++                      val[i] = 0;
++                      /* High byte comes first */
++                      if (data_length == 1)
++                              val[i] = data[0];
++                      else if (data_length == 2)
++                              val[i] = data[1] + (data[0] << 8);
++                      dev_dbg(&client->dev, "i2c Block Read2 at 0x%x, "
++                                             "*val=%d flags=%d byte=%d "
++                                             "err=%d\n",
++                               reg, val[i], msg->flags, i, err);
++              } else {
++                      break;
++              }
++      }
++      *out_len = i;
++      dev_dbg(&client->dev, "i2c Block Read at 0x%x, bytes read = %d\n",
++              client->addr, *out_len);
++
++      if (err < 0) {
++              dev_err(&client->dev, "ERROR:  i2c Read at 0x%x, "
++                                    "*val=%d flags=%d bytes read=%d err=%d\n",
++                      reg, *val, msg->flags, i, err);
++              return err;
++      }
++      return 0;
++}
++
++static int sil9022_write_reg(struct omap_dss_device *dssdev,
++                                      u8 reg, unsigned int val)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct regmap *map = ddata->regmap;
++      int err = 0;
++      err = regmap_write(map, reg, val);
++      return err;
++}
++
++static int sil9022_read_reg(struct omap_dss_device *dssdev,
++                                      u8 reg, unsigned int *val)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct regmap *map = ddata->regmap;
++      int err = 0;
++      err = regmap_read(map, reg, val);
++      return err;
++}
++
++static int sil9022_hw_enable(struct omap_dss_device *dssdev)
++{
++      int             err;
++      u8              vals[14];
++      unsigned int val;
++      u16             out_len = 0;
++      u16             horizontal_res;
++      u16             vertical_res;
++      u16             pixel_clk;
++
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_video_timings *hdmi_timings = &ddata->timings;
++      struct i2c_client *sil9022_client = ddata->i2c_client;
++
++      memset(vals, 0, 14);
++
++      horizontal_res = hdmi_timings->x_res;
++      vertical_res = hdmi_timings->y_res;
++      pixel_clk = hdmi_timings->pixel_clock;
++
++      dev_info(dssdev->dev,
++                       "HW_ENABLE -> Timings\n"
++                       "pixel_clk                     = %d\n"
++                       "horizontal res                = %d\n"
++                       "vertical res                  = %d\n",
++                       hdmi_timings->pixel_clock,
++                       hdmi_timings->x_res,
++                       hdmi_timings->y_res
++                       );
++
++      /*  Fill the TPI Video Mode Data structure */
++      vals[0] = (pixel_clk & 0xFF);                  /* Pixel clock */
++      vals[1] = ((pixel_clk & 0xFF00) >> 8);
++      vals[2] = VERTICAL_FREQ;                    /* Vertical freq */
++      /* register programming information on how vertical freq is to be
++      programmed to Sil9022 not clear. Hence setting to 60 for now */
++      vals[3] = 0x00;
++      vals[4] = (horizontal_res & 0xFF);         /* Horizontal pixels*/
++      vals[5] = ((horizontal_res & 0xFF00) >> 8);
++      vals[6] = (vertical_res & 0xFF);           /* Vertical pixels */
++      vals[7] = ((vertical_res & 0xFF00) >> 8);
++
++      /*  Write out the TPI Video Mode Data */
++      out_len = 0;
++      err = sil9022_blockwrite_reg(sil9022_client,
++                                   HDMI_TPI_VIDEO_DATA_BASE_REG,
++                                   8, vals, &out_len);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing TPI video mode data\n");
++              return err;
++      }
++
++      /* Write out the TPI Input bus and pixel repetition Data:
++      (24 bit wide bus, falling edge, no pixel replication, 1:1 CLK ration) */
++      val = TPI_AVI_PIXEL_REP_BUS_24BIT |
++              TPI_AVI_PIXEL_REP_FALLING_EDGE |
++              TPI_AVI_PIXEL_REP_NONE | TPI_CLK_RATIO_1X;
++      err = sil9022_write_reg(dssdev,
++                              HDMI_TPI_PIXEL_REPETITION_REG,
++                              val);
++
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing TPI pixel repetition data\n");
++              return err;
++      }
++
++       /*  Write out the TPI AVI Input Format */
++      val = TPI_AVI_INPUT_BITMODE_8BIT |
++              TPI_AVI_INPUT_RANGE_AUTO |
++              TPI_AVI_INPUT_COLORSPACE_RGB;
++      err = sil9022_write_reg(dssdev,
++                              HDMI_TPI_AVI_IN_FORMAT_REG,
++                              val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing TPI AVI Input format\n");
++              return err;
++      }
++
++      /*  Write out the TPI AVI Output Format */
++      val = TPI_AVI_OUTPUT_CONV_BT709 |
++              TPI_AVI_OUTPUT_RANGE_AUTO |
++              TPI_AVI_OUTPUT_COLORSPACE_RGBHDMI;
++      err = sil9022_write_reg(dssdev,
++                              HDMI_TPI_AVI_OUT_FORMAT_REG, val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing TPI AVI output format\n");
++              return err;
++      }
++
++      /* Write out the TPI System Control Data to power down */
++      val = TPI_SYS_CTRL_POWER_DOWN;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing TPI power down control data\n");
++              return err;
++      }
++
++      /* Move from ENABLED -> FULLY ENABLED Power State  */
++      val = TPI_AVI_POWER_STATE_D0;
++      err = sil9022_write_reg(dssdev,
++                              HDMI_TPI_POWER_STATE_CTRL_REG, val);
++      if (err < 0) {
++              dev_err(&sil9022_client->dev,
++                      "<%s> ERROR: Setting device power state to D0\n",
++                      __func__);
++              return err;
++      }
++
++      /* Write out the TPI System Control Data to power up and
++       * select output mode
++       */
++      val = TPI_SYS_CTRL_POWER_ACTIVE | TPI_SYS_CTRL_OUTPUT_MODE_HDMI;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(&sil9022_client->dev,
++                      "<%s> ERROR: Writing system control data\n", __func__);
++              return err;
++      }
++
++      /*  Read back TPI System Control Data to latch settings */
++      msleep(20);
++      err = sil9022_read_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, &val);
++      if (err < 0) {
++              dev_err(&sil9022_client->dev,
++                      "<%s> ERROR: Writing system control data\n",
++                      __func__);
++              return err;
++      }
++
++      /* HDCP */
++      val = 0; /* DISABLED */
++      err = sil9022_write_reg(dssdev,
++                              HDMI_TPI_HDCP_CONTROLDATA_REG, val);
++      if (err < 0) {
++              dev_err(&sil9022_client->dev,
++                      "<%s> ERROR: Enable (1) / Disable (0) => HDCP: %d\n",
++                      __func__, val);
++              return err;
++      }
++
++      dev_info(&sil9022_client->dev, "<%s> hdmi enabled\n", __func__);
++      return 0;
++
++}
++
++static int sil9022_hw_disable(struct omap_dss_device *dssdev)
++{
++      unsigned int val = 0;
++      int err = 0;
++
++      /*  Write out the TPI System Control Data to power down  */
++      val = TPI_SYS_CTRL_POWER_DOWN;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: writing control data - power down\n");
++              return err;
++      }
++
++      /*  Move from FULLY ENABLED -> ENABLED Power state */
++      val = TPI_AVI_POWER_STATE_D2;
++      err = sil9022_write_reg(dssdev,
++                        HDMI_TPI_DEVICE_POWER_STATE_DATA, val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: Setting device power state to D2\n");
++              return err;
++      }
++
++      /*  Read back TPI System Control Data to latch settings */
++      mdelay(10);
++      err = sil9022_read_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, &val);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR:  Reading System control data "
++                      "- latch settings\n");
++              return err;
++      }
++
++      dev_info(dssdev->dev, "hdmi disabled\n");
++      return 0;
++
++}
++
++static int sil9022_probe_chip_version(struct omap_dss_device *dssdev)
++{
++      int err = 0;
++      unsigned int ver;
++
++      /* probe for sil9022 chip version*/
++      err = sil9022_write_reg(dssdev, SIL9022_REG_TPI_RQB, 0x00);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: Writing HDMI configuration to "
++                      "reg - SI9022_REG_TPI_RQB\n");
++              err = -ENODEV;
++              return err;
++      }
++
++      err = sil9022_read_reg(dssdev, SIL9022_REG_CHIPID0, &ver);
++      if (err < 0) {
++              dev_err(dssdev->dev,
++                      "ERROR: Reading HDMI version Id\n");
++              err = -ENODEV;
++      } else if (ver != SIL9022_CHIPID_902x) {
++              dev_err(dssdev->dev,
++                      "Not a valid verId: 0x%x\n", ver);
++              err = -ENODEV;
++      } else {
++              dev_info(dssdev->dev,
++                       "sil9022 HDMI Chip version = %x\n", ver);
++      }
++      return err;
++}
++
++/* Hdmi ops */
++
++static int sil9022_connect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int err;
++
++      dev_err(dssdev->dev, "CONNECT\n");
++
++      if (omapdss_device_is_connected(dssdev))
++              return -EBUSY;
++
++      err = in->ops.dpi->connect(in, dssdev);
++      if (err)
++              return err;
++
++      dst->src = dssdev;
++      dssdev->dst = dst;
++
++      /* Move from LOW -> ENABLED Power state */
++      err = sil9022_write_reg(dssdev, HDMI_TPI_POWER_STATE_CTRL_REG,
++                      TPI_AVI_POWER_STATE_D2);
++      if (err < 0) {
++              dev_err(dssdev->dev, "ERROR: Setting device power state to D2\n");
++              return err;
++      }
++
++      return 0;
++
++}
++
++static void sil9022_disconnect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int err;
++
++      WARN_ON(!omapdss_device_is_connected(dssdev));
++      if (!omapdss_device_is_connected(dssdev))
++              return;
++
++      WARN_ON(dst != dssdev->dst);
++      if (dst != dssdev->dst)
++              return;
++
++      dst->src = NULL;
++      dssdev->dst = NULL;
++
++      /* Move from ENABLED -> LOW Power state */
++      err = sil9022_write_reg(dssdev, HDMI_TPI_POWER_STATE_CTRL_REG,
++                      TPI_AVI_POWER_STATE_D3);
++      if (err < 0) {
++              dev_err(dssdev->dev, "ERROR: Setting device power state to D3\n");
++      }
++
++      in->ops.dpi->disconnect(in, &ddata->dssdev);
++      return;
++
++}
++
++static int sil9022_enable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int r;
++
++      dev_err(dssdev->dev, "ENABLE\n");
++
++      if (!omapdss_device_is_connected(dssdev))
++              return -ENODEV;
++
++      if (omapdss_device_is_enabled(dssdev))
++              return 0;
++
++      in->ops.dpi->set_timings(in, &ddata->timings);
++      in->ops.dpi->set_data_lines(in, ddata->data_lines);
++
++      r = in->ops.dpi->enable(in);
++      if (r)
++              return r;
++
++      if (gpio_is_valid(ddata->reset_gpio))
++              gpio_set_value_cansleep(ddata->reset_gpio, 0);
++
++      r = sil9022_hw_enable(dssdev);
++      if (r)
++              return r;
++
++      dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
++      return 0;
++}
++
++static void sil9022_disable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      if (!omapdss_device_is_enabled(dssdev))
++              return;
++
++      if (!sil9022_hw_disable(dssdev))
++              return;
++
++      if (gpio_is_valid(ddata->reset_gpio))
++              gpio_set_value_cansleep(ddata->reset_gpio, 1);
++
++      in->ops.dpi->disable(in);
++
++      dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
++      return;
++}
++
++static void sil9022_set_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      struct omap_video_timings *sil9022_timings = timings;
++
++       /* update DPI specific timing info */
++      sil9022_timings->data_pclk_edge  = OMAPDSS_DRIVE_SIG_RISING_EDGE;
++      sil9022_timings->de_level                 = OMAPDSS_SIG_ACTIVE_HIGH;
++      sil9022_timings->sync_pclk_edge = OMAPDSS_DRIVE_SIG_OPPOSITE_EDGES;
++      ddata->timings = *sil9022_timings;
++      dssdev->panel.timings = *sil9022_timings;
++
++      in->ops.dpi->set_timings(in, sil9022_timings);
++      return;
++}
++
++static void sil9022_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      *timings = ddata->timings;
++      return;
++}
++
++static int sil9022_check_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      struct omap_video_timings *sil9022_timings = timings;
++
++      /* update DPI specific timing info */
++      sil9022_timings->data_pclk_edge  = OMAPDSS_DRIVE_SIG_RISING_EDGE;
++      sil9022_timings->de_level                 = OMAPDSS_SIG_ACTIVE_HIGH;
++      sil9022_timings->sync_pclk_edge = OMAPDSS_DRIVE_SIG_OPPOSITE_EDGES;
++
++      return in->ops.dpi->check_timings(in, sil9022_timings);
++}
++
++static int sil9022_read_edid(struct omap_dss_device *dssdev,
++             u8 *edid, int len)
++{
++
++      int err =  0;
++      unsigned int val = 0;
++      int retries = 0;
++      u16 out_len = 0;
++      int i2c_client_addr;
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct i2c_client *client = ddata->i2c_client;
++
++      len = (len < HDMI_EDID_MAX_LENGTH) ? len : HDMI_EDID_MAX_LENGTH;
++
++      /* Request DDC bus access to read EDID info from HDTV */
++      dev_info(&client->dev, "Reading HDMI EDID\n");
++
++      val = 0;
++      err = sil9022_read_reg(dssdev, 0x3D, &val);
++              if (err < 0) {
++                      dev_err(&client->dev,
++                              "ERROR: Reading Monitor Status register\n");
++                      return err;
++      }
++
++      if (val & 0x2)
++              dev_err(&client->dev, " MONITOR PRESENT \n");
++      else
++              dev_err(&client->dev, " MONITOR NOT PRESENT \n");
++
++      /* Disable TMDS clock */
++      val = 0x11;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(&client->dev,
++                      "ERROR: Failed to disable TMDS clock\n");
++              return err;
++      }
++
++      val = 0;
++
++      /* Read TPI system control register*/
++      err = sil9022_read_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, &val);
++      if (err < 0) {
++              dev_err(&client->dev,
++                      "ERROR: Reading DDC BUS REQUEST\n");
++              return err;
++      }
++
++      /* The host writes 0x1A[2]=1 to request the
++       * DDC(Display Data Channel) bus
++       */
++      val |= TPI_SYS_CTRL_DDC_BUS_REQUEST;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(&client->dev,
++                      "ERROR: Writing DDC BUS REQUEST\n");
++              return err;
++      }
++
++       /*  Poll for bus DDC Bus control to be granted */
++      dev_info(&client->dev, "Poll for DDC bus access\n");
++      val = 0;
++      do {
++              err = sil9022_read_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, &val);
++              if (retries++ > 100)
++                      return err;
++
++      } while ((val & TPI_SYS_CTRL_DDC_BUS_GRANTED) == 0);
++
++      /*  Close the switch to the DDC */
++      val |= TPI_SYS_CTRL_DDC_BUS_REQUEST | TPI_SYS_CTRL_DDC_BUS_GRANTED;
++      err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++      if (err < 0) {
++              dev_err(&client->dev,
++                      "<%s> ERROR: Close switch to DDC BUS REQUEST\n",
++                      __func__);
++              return err;
++      }
++
++      memset(edid, 0, len);
++      /* change I2C SetSlaveAddress to HDMI_I2C_MONITOR_ADDRESS */
++      /*  Read the EDID structure from the monitor I2C address  */
++      i2c_client_addr = client->addr;
++      client->addr = HDMI_I2C_MONITOR_ADDRESS;
++      err = sil9022_blockread_reg(client, 1, len,
++                                  0x00, edid, &out_len);
++      if (err < 0 || out_len <= 0) {
++              dev_err(&client->dev, "ERROR: Reading EDID\n");
++              return err;
++      }
++
++      /* Release DDC bus access */
++      client->addr = i2c_client_addr;
++      val &= ~(TPI_SYS_CTRL_DDC_BUS_REQUEST | TPI_SYS_CTRL_DDC_BUS_GRANTED);
++
++      retries = 0;
++      do {
++              err = sil9022_write_reg(dssdev, HDMI_SYS_CTRL_DATA_REG, val);
++              if (err >= 0)
++                      break;
++              retries++;
++      } while (retries < 5);
++      if (err < 0) {
++              dev_err(&client->dev, "ERROR: Releasing DDC Bus Access\n");
++              return err;
++              }
++
++      print_hex_dump(KERN_ERR, "\t", DUMP_PREFIX_NONE, 16, 1, edid, len, 0);
++
++      return 0;
++
++}
++
++static bool sil9022_detect(struct omap_dss_device *dssdev)
++{
++      /* Hot plug detection is not implemented */
++      /* Hence we assume monitor connected */
++      /* This will be fixed once HPD / polling is implemented */
++      return true;
++}
++
++static bool sil9022_audio_supported(struct omap_dss_device *dssdev)
++{
++      /* Audio configuration not present, hence returning false */
++      return false;
++}
++
++static const struct omapdss_hdmi_ops sil9022_hdmi_ops = {
++      .connect                        = sil9022_connect,
++      .disconnect             = sil9022_disconnect,
++
++      .enable                 = sil9022_enable,
++      .disable                        = sil9022_disable,
++
++      .check_timings  = sil9022_check_timings,
++      .set_timings            = sil9022_set_timings,
++      .get_timings            = sil9022_get_timings,
++
++      .read_edid              = sil9022_read_edid,
++      .detect                 = sil9022_detect,
++
++      .audio_supported        = sil9022_audio_supported,
++      /* Yet to implement audio ops */
++      /* For now audio_supported ops to return false */
++};
++
++
++static int sil9022_probe_of(struct i2c_client *client)
++{
++      struct panel_drv_data *ddata = dev_get_drvdata(&client->dev);
++      struct device_node *node = client->dev.of_node;
++      struct device_node *src_node;
++      struct omap_dss_device *dssdev, *in;
++
++      int r, reset_gpio, datalines;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&client->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&client->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      reset_gpio = of_get_named_gpio(node, "reset-gpio", 0);
++
++      if (gpio_is_valid(reset_gpio) || reset_gpio == -ENOENT) {
++              ddata->reset_gpio = reset_gpio;
++      } else {
++              dev_err(&client->dev, "failed to parse lcdorhdmi gpio\n");
++              return reset_gpio;
++      }
++
++      r = of_property_read_u32(node, "data-lines", &datalines);
++      if (r) {
++              dev_err(&client->dev, "failed to parse datalines\n");
++              return r;
++      }
++
++      ddata->data_lines = datalines;
++      ddata->reset_gpio = reset_gpio;
++      dssdev = &ddata->dssdev;
++
++      return 0;
++
++}
++static int sil9022_probe_pdata(struct i2c_client *client)
++{
++      struct encoder_sil9022_platform_data *pdata;
++      struct panel_drv_data *ddata = dev_get_drvdata(&client->dev);
++      struct omap_dss_device *dssdev, *in;
++      pdata = dev_get_platdata(&client->dev);
++
++      ddata->reset_gpio = pdata->reset_gpio;
++      ddata->data_lines = pdata->data_lines;
++
++      in = omap_dss_find_output(pdata->source);
++      if (in == NULL) {
++              dev_err(&client->dev, "Failed to find video source\n");
++              return -ENODEV;
++      }
++
++      ddata->in = in;
++      dssdev = &ddata->dssdev;
++      dssdev->name = pdata->name;
++
++      return 0;
++}
++
++static int sil9022_probe(struct i2c_client *client,
++              const struct i2c_device_id *id)
++{
++      struct panel_drv_data *ddata;
++      struct omap_dss_device *dssdev;
++      struct regmap *regmap;
++      int err = 0;
++
++      regmap = devm_regmap_init_i2c(client, &sil9022_regmap_config);
++      if (IS_ERR(regmap)) {
++              err = PTR_ERR(regmap);
++              dev_err(&client->dev, "Failed to init regmap: %d\n", err);
++              return err;
++      }
++
++      ddata = devm_kzalloc(&client->dev, sizeof(*ddata), GFP_KERNEL);
++      if (ddata == NULL)
++              return -ENOMEM;
++
++      dev_set_drvdata(&client->dev, ddata);
++
++      if (dev_get_platdata(&client->dev)) {
++              err = sil9022_probe_pdata(client);
++              if (err)
++                      return err;
++      } else if (client->dev.of_node) {
++              err = sil9022_probe_of(client);
++              if (err)
++                      return err;
++      } else {
++              return -ENODEV;
++      }
++
++      if (gpio_is_valid(ddata->reset_gpio)) {
++              err = devm_gpio_request_one(&client->dev, ddata->reset_gpio,
++                              GPIOF_OUT_INIT_HIGH, "Sil9022-Encoder");
++              if (err)
++                      goto err_gpio;
++      }
++
++      ddata->regmap = regmap;
++      ddata->i2c_client = client;
++      dssdev = &ddata->dssdev;
++      dssdev->dev = &client->dev;
++      dssdev->ops.hdmi = &sil9022_hdmi_ops;
++      dssdev->type = OMAP_DISPLAY_TYPE_DPI;
++      dssdev->output_type = OMAP_DISPLAY_TYPE_HDMI;
++      dssdev->owner = THIS_MODULE;
++      dssdev->phy.dpi.data_lines = ddata->data_lines;
++      err = omapdss_register_output(dssdev);
++      if (err) {
++              dev_err(&client->dev, "Failed to register output\n");
++              goto err_reg;
++      }
++
++      /* Read sil9022 chip version */
++      err = sil9022_probe_chip_version(dssdev);
++      if (err) {
++              dev_err(&client->dev, "Failed to read CHIP VERSION\n");
++              goto err_i2c;
++      }
++
++      return 0;
++
++err_gpio:
++err_reg:
++err_i2c:
++      omap_dss_put_device(ddata->in);
++      return err;
++}
++
++
++static int sil9022_remove(struct i2c_client *client)
++{
++      struct panel_drv_data *ddata = dev_get_drvdata(&client->dev);
++      struct omap_dss_device *dssdev = &ddata->dssdev;
++
++      omapdss_unregister_output(&ddata->dssdev);
++
++      WARN_ON(omapdss_device_is_enabled(dssdev));
++      if (omapdss_device_is_enabled(dssdev))
++              sil9022_disable(dssdev);
++
++      WARN_ON(omapdss_device_is_connected(dssdev));
++      if (omapdss_device_is_connected(dssdev))
++              sil9022_disconnect(dssdev, dssdev->dst);
++
++      omap_dss_put_device(ddata->in);
++
++      if (!client->adapter) {
++              dev_err(&client->dev, "No HDMI Device\n");
++              return -ENODEV;
++      }
++
++      return 0;
++}
++
++static const struct i2c_device_id sil9022_id[] = {
++      { SIL9022_DRV_NAME, 0 },
++      { },
++};
++
++MODULE_DEVICE_TABLE(i2c, sil9022_id);
++
++static struct i2c_driver sil9022_driver = {
++      .driver = {
++              .name  = SIL9022_DRV_NAME,
++              .owner = THIS_MODULE,
++              },
++      .probe          = sil9022_probe,
++      .remove         = sil9022_remove,
++      .id_table       = sil9022_id,
++};
++
++module_i2c_driver(sil9022_driver);
++
++MODULE_AUTHOR("Sathya Prakash M R <sathyap@ti.com>");
++MODULE_DESCRIPTION("Sil9022 DPI to HDMI encoder Driver");
++MODULE_LICENSE("GPL");
+--- /dev/null
++++ b/drivers/video/omap2/displays-new/encoder-sil9022.h
+@@ -0,0 +1,123 @@
++/*
++ * drivers/video/omap2/displays-new/encoder-sil9022.c
++ *
++ * Copyright (C) 2013 Texas Instruments
++ * Author : Sathya Prakash M R <sathyap@ti.com>
++ *
++ * This file is licensed under the terms of the GNU General Public License
++ * version 2. This program is licensed "as is" without any warranty of any
++ * kind, whether express or implied.
++ *
++ */
++
++#ifndef _SI9022_H_
++#define _SI9022_H_
++
++#define SIL9022_DRV_NAME      "sii9022"
++
++#define SIL9022_REG_CHIPID0           0x1B
++#define SIL9022_REG_TPI_RQB           0xC7
++#define SIL9022_CHIPID_902x           0xB0
++
++#define HDMI_I2C_MONITOR_ADDRESS            0x50
++
++/* HDMI EDID Length  */
++#define HDMI_EDID_MAX_LENGTH  256
++
++#define VERTICAL_FREQ                 0x3C
++
++/*  HDMI TPI Registers  */
++#define HDMI_TPI_VIDEO_DATA_BASE_REG  0x00
++#define HDMI_TPI_PIXEL_CLK_LSB_REG     (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x00)
++#define HDMI_TPI_PIXEL_CLK_MSB_REG (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x01)
++#define HDMI_TPI_VFREQ_LSB_REG        (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x02)
++#define HDMI_TPI_VFREQ_MSB_REG        (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x03)
++#define HDMI_TPI_PIXELS_LSB_REG       (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x04)
++#define HDMI_TPI_PIXELS_MSB_REG       (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x05)
++#define HDMI_TPI_LINES_LSB_REG                (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x06)
++#define HDMI_TPI_LINES_MSB_REG                (HDMI_TPI_VIDEO_DATA_BASE_REG + 0x07)
++
++#define HDMI_TPI_PIXEL_REPETITION_REG 0x08
++
++#define HDMI_TPI_AVI_INOUT_BASE_REG   0x09
++#define HDMI_TPI_AVI_IN_FORMAT_REG    (HDMI_TPI_AVI_INOUT_BASE_REG + 0x00)
++#define HDMI_TPI_AVI_OUT_FORMAT_REG   (HDMI_TPI_AVI_INOUT_BASE_REG + 0x01)
++
++#define HDMI_SYS_CTRL_DATA_REG                0x1A
++#define HDMI_TPI_POWER_STATE_CTRL_REG         0x1E
++#define HDMI_TPI_DEVICE_POWER_STATE_DATA              0x1E
++
++
++/* HDCP */
++#define HDMI_TPI_HDCP_QUERYDATA_REG         0x29
++#define HDMI_TPI_HDCP_CONTROLDATA_REG       0x2A
++
++/* HDMI_TPI_DEVICE_ID_REG  */
++#define TPI_DEVICE_ID                       0xB0
++
++/* HDMI_TPI_REVISION_REG  */
++#define TPI_REVISION                        0x00
++
++/* HDMI_TPI_ID_BYTE2_REG  */
++#define TPI_ID_BYTE2_VALUE                  0x00
++
++/* HDMI_SYS_CTRL_DATA_REG  */
++#define TPI_SYS_CTRL_POWER_DOWN             (1 << 4)
++#define TPI_SYS_CTRL_POWER_ACTIVE           (0 << 4)
++#define TPI_SYS_CTRL_AV_MUTE                (1 << 3)
++#define TPI_SYS_CTRL_DDC_BUS_REQUEST        (1 << 2)
++#define TPI_SYS_CTRL_DDC_BUS_GRANTED        (1 << 1)
++#define TPI_SYS_CTRL_OUTPUT_MODE_HDMI       (1 << 0)
++#define TPI_SYS_CTRL_OUTPUT_MODE_DVI        (0 << 0)
++
++/* HDMI_TPI_PIXEL_REPETITION  */
++#define TPI_AVI_PIXEL_REP_BUS_24BIT         (1 << 5)
++#define TPI_AVI_PIXEL_REP_BUS_12BIT         (0 << 5)
++#define TPI_AVI_PIXEL_REP_RISING_EDGE       (1 << 4)
++#define TPI_AVI_PIXEL_REP_FALLING_EDGE      (0 << 4)
++#define TPI_AVI_PIXEL_REP_4X                (3 << 0)
++#define TPI_AVI_PIXEL_REP_2X                (1 << 0)
++#define TPI_AVI_PIXEL_REP_NONE              (0 << 0)
++
++/*Ratio of TDMS Clock to input Video Clock*/
++#define TPI_CLK_RATIO_HALF            (0 << 6)
++#define TPI_CLK_RATIO_1X              (1 << 6)
++#define TPI_CLK_RATIO_2X              (2 << 6)
++#define TPI_CLK_RATIO_4X             (3 << 6)
++
++
++/* HDMI_TPI_AVI_INPUT_FORMAT  */
++#define TPI_AVI_INPUT_BITMODE_12BIT         (1 << 7)
++#define TPI_AVI_INPUT_BITMODE_8BIT          (0 << 7)
++#define TPI_AVI_INPUT_DITHER                (1 << 6)
++#define TPI_AVI_INPUT_RANGE_LIMITED         (2 << 2)
++#define TPI_AVI_INPUT_RANGE_FULL            (1 << 2)
++#define TPI_AVI_INPUT_RANGE_AUTO            (0 << 2)
++#define TPI_AVI_INPUT_COLORSPACE_BLACK      (3 << 0)
++#define TPI_AVI_INPUT_COLORSPACE_YUV422     (2 << 0)
++#define TPI_AVI_INPUT_COLORSPACE_YUV444     (1 << 0)
++#define TPI_AVI_INPUT_COLORSPACE_RGB        (0 << 0)
++
++
++/* HDMI_TPI_AVI_OUTPUT_FORMAT  */
++#define TPI_AVI_OUTPUT_CONV_BT709           (1 << 4)
++#define TPI_AVI_OUTPUT_CONV_BT601           (0 << 4)
++#define TPI_AVI_OUTPUT_RANGE_LIMITED        (2 << 2)
++#define TPI_AVI_OUTPUT_RANGE_FULL           (1 << 2)
++#define TPI_AVI_OUTPUT_RANGE_AUTO           (0 << 2)
++#define TPI_AVI_OUTPUT_COLORSPACE_RGBDVI    (3 << 0)
++#define TPI_AVI_OUTPUT_COLORSPACE_YUV422    (2 << 0)
++#define TPI_AVI_OUTPUT_COLORSPACE_YUV444    (1 << 0)
++#define TPI_AVI_OUTPUT_COLORSPACE_RGBHDMI   (0 << 0)
++
++/* HDMI_TPI_DEVICE_POWER_STATE  */
++#define TPI_AVI_POWER_STATE_D3              (3 << 0)
++#define TPI_AVI_POWER_STATE_D2              (2 << 0)
++#define TPI_AVI_POWER_STATE_D0              (0 << 0)
++
++struct regmap_config sil9022_regmap_config = {
++      .reg_bits = 8,
++      .val_bits = 8,
++};
++
++#endif
+--- a/drivers/video/omap2/displays-new/encoder-tfp410.c
++++ b/drivers/video/omap2/displays-new/encoder-tfp410.c
+@@ -13,6 +13,7 @@
+ #include <linux/module.h>
+ #include <linux/platform_device.h>
+ #include <linux/slab.h>
++#include <linux/of_gpio.h>
+ #include <video/omapdss.h>
+ #include <video/omap-panel-data.h>
+@@ -179,6 +180,47 @@ static int tfp410_probe_pdata(struct pla
+       return 0;
+ }
++static int tfp410_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      int r, gpio, datalines;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      gpio = of_get_gpio(node, 0);
++
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->pd_gpio = gpio;
++      } else {
++              dev_err(&pdev->dev, "failed to parse PD gpio\n");
++              return gpio;
++      }
++
++      r = of_property_read_u32(node, "data-lines", &datalines);
++      if (r) {
++              dev_err(&pdev->dev, "failed to parse datalines\n");
++              return r;
++      }
++
++      ddata->data_lines = datalines;
++
++      return 0;
++}
++
+ static int tfp410_probe(struct platform_device *pdev)
+ {
+       struct panel_drv_data *ddata;
+@@ -195,6 +237,10 @@ static int tfp410_probe(struct platform_
+               r = tfp410_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = tfp410_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -251,12 +297,20 @@ static int __exit tfp410_remove(struct p
+       return 0;
+ }
++static const struct of_device_id tfp410_of_match[] = {
++      { .compatible = "ti,tfp410", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, tfp410_of_match);
++
+ static struct platform_driver tfp410_driver = {
+       .probe  = tfp410_probe,
+       .remove = __exit_p(tfp410_remove),
+       .driver = {
+               .name   = "tfp410",
+               .owner  = THIS_MODULE,
++              .of_match_table = tfp410_of_match,
+       },
+ };
+--- a/drivers/video/omap2/displays-new/encoder-tpd12s015.c
++++ b/drivers/video/omap2/displays-new/encoder-tpd12s015.c
+@@ -15,6 +15,7 @@
+ #include <linux/slab.h>
+ #include <linux/gpio.h>
+ #include <linux/platform_device.h>
++#include <linux/of_gpio.h>
+ #include <video/omapdss.h>
+ #include <video/omap-panel-data.h>
+@@ -289,6 +290,55 @@ static int tpd_probe_pdata(struct platfo
+       return 0;
+ }
++static int tpd_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      int gpio;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      /* CT CP HPD GPIO */
++      gpio = of_get_gpio(node, 0);
++      if (!gpio_is_valid(gpio)) {
++              dev_err(&pdev->dev, "failed to parse CT CP HPD gpio\n");
++              return gpio;
++      }
++      ddata->ct_cp_hpd_gpio = gpio;
++
++      /* LS OE GPIO */
++      gpio = of_get_gpio(node, 1);
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->ls_oe_gpio = gpio;
++      } else {
++              dev_err(&pdev->dev, "failed to parse LS OE gpio\n");
++              return gpio;
++      }
++
++      /* HPD GPIO */
++      gpio = of_get_gpio(node, 2);
++      if (!gpio_is_valid(gpio)) {
++              dev_err(&pdev->dev, "failed to parse HPD gpio\n");
++              return gpio;
++      }
++      ddata->hpd_gpio = gpio;
++
++      return 0;
++}
++
+ static int tpd_probe(struct platform_device *pdev)
+ {
+       struct omap_dss_device *in, *dssdev;
+@@ -307,6 +357,10 @@ static int tpd_probe(struct platform_dev
+               r = tpd_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = tpd_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -379,12 +433,20 @@ static int __exit tpd_remove(struct plat
+       return 0;
+ }
++static const struct of_device_id tpd_of_match[] = {
++      { .compatible = "ti,tpd12s015", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, tpd_of_match);
++
+ static struct platform_driver tpd_driver = {
+       .probe  = tpd_probe,
+       .remove = __exit_p(tpd_remove),
+       .driver = {
+               .name   = "tpd12s015",
+               .owner  = THIS_MODULE,
++              .of_match_table = tpd_of_match,
+       },
+ };
+--- a/drivers/video/omap2/displays-new/Kconfig
++++ b/drivers/video/omap2/displays-new/Kconfig
+@@ -12,6 +12,20 @@ config DISPLAY_ENCODER_TPD12S015
+         Driver for TPD12S015, which offers HDMI ESD protection and level
+         shifting.
++config DISPLAY_DRA_EVM_ENCODER_TPD12S015
++        tristate "TPD12S015 HDMI ESD protection and level shifter on DRA7 EVM"
++      help
++        Driver for TPD12S015, which offers HDMI ESD protection and level
++        shifting on DRA EVM.
++
++config DISPLAY_ENCODER_SIL9022
++        tristate "Sil9022 DPI to HDMI Encoder"
++      depends on I2C
++      help
++        Driver for Silicon Image Sil9022 DPI to HDMI encoder and
++        a brief about Sil9022 can be found here:
++        http://www.semiconductorstore.com/pdf/newsite/siliconimage/SiI9022a_pb.pdf
++
+ config DISPLAY_CONNECTOR_DVI
+         tristate "DVI Connector"
+       depends on I2C
+@@ -71,4 +85,11 @@ config DISPLAY_PANEL_NEC_NL8048HL11
+               This NEC NL8048HL11 panel is TFT LCD used in the
+               Zoom2/3/3630 sdp boards.
++config DISPLAY_PANEL_TFCS9700
++      tristate "Three Five DPI panel"
++      depends on I2C
++      help
++              A TFT LCD DPI panel used on the LCD daughter board
++              of Vayu EVM
++
+ endmenu
+--- a/drivers/video/omap2/displays-new/Makefile
++++ b/drivers/video/omap2/displays-new/Makefile
+@@ -1,5 +1,7 @@
+ obj-$(CONFIG_DISPLAY_ENCODER_TFP410) += encoder-tfp410.o
+ obj-$(CONFIG_DISPLAY_ENCODER_TPD12S015) += encoder-tpd12s015.o
++obj-$(CONFIG_DISPLAY_DRA_EVM_ENCODER_TPD12S015) += dra-evm-encoder-tpd12s015.o
++obj-$(CONFIG_DISPLAY_ENCODER_SIL9022) += encoder-sil9022.o
+ obj-$(CONFIG_DISPLAY_CONNECTOR_DVI) += connector-dvi.o
+ obj-$(CONFIG_DISPLAY_CONNECTOR_HDMI) += connector-hdmi.o
+ obj-$(CONFIG_DISPLAY_CONNECTOR_ANALOG_TV) += connector-analog-tv.o
+@@ -10,3 +12,4 @@ obj-$(CONFIG_DISPLAY_PANEL_LGPHILIPS_LB0
+ obj-$(CONFIG_DISPLAY_PANEL_SHARP_LS037V7DW01) += panel-sharp-ls037v7dw01.o
+ obj-$(CONFIG_DISPLAY_PANEL_TPO_TD043MTEA1) += panel-tpo-td043mtea1.o
+ obj-$(CONFIG_DISPLAY_PANEL_NEC_NL8048HL11) += panel-nec-nl8048hl11.o
++obj-$(CONFIG_DISPLAY_PANEL_TFCS9700) += panel-tfcs9700.o
+--- a/drivers/video/omap2/displays-new/panel-dpi.c
++++ b/drivers/video/omap2/displays-new/panel-dpi.c
+@@ -13,9 +13,12 @@
+ #include <linux/module.h>
+ #include <linux/platform_device.h>
+ #include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_gpio.h>
+ #include <video/omapdss.h>
+ #include <video/omap-panel-data.h>
++#include <video/of_display_timing.h>
+ struct panel_drv_data {
+       struct omap_dss_device dssdev;
+@@ -26,6 +29,7 @@ struct panel_drv_data {
+       struct omap_video_timings videomode;
+       int backlight_gpio;
++      bool backlight_enable;
+       int enable_gpio;
+ };
+@@ -81,7 +85,7 @@ static int panel_dpi_enable(struct omap_
+               gpio_set_value_cansleep(ddata->enable_gpio, 1);
+       if (gpio_is_valid(ddata->backlight_gpio))
+-              gpio_set_value_cansleep(ddata->backlight_gpio, 1);
++              gpio_set_value_cansleep(ddata->backlight_gpio, ddata->backlight_enable);
+       dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
+@@ -100,7 +104,7 @@ static void panel_dpi_disable(struct oma
+               gpio_set_value_cansleep(ddata->enable_gpio, 0);
+       if (gpio_is_valid(ddata->backlight_gpio))
+-              gpio_set_value_cansleep(ddata->backlight_gpio, 0);
++              gpio_set_value_cansleep(ddata->backlight_gpio, ~(ddata->backlight_enable));
+       in->ops.dpi->disable(in);
+@@ -182,6 +186,73 @@ static int panel_dpi_probe_pdata(struct
+       return 0;
+ }
++static int panel_dpi_probe_of(struct platform_device *pdev)
++{
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct device_node *node = pdev->dev.of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      int r, datalines;
++      struct display_timing timing;
++      struct videomode vm;
++      int gpio;
++      enum of_gpio_flags gpio_flags;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      r = of_property_read_u32(node, "data-lines", &datalines);
++      if (r) {
++              dev_err(&pdev->dev, "failed to parse datalines\n");
++              return r;
++      }
++
++      ddata->data_lines = datalines;
++
++      gpio = of_get_gpio(node, 0);
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->enable_gpio = gpio;
++      } else {
++              dev_err(&pdev->dev, "failed to parse enable gpio\n");
++              return gpio;
++      }
++
++      gpio = of_get_gpio_flags(node, 1, &gpio_flags);
++
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->backlight_gpio = gpio;
++      } else {
++              dev_err(&pdev->dev, "failed to parse backlight gpio\n");
++              return gpio;
++      }
++
++      if (gpio_flags == OF_GPIO_ACTIVE_LOW)
++              ddata->backlight_enable = 0;
++      else
++              ddata->backlight_enable = 1;
++
++      r = of_get_display_timing(node, "panel-timing", &timing);
++      if (r) {
++              dev_err(&pdev->dev, "failed to get video timing\n");
++              return r;
++      }
++
++      videomode_from_timing(&timing, &vm);
++      videomode_to_omap_video_timings(&vm, &ddata->videomode);
++
++      return 0;
++}
++
+ static int panel_dpi_probe(struct platform_device *pdev)
+ {
+       struct panel_drv_data *ddata;
+@@ -198,6 +269,10 @@ static int panel_dpi_probe(struct platfo
+               r = panel_dpi_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = panel_dpi_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -254,12 +329,20 @@ static int __exit panel_dpi_remove(struc
+       return 0;
+ }
++static const struct of_device_id panel_dpi_of_match[] = {
++      { .compatible = "panel-dpi", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, panel_dpi_of_match);
++
+ static struct platform_driver panel_dpi_driver = {
+       .probe = panel_dpi_probe,
+       .remove = __exit_p(panel_dpi_remove),
+       .driver = {
+               .name = "panel-dpi",
+               .owner = THIS_MODULE,
++              .of_match_table = panel_dpi_of_match,
+       },
+ };
+--- a/drivers/video/omap2/displays-new/panel-dsi-cm.c
++++ b/drivers/video/omap2/displays-new/panel-dsi-cm.c
+@@ -22,6 +22,8 @@
+ #include <linux/sched.h>
+ #include <linux/slab.h>
+ #include <linux/workqueue.h>
++#include <linux/of_device.h>
++#include <linux/of_gpio.h>
+ #include <video/omapdss.h>
+ #include <video/omap-panel-data.h>
+@@ -1156,6 +1158,79 @@ static int dsicm_probe_pdata(struct plat
+       return 0;
+ }
++static int dsicm_probe_of(struct platform_device *pdev)
++{
++      struct device_node *node = pdev->dev.of_node;
++      struct panel_drv_data *ddata = platform_get_drvdata(pdev);
++      struct omap_dss_device *in;
++      struct property *prop;
++      struct device_node *src_node;
++      u32 lane_arr[10];
++      int gpio, len, num_pins;
++      int r, i;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(&pdev->dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(&pdev->dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++      ddata->in = in;
++
++      gpio = of_get_gpio(node, 0);
++      if (!gpio_is_valid(gpio)) {
++              dev_err(&pdev->dev, "failed to parse reset gpio\n");
++              return gpio;
++      }
++      ddata->reset_gpio = gpio;
++
++      if (of_gpio_count(node) > 1) {
++              gpio = of_get_gpio(node, 1);
++
++              if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++                      ddata->ext_te_gpio = gpio;
++              } else {
++                      dev_err(&pdev->dev, "failed to parse TE gpio\n");
++                      return gpio;
++              }
++      } else {
++              ddata->ext_te_gpio = -1;
++      }
++
++      prop = of_find_property(node, "lanes", &len);
++      if (prop == NULL) {
++              dev_err(&pdev->dev, "failed to find lane data\n");
++              return -EINVAL;
++      }
++
++      num_pins = len / sizeof(u32);
++
++      if (num_pins < 4 || num_pins % 2 != 0
++                      || num_pins > ARRAY_SIZE(lane_arr)) {
++              dev_err(&pdev->dev, "bad number of lanes\n");
++              return -EINVAL;
++      }
++
++      r = of_property_read_u32_array(node, "lanes", lane_arr, num_pins);
++      if (r) {
++              dev_err(&pdev->dev, "failed to read lane data\n");
++              return r;
++      }
++
++      ddata->pin_config.num_pins = num_pins;
++      for (i = 0; i < num_pins; ++i)
++              ddata->pin_config.pins[i] = (int)lane_arr[i];
++
++      /* TODO: ulps, backlight */
++
++      return 0;
++}
++
+ static int dsicm_probe(struct platform_device *pdev)
+ {
+       struct backlight_properties props;
+@@ -1178,6 +1253,10 @@ static int dsicm_probe(struct platform_d
+               r = dsicm_probe_pdata(pdev);
+               if (r)
+                       return r;
++      } else if (pdev->dev.of_node) {
++              r = dsicm_probe_of(pdev);
++              if (r)
++                      return r;
+       } else {
+               return -ENODEV;
+       }
+@@ -1320,12 +1399,20 @@ static int __exit dsicm_remove(struct pl
+       return 0;
+ }
++static const struct of_device_id dsicm_of_match[] = {
++      { .compatible = "panel-dsi-cm", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, dsicm_of_match);
++
+ static struct platform_driver dsicm_driver = {
+       .probe = dsicm_probe,
+       .remove = __exit_p(dsicm_remove),
+       .driver = {
+               .name = "panel-dsi-cm",
+               .owner = THIS_MODULE,
++              .of_match_table = dsicm_of_match,
+       },
+ };
+--- /dev/null
++++ b/drivers/video/omap2/displays-new/panel-tfcs9700.c
+@@ -0,0 +1,387 @@
++/*
++ * TLC59108 TFC-S9700 Panel Driver
++ *
++ * Copyright (C) 2013 Texas Instruments
++ * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
++ *
++ * 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.
++ */
++
++#include <linux/gpio.h>
++#include <linux/module.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++#include <linux/of_gpio.h>
++#include <linux/i2c.h>
++#include <linux/regmap.h>
++#include <linux/delay.h>
++
++#include <video/omapdss.h>
++#include <video/omap-panel-data.h>
++#include <video/of_display_timing.h>
++
++#define TLC_NAME              "tlc59108"
++#define TLC_I2C_ADDR          0x40
++
++#define TLC59108_MODE1                0x00
++#define TLC59108_PWM2         0x04
++#define TLC59108_LEDOUT0      0x0c
++#define TLC59108_LEDOUT1      0x0d
++
++struct panel_drv_data {
++      struct omap_dss_device dssdev;
++      struct omap_dss_device *in;
++
++      int data_lines;
++      struct omap_video_timings videomode;
++
++      int enable_gpio;
++      struct regmap *regmap;
++};
++
++static const struct omap_video_timings tfc_s9700_timings = {
++      .x_res          = 800,
++      .y_res          = 480,
++
++      .pixel_clock    = 29232,
++
++      .hfp            = 41,
++      .hsw            = 49,
++      .hbp            = 41,
++
++      .vfp            = 13,
++      .vsw            = 4,
++      .vbp            = 29,
++
++      .vsync_level    = OMAPDSS_SIG_ACTIVE_LOW,
++      .hsync_level    = OMAPDSS_SIG_ACTIVE_LOW,
++      .data_pclk_edge = OMAPDSS_DRIVE_SIG_RISING_EDGE,
++      .de_level       = OMAPDSS_SIG_ACTIVE_HIGH,
++      .sync_pclk_edge = OMAPDSS_DRIVE_SIG_OPPOSITE_EDGES,
++};
++
++static int tlc_init(struct panel_drv_data *ddata)
++{
++      struct regmap *map = ddata->regmap;
++
++      /* init the TLC chip */
++      regmap_write(map, TLC59108_MODE1, 0x01);
++
++      /*
++       * set LED1(AVDD) to ON state(default), enable LED2 in PWM mode, enable
++       * LED0 to OFF state
++       */
++      regmap_write(map, TLC59108_LEDOUT0, 0x21);
++
++      /* set LED2 PWM to full freq */
++      regmap_write(map, TLC59108_PWM2, 0xff);
++
++      /* set LED4(UPDN) and LED6(MODE3) to OFF state */
++      regmap_write(map, TLC59108_LEDOUT1, 0x11);
++
++      return 0;
++}
++
++static int tlc_uninit(struct panel_drv_data *ddata)
++{
++      struct regmap *map = ddata->regmap;
++
++      /* clear TLC chip regs */
++      regmap_write(map, TLC59108_PWM2, 0x0);
++      regmap_write(map, TLC59108_LEDOUT0, 0x0);
++      regmap_write(map, TLC59108_LEDOUT1, 0x0);
++
++      regmap_write(map, TLC59108_MODE1, 0x0);
++
++      return 0;
++}
++
++#define to_panel_data(p) container_of(p, struct panel_drv_data, dssdev)
++
++static int panel_dpi_connect(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int r;
++
++      if (omapdss_device_is_connected(dssdev))
++              return 0;
++
++      r = in->ops.dpi->connect(in, dssdev);
++      if (r)
++              return r;
++
++      return 0;
++}
++
++static void panel_dpi_disconnect(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      if (!omapdss_device_is_connected(dssdev))
++              return;
++
++      in->ops.dpi->disconnect(in, dssdev);
++}
++
++static int panel_dpi_enable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++      int r;
++
++      if (!omapdss_device_is_connected(dssdev))
++              return -ENODEV;
++
++      if (omapdss_device_is_enabled(dssdev))
++              return 0;
++
++      in->ops.dpi->set_data_lines(in, ddata->data_lines);
++      in->ops.dpi->set_timings(in, &ddata->videomode);
++
++      r = in->ops.dpi->enable(in);
++      if (r)
++              return r;
++
++      tlc_init(ddata);
++
++      dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
++
++      return 0;
++}
++
++static void panel_dpi_disable(struct omap_dss_device *dssdev)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      if (!omapdss_device_is_enabled(dssdev))
++              return;
++
++      tlc_uninit(ddata);
++
++      in->ops.dpi->disable(in);
++
++      dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
++}
++
++static void panel_dpi_set_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      ddata->videomode = *timings;
++      dssdev->panel.timings = *timings;
++
++      in->ops.dpi->set_timings(in, timings);
++}
++
++static void panel_dpi_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++
++      *timings = ddata->videomode;
++}
++
++static int panel_dpi_check_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct panel_drv_data *ddata = to_panel_data(dssdev);
++      struct omap_dss_device *in = ddata->in;
++
++      return in->ops.dpi->check_timings(in, timings);
++}
++
++static struct omap_dss_driver panel_dpi_ops = {
++      .connect        = panel_dpi_connect,
++      .disconnect     = panel_dpi_disconnect,
++
++      .enable         = panel_dpi_enable,
++      .disable        = panel_dpi_disable,
++
++      .set_timings    = panel_dpi_set_timings,
++      .get_timings    = panel_dpi_get_timings,
++      .check_timings  = panel_dpi_check_timings,
++
++      .get_resolution = omapdss_default_get_resolution,
++};
++
++static int tlc_probe_of(struct device *dev)
++{
++      struct panel_drv_data *ddata = dev_get_drvdata(dev);
++      struct device_node *node = dev->of_node;
++      struct omap_dss_device *in;
++      struct device_node *src_node;
++      int r, datalines;
++      int gpio;
++
++      src_node = of_parse_phandle(node, "video-source", 0);
++      if (!src_node) {
++              dev_err(dev, "failed to parse video source\n");
++              return -ENODEV;
++      }
++
++      in = omap_dss_find_output_by_node(src_node);
++      if (in == NULL) {
++              dev_err(dev, "failed to find video source\n");
++              return -EPROBE_DEFER;
++      }
++
++      ddata->in = in;
++
++      r = of_property_read_u32(node, "data-lines", &datalines);
++      if (r) {
++              dev_err(dev, "failed to parse datalines\n");
++              return r;
++      }
++
++      ddata->data_lines = datalines;
++
++      gpio = of_get_gpio(node, 0);
++      if (gpio_is_valid(gpio) || gpio == -ENOENT) {
++              ddata->enable_gpio = gpio;
++      } else {
++              dev_err(dev, "failed to parse enable gpio\n");
++              return gpio;
++      }
++
++      return 0;
++}
++
++struct regmap_config tlc59108_regmap_config = {
++      .reg_bits = 8,
++      .val_bits = 8,
++};
++
++static int tlc59108_i2c_probe(struct i2c_client *client,
++              const struct i2c_device_id *id)
++{
++      int r;
++      struct regmap *regmap;
++      struct panel_drv_data *ddata;
++      struct device *dev = &client->dev;
++      struct omap_dss_device *dssdev;
++      unsigned int val;
++
++      ddata = devm_kzalloc(dev, sizeof(*ddata), GFP_KERNEL);
++      if (ddata == NULL)
++              return -ENOMEM;
++
++      dev_set_drvdata(dev, ddata);
++
++      r = tlc_probe_of(dev);
++      if (r)
++              return r;
++
++      ddata->videomode = tfc_s9700_timings;
++
++      if (gpio_is_valid(ddata->enable_gpio)) {
++              r = devm_gpio_request_one(dev, ddata->enable_gpio,
++                              GPIOF_OUT_INIT_LOW, "panel enable");
++              if (r)
++                      goto err_gpio;
++      }
++
++      regmap = devm_regmap_init_i2c(client, &tlc59108_regmap_config);
++      if (IS_ERR(regmap)) {
++              r = PTR_ERR(regmap);
++              dev_err(dev, "Failed to init regmap: %d\n", r);
++              goto err_gpio;
++      }
++
++      ddata->regmap = regmap;
++
++      msleep(10);
++
++      /* Try to read a TLC register to verify if i2c works */
++      r = regmap_read(ddata->regmap, TLC59108_MODE1, &val);
++      if (r < 0) {
++              dev_err(dev, "Failed to set MODE1: %d\n", r);
++              return r;
++      }
++
++      dssdev = &ddata->dssdev;
++      dssdev->dev = dev;
++      dssdev->driver = &panel_dpi_ops;
++      dssdev->type = OMAP_DISPLAY_TYPE_DPI;
++      dssdev->owner = THIS_MODULE;
++      dssdev->panel.timings = ddata->videomode;
++      dssdev->phy.dpi.data_lines = ddata->data_lines;
++
++      r = omapdss_register_display(dssdev);
++      if (r) {
++              dev_err(dev, "Failed to register panel\n");
++              goto err_reg;
++      }
++
++      dev_info(dev, "Successfully initialized %s\n", TLC_NAME);
++
++      return 0;
++err_reg:
++err_gpio:
++      omap_dss_put_device(ddata->in);
++      return r;
++}
++
++static int tlc59108_i2c_remove(struct i2c_client *client)
++{
++      struct panel_drv_data *ddata = dev_get_drvdata(&client->dev);
++      struct omap_dss_device *dssdev = &ddata->dssdev;
++      struct omap_dss_device *in = ddata->in;
++
++      if (gpio_is_valid(ddata->enable_gpio))
++              gpio_set_value_cansleep(ddata->enable_gpio, 1);
++
++      omapdss_unregister_display(dssdev);
++
++      panel_dpi_disable(dssdev);
++      panel_dpi_disconnect(dssdev);
++
++      omap_dss_put_device(in);
++
++      return 0;
++}
++
++static const struct i2c_device_id tlc59108_id[] = {
++      { TLC_NAME, 0 },
++      { }
++};
++MODULE_DEVICE_TABLE(i2c, tlc59108_id);
++
++static const struct of_device_id tlc59108_of_match[] = {
++      { .compatible = "ti,tlc59108", },
++      { },
++};
++MODULE_DEVICE_TABLE(of, tlc59108_of_match);
++
++static struct i2c_driver tlc59108_i2c_driver = {
++      .driver = {
++              .owner  = THIS_MODULE,
++              .name   = TLC_NAME,
++              .of_match_table = tlc59108_of_match,
++      },
++      .id_table       = tlc59108_id,
++      .probe          = tlc59108_i2c_probe,
++      .remove         = tlc59108_i2c_remove,
++};
++
++static int __init tfc_s9700_init(void)
++{
++      return i2c_add_driver(&tlc59108_i2c_driver);
++}
++
++static void __exit tfc_s9700_exit(void)
++{
++}
++module_init(tfc_s9700_init);
++module_exit(tfc_s9700_exit);
++
++MODULE_AUTHOR("Archit Taneja  <archit@ti.com>");
++MODULE_DESCRIPTION("TFC-S9700 DPI Panel Driver");
++MODULE_LICENSE("GPL");
+--- a/drivers/video/omap2/dss/core.c
++++ b/drivers/video/omap2/dss/core.c
+@@ -256,6 +256,9 @@ static int (*dss_output_drv_reg_funcs[])
+ #ifdef CONFIG_OMAP2_DSS_DPI
+       dpi_init_platform_driver,
+ #endif
++#ifdef CONFIG_OMAP2_DSS_DRA7XX_DPI
++      dra7xx_dpi_init_platform_driver,
++#endif
+ #ifdef CONFIG_OMAP2_DSS_SDI
+       sdi_init_platform_driver,
+ #endif
+@@ -266,7 +269,10 @@ static int (*dss_output_drv_reg_funcs[])
+       venc_init_platform_driver,
+ #endif
+ #ifdef CONFIG_OMAP4_DSS_HDMI
+-      hdmi_init_platform_driver,
++      hdmi4_init_platform_driver,
++#endif
++#ifdef CONFIG_OMAP5_DSS_HDMI
++      hdmi5_init_platform_driver,
+ #endif
+ };
+@@ -277,6 +283,9 @@ static void (*dss_output_drv_unreg_funcs
+ #ifdef CONFIG_OMAP2_DSS_DPI
+       dpi_uninit_platform_driver,
+ #endif
++#ifdef CONFIG_OMAP2_DSS_DRA7XX_DPI
++      dra7xx_dpi_uninit_platform_driver,
++#endif
+ #ifdef CONFIG_OMAP2_DSS_SDI
+       sdi_uninit_platform_driver,
+ #endif
+@@ -287,7 +296,10 @@ static void (*dss_output_drv_unreg_funcs
+       venc_uninit_platform_driver,
+ #endif
+ #ifdef CONFIG_OMAP4_DSS_HDMI
+-      hdmi_uninit_platform_driver,
++      hdmi4_uninit_platform_driver,
++#endif
++#ifdef CONFIG_OMAP5_DSS_HDMI
++      hdmi5_uninit_platform_driver,
+ #endif
+ };
+--- a/drivers/video/omap2/dss/dispc.c
++++ b/drivers/video/omap2/dss/dispc.c
+@@ -3622,6 +3622,7 @@ static int __init dispc_init_features(st
+       case OMAPDSS_VER_OMAP34xx_ES3:
+       case OMAPDSS_VER_OMAP3630:
+       case OMAPDSS_VER_AM35xx:
++      case OMAPDSS_VER_AM43xx:
+               src = &omap34xx_rev3_0_dispc_feats;
+               break;
+@@ -3632,6 +3633,7 @@ static int __init dispc_init_features(st
+               break;
+       case OMAPDSS_VER_OMAP5:
++      case OMAPDSS_VER_DRA7xx:
+               src = &omap54xx_dispc_feats;
+               break;
+@@ -3691,7 +3693,6 @@ static int __init omap_dispchw_probe(str
+       }
+       pm_runtime_enable(&pdev->dev);
+-      pm_runtime_irq_safe(&pdev->dev);
+       r = dispc_runtime_get();
+       if (r)
+@@ -3744,12 +3745,19 @@ static const struct dev_pm_ops dispc_pm_
+       .runtime_resume = dispc_runtime_resume,
+ };
++static const struct of_device_id dispc_of_match[] = {
++      { .compatible = "ti,omap3-dispc", },
++      { .compatible = "ti,omap4-dispc", },
++      {},
++};
++
+ static struct platform_driver omap_dispchw_driver = {
+       .remove         = __exit_p(omap_dispchw_remove),
+       .driver         = {
+               .name   = "omapdss_dispc",
+               .owner  = THIS_MODULE,
+               .pm     = &dispc_pm_ops,
++              .of_match_table = dispc_of_match,
+       },
+ };
+--- a/drivers/video/omap2/dss/display.c
++++ b/drivers/video/omap2/dss/display.c
+@@ -26,6 +26,7 @@
+ #include <linux/module.h>
+ #include <linux/jiffies.h>
+ #include <linux/platform_device.h>
++#include <linux/of.h>
+ #include <video/omapdss.h>
+ #include "dss.h"
+@@ -133,9 +134,27 @@ static int disp_num_counter;
+ int omapdss_register_display(struct omap_dss_device *dssdev)
+ {
+       struct omap_dss_driver *drv = dssdev->driver;
++      int id;
+-      snprintf(dssdev->alias, sizeof(dssdev->alias),
+-                      "display%d", disp_num_counter++);
++      /*
++       * Note: this presumes all the displays are either using DT or non-DT,
++       * which normally should be the case. This also presumes that all
++       * displays either have an DT alias, or none has.
++       */
++
++      if (dssdev->dev->of_node) {
++              id = of_alias_get_id(dssdev->dev->of_node, "display");
++
++              if (id < 0)
++                      id = disp_num_counter++;
++      } else {
++              id = disp_num_counter++;
++      }
++
++      snprintf(dssdev->alias, sizeof(dssdev->alias), "display%d", id);
++
++      if (dssdev->name == NULL)
++              dssdev->name = dssdev->alias;
+       if (drv && drv->get_resolution == NULL)
+               drv->get_resolution = omapdss_default_get_resolution;
+--- a/drivers/video/omap2/dss/display-sysfs.c
++++ b/drivers/video/omap2/dss/display-sysfs.c
+@@ -277,7 +277,7 @@ static ssize_t display_wss_store(struct
+       return size;
+ }
+-static DEVICE_ATTR(name, S_IRUGO, display_name_show, NULL);
++static DEVICE_ATTR(disp_name, S_IRUGO, display_name_show, NULL);
+ static DEVICE_ATTR(enabled, S_IRUGO|S_IWUSR,
+               display_enabled_show, display_enabled_store);
+ static DEVICE_ATTR(tear_elim, S_IRUGO|S_IWUSR,
+@@ -292,7 +292,7 @@ static DEVICE_ATTR(wss, S_IRUGO|S_IWUSR,
+               display_wss_show, display_wss_store);
+ static const struct attribute *display_sysfs_attrs[] = {
+-      &dev_attr_name.attr,
++      &dev_attr_disp_name.attr,
+       &dev_attr_enabled.attr,
+       &dev_attr_tear_elim.attr,
+       &dev_attr_timings.attr,
+--- a/drivers/video/omap2/dss/dpi.c
++++ b/drivers/video/omap2/dss/dpi.c
+@@ -30,6 +30,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/regulator/consumer.h>
+ #include <linux/string.h>
++#include <linux/of.h>
+ #include <video/omapdss.h>
+@@ -64,6 +65,7 @@ static struct platform_device *dpi_get_d
+       case OMAPDSS_VER_OMAP34xx_ES3:
+       case OMAPDSS_VER_OMAP3630:
+       case OMAPDSS_VER_AM35xx:
++      case OMAPDSS_VER_AM43xx:
+               return NULL;
+       case OMAPDSS_VER_OMAP4430_ES1:
+@@ -374,7 +376,7 @@ static int dpi_display_enable(struct oma
+       if (r)
+               goto err_get_dispc;
+-      r = dss_dpi_select_source(out->manager->id);
++      r = dss_dpi_select_source(0, out->manager->id);
+       if (r)
+               goto err_src_sel;
+@@ -593,6 +595,7 @@ static enum omap_channel dpi_get_channel
+       case OMAPDSS_VER_OMAP34xx_ES3:
+       case OMAPDSS_VER_OMAP3630:
+       case OMAPDSS_VER_AM35xx:
++      case OMAPDSS_VER_AM43xx:
+               return OMAP_DSS_CHANNEL_LCD;
+       case OMAPDSS_VER_OMAP4430_ES1:
+@@ -708,12 +711,19 @@ static int __exit omap_dpi_remove(struct
+       return 0;
+ }
++static const struct of_device_id dpi_of_match[] = {
++      { .compatible = "ti,omap3-dpi", },
++      { .compatible = "ti,omap4-dpi", },
++      {},
++};
++
+ static struct platform_driver omap_dpi_driver = {
+       .probe          = omap_dpi_probe,
+       .remove         = __exit_p(omap_dpi_remove),
+       .driver         = {
+               .name   = "omapdss_dpi",
+               .owner  = THIS_MODULE,
++              .of_match_table = dpi_of_match,
+       },
+ };
+--- /dev/null
++++ b/drivers/video/omap2/dss/dra7xx_dpi.c
+@@ -0,0 +1,632 @@
++/*
++ * Some code and ideas taken from drivers/video/omap/ driver
++ * by Imre Deak.
++ *
++ * 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 "DRA7XX_DPI"
++
++#include <linux/kernel.h>
++#include <linux/delay.h>
++#include <linux/export.h>
++#include <linux/err.h>
++#include <linux/errno.h>
++#include <linux/platform_device.h>
++#include <linux/regulator/consumer.h>
++#include <linux/string.h>
++#include <linux/slab.h>
++#include <linux/of.h>
++
++#include <video/omapdss.h>
++
++#include "dss.h"
++#include "dss_features.h"
++
++struct dpi_data {
++      enum dss_dpll dpll;
++
++      struct mutex lock;
++
++      u32 module_id;
++      enum omap_channel channel;
++
++      struct omap_video_timings timings;
++      struct dss_lcd_mgr_config mgr_config;
++      int data_lines;
++
++      struct omap_dss_device output;
++};
++
++/*
++ * On DRA7xx, we will try to use the DPLL_VIDEOx PLLs, only if we can't get one,
++ * we will try to modify the DSS_FCLK to get the pixel clock. Leave HDMI PLL out
++ * for now
++ */
++enum dss_dpll dpi_get_dpll(struct dpi_data *dpi)
++{
++      switch (dpi->module_id) {
++      case 0:
++              if (dss_dpll_disabled(DSS_DPLL_VIDEO1))
++                      return DSS_DPLL_VIDEO1;
++              else
++                      return DSS_DPLL_NONE;
++      case 1:
++      case 2:
++              if (dss_dpll_disabled(DSS_DPLL_VIDEO1))
++                      return DSS_DPLL_VIDEO1;
++              else if (dss_dpll_disabled(DSS_DPLL_VIDEO2))
++                      return DSS_DPLL_VIDEO2;
++              else
++                      return DSS_DPLL_NONE;
++      default:
++              return DSS_DPLL_NONE;
++      }
++
++      return DSS_DPLL_NONE;
++}
++
++struct dpi_clk_calc_ctx {
++      enum dss_dpll dpll;
++
++      /* inputs */
++      unsigned long pck_min, pck_max;
++
++      /* outputs */
++      struct dss_dpll_cinfo dpll_cinfo;
++      struct dss_clock_info dss_cinfo;
++      struct dispc_clock_info dispc_cinfo;
++};
++
++static bool dpi_calc_dispc_cb(int lckd, int pckd, unsigned long lck,
++              unsigned long pck, void *data)
++{
++      struct dpi_clk_calc_ctx *ctx = data;
++
++      /*
++       * Odd dividers give us uneven duty cycle, causing problem when level
++       * shifted. So skip all odd dividers when the pixel clock is on the
++       * higher side.
++       */
++      if (ctx->pck_min >= 100000000) {
++              if (lckd > 1 && lckd % 2 != 0)
++                      return false;
++
++              if (pckd > 1 && pckd % 2 != 0)
++                      return false;
++      }
++
++      ctx->dispc_cinfo.lck_div = lckd;
++      ctx->dispc_cinfo.pck_div = pckd;
++      ctx->dispc_cinfo.lck = lck;
++      ctx->dispc_cinfo.pck = pck;
++
++      return true;
++}
++
++static bool dpi_calc_hsdiv_cb(int regm_hsdiv, unsigned long dispc,
++              void *data)
++{
++      struct dpi_clk_calc_ctx *ctx = data;
++
++      /*
++       * Odd dividers give us uneven duty cycle, causing problem when level
++       * shifted. So skip all odd dividers when the pixel clock is on the
++       * higher side.
++       */
++      if (regm_hsdiv > 1 && regm_hsdiv % 2 != 0 && ctx->pck_min >= 100000000)
++              return false;
++
++      ctx->dpll_cinfo.regm_hsdiv = regm_hsdiv;
++      ctx->dpll_cinfo.hsdiv_clk = dispc;
++
++      return dispc_div_calc(dispc, ctx->pck_min, ctx->pck_max,
++                      dpi_calc_dispc_cb, ctx);
++}
++
++static bool dpi_calc_pll_cb(int regn, int regm, unsigned long fint,
++              unsigned long pll,
++              void *data)
++{
++      struct dpi_clk_calc_ctx *ctx = data;
++
++      ctx->dpll_cinfo.regn = regn;
++      ctx->dpll_cinfo.regm = regm;
++      ctx->dpll_cinfo.fint = fint;
++      ctx->dpll_cinfo.clkout = pll;
++
++      return dss_dpll_hsdiv_calc(ctx->dpll, pll, ctx->pck_min,
++                      dpi_calc_hsdiv_cb, ctx);
++}
++
++static bool dpi_calc_dss_cb(int fckd, unsigned long fck, void *data)
++{
++      struct dpi_clk_calc_ctx *ctx = data;
++
++      ctx->dss_cinfo.fck = fck;
++      ctx->dss_cinfo.fck_div = fckd;
++
++      return dispc_div_calc(fck, ctx->pck_min, ctx->pck_max,
++                      dpi_calc_dispc_cb, ctx);
++}
++
++
++static bool dpi_dpll_clk_calc(enum dss_dpll dpll, unsigned long pck,
++              struct dpi_clk_calc_ctx *ctx)
++{
++      unsigned long clkin;
++      unsigned long pll_min, pll_max;
++
++      clkin = dpll_get_clkin(dpll);
++
++      memset(ctx, 0, sizeof(*ctx));
++      ctx->dpll = dpll;
++      ctx->pck_min = pck - 1000;
++      ctx->pck_max = pck + 1000;
++      ctx->dpll_cinfo.clkin = clkin;
++
++      pll_min = 0;
++      pll_max = 0;
++
++      return dss_dpll_calc(dpll, clkin, pll_min, pll_max, dpi_calc_pll_cb,
++                      ctx);
++}
++
++static bool dpi_dss_clk_calc(unsigned long pck, struct dpi_clk_calc_ctx *ctx)
++{
++      int i;
++
++      /*
++       * DSS fck gives us very few possibilities, so finding a good pixel
++       * clock may not be possible. We try multiple times to find the clock,
++       * each time widening the pixel clock range we look for, up to
++       * +/- ~15MHz.
++       */
++
++      for (i = 0; i < 25; ++i) {
++              bool ok;
++
++              memset(ctx, 0, sizeof(*ctx));
++              if (pck > 1000 * i * i * i)
++                      ctx->pck_min = max(pck - 1000 * i * i * i, 0lu);
++              else
++                      ctx->pck_min = 0;
++              ctx->pck_max = pck + 1000 * i * i * i;
++
++              ok = dss_div_calc(ctx->pck_min, dpi_calc_dss_cb, ctx);
++              if (ok)
++                      return ok;
++      }
++
++      return false;
++}
++
++static int dpi_set_dss_dpll_clk(struct dpi_data *dpi, unsigned long pck_req,
++              unsigned long *fck, u16 *lck_div, u16 *pck_div)
++{
++      struct dpi_clk_calc_ctx ctx;
++      int r;
++      bool ok;
++
++      ok = dpi_dpll_clk_calc(dpi->dpll, pck_req, &ctx);
++      if (!ok)
++              return -EINVAL;
++
++      r = dss_dpll_set_clock_div(dpi->dpll, &ctx.dpll_cinfo);
++      if (r)
++              return r;
++
++      dss_use_dpll_lcd(dpi->output.dispc_channel, true);
++
++      dpi->mgr_config.clock_info = ctx.dispc_cinfo;
++
++      *fck = ctx.dpll_cinfo.hsdiv_clk;
++      *lck_div = ctx.dispc_cinfo.lck_div;
++      *pck_div = ctx.dispc_cinfo.pck_div;
++
++      return 0;
++}
++
++static int dpi_set_dispc_clk(struct dpi_data *dpi, unsigned long pck_req,
++              unsigned long *fck, u16 *lck_div, u16 *pck_div)
++{
++      struct dpi_clk_calc_ctx ctx;
++      int r;
++      bool ok;
++
++      ok = dpi_dss_clk_calc(pck_req, &ctx);
++      if (!ok)
++              return -EINVAL;
++
++      r = dss_set_clock_div(&ctx.dss_cinfo);
++      if (r)
++              return r;
++
++      dpi->mgr_config.clock_info = ctx.dispc_cinfo;
++
++      *fck = ctx.dss_cinfo.fck;
++      *lck_div = ctx.dispc_cinfo.lck_div;
++      *pck_div = ctx.dispc_cinfo.pck_div;
++
++      return 0;
++}
++
++static int dpi_set_mode(struct dpi_data *dpi)
++{
++      struct omap_overlay_manager *mgr = dpi->output.manager;
++      struct omap_video_timings *t = &dpi->timings;
++      u16 lck_div = 0, pck_div = 0;
++      unsigned long fck = 0;
++      unsigned long pck;
++      int r = 0;
++
++      if (dpi->dpll != DSS_DPLL_NONE)
++              r = dpi_set_dss_dpll_clk(dpi, t->pixel_clock * 1000, &fck,
++                      &lck_div, &pck_div);
++      else
++              r = dpi_set_dispc_clk(dpi, t->pixel_clock * 1000, &fck,
++                      &lck_div, &pck_div);
++      if (r)
++              return r;
++
++      pck = fck / lck_div / pck_div / 1000;
++
++      if (pck != t->pixel_clock) {
++              DSSWARN("Could not find exact pixel clock. "
++                              "Requested %d kHz, got %lu kHz\n",
++                              t->pixel_clock, pck);
++
++              t->pixel_clock = pck;
++      }
++
++      dss_mgr_set_timings(mgr, t);
++
++      return 0;
++}
++
++static void dpi_config_lcd_manager(struct dpi_data *dpi)
++{
++      struct omap_overlay_manager *mgr = dpi->output.manager;
++
++      dpi->mgr_config.io_pad_mode = DSS_IO_PAD_MODE_BYPASS;
++
++      dpi->mgr_config.stallmode = false;
++      dpi->mgr_config.fifohandcheck = false;
++
++      dpi->mgr_config.video_port_width = dpi->data_lines;
++
++      dpi->mgr_config.lcden_sig_polarity = 0;
++
++      dss_mgr_set_lcd_config(mgr, &dpi->mgr_config);
++}
++
++static int dra7xx_dpi_display_enable(struct omap_dss_device *dssdev)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++      struct omap_dss_device *out = &dpi->output;
++      int r;
++
++      mutex_lock(&dpi->lock);
++
++      if (out == NULL || out->manager == NULL) {
++              DSSERR("failed to enable display: no output/manager\n");
++              r = -ENODEV;
++              goto err_no_out_mgr;
++      }
++
++      r = dispc_runtime_get();
++      if (r)
++              goto err_get_dispc;
++
++      r = dss_dpi_select_source(dpi->module_id, out->dispc_channel);
++      if (r)
++              goto err_src_sel;
++
++      if (dpi->dpll != DSS_DPLL_NONE) {
++              DSSDBG("using DPLL %d for DPI%d\n", dpi->dpll, dpi->module_id);
++              dss_dpll_activate(dpi->dpll);
++              dss_dpll_set_control_mux(out->dispc_channel, dpi->dpll);
++      }
++
++      r = dpi_set_mode(dpi);
++      if (r)
++              goto err_set_mode;
++
++
++      dpi_config_lcd_manager(dpi);
++
++      mdelay(2);
++
++      r = dss_mgr_enable(out->manager);
++      if (r)
++              goto err_mgr_enable;
++
++      mutex_unlock(&dpi->lock);
++
++      return 0;
++
++err_mgr_enable:
++err_set_mode:
++      if (dpi->dpll != DSS_DPLL_NONE)
++              dss_dpll_disable(dpi->dpll);
++err_src_sel:
++      dispc_runtime_put();
++err_get_dispc:
++err_no_out_mgr:
++      mutex_unlock(&dpi->lock);
++      return r;
++}
++
++static void dra7xx_dpi_display_disable(struct omap_dss_device *dssdev)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++      struct omap_overlay_manager *mgr = dpi->output.manager;
++
++      mutex_lock(&dpi->lock);
++
++      dss_mgr_disable(mgr);
++
++      if (dpi->dpll != DSS_DPLL_NONE) {
++              dss_use_dpll_lcd(dssdev->dispc_channel, false);
++              dss_dpll_disable(dpi->dpll);
++      }
++
++      dispc_runtime_put();
++
++      mutex_unlock(&dpi->lock);
++}
++
++static void dra7xx_dpi_set_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++
++      DSSDBG("set_timings\n");
++
++      mutex_lock(&dpi->lock);
++
++      dpi->timings = *timings;
++
++      mutex_unlock(&dpi->lock);
++}
++
++static int dra7xx_dpi_check_timings(struct omap_dss_device *dssdev,
++                      struct omap_video_timings *timings)
++{
++      DSSDBG("check_timings\n");
++
++      return 0;
++}
++
++static void dra7xx_dpi_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++
++      DSSDBG("set_timings\n");
++
++      mutex_lock(&dpi->lock);
++
++      *timings = dpi->timings;
++
++      mutex_unlock(&dpi->lock);
++}
++
++static void dra7xx_dpi_set_data_lines(struct omap_dss_device *dssdev,
++              int data_lines)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++
++      mutex_lock(&dpi->lock);
++
++      dpi->data_lines = data_lines;
++
++      mutex_unlock(&dpi->lock);
++}
++
++static int dra7xx_dpi_connect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++      struct omap_overlay_manager *mgr;
++      int r;
++
++      /* try to get a free dpll */
++      dpi->dpll = dpi_get_dpll(dpi);
++
++      r = dss_dpll_init_regulator(dpi->dpll);
++      if (r)
++              return r;
++
++      mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
++      if (!mgr)
++              return -ENODEV;
++
++      r = dss_mgr_connect(mgr, dssdev);
++      if (r)
++              return r;
++
++      r = omapdss_output_set_device(dssdev, dst);
++      if (r) {
++              DSSERR("failed to connect output to new device: %s\n",
++                              dst->name);
++              dss_mgr_disconnect(mgr, dssdev);
++              return r;
++      }
++
++      return 0;
++}
++
++static void dra7xx_dpi_disconnect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct dpi_data *dpi = dev_get_drvdata(dssdev->dev);
++
++      WARN_ON(dst != dssdev->dst);
++
++      if (dst != dssdev->dst)
++              return;
++
++      dpi->dpll = DSS_DPLL_NONE;
++
++      omapdss_output_unset_device(dssdev);
++
++      if (dssdev->manager)
++              dss_mgr_disconnect(dssdev->manager, dssdev);
++}
++
++static const struct omapdss_dpi_ops dra7xx_dpi_ops = {
++      .connect = dra7xx_dpi_connect,
++      .disconnect = dra7xx_dpi_disconnect,
++
++      .enable = dra7xx_dpi_display_enable,
++      .disable = dra7xx_dpi_display_disable,
++
++      .check_timings = dra7xx_dpi_check_timings,
++      .set_timings = dra7xx_dpi_set_timings,
++      .get_timings = dra7xx_dpi_get_timings,
++
++      .set_data_lines = dra7xx_dpi_set_data_lines,
++};
++
++static enum omap_channel dra7xx_dpi_get_channel(struct dpi_data *dpi)
++{
++      switch (dpi->module_id) {
++      case 0:
++              return dpi->channel;
++      case 1:
++              return OMAP_DSS_CHANNEL_LCD2;
++      case 2:
++              return OMAP_DSS_CHANNEL_LCD3;
++      default:
++              DSSWARN("unknown DPI instance\n");
++              return OMAP_DSS_CHANNEL_LCD;
++      }
++}
++
++static void dra7xx_dpi_init_output(struct platform_device *pdev)
++{
++      struct dpi_data *dpi = dev_get_drvdata(&pdev->dev);
++      struct omap_dss_device *out = &dpi->output;
++      char *name;
++
++      out->dev = &pdev->dev;
++      name = devm_kzalloc(&pdev->dev, 5, GFP_KERNEL);
++
++      switch (dpi->module_id) {
++      case 0:
++              out->id = OMAP_DSS_OUTPUT_DPI;
++              break;
++      case 1:
++              out->id = OMAP_DSS_OUTPUT_DPI1;
++              break;
++      case 2:
++              out->id = OMAP_DSS_OUTPUT_DPI2;
++              break;
++      };
++
++      snprintf(name, 5, "dpi.%d", dpi->module_id);
++      out->name = name;
++      out->output_type = OMAP_DISPLAY_TYPE_DPI;
++      out->dispc_channel = dra7xx_dpi_get_channel(dpi);
++      out->ops.dpi = &dra7xx_dpi_ops;
++      out->owner = THIS_MODULE;
++
++      omapdss_register_output(out);
++}
++
++static void __exit dra7xx_dpi_uninit_output(struct platform_device *pdev)
++{
++      struct dpi_data *dpi = dev_get_drvdata(&pdev->dev);
++      struct omap_dss_device *out = &dpi->output;
++
++      omapdss_unregister_output(out);
++}
++
++static int dra7xx_dpi_probe(struct platform_device *pdev)
++{
++      int r;
++      struct dpi_data *dpi;
++
++      dpi = devm_kzalloc(&pdev->dev, sizeof(*dpi), GFP_KERNEL);
++      if (!dpi)
++              return -ENOMEM;
++
++      dev_set_drvdata(&pdev->dev, dpi);
++
++      mutex_init(&dpi->lock);
++
++      if (pdev->dev.of_node) {
++              u32 id;
++              enum omap_channel channel;
++
++              r = of_property_read_u32(pdev->dev.of_node, "id", &id);
++              if (r) {
++                      DSSERR("failed to read DPI module ID\n");
++                      return r;
++              }
++
++              r = of_property_read_u32(pdev->dev.of_node, "channel", &channel);
++              if (r && id == 0) {
++                      DSSERR("failed to read DPI channel\n");
++                      return r;
++              }
++
++              dpi->module_id = id;
++              dpi->channel = channel;
++      } else {
++              dpi->module_id = pdev->id;
++      }
++
++      dra7xx_dpi_init_output(pdev);
++
++      return 0;
++}
++
++static int __exit dra7xx_dpi_remove(struct platform_device *pdev)
++{
++      dra7xx_dpi_uninit_output(pdev);
++
++      return 0;
++}
++
++#if defined(CONFIG_OF)
++static const struct of_device_id dpi_of_match[] = {
++      {
++              .compatible = "ti,dra7xx-dpi",
++      },
++      {},
++};
++#else
++#define dpi_of_match NULL
++#endif
++
++static struct platform_driver dra7xx_dpi_driver = {
++      .probe          = dra7xx_dpi_probe,
++      .remove         = __exit_p(dra7xx_dpi_remove),
++      .driver         = {
++              .name   = "omapdss_dra7xx_dpi",
++              .owner  = THIS_MODULE,
++              .of_match_table = dpi_of_match,
++      },
++};
++
++int __init dra7xx_dpi_init_platform_driver(void)
++{
++      return platform_driver_register(&dra7xx_dpi_driver);
++}
++
++void __exit dra7xx_dpi_uninit_platform_driver(void)
++{
++      platform_driver_unregister(&dra7xx_dpi_driver);
++}
+--- a/drivers/video/omap2/dss/dsi.c
++++ b/drivers/video/omap2/dss/dsi.c
+@@ -38,6 +38,7 @@
+ #include <linux/slab.h>
+ #include <linux/debugfs.h>
+ #include <linux/pm_runtime.h>
++#include <linux/of.h>
+ #include <video/omapdss.h>
+ #include <video/mipi_display.h>
+@@ -373,6 +374,13 @@ struct dsi_packet_sent_handler_data {
+       struct completion *completion;
+ };
++struct dsi_module_id_data {
++      u32 address;
++      int id;
++};
++
++static const struct of_device_id dsi_of_match[];
++
+ #ifdef DEBUG
+ static bool dsi_perf;
+ module_param(dsi_perf, bool, 0644);
+@@ -1123,11 +1131,6 @@ static int dsi_regulator_init(struct pla
+               return 0;
+       vdds_dsi = devm_regulator_get(&dsi->pdev->dev, "vdds_dsi");
+-
+-      /* DT HACK: try VCXIO to make omapdss work for o4 sdp/panda */
+-      if (IS_ERR(vdds_dsi))
+-              vdds_dsi = devm_regulator_get(&dsi->pdev->dev, "VCXIO");
+-
+       if (IS_ERR(vdds_dsi)) {
+               DSSERR("can't get VDDS_DSI regulator\n");
+               return PTR_ERR(vdds_dsi);
+@@ -5082,6 +5085,7 @@ static enum omap_channel dsi_get_channel
+ {
+       switch (omapdss_get_version()) {
+       case OMAPDSS_VER_OMAP24xx:
++      case OMAPDSS_VER_AM43xx:
+               DSSWARN("DSI not supported\n");
+               return OMAP_DSS_CHANNEL_LCD;
+@@ -5352,7 +5356,6 @@ static int omap_dsihw_probe(struct platf
+       if (!dsi)
+               return -ENOMEM;
+-      dsi->module_id = dsidev->id;
+       dsi->pdev = dsidev;
+       dev_set_drvdata(&dsidev->dev, dsi);
+@@ -5402,6 +5405,31 @@ static int omap_dsihw_probe(struct platf
+               return r;
+       }
++      if (dsidev->dev.of_node) {
++              const struct of_device_id *match;
++              const struct dsi_module_id_data *d;
++
++              match = of_match_node(dsi_of_match, dsidev->dev.of_node);
++              if (!match) {
++                      DSSERR("unsupported DSI module\n");
++                      return -ENODEV;
++              }
++
++              d = match->data;
++
++              while (d->address != 0 && d->address != dsi_mem->start)
++                      d++;
++
++              if (d->address == 0) {
++                      DSSERR("unsupported DSI module\n");
++                      return -ENODEV;
++              }
++
++              dsi->module_id = d->id;
++      } else {
++              dsi->module_id = dsidev->id;
++      }
++
+       /* DSI VCs initialization */
+       for (i = 0; i < ARRAY_SIZE(dsi->vc); i++) {
+               dsi->vc[i].source = DSI_VC_SOURCE_L4;
+@@ -5450,6 +5478,7 @@ static int omap_dsihw_probe(struct platf
+       else if (dsi->module_id == 1)
+               dss_debugfs_create_file("dsi2_irqs", dsi2_dump_irqs);
+ #endif
++
+       return 0;
+ err_runtime_get:
+@@ -5498,6 +5527,23 @@ static const struct dev_pm_ops dsi_pm_op
+       .runtime_resume = dsi_runtime_resume,
+ };
++static const struct dsi_module_id_data dsi_of_data_omap3[] = {
++      { .address = 0x4804fc00, .id = 0, },
++      { },
++};
++
++static const struct dsi_module_id_data dsi_of_data_omap4[] = {
++      { .address = 0x58004000, .id = 0, },
++      { .address = 0x58005000, .id = 1, },
++      { },
++};
++
++static const struct of_device_id dsi_of_match[] = {
++      { .compatible = "ti,omap3-dsi", .data = dsi_of_data_omap3, },
++      { .compatible = "ti,omap4-dsi", .data = dsi_of_data_omap4, },
++      {},
++};
++
+ static struct platform_driver omap_dsihw_driver = {
+       .probe          = omap_dsihw_probe,
+       .remove         = __exit_p(omap_dsihw_remove),
+@@ -5505,6 +5551,7 @@ static struct platform_driver omap_dsihw
+               .name   = "omapdss_dsi",
+               .owner  = THIS_MODULE,
+               .pm     = &dsi_pm_ops,
++              .of_match_table = dsi_of_match,
+       },
+ };
+--- a/drivers/video/omap2/dss/dss.c
++++ b/drivers/video/omap2/dss/dss.c
+@@ -23,6 +23,7 @@
+ #define DSS_SUBSYS_NAME "DSS"
+ #include <linux/kernel.h>
++#include <linux/module.h>
+ #include <linux/io.h>
+ #include <linux/export.h>
+ #include <linux/err.h>
+@@ -33,6 +34,7 @@
+ #include <linux/pm_runtime.h>
+ #include <linux/gfp.h>
+ #include <linux/sizes.h>
++#include <linux/clk-private.h>
+ #include <video/omapdss.h>
+@@ -68,7 +70,8 @@ struct dss_features {
+       u8 fck_div_max;
+       u8 dss_fck_multiplier;
+       const char *clk_name;
+-      int (*dpi_select_source)(enum omap_channel channel);
++      int (*dpi_select_source)(int module_id, enum omap_channel channel);
++      bool dpll_clks;
+ };
+ static struct {
+@@ -428,6 +431,28 @@ void dss_select_lcd_clk_source(enum omap
+       dss.lcd_clk_source[ix] = clk_src;
+ }
++void dss_use_dpll_lcd(enum omap_channel channel, bool use_dpll)
++{
++      u8 bit;
++
++      switch (channel) {
++      case OMAP_DSS_CHANNEL_LCD:
++              bit = 0;
++              break;
++      case OMAP_DSS_CHANNEL_LCD2:
++              bit = 12;
++              break;
++      case OMAP_DSS_CHANNEL_LCD3:
++              bit = 19;
++              break;
++      case OMAP_DSS_CHANNEL_DIGIT:
++      default:
++              return;
++      }
++
++      REG_FLD_MOD(DSS_CONTROL, use_dpll, bit, bit);
++}
++
+ enum omap_dss_clk_source dss_get_dispc_clk_source(void)
+ {
+       return dss.dispc_clk_source;
+@@ -466,7 +491,7 @@ int dss_calc_clock_rates(struct dss_cloc
+               cinfo->fck = prate / cinfo->fck_div *
+                       dss.feat->dss_fck_multiplier;
+       } else {
+-              if (cinfo->fck_div != 0)
++              if (cinfo->fck_div != 1)
+                       return -EINVAL;
+               cinfo->fck = clk_get_rate(dss.dss_clk);
+       }
+@@ -529,7 +554,7 @@ int dss_set_clock_div(struct dss_clock_i
+               if (r)
+                       return r;
+       } else {
+-              if (cinfo->fck_div != 0)
++              if (cinfo->fck_div != 1)
+                       return -EINVAL;
+       }
+@@ -635,7 +660,8 @@ enum dss_hdmi_venc_clk_source_select dss
+       return REG_GET(DSS_CONTROL, 15, 15);
+ }
+-static int dss_dpi_select_source_omap2_omap3(enum omap_channel channel)
++static int dss_dpi_select_source_omap2_omap3(int module_id,
++              enum omap_channel channel)
+ {
+       if (channel != OMAP_DSS_CHANNEL_LCD)
+               return -EINVAL;
+@@ -643,7 +669,7 @@ static int dss_dpi_select_source_omap2_o
+       return 0;
+ }
+-static int dss_dpi_select_source_omap4(enum omap_channel channel)
++static int dss_dpi_select_source_omap4(int module_id, enum omap_channel channel)
+ {
+       int val;
+@@ -663,7 +689,7 @@ static int dss_dpi_select_source_omap4(e
+       return 0;
+ }
+-static int dss_dpi_select_source_omap5(enum omap_channel channel)
++static int dss_dpi_select_source_omap5(int module_id, enum omap_channel channel)
+ {
+       int val;
+@@ -689,9 +715,17 @@ static int dss_dpi_select_source_omap5(e
+       return 0;
+ }
+-int dss_dpi_select_source(enum omap_channel channel)
++static int dss_dpi_select_source_dra7xx(int module_id, enum omap_channel channel)
++{
++      if (module_id != 0)
++              return 0;
++
++      return dss_dpi_select_source_omap5(module_id, channel);
++}
++
++int dss_dpi_select_source(int module_id, enum omap_channel channel)
+ {
+-      return dss.feat->dpi_select_source(channel);
++      return dss.feat->dpi_select_source(module_id, channel);
+ }
+ static int dss_get_clocks(void)
+@@ -713,11 +747,26 @@ static int dss_get_clocks(void)
+                       return PTR_ERR(clk);
+               }
+       } else {
++              int r;
++
++              DSSDBG("DSS CLOCK HACK\n");
++              printk("FCK %s\n", clk->name);
++
++              clk = clk_get_parent(clk);
++              DSSDBG("GATE %s\n", clk->name);
++
++              clk = clk_get_parent(clk);
++              DSSDBG("PLL %s\n", clk->name);
++
++              r = clk_set_rate(clk, 150000000);
++              if (!r)
++                      DSSERR("SET CLK RATE Failed");
+               clk = NULL;
+       }
+       dss.dpll4_m4_ck = clk;
++
+       return 0;
+ }
+@@ -795,6 +844,21 @@ static const struct dss_features omap54x
+       .dpi_select_source      =       &dss_dpi_select_source_omap5,
+ };
++static const struct dss_features dra7xx_dss_feats __initconst = {
++      .fck_div_max            =       64,
++      .dss_fck_multiplier     =       1,
++      .clk_name               =       "dpll_per_h12x2_ck",
++      .dpi_select_source      =       &dss_dpi_select_source_dra7xx,
++      .dpll_clks              =       true,
++};
++
++static const struct dss_features am43xx_dss_feats __initconst = {
++      .fck_div_max            =       0,
++      .dss_fck_multiplier     =       0,
++      .clk_name               =       NULL,
++      .dpi_select_source      =       &dss_dpi_select_source_omap2_omap3,
++};
++
+ static int __init dss_init_features(struct platform_device *pdev)
+ {
+       const struct dss_features *src;
+@@ -831,6 +895,14 @@ static int __init dss_init_features(stru
+               src = &omap54xx_dss_feats;
+               break;
++      case OMAPDSS_VER_DRA7xx:
++              src = &dra7xx_dss_feats;
++              break;
++
++      case OMAPDSS_VER_AM43xx:
++              src = &am43xx_dss_feats;
++              break;
++
+       default:
+               return -ENODEV;
+       }
+@@ -907,6 +979,15 @@ static int __init omap_dsshw_probe(struc
+       dss_debugfs_create_file("dss", dss_dump_regs);
++      if (dss.feat->dpll_clks) {
++              r = dss_dpll_configure(pdev);
++              if (r)
++                      goto err_runtime_get;
++              r = dss_dpll_configure_ctrl();
++              if (r)
++                      goto err_runtime_get;
++      }
++
+       return 0;
+ err_runtime_get:
+@@ -920,6 +1001,9 @@ static int __exit omap_dsshw_remove(stru
+ {
+       pm_runtime_disable(&pdev->dev);
++      if (dss.feat->dpll_clks)
++              dss_dpll_unconfigure_ctrl();
++
+       dss_put_clocks();
+       return 0;
+@@ -955,12 +1039,21 @@ static const struct dev_pm_ops dss_pm_op
+       .runtime_resume = dss_runtime_resume,
+ };
++static const struct of_device_id dss_of_match[] = {
++      { .compatible = "ti,omap3-dss", },
++      { .compatible = "ti,omap4-dss", },
++      {},
++};
++
++MODULE_DEVICE_TABLE(of, dss_of_match);
++
+ static struct platform_driver omap_dsshw_driver = {
+       .remove         = __exit_p(omap_dsshw_remove),
+       .driver         = {
+               .name   = "omapdss_dss",
+               .owner  = THIS_MODULE,
+               .pm     = &dss_pm_ops,
++              .of_match_table = dss_of_match,
+       },
+ };
+--- /dev/null
++++ b/drivers/video/omap2/dss/dss_dpll.c
+@@ -0,0 +1,536 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Ltd
++ *
++ * Copy of the DSI PLL code
++ *
++ * 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/>.
++ */
++
++#include <linux/kernel.h>
++#include <linux/err.h>
++#include <linux/delay.h>
++#include <linux/io.h>
++#include <linux/clk.h>
++#include <linux/platform_device.h>
++#include <linux/regulator/consumer.h>
++#include <linux/sched.h>
++#include <linux/wait.h>
++
++#include <video/omapdss.h>
++
++#include "dss.h"
++#include "dss_features.h"
++
++#define CLK_CTRL              0x054
++#define PLL_CONTROL           0x300
++#define PLL_STATUS            0x304
++#define PLL_GO                        0x308
++#define PLL_CONFIGURATION1    0x30C
++#define PLL_CONFIGURATION2    0x310
++#define PLL_CONFIGURATION3    0x314
++#define PLL_SSC_CONFIGURATION1        0x318
++#define PLL_SSC_CONFIGURATION2        0x31C
++
++#define CTRL_BASE             0x4a002500
++#define DSS_PLL_CONTROL               0x38
++
++#define REG_GET(dpll, idx, start, end) \
++      FLD_GET(dpll_read_reg(dpll, idx), start, end)
++
++#define REG_FLD_MOD(dpll, idx, val, start, end) \
++      dpll_write_reg(dpll, idx, FLD_MOD(dpll_read_reg(dpll, idx), val, start, end))
++
++static struct {
++      struct platform_device *pdev;
++      struct regulator *vdda_video_reg;
++
++      void __iomem *base[2], *control_base;
++      unsigned scp_refcount[2];
++      struct clk *sys_clk[2];
++      bool enabled[3];
++} dss_dpll;
++
++static inline u32 dpll_read_reg(enum dss_dpll dpll, u16 offset)
++{
++      return __raw_readl(dss_dpll.base[dpll] + offset);
++}
++
++static inline void dpll_write_reg(enum dss_dpll dpll, u16 offset, u32 val)
++{
++      __raw_writel(val, dss_dpll.base[dpll] + offset);
++}
++
++#define CTRL_REG_GET(start, end) \
++      FLD_GET(ctrl_read_reg(), start, end)
++
++#define CTRL_REG_FLD_MOD(val, start, end) \
++      ctrl_write_reg(FLD_MOD(ctrl_read_reg(), val, start, end))
++
++static inline u32 ctrl_read_reg(void)
++{
++      return __raw_readl(dss_dpll.control_base + DSS_PLL_CONTROL);
++}
++
++static inline void ctrl_write_reg(u32 val)
++{
++      __raw_writel(val, dss_dpll.control_base + DSS_PLL_CONTROL);
++}
++
++static inline int wait_for_bit_change(enum dss_dpll dpll,
++              const u16 offset, int bitnum, int value)
++{
++      unsigned long timeout;
++      ktime_t wait;
++      int t;
++
++      /* first busyloop to see if the bit changes right away */
++      t = 100;
++      while (t-- > 0) {
++              if (REG_GET(dpll, offset, bitnum, bitnum) == value)
++                      return value;
++      }
++
++      /* then loop for 500ms, sleeping for 1ms in between */
++      timeout = jiffies + msecs_to_jiffies(500);
++      while (time_before(jiffies, timeout)) {
++              if (REG_GET(dpll, offset, bitnum, bitnum) == value)
++                      return value;
++
++              wait = ns_to_ktime(1000 * 1000);
++              set_current_state(TASK_UNINTERRUPTIBLE);
++              schedule_hrtimeout(&wait, HRTIMER_MODE_REL);
++      }
++
++      return !value;
++}
++
++bool dss_dpll_disabled(enum dss_dpll dpll)
++{
++      return !dss_dpll.enabled[dpll];
++}
++
++unsigned long dpll_get_clkin(enum dss_dpll dpll)
++{
++      return clk_get_rate(dss_dpll.sys_clk[dpll]);
++}
++
++bool dss_dpll_calc(enum dss_dpll dpll, unsigned long clkin,
++              unsigned long pll_min, unsigned long pll_max,
++              dss_dpll_calc_func func, void *data)
++{
++      int regn, regn_start, regn_stop;
++      int regm, regm_start, regm_stop;
++      unsigned long fint, pll;
++      const unsigned long pll_hw_max = 1800000000;
++      unsigned long fint_hw_min, fint_hw_max, regm_max, regn_max;
++
++      fint_hw_min = dss_feat_get_param_min(FEAT_PARAM_DSIPLL_FINT);
++      fint_hw_max = dss_feat_get_param_max(FEAT_PARAM_DSIPLL_FINT);
++      regm_max = dss_feat_get_param_max(FEAT_PARAM_DSIPLL_REGM);
++      regn_max = dss_feat_get_param_max(FEAT_PARAM_DSIPLL_REGN);
++
++      regn_start = max(DIV_ROUND_UP(clkin, fint_hw_max), 1ul);
++      regn_stop = min(clkin / fint_hw_min, regn_max);
++
++      pll_max = pll_max ? pll_max : ULONG_MAX;
++
++      for (regn = regn_start; regn <= regn_stop; ++regn) {
++              fint = clkin / regn;
++
++              regm_start = max(DIV_ROUND_UP(DIV_ROUND_UP(pll_min, fint), 2),
++                              1ul);
++              regm_stop = min3(pll_max / fint / 2,
++                              pll_hw_max / fint / 2,
++                              regm_max);
++
++              for (regm = regm_start; regm <= regm_stop; ++regm) {
++                      pll = 2 * regm * fint;
++
++                      if (func(regn, regm, fint, pll, data))
++                              return true;
++              }
++      }
++
++      return false;
++}
++
++bool dss_dpll_hsdiv_calc(enum dss_dpll dpll, unsigned long pll,
++              unsigned long out_min, dss_dpll_hsdiv_calc_func func, void *data)
++{
++      int regm, regm_start, regm_stop;
++      unsigned long out_max;
++      unsigned long out;
++      unsigned long regm_dispc_max;
++
++      regm_dispc_max = dss_feat_get_param_max(FEAT_PARAM_DSIPLL_REGM_DISPC);
++
++      out_min = out_min ? out_min : 1;
++      out_max = dss_feat_get_param_max(FEAT_PARAM_DSS_FCK);
++
++      regm_start = max(DIV_ROUND_UP(pll, out_max), 1ul);
++      regm_stop = min(pll / out_min, regm_dispc_max);
++
++      for (regm = regm_start; regm <= regm_stop; ++regm) {
++              out = pll / regm;
++
++              if (func(regm, out, data))
++                      return true;
++      }
++
++      return false;
++}
++
++int dss_dpll_set_clock_div(enum dss_dpll dpll, struct dss_dpll_cinfo *cinfo)
++{
++      int r = 0;
++      u32 l;
++      u8 regn_start, regn_end, regm_start, regm_end;
++      u8 regm_hsdiv_start, regm_hsdiv_end;
++
++      DSSDBG("DPLL_VIDEO%d clock config starts\n", dpll + 1);
++
++      DSSDBG("DPLL Fint %ld\n", cinfo->fint);
++
++      DSSDBG("clkin rate %ld\n", cinfo->clkin);
++
++      DSSDBG("CLKOUT = 2 * %d / %d * %lu = %lu\n",
++                      cinfo->regm,
++                      cinfo->regn,
++                      cinfo->clkin,
++                      cinfo->clkout);
++
++      DSSDBG("regm_hsdiv = %d\n", cinfo->regm_hsdiv);
++
++      dss_feat_get_reg_field(FEAT_REG_DSIPLL_REGN, &regn_start, &regn_end);
++      dss_feat_get_reg_field(FEAT_REG_DSIPLL_REGM, &regm_start, &regm_end);
++      dss_feat_get_reg_field(FEAT_REG_DSIPLL_REGM_DISPC, &regm_hsdiv_start,
++                      &regm_hsdiv_end);
++
++      /* PLL_AUTOMODE = manual */
++      REG_FLD_MOD(dpll, PLL_CONTROL, 0, 0, 0);
++
++      /* CONFIGURATION1 */
++      l = dpll_read_reg(dpll, PLL_CONFIGURATION1);
++      /* PLL_REGN */
++      l = FLD_MOD(l, cinfo->regn - 1, regn_start, regn_end);
++      /* PLL_REGM */
++      l = FLD_MOD(l, cinfo->regm, regm_start, regm_end);
++      /* M4_CLOCK_DIV */
++      l = FLD_MOD(l, cinfo->regm_hsdiv > 0 ? cinfo->regm_hsdiv - 1 : 0,
++                      regm_hsdiv_start, regm_hsdiv_end);
++      dpll_write_reg(dpll, PLL_CONFIGURATION1, l);
++
++      /* CONFIGURATION3 */
++      l = dpll_read_reg(dpll, PLL_CONFIGURATION3);
++      /* M6_CLOCK_DIV */
++      l = FLD_MOD(l, cinfo->regm_hsdiv > 0 ? cinfo->regm_hsdiv - 1 : 0, 4, 0);
++      dpll_write_reg(dpll, PLL_CONFIGURATION3, l);
++
++      /* CONFIGURATION2 */
++      l = dpll_read_reg(dpll, PLL_CONFIGURATION2);
++      l = FLD_MOD(l, 1, 13, 13);      /* PLL_REFEN */
++      l = FLD_MOD(l, 0, 14, 14);      /* DSIPHY_CLKINEN */
++      l = FLD_MOD(l, 1, 20, 20);      /* HSDIVBYPASS */
++      l = FLD_MOD(l, 3, 22, 21);      /* REF_SYSCLK = sysclk */
++      dpll_write_reg(dpll, PLL_CONFIGURATION2, l);
++
++      REG_FLD_MOD(dpll, PLL_GO, 1, 0, 0);     /* PLL_GO */
++
++      if (wait_for_bit_change(dpll, PLL_GO, 0, 0) != 0) {
++              DSSERR("dsi pll go bit not going down.\n");
++              r = -EIO;
++              goto err;
++      }
++
++      if (wait_for_bit_change(dpll, PLL_STATUS, 1, 1) != 1) {
++              DSSERR("cannot lock PLL\n");
++              r = -EIO;
++              goto err;
++      }
++
++      l = dpll_read_reg(dpll, PLL_CONFIGURATION2);
++      l = FLD_MOD(l, 0, 0, 0);        /* PLL_IDLE */
++      l = FLD_MOD(l, 0, 5, 5);        /* PLL_PLLLPMODE */
++      l = FLD_MOD(l, 0, 6, 6);        /* PLL_LOWCURRSTBY */
++      l = FLD_MOD(l, 0, 7, 7);        /* PLL_TIGHTPHASELOCK */
++      l = FLD_MOD(l, 0, 8, 8);        /* PLL_DRIFTGUARDEN */
++      l = FLD_MOD(l, 0, 10, 9);       /* PLL_LOCKSEL */
++      l = FLD_MOD(l, 1, 13, 13);      /* PLL_REFEN */
++      l = FLD_MOD(l, 1, 14, 14);      /* PHY_CLKINEN */
++      l = FLD_MOD(l, 0, 15, 15);      /* BYPASSEN */
++      l = FLD_MOD(l, 1, 16, 16);      /* M4_CLOCK_EN */
++      l = FLD_MOD(l, 0, 17, 17);      /* CLOCK_PWDN */
++      l = FLD_MOD(l, 1, 18, 18);      /* PROTO_CLOCK_EN */
++      l = FLD_MOD(l, 0, 19, 19);      /* PROTO_CLOCK_PWDN */
++      l = FLD_MOD(l, 0, 20, 20);      /* HSDIVBYPASS */
++      l = FLD_MOD(l, 1, 23, 23);      /* M6_CLOCK_EN */
++      dpll_write_reg(dpll, PLL_CONFIGURATION2, l);
++
++      DSSDBG("PLL config done\n");
++
++err:
++      return r;
++}
++
++static void dss_dpll_disable_scp_clk(enum dss_dpll dpll)
++{
++      unsigned *refcount;
++
++      refcount = &dss_dpll.scp_refcount[dpll];
++
++      WARN_ON(*refcount == 0);
++      if (--(*refcount) == 0)
++              REG_FLD_MOD(dpll, CLK_CTRL, 0, 14, 14); /* CIO_CLK_ICG */
++}
++
++static void dss_dpll_enable_scp_clk(enum dss_dpll dpll)
++{
++      unsigned *refcount;
++
++      refcount = &dss_dpll.scp_refcount[dpll];
++
++      if ((*refcount)++ == 0)
++              REG_FLD_MOD(dpll, CLK_CTRL, 1, 14, 14); /* CIO_CLK_ICG */
++}
++
++static int dpll_power(enum dss_dpll dpll, int state)
++{
++      int t = 0;
++      /* PLL_PWR_CMD = enable both hsdiv and clkout*/
++      REG_FLD_MOD(dpll, CLK_CTRL, state, 31, 30);
++
++      /* PLL_PWR_STATUS: (NOTE: apparently buggy) */
++      while (FLD_GET(dpll_read_reg(dpll, CLK_CTRL), 29, 28) != state) {
++              if (++t > 1000) {
++                      DSSERR("Failed to set DPLL power mode to %d\n", state);
++                      /* return -ENODEV; */
++                      return 0;
++              }
++              udelay(1);
++      }
++
++      return 0;
++}
++
++void dss_dpll_enable_ctrl(enum dss_dpll dpll, bool enable)
++{
++      u8 bit;
++
++      switch (dpll) {
++      case DSS_DPLL_VIDEO1:
++              bit = 0;
++              break;
++      case DSS_DPLL_VIDEO2:
++              bit = 1;
++              break;
++      case DSS_DPLL_HDMI:
++              bit = 2;
++              break;
++      default:
++              DSSERR("invalid dpll\n");
++              return;
++      }
++
++      CTRL_REG_FLD_MOD(!enable, bit, bit);
++
++      dss_dpll.enabled[dpll] = enable;
++}
++
++static int dpll_init(enum dss_dpll dpll)
++{
++      int r;
++
++      clk_prepare_enable(dss_dpll.sys_clk[dpll]);
++      dss_dpll_enable_scp_clk(dpll);
++
++      r = regulator_enable(dss_dpll.vdda_video_reg);
++      if (r)
++              goto err_reg;
++
++      if (wait_for_bit_change(dpll, PLL_STATUS, 0, 1) != 1) {
++              DSSERR("PLL not coming out of reset.\n");
++              r = -ENODEV;
++              goto err_reset;
++      }
++
++      r = dpll_power(dpll, 0x2);
++      if (r)
++              goto err_reset;
++
++      return 0;
++
++err_reset:
++      regulator_disable(dss_dpll.vdda_video_reg);
++err_reg:
++      dss_dpll_disable_scp_clk(dpll);
++      clk_disable_unprepare(dss_dpll.sys_clk[dpll]);
++
++      return r;
++}
++
++int dss_dpll_activate(enum dss_dpll dpll)
++{
++      int r;
++
++      /* enable from control module */
++      dss_dpll_enable_ctrl(dpll, true);
++
++      r = dpll_init(dpll);
++
++      return r;
++}
++
++void dss_dpll_set_control_mux(enum omap_channel channel, enum dss_dpll dpll)
++{
++      u8 start, end;
++      u8 val;
++
++      if (channel == OMAP_DSS_CHANNEL_LCD) {
++              start = 4;
++              end = 3;
++
++              switch (dpll) {
++              case DSS_DPLL_VIDEO1:
++                      val = 0;
++                      break;
++              default:
++                      DSSERR("error in mux config for LCD\n");
++                      return;
++              }
++      } else if (channel == OMAP_DSS_CHANNEL_LCD2) {
++              start = 6;
++              end = 5;
++
++              switch (dpll) {
++              case DSS_DPLL_VIDEO1:
++                      val = 0;
++                      break;
++              case DSS_DPLL_VIDEO2:
++                      val = 1;
++                      break;
++              default:
++                      DSSERR("error in mux config for LCD2\n");
++                      return;
++              }
++      } else {
++              start = 8;
++              end = 7;
++
++              switch (dpll) {
++              case DSS_DPLL_VIDEO1:
++                      val = 1;
++                      break;
++              case DSS_DPLL_VIDEO2:
++                      val = 0;
++                      break;
++              default:
++                      DSSERR("error in mux config for LCD3\n");
++                      return;
++              }
++      }
++
++      CTRL_REG_FLD_MOD(val, start, end);
++}
++
++void dss_dpll_disable(enum dss_dpll dpll)
++{
++      dpll_power(dpll, 0);
++
++      regulator_disable(dss_dpll.vdda_video_reg);
++
++      dss_dpll_disable_scp_clk(dpll);
++      clk_disable_unprepare(dss_dpll.sys_clk[dpll]);
++
++      dss_dpll_enable_ctrl(dpll, false);
++}
++
++static int dss_dpll_configure_one(struct platform_device *pdev,
++              enum dss_dpll dpll)
++{
++      struct resource *dpll_mem;
++
++      dpll_mem = platform_get_resource(pdev, IORESOURCE_MEM, dpll + 1);
++      if (!dpll_mem) {
++              DSSERR("can't get IORESOURCE_MEM for DPLL %d\n", dpll);
++              return -EINVAL;
++      }
++
++      dss_dpll.base[dpll] = devm_ioremap(&pdev->dev, dpll_mem->start,
++                              resource_size(dpll_mem));
++      if (!dss_dpll.base[dpll]) {
++              DSSERR("can't ioremap DPLL %d\n", dpll);
++              return -ENOMEM;
++      }
++
++      dss_dpll.sys_clk[dpll] = devm_clk_get(&pdev->dev,
++              dpll == DSS_DPLL_VIDEO1 ? "video1_clk" : "video2_clk");
++      if (IS_ERR(dss_dpll.sys_clk[dpll])) {
++              DSSERR("can't get sys clock for DPLL_VIDEO%d\n", dpll + 1);
++              return PTR_ERR(dss_dpll.sys_clk[dpll]);
++      }
++
++      return 0;
++}
++
++int dss_dpll_init_regulator(enum dss_dpll dpll)
++{
++      struct regulator *reg;
++      struct platform_device *pdev = dss_dpll.pdev;
++
++      if (dpll == DSS_DPLL_NONE)
++              return 0;
++
++      reg = devm_regulator_get(&pdev->dev, "vdda_video");
++      if (IS_ERR(reg)) {
++              DSSERR("can't get vdda_video regulator\n");
++              return PTR_ERR(reg);
++      }
++
++      dss_dpll.vdda_video_reg = reg;
++
++      return 0;
++}
++
++int dss_dpll_configure(struct platform_device *pdev)
++{
++      int r;
++
++      r = dss_dpll_configure_one(pdev, DSS_DPLL_VIDEO1);
++      if (r)
++              return r;
++
++      r = dss_dpll_configure_one(pdev, DSS_DPLL_VIDEO2);
++      if (r)
++              return r;
++
++      dss_dpll.pdev = pdev;
++
++      return 0;
++}
++
++int dss_dpll_configure_ctrl(void)
++{
++      dss_dpll.control_base = ioremap(CTRL_BASE, SZ_1K);
++
++      if (!dss_dpll.control_base) {
++              DSSERR("can't ioremap control base\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
++
++void dss_dpll_unconfigure_ctrl(void) {
++      if (dss_dpll.control_base)
++              iounmap(dss_dpll.control_base);
++}
+--- a/drivers/video/omap2/dss/dss_features.c
++++ b/drivers/video/omap2/dss/dss_features.c
+@@ -93,6 +93,17 @@ static const struct dss_reg_field omap3_
+       [FEAT_REG_DSIPLL_REGM_DSI]              = { 26, 23 },
+ };
++static const struct dss_reg_field am43xx_dss_reg_fields[] = {
++      [FEAT_REG_FIRHINC]                      = { 12, 0 },
++      [FEAT_REG_FIRVINC]                      = { 28, 16 },
++      [FEAT_REG_FIFOLOWTHRESHOLD]     = { 11, 0 },
++      [FEAT_REG_FIFOHIGHTHRESHOLD]            = { 27, 16 },
++      [FEAT_REG_FIFOSIZE]             = { 10, 0 },
++      [FEAT_REG_HORIZONTALACCU]               = { 9, 0 },
++      [FEAT_REG_VERTICALACCU]                 = { 25, 16 },
++      [FEAT_REG_DISPC_CLK_SWITCH]             = { 0, 0 },
++};
++
+ static const struct dss_reg_field omap4_dss_reg_fields[] = {
+       [FEAT_REG_FIRHINC]                      = { 12, 0 },
+       [FEAT_REG_FIRVINC]                      = { 28, 16 },
+@@ -149,6 +160,11 @@ static const enum omap_display_type omap
+       OMAP_DISPLAY_TYPE_VENC,
+ };
++static const enum omap_display_type am43xx_dss_supported_displays[] = {
++      /* OMAP_DSS_CHANNEL_LCD */
++      OMAP_DISPLAY_TYPE_DPI | OMAP_DISPLAY_TYPE_DBI,
++};
++
+ static const enum omap_display_type omap4_dss_supported_displays[] = {
+       /* OMAP_DSS_CHANNEL_LCD */
+       OMAP_DISPLAY_TYPE_DBI | OMAP_DISPLAY_TYPE_DSI,
+@@ -174,6 +190,20 @@ static const enum omap_display_type omap
+       OMAP_DISPLAY_TYPE_DSI,
+ };
++static const enum omap_display_type dra7xx_dss_supported_displays[] = {
++      /* OMAP_DSS_CHANNEL_LCD */
++      OMAP_DISPLAY_TYPE_DPI,
++
++      /* OMAP_DSS_CHANNEL_DIGIT */
++      OMAP_DISPLAY_TYPE_HDMI | OMAP_DISPLAY_TYPE_DPI,
++
++      /* OMAP_DSS_CHANNEL_LCD2 */
++      OMAP_DISPLAY_TYPE_DPI,
++
++      /* OMAP_DSS_CHANNEL_LCD3 */
++      OMAP_DISPLAY_TYPE_DPI,
++};
++
+ static const enum omap_dss_output_id omap2_dss_supported_outputs[] = {
+       /* OMAP_DSS_CHANNEL_LCD */
+       OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI,
+@@ -200,6 +230,11 @@ static const enum omap_dss_output_id oma
+       OMAP_DSS_OUTPUT_VENC,
+ };
++static const enum omap_dss_output_id am43xx_dss_supported_outputs[] = {
++      /* OMAP_DSS_CHANNEL_LCD */
++      OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DBI,
++};
++
+ static const enum omap_dss_output_id omap4_dss_supported_outputs[] = {
+       /* OMAP_DSS_CHANNEL_LCD */
+       OMAP_DSS_OUTPUT_DBI | OMAP_DSS_OUTPUT_DSI1,
+@@ -229,6 +264,20 @@ static const enum omap_dss_output_id oma
+       OMAP_DSS_OUTPUT_DSI2,
+ };
++static const enum omap_dss_output_id dra7xx_dss_supported_outputs[] = {
++      /* OMAP_DSS_CHANNEL_LCD */
++      OMAP_DSS_OUTPUT_DPI,
++
++      /* OMAP_DSS_CHANNEL_DIGIT */
++      OMAP_DSS_OUTPUT_HDMI | OMAP_DSS_OUTPUT_DPI,
++
++      /* OMAP_DSS_CHANNEL_LCD2 */
++      OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DPI1,
++
++      /* OMAP_DSS_CHANNEL_LCD3 */
++      OMAP_DSS_OUTPUT_DPI | OMAP_DSS_OUTPUT_DPI2,
++};
++
+ static const enum omap_color_mode omap2_dss_supported_color_modes[] = {
+       /* OMAP_DSS_GFX */
+       OMAP_DSS_COLOR_CLUT1 | OMAP_DSS_COLOR_CLUT2 |
+@@ -444,6 +493,13 @@ static const struct dss_param_range omap
+       [FEAT_PARAM_LINEWIDTH]                  = { 1, 1024 },
+ };
++static const struct dss_param_range am43xx_dss_param_range[] = {
++      [FEAT_PARAM_DSS_FCK]                    = { 0, 200000000 },
++      [FEAT_PARAM_DSS_PCD]                    = { 2, 255 },
++      [FEAT_PARAM_DOWNSCALE]                  = { 1, 4 },
++      [FEAT_PARAM_LINEWIDTH]                  = { 1, 1024 },
++};
++
+ static const struct dss_param_range omap4_dss_param_range[] = {
+       [FEAT_PARAM_DSS_FCK]                    = { 0, 186000000 },
+       [FEAT_PARAM_DSS_PCD]                    = { 1, 255 },
+@@ -520,6 +576,21 @@ static const enum dss_feat_id am35xx_dss
+       FEAT_OMAP3_DSI_FIFO_BUG,
+ };
++static const enum dss_feat_id am43xx_dss_feat_list[] = {
++      FEAT_LCDENABLEPOL,
++      FEAT_LCDENABLESIGNAL,
++      FEAT_PCKFREEENABLE,
++      FEAT_FUNCGATED,
++      FEAT_LINEBUFFERSPLIT,
++      FEAT_ROWREPEATENABLE,
++      FEAT_RESIZECONF,
++      FEAT_CPR,
++      FEAT_PRELOAD,
++      FEAT_FIR_COEF_V,
++      FEAT_ALPHA_FIXED_ZORDER,
++      FEAT_FIFO_MERGE,
++};
++
+ static const enum dss_feat_id omap3630_dss_feat_list[] = {
+       FEAT_LCDENABLEPOL,
+       FEAT_LCDENABLESIGNAL,
+@@ -595,6 +666,7 @@ static const enum dss_feat_id omap4_dss_
+ static const enum dss_feat_id omap5_dss_feat_list[] = {
+       FEAT_MGR_LCD2,
++      FEAT_MGR_LCD3,
+       FEAT_CORE_CLK_DIV,
+       FEAT_LCD_CLK_SRC,
+       FEAT_DSI_DCS_CMD_CONFIG_VC,
+@@ -681,6 +753,26 @@ static const struct omap_dss_features am
+       .burst_size_unit = 8,
+ };
++static const struct omap_dss_features am43xx_dss_features = {
++      .reg_fields = am43xx_dss_reg_fields,
++      .num_reg_fields = ARRAY_SIZE(am43xx_dss_reg_fields),
++
++      .features = am43xx_dss_feat_list,
++      .num_features = ARRAY_SIZE(am43xx_dss_feat_list),
++
++      .num_mgrs = 1,
++      .num_ovls = 3,
++      .supported_displays = am43xx_dss_supported_displays,
++      .supported_outputs = am43xx_dss_supported_outputs,
++      .supported_color_modes = omap3_dss_supported_color_modes,
++      .overlay_caps = omap3430_dss_overlay_caps,
++      .clksrc_names = omap2_dss_clk_source_names,
++      .dss_params = am43xx_dss_param_range,
++      .supported_rotation_types = OMAP_DSS_ROT_DMA,
++      .buffer_size_unit = 1,
++      .burst_size_unit = 8,
++};
++
+ static const struct omap_dss_features omap3630_dss_features = {
+       .reg_fields = omap3_dss_reg_fields,
+       .num_reg_fields = ARRAY_SIZE(omap3_dss_reg_fields),
+@@ -789,49 +881,26 @@ static const struct omap_dss_features om
+       .burst_size_unit = 16,
+ };
+-#if defined(CONFIG_OMAP4_DSS_HDMI)
+-/* HDMI OMAP4 Functions*/
+-static const struct ti_hdmi_ip_ops omap4_hdmi_functions = {
+-
+-      .video_configure        =       ti_hdmi_4xxx_basic_configure,
+-      .phy_enable             =       ti_hdmi_4xxx_phy_enable,
+-      .phy_disable            =       ti_hdmi_4xxx_phy_disable,
+-      .read_edid              =       ti_hdmi_4xxx_read_edid,
+-      .pll_enable             =       ti_hdmi_4xxx_pll_enable,
+-      .pll_disable            =       ti_hdmi_4xxx_pll_disable,
+-      .video_enable           =       ti_hdmi_4xxx_wp_video_start,
+-      .video_disable          =       ti_hdmi_4xxx_wp_video_stop,
+-      .dump_wrapper           =       ti_hdmi_4xxx_wp_dump,
+-      .dump_core              =       ti_hdmi_4xxx_core_dump,
+-      .dump_pll               =       ti_hdmi_4xxx_pll_dump,
+-      .dump_phy               =       ti_hdmi_4xxx_phy_dump,
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-      .audio_enable           =       ti_hdmi_4xxx_wp_audio_enable,
+-      .audio_disable          =       ti_hdmi_4xxx_wp_audio_disable,
+-      .audio_start            =       ti_hdmi_4xxx_audio_start,
+-      .audio_stop             =       ti_hdmi_4xxx_audio_stop,
+-      .audio_config           =       ti_hdmi_4xxx_audio_config,
+-      .audio_get_dma_port     =       ti_hdmi_4xxx_audio_get_dma_port,
+-#endif
+-
+-};
++/* DRA DSS Features */
++static const struct omap_dss_features dra7xx_dss_features = {
++      .reg_fields = omap5_dss_reg_fields,
++      .num_reg_fields = ARRAY_SIZE(omap5_dss_reg_fields),
+-void dss_init_hdmi_ip_ops(struct hdmi_ip_data *ip_data,
+-              enum omapdss_version version)
+-{
+-      switch (version) {
+-      case OMAPDSS_VER_OMAP4430_ES1:
+-      case OMAPDSS_VER_OMAP4430_ES2:
+-      case OMAPDSS_VER_OMAP4:
+-              ip_data->ops = &omap4_hdmi_functions;
+-              break;
+-      default:
+-              ip_data->ops = NULL;
+-      }
++      .features = omap5_dss_feat_list,
++      .num_features = ARRAY_SIZE(omap5_dss_feat_list),
+-      WARN_ON(ip_data->ops == NULL);
+-}
+-#endif
++      .num_mgrs = 4,
++      .num_ovls = 4,
++      .supported_displays = dra7xx_dss_supported_displays,
++      .supported_outputs = dra7xx_dss_supported_outputs,
++      .supported_color_modes = omap4_dss_supported_color_modes,
++      .overlay_caps = omap4_dss_overlay_caps,
++      .clksrc_names = omap5_dss_clk_source_names,
++      .dss_params = omap5_dss_param_range,
++      .supported_rotation_types = OMAP_DSS_ROT_DMA | OMAP_DSS_ROT_TILER,
++      .buffer_size_unit = 16,
++      .burst_size_unit = 16,
++};
+ /* Functions returning values related to a DSS feature */
+ int dss_feat_get_num_mgrs(void)
+@@ -967,10 +1036,18 @@ void dss_features_init(enum omapdss_vers
+               omap_current_dss_features = &omap5_dss_features;
+               break;
++      case OMAPDSS_VER_DRA7xx:
++              omap_current_dss_features = &dra7xx_dss_features;
++              break;
++
+       case OMAPDSS_VER_AM35xx:
+               omap_current_dss_features = &am35xx_dss_features;
+               break;
++      case OMAPDSS_VER_AM43xx:
++              omap_current_dss_features = &am43xx_dss_features;
++              break;
++
+       default:
+               DSSWARN("Unsupported OMAP version");
+               break;
+--- a/drivers/video/omap2/dss/dss_features.h
++++ b/drivers/video/omap2/dss/dss_features.h
+@@ -20,10 +20,6 @@
+ #ifndef __OMAP2_DSS_FEATURES_H
+ #define __OMAP2_DSS_FEATURES_H
+-#if defined(CONFIG_OMAP4_DSS_HDMI)
+-#include "ti_hdmi.h"
+-#endif
+-
+ #define MAX_DSS_MANAGERS      4
+ #define MAX_DSS_OVERLAYS      4
+ #define MAX_DSS_LCD_MANAGERS  3
+@@ -117,8 +113,4 @@ bool dss_feat_rotation_type_supported(en
+ bool dss_has_feature(enum dss_feat_id id);
+ void dss_feat_get_reg_field(enum dss_feat_reg_field id, u8 *start, u8 *end);
+ void dss_features_init(enum omapdss_version version);
+-#if defined(CONFIG_OMAP4_DSS_HDMI)
+-void dss_init_hdmi_ip_ops(struct hdmi_ip_data *ip_data,
+-              enum omapdss_version version);
+-#endif
+ #endif
+--- a/drivers/video/omap2/dss/dss.h
++++ b/drivers/video/omap2/dss/dss.h
+@@ -100,6 +100,13 @@ enum dss_writeback_channel {
+       DSS_WB_LCD3_MGR =       7,
+ };
++enum dss_dpll {
++      DSS_DPLL_VIDEO1 = 0,
++      DSS_DPLL_VIDEO2,
++      DSS_DPLL_HDMI,
++      DSS_DPLL_NONE,
++};
++
+ struct dss_clock_info {
+       /* rates that we get with dividers below */
+       unsigned long fck;
+@@ -139,6 +146,12 @@ struct dsi_clock_info {
+       u16 lp_clk_div;
+ };
++struct dss_dpll_cinfo {
++      unsigned long fint, clkin, clkout, hsdiv_clk;
++
++      u16 regm, regn, regm_hsdiv;
++};
++
+ struct reg_field {
+       u16 reg;
+       u8 high;
+@@ -223,9 +236,10 @@ int dss_init_platform_driver(void) __ini
+ void dss_uninit_platform_driver(void);
+ unsigned long dss_get_dispc_clk_rate(void);
+-int dss_dpi_select_source(enum omap_channel channel);
++int dss_dpi_select_source(int module_id, enum omap_channel channel);
+ void dss_select_hdmi_venc_clk_source(enum dss_hdmi_venc_clk_source_select);
+ enum dss_hdmi_venc_clk_source_select dss_get_hdmi_venc_clk_source(void);
++void dss_use_dpll_lcd(enum omap_channel channel, bool use_dpll);
+ const char *dss_get_generic_clk_source_name(enum omap_dss_clk_source clk_src);
+ void dss_dump_clocks(struct seq_file *s);
+@@ -372,6 +386,10 @@ static inline bool dsi_pll_calc(struct p
+ int dpi_init_platform_driver(void) __init;
+ void dpi_uninit_platform_driver(void) __exit;
++/* DRA7x DPI */
++int dra7xx_dpi_init_platform_driver(void) __init;
++void dra7xx_dpi_uninit_platform_driver(void) __exit;
++
+ /* DISPC */
+ int dispc_init_platform_driver(void) __init;
+ void dispc_uninit_platform_driver(void) __exit;
+@@ -398,12 +416,6 @@ unsigned long dispc_fclk_rate(void);
+ int dispc_calc_clock_rates(unsigned long dispc_fclk_rate,
+               struct dispc_clock_info *cinfo);
+-
+-void dispc_ovl_set_fifo_threshold(enum omap_plane plane, u32 low, u32 high);
+-void dispc_ovl_compute_fifo_thresholds(enum omap_plane plane,
+-              u32 *fifo_low, u32 *fifo_high, bool use_fifomerge,
+-              bool manual_update);
+-
+ unsigned long dispc_mgr_lclk_rate(enum omap_channel channel);
+ unsigned long dispc_mgr_pclk_rate(enum omap_channel channel);
+ unsigned long dispc_core_clk_rate(void);
+@@ -427,8 +439,11 @@ int venc_init_platform_driver(void) __in
+ void venc_uninit_platform_driver(void) __exit;
+ /* HDMI */
+-int hdmi_init_platform_driver(void) __init;
+-void hdmi_uninit_platform_driver(void) __exit;
++int hdmi4_init_platform_driver(void) __init;
++void hdmi4_uninit_platform_driver(void) __exit;
++
++int hdmi5_init_platform_driver(void) __init;
++void hdmi5_uninit_platform_driver(void) __exit;
+ /* RFBI */
+ int rfbi_init_platform_driver(void) __init;
+@@ -446,4 +461,27 @@ static inline void dss_collect_irq_stats
+ }
+ #endif
++typedef bool (*dss_dpll_calc_func)(int regn, int regm, unsigned long fint,
++              unsigned long pll, void *data);
++typedef bool (*dss_dpll_hsdiv_calc_func)(int regm_dispc, unsigned long dispc,
++              void *data);
++bool dss_dpll_disabled(enum dss_dpll dpll);
++unsigned long dpll_get_clkin(enum dss_dpll dpll);
++bool dss_dpll_calc(enum dss_dpll dpll, unsigned long clkin,
++              unsigned long pll_min, unsigned long pll_max,
++              dss_dpll_calc_func func, void *data);
++bool dss_dpll_hsdiv_calc(enum dss_dpll dpll, unsigned long pll,
++              unsigned long out_min, dss_dpll_hsdiv_calc_func func,
++              void *data);
++int dss_dpll_set_clock_div(enum dss_dpll dpll, struct dss_dpll_cinfo *cinfo);
++
++void dss_dpll_enable_ctrl(enum dss_dpll dpll, bool enable);
++int dss_dpll_activate(enum dss_dpll dpll);
++void dss_dpll_set_control_mux(enum omap_channel channel, enum dss_dpll dpll);
++void dss_dpll_disable(enum dss_dpll dpll);
++int dss_dpll_init_regulator(enum dss_dpll dpll);
++int dss_dpll_configure(struct platform_device *pdev);
++int dss_dpll_configure_ctrl(void);
++void dss_dpll_unconfigure_ctrl(void);
++
+ #endif
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi4.c
+@@ -0,0 +1,761 @@
++/*
++ * HDMI interface DSS driver for TI's OMAP4 family of SoCs.
++ * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
++ * Authors: Yong Zhi
++ *    Mythri pk <mythripk@ti.com>
++ *
++ * 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 "HDMI"
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/interrupt.h>
++#include <linux/mutex.h>
++#include <linux/delay.h>
++#include <linux/string.h>
++#include <linux/platform_device.h>
++#include <linux/pm_runtime.h>
++#include <linux/clk.h>
++#include <linux/gpio.h>
++#include <linux/regulator/consumer.h>
++#include <video/omapdss.h>
++
++#include "hdmi4_core.h"
++#include "dss.h"
++#include "dss_features.h"
++
++static struct {
++      struct mutex lock;
++      struct platform_device *pdev;
++
++      struct hdmi_wp_data     wp;
++      struct hdmi_pll_data    pll;
++      struct hdmi_phy_data    phy;
++      struct hdmi_core_data   core;
++
++      struct hdmi_config cfg;
++
++      struct clk *sys_clk;
++      struct regulator *vdda_hdmi_dac_reg;
++
++      bool core_enabled;
++
++      struct omap_dss_device output;
++} hdmi;
++
++static int hdmi_runtime_get(void)
++{
++      int r;
++
++      DSSDBG("hdmi_runtime_get\n");
++
++      r = pm_runtime_get_sync(&hdmi.pdev->dev);
++      WARN_ON(r < 0);
++      if (r < 0)
++              return r;
++
++      return 0;
++}
++
++static void hdmi_runtime_put(void)
++{
++      int r;
++
++      DSSDBG("hdmi_runtime_put\n");
++
++      r = pm_runtime_put_sync(&hdmi.pdev->dev);
++      WARN_ON(r < 0 && r != -ENOSYS);
++}
++
++static irqreturn_t hdmi_irq_handler(int irq, void *data)
++{
++      struct hdmi_wp_data *wp = data;
++      u32 irqstatus;
++
++      irqstatus = hdmi_wp_get_irqstatus(wp);
++      hdmi_wp_set_irqstatus(wp, irqstatus);
++
++      if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
++                      irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
++              /*
++               * If we get both connect and disconnect interrupts at the same
++               * time, turn off the PHY, clear interrupts, and restart, which
++               * raises connect interrupt if a cable is connected, or nothing
++               * if cable is not connected.
++               */
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);
++
++              hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT |
++                              HDMI_IRQ_LINK_DISCONNECT);
++
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
++      } else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
++      } else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
++      }
++
++      return IRQ_HANDLED;
++}
++
++static int hdmi_init_regulator(void)
++{
++      int r;
++      struct regulator *reg;
++
++      if (hdmi.vdda_hdmi_dac_reg != NULL)
++              return 0;
++
++      reg = devm_regulator_get(&hdmi.pdev->dev, "vdda_hdmi_dac");
++      if (IS_ERR(reg)) {
++              DSSERR("can't get VDDA_HDMI_DAC regulator\n");
++              return PTR_ERR(reg);
++      }
++
++      r = regulator_set_voltage(reg, 1800000, 1980000);
++      if (r)
++              DSSWARN("can't set the regulator voltage");
++
++      hdmi.vdda_hdmi_dac_reg = reg;
++
++      return 0;
++}
++
++static int hdmi_power_on_core(struct omap_dss_device *dssdev)
++{
++      int r;
++
++      r = regulator_enable(hdmi.vdda_hdmi_dac_reg);
++      if (r)
++              return r;
++
++      r = hdmi_runtime_get();
++      if (r)
++              goto err_runtime_get;
++
++      /* Make selection of HDMI in DSS */
++      dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);
++
++      hdmi.core_enabled = true;
++
++      return 0;
++
++err_runtime_get:
++      regulator_disable(hdmi.vdda_hdmi_dac_reg);
++
++      return r;
++}
++
++static void hdmi_power_off_core(struct omap_dss_device *dssdev)
++{
++      hdmi.core_enabled = false;
++
++      hdmi_runtime_put();
++      regulator_disable(hdmi.vdda_hdmi_dac_reg);
++}
++
++static int hdmi_power_on_full(struct omap_dss_device *dssdev)
++{
++      int r;
++      struct omap_video_timings *p;
++      struct omap_overlay_manager *mgr = hdmi.output.manager;
++      unsigned long phy;
++      struct hdmi_wp_data *wp = &hdmi.wp;
++
++      r = hdmi_power_on_core(dssdev);
++      if (r)
++              return r;
++
++      /* disable and clear irqs */
++      hdmi_wp_clear_irqenable(wp, 0xffffffff);
++      hdmi_wp_set_irqstatus(wp, 0xffffffff);
++
++      p = &hdmi.cfg.timings;
++
++      DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
++
++      phy = p->pixel_clock;
++
++      hdmi_pll_compute(&hdmi.pll, clk_get_rate(hdmi.sys_clk), phy);
++
++      /* config the PLL and PHY hdmi_set_pll_pwrfirst */
++      r = hdmi_pll_enable(&hdmi.pll, &hdmi.wp);
++      if (r) {
++              DSSDBG("Failed to lock PLL\n");
++              goto err_pll_enable;
++      }
++
++      r = hdmi_phy_configure(&hdmi.phy, &hdmi.cfg);
++      if (r) {
++              DSSDBG("Failed to configure PHY\n");
++              goto err_phy_cfg;
++      }
++
++      r = hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
++      if (r)
++              goto err_phy_pwr;
++
++      hdmi4_configure(&hdmi.core, &hdmi.wp, &hdmi.cfg);
++
++      /* bypass TV gamma table */
++      dispc_enable_gamma_table(0);
++
++      /* tv size */
++      dss_mgr_set_timings(mgr, p);
++
++      r = hdmi_wp_video_start(&hdmi.wp);
++      if (r)
++              goto err_vid_enable;
++
++      r = dss_mgr_enable(mgr);
++      if (r)
++              goto err_mgr_enable;
++
++      hdmi_wp_set_irqenable(wp,
++              HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
++
++      return 0;
++
++err_mgr_enable:
++      hdmi_wp_video_stop(&hdmi.wp);
++err_vid_enable:
++err_phy_cfg:
++      hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
++err_phy_pwr:
++      hdmi_pll_disable(&hdmi.pll, &hdmi.wp);
++err_pll_enable:
++      hdmi_power_off_core(dssdev);
++      return -EIO;
++}
++
++static void hdmi_power_off_full(struct omap_dss_device *dssdev)
++{
++      struct omap_overlay_manager *mgr = hdmi.output.manager;
++
++      hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
++
++      dss_mgr_disable(mgr);
++
++      hdmi_wp_video_stop(&hdmi.wp);
++
++      hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
++
++      hdmi_pll_disable(&hdmi.pll, &hdmi.wp);
++
++      hdmi_power_off_core(dssdev);
++}
++
++static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
++                                      struct omap_video_timings *timings)
++{
++      struct hdmi_cm cm;
++
++      cm = hdmi_get_code(timings);
++      if (cm.code == -1)
++              return -EINVAL;
++
++      return 0;
++
++}
++
++static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct hdmi_cm cm;
++      const struct hdmi_config *t;
++
++      mutex_lock(&hdmi.lock);
++
++      cm = hdmi_get_code(timings);
++      hdmi.cfg.cm = cm;
++
++      t = hdmi_get_timings(cm.mode, cm.code);
++      if (t != NULL) {
++              hdmi.cfg = *t;
++
++              dispc_set_tv_pclk(t->timings.pixel_clock * 1000);
++      }
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      const struct hdmi_config *cfg;
++      struct hdmi_cm cm = hdmi.cfg.cm;
++
++      cfg = hdmi_get_timings(cm.mode, cm.code);
++      if (cfg == NULL)
++              cfg = hdmi_default_timing();
++
++      memcpy(timings, &cfg->timings, sizeof(cfg->timings));
++}
++
++static void hdmi_dump_regs(struct seq_file *s)
++{
++      mutex_lock(&hdmi.lock);
++
++      if (hdmi_runtime_get()) {
++              mutex_unlock(&hdmi.lock);
++              return;
++      }
++
++      hdmi_wp_dump(&hdmi.wp, s);
++      hdmi_pll_dump(&hdmi.pll, s);
++      hdmi_phy_dump(&hdmi.phy, s);
++      hdmi4_core_dump(&hdmi.core, s);
++
++      hdmi_runtime_put();
++      mutex_unlock(&hdmi.lock);
++}
++
++static int read_edid(u8 *buf, int len)
++{
++      int r;
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_runtime_get();
++      BUG_ON(r);
++
++      r = hdmi4_read_edid(&hdmi.core,  buf, len);
++
++      hdmi_runtime_put();
++      mutex_unlock(&hdmi.lock);
++
++      return r;
++}
++
++static int hdmi_display_enable(struct omap_dss_device *dssdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++      int r = 0;
++
++      DSSDBG("ENTER hdmi_display_enable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      if (out == NULL || out->manager == NULL) {
++              DSSERR("failed to enable display: no output/manager\n");
++              r = -ENODEV;
++              goto err0;
++      }
++
++      r = hdmi_power_on_full(dssdev);
++      if (r) {
++              DSSERR("failed to power on device\n");
++              goto err0;
++      }
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err0:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_display_disable(struct omap_dss_device *dssdev)
++{
++      DSSDBG("Enter hdmi_display_disable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      hdmi_power_off_full(dssdev);
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static int hdmi_core_enable(struct omap_dss_device *dssdev)
++{
++      int r = 0;
++
++      DSSDBG("ENTER omapdss_hdmi_core_enable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_power_on_core(dssdev);
++      if (r) {
++              DSSERR("failed to power on device\n");
++              goto err0;
++      }
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err0:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_core_disable(struct omap_dss_device *dssdev)
++{
++      DSSDBG("Enter omapdss_hdmi_core_disable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      hdmi_power_off_core(dssdev);
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static int hdmi_get_clocks(struct platform_device *pdev)
++{
++      struct clk *clk;
++
++      clk = devm_clk_get(&pdev->dev, "sys_clk");
++      if (IS_ERR(clk)) {
++              DSSERR("can't get sys_clk\n");
++              return PTR_ERR(clk);
++      }
++
++      hdmi.sys_clk = clk;
++
++      return 0;
++}
++
++static int hdmi_connect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct omap_overlay_manager *mgr;
++      int r;
++
++      r = hdmi_init_regulator();
++      if (r)
++              return r;
++
++      mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
++      if (!mgr)
++              return -ENODEV;
++
++      r = dss_mgr_connect(mgr, dssdev);
++      if (r)
++              return r;
++
++      r = omapdss_output_set_device(dssdev, dst);
++      if (r) {
++              DSSERR("failed to connect output to new device: %s\n",
++                              dst->name);
++              dss_mgr_disconnect(mgr, dssdev);
++              return r;
++      }
++
++      return 0;
++}
++
++static void hdmi_disconnect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      WARN_ON(dst != dssdev->dst);
++
++      if (dst != dssdev->dst)
++              return;
++
++      omapdss_output_unset_device(dssdev);
++
++      if (dssdev->manager)
++              dss_mgr_disconnect(dssdev->manager, dssdev);
++}
++
++static int hdmi_read_edid(struct omap_dss_device *dssdev,
++              u8 *edid, int len)
++{
++      bool need_enable;
++      int r;
++
++      need_enable = hdmi.core_enabled == false;
++
++      if (need_enable) {
++              r = hdmi_core_enable(dssdev);
++              if (r)
++                      return r;
++      }
++
++      r = read_edid(edid, len);
++
++      if (need_enable)
++              hdmi_core_disable(dssdev);
++
++      return r;
++}
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
++static int hdmi_audio_enable(struct omap_dss_device *dssdev)
++{
++      int r;
++
++      mutex_lock(&hdmi.lock);
++
++      if (!hdmi_mode_has_audio(hdmi.cfg.cm.mode)) {
++              r = -EPERM;
++              goto err;
++      }
++
++      r = hdmi_wp_audio_enable(&hdmi.wp, true);
++      if (r)
++              goto err;
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_audio_disable(struct omap_dss_device *dssdev)
++{
++      hdmi_wp_audio_enable(&hdmi.wp, false);
++}
++
++static int hdmi_audio_start(struct omap_dss_device *dssdev)
++{
++      return hdmi4_audio_start(&hdmi.core, &hdmi.wp);
++}
++
++static void hdmi_audio_stop(struct omap_dss_device *dssdev)
++{
++      hdmi4_audio_stop(&hdmi.core, &hdmi.wp);
++}
++
++static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
++{
++      bool r;
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_mode_has_audio(hdmi.cfg.cm.mode);
++
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static int hdmi_audio_config(struct omap_dss_device *dssdev,
++              struct omap_dss_audio *audio)
++{
++      int r;
++      u32 pclk = hdmi.cfg.timings.pixel_clock;
++
++      mutex_lock(&hdmi.lock);
++
++      if (!hdmi_mode_has_audio(hdmi.cfg.cm.mode)) {
++              r = -EPERM;
++              goto err;
++      }
++
++      r = hdmi4_audio_config(&hdmi.core, &hdmi.wp, audio, pclk);
++      if (r)
++              goto err;
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++#else
++static int hdmi_audio_enable(struct omap_dss_device *dssdev)
++{
++      return -EPERM;
++}
++
++static void hdmi_audio_disable(struct omap_dss_device *dssdev)
++{
++}
++
++static int hdmi_audio_start(struct omap_dss_device *dssdev)
++{
++      return -EPERM;
++}
++
++static void hdmi_audio_stop(struct omap_dss_device *dssdev)
++{
++}
++
++static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
++{
++      return false;
++}
++
++static int hdmi_audio_config(struct omap_dss_device *dssdev,
++              struct omap_dss_audio *audio)
++{
++      return -EPERM;
++}
++#endif
++
++static const struct omapdss_hdmi_ops hdmi_ops = {
++      .connect                = hdmi_connect,
++      .disconnect             = hdmi_disconnect,
++
++      .enable                 = hdmi_display_enable,
++      .disable                = hdmi_display_disable,
++
++      .check_timings          = hdmi_display_check_timing,
++      .set_timings            = hdmi_display_set_timing,
++      .get_timings            = hdmi_display_get_timings,
++
++      .read_edid              = hdmi_read_edid,
++
++      .audio_enable           = hdmi_audio_enable,
++      .audio_disable          = hdmi_audio_disable,
++      .audio_start            = hdmi_audio_start,
++      .audio_stop             = hdmi_audio_stop,
++      .audio_supported        = hdmi_audio_supported,
++      .audio_config           = hdmi_audio_config,
++};
++
++static void hdmi_init_output(struct platform_device *pdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++
++      out->dev = &pdev->dev;
++      out->id = OMAP_DSS_OUTPUT_HDMI;
++      out->output_type = OMAP_DISPLAY_TYPE_HDMI;
++      out->name = "hdmi.0";
++      out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
++      out->ops.hdmi = &hdmi_ops;
++      out->owner = THIS_MODULE;
++
++      omapdss_register_output(out);
++}
++
++static void __exit hdmi_uninit_output(struct platform_device *pdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++
++      omapdss_unregister_output(out);
++}
++
++/* HDMI HW IP initialisation */
++static int omapdss_hdmihw_probe(struct platform_device *pdev)
++{
++      int r;
++      int irq;
++
++      hdmi.pdev = pdev;
++
++      mutex_init(&hdmi.lock);
++
++      r = hdmi_wp_init(pdev, &hdmi.wp);
++      if (r)
++              return r;
++
++      r = hdmi_pll_init(pdev, &hdmi.pll);
++      if (r)
++              return r;
++
++      r = hdmi_phy_init(pdev, &hdmi.phy);
++      if (r)
++              return r;
++
++      r = hdmi4_core_init(pdev, &hdmi.core);
++      if (r)
++              return r;
++
++      r = hdmi_get_clocks(pdev);
++      if (r) {
++              DSSERR("can't get clocks\n");
++              return r;
++      }
++
++      irq = platform_get_irq(pdev, 0);
++      if (irq < 0) {
++              DSSERR("platform_get_irq failed\n");
++              return -ENODEV;
++      }
++
++      r = devm_request_threaded_irq(&pdev->dev, irq,
++                      NULL, hdmi_irq_handler,
++                      IRQF_ONESHOT, "OMAP HDMI", &hdmi.wp);
++      if (r) {
++              DSSERR("HDMI IRQ request failed\n");
++              return r;
++      }
++
++      pm_runtime_enable(&pdev->dev);
++
++      hdmi_init_output(pdev);
++
++      dss_debugfs_create_file("hdmi", hdmi_dump_regs);
++
++      return 0;
++}
++
++static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
++{
++      hdmi_uninit_output(pdev);
++
++      pm_runtime_disable(&pdev->dev);
++
++      return 0;
++}
++
++static int hdmi_runtime_suspend(struct device *dev)
++{
++      clk_disable_unprepare(hdmi.sys_clk);
++
++      dispc_runtime_put();
++
++      return 0;
++}
++
++static int hdmi_runtime_resume(struct device *dev)
++{
++      int r;
++
++      r = dispc_runtime_get();
++      if (r < 0)
++              return r;
++
++      clk_prepare_enable(hdmi.sys_clk);
++
++      return 0;
++}
++
++static const struct dev_pm_ops hdmi_pm_ops = {
++      .runtime_suspend = hdmi_runtime_suspend,
++      .runtime_resume = hdmi_runtime_resume,
++};
++
++static const struct of_device_id hdmi_of_match[] = {
++      { .compatible = "ti,omap4-hdmi", },
++      {},
++};
++
++static struct platform_driver omapdss_hdmihw_driver = {
++      .probe          = omapdss_hdmihw_probe,
++      .remove         = __exit_p(omapdss_hdmihw_remove),
++      .driver         = {
++              .name   = "omapdss_hdmi",
++              .owner  = THIS_MODULE,
++              .pm     = &hdmi_pm_ops,
++              .of_match_table = hdmi_of_match,
++      },
++};
++
++int __init hdmi4_init_platform_driver(void)
++{
++      return platform_driver_register(&omapdss_hdmihw_driver);
++}
++
++void __exit hdmi4_uninit_platform_driver(void)
++{
++      platform_driver_unregister(&omapdss_hdmihw_driver);
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi4_core.c
+@@ -0,0 +1,1016 @@
++/*
++ * ti_hdmi_4xxx_ip.c
++ *
++ * HDMI TI81xx, TI38xx, TI OMAP4 etc IP driver Library
++ * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
++ * Authors: Yong Zhi
++ *    Mythri pk <mythripk@ti.com>
++ *
++ * 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/>.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/interrupt.h>
++#include <linux/mutex.h>
++#include <linux/delay.h>
++#include <linux/platform_device.h>
++#include <linux/string.h>
++#include <linux/seq_file.h>
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
++#include <sound/asound.h>
++#include <sound/asoundef.h>
++#endif
++
++#include "hdmi4_core.h"
++#include "dss_features.h"
++
++#define HDMI_CORE_AV          0x500
++
++static inline void __iomem *hdmi_av_base(struct hdmi_core_data *core)
++{
++      return core->base + HDMI_CORE_AV;
++}
++
++static int hdmi_core_ddc_init(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++
++      /* Turn on CLK for DDC */
++      REG_FLD_MOD(base, HDMI_CORE_AV_DPD, 0x7, 2, 0);
++
++      /* IN_PROG */
++      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 4, 4) == 1) {
++              /* Abort transaction */
++              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0xf, 3, 0);
++              /* IN_PROG */
++              if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
++                                      4, 4, 0) != 0) {
++                      DSSERR("Timeout aborting DDC transaction\n");
++                      return -ETIMEDOUT;
++              }
++      }
++
++      /* Clk SCL Devices */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0xA, 3, 0);
++
++      /* HDMI_CORE_DDC_STATUS_IN_PROG */
++      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
++                              4, 4, 0) != 0) {
++              DSSERR("Timeout starting SCL clock\n");
++              return -ETIMEDOUT;
++      }
++
++      /* Clear FIFO */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x9, 3, 0);
++
++      /* HDMI_CORE_DDC_STATUS_IN_PROG */
++      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
++                              4, 4, 0) != 0) {
++              DSSERR("Timeout clearing DDC fifo\n");
++              return -ETIMEDOUT;
++      }
++
++      return 0;
++}
++
++static int hdmi_core_ddc_edid(struct hdmi_core_data *core,
++              u8 *pedid, int ext)
++{
++      void __iomem *base = core->base;
++      u32 i;
++      char checksum;
++      u32 offset = 0;
++
++      /* HDMI_CORE_DDC_STATUS_IN_PROG */
++      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
++                              4, 4, 0) != 0) {
++              DSSERR("Timeout waiting DDC to be ready\n");
++              return -ETIMEDOUT;
++      }
++
++      if (ext % 2 != 0)
++              offset = 0x80;
++
++      /* Load Segment Address Register */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_SEGM, ext / 2, 7, 0);
++
++      /* Load Slave Address Register */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_ADDR, 0xA0 >> 1, 7, 1);
++
++      /* Load Offset Address Register */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_OFFSET, offset, 7, 0);
++
++      /* Load Byte Count */
++      REG_FLD_MOD(base, HDMI_CORE_DDC_COUNT1, 0x80, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_DDC_COUNT2, 0x0, 1, 0);
++
++      /* Set DDC_CMD */
++      if (ext)
++              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x4, 3, 0);
++      else
++              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x2, 3, 0);
++
++      /* HDMI_CORE_DDC_STATUS_BUS_LOW */
++      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 6, 6) == 1) {
++              pr_err("I2C Bus Low?\n");
++              return -EIO;
++      }
++      /* HDMI_CORE_DDC_STATUS_NO_ACK */
++      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 5, 5) == 1) {
++              pr_err("I2C No Ack\n");
++              return -EIO;
++      }
++
++      for (i = 0; i < 0x80; ++i) {
++              int t;
++
++              /* IN_PROG */
++              if (REG_GET(base, HDMI_CORE_DDC_STATUS, 4, 4) == 0) {
++                      DSSERR("operation stopped when reading edid\n");
++                      return -EIO;
++              }
++
++              t = 0;
++              /* FIFO_EMPTY */
++              while (REG_GET(base, HDMI_CORE_DDC_STATUS, 2, 2) == 1) {
++                      if (t++ > 10000) {
++                              DSSERR("timeout reading edid\n");
++                              return -ETIMEDOUT;
++                      }
++                      udelay(1);
++              }
++
++              pedid[i] = REG_GET(base, HDMI_CORE_DDC_DATA, 7, 0);
++      }
++
++      checksum = 0;
++      for (i = 0; i < 0x80; ++i)
++              checksum += pedid[i];
++
++      if (checksum != 0) {
++              pr_err("E-EDID checksum failed!!\n");
++              return -EIO;
++      }
++
++      return 0;
++}
++
++int hdmi4_read_edid(struct hdmi_core_data *core, u8 *edid, int len)
++{
++      int r, l;
++
++      if (len < 128)
++              return -EINVAL;
++
++      r = hdmi_core_ddc_init(core);
++      if (r)
++              return r;
++
++      r = hdmi_core_ddc_edid(core, edid, 0);
++      if (r)
++              return r;
++
++      l = 128;
++
++      if (len >= 128 * 2 && edid[0x7e] > 0) {
++              r = hdmi_core_ddc_edid(core, edid + 0x80, 1);
++              if (r)
++                      return r;
++              l += 128;
++      }
++
++      return l;
++}
++
++static void hdmi_core_init(struct hdmi_core_video_config *video_cfg,
++                      struct hdmi_core_infoframe_avi *avi_cfg,
++                      struct hdmi_core_packet_enable_repeat *repeat_cfg)
++{
++      pr_debug("Enter hdmi_core_init\n");
++
++      /* video core */
++      video_cfg->ip_bus_width = HDMI_INPUT_8BIT;
++      video_cfg->op_dither_truc = HDMI_OUTPUTTRUNCATION_8BIT;
++      video_cfg->deep_color_pkt = HDMI_DEEPCOLORPACKECTDISABLE;
++      video_cfg->pkt_mode = HDMI_PACKETMODERESERVEDVALUE;
++      video_cfg->hdmi_dvi = HDMI_DVI;
++      video_cfg->tclk_sel_clkmult = HDMI_FPLL10IDCK;
++
++      /* info frame */
++      avi_cfg->db1_format = 0;
++      avi_cfg->db1_active_info = 0;
++      avi_cfg->db1_bar_info_dv = 0;
++      avi_cfg->db1_scan_info = 0;
++      avi_cfg->db2_colorimetry = 0;
++      avi_cfg->db2_aspect_ratio = 0;
++      avi_cfg->db2_active_fmt_ar = 0;
++      avi_cfg->db3_itc = 0;
++      avi_cfg->db3_ec = 0;
++      avi_cfg->db3_q_range = 0;
++      avi_cfg->db3_nup_scaling = 0;
++      avi_cfg->db4_videocode = 0;
++      avi_cfg->db5_pixel_repeat = 0;
++      avi_cfg->db6_7_line_eoftop = 0;
++      avi_cfg->db8_9_line_sofbottom = 0;
++      avi_cfg->db10_11_pixel_eofleft = 0;
++      avi_cfg->db12_13_pixel_sofright = 0;
++
++      /* packet enable and repeat */
++      repeat_cfg->audio_pkt = 0;
++      repeat_cfg->audio_pkt_repeat = 0;
++      repeat_cfg->avi_infoframe = 0;
++      repeat_cfg->avi_infoframe_repeat = 0;
++      repeat_cfg->gen_cntrl_pkt = 0;
++      repeat_cfg->gen_cntrl_pkt_repeat = 0;
++      repeat_cfg->generic_pkt = 0;
++      repeat_cfg->generic_pkt_repeat = 0;
++}
++
++static void hdmi_core_powerdown_disable(struct hdmi_core_data *core)
++{
++      pr_debug("Enter hdmi_core_powerdown_disable\n");
++      REG_FLD_MOD(core->base, HDMI_CORE_SYS_SYS_CTRL1, 0x0, 0, 0);
++}
++
++static void hdmi_core_swreset_release(struct hdmi_core_data *core)
++{
++      pr_debug("Enter hdmi_core_swreset_release\n");
++      REG_FLD_MOD(core->base, HDMI_CORE_SYS_SRST, 0x0, 0, 0);
++}
++
++static void hdmi_core_swreset_assert(struct hdmi_core_data *core)
++{
++      pr_debug("Enter hdmi_core_swreset_assert\n");
++      REG_FLD_MOD(core->base, HDMI_CORE_SYS_SRST, 0x1, 0, 0);
++}
++
++/* HDMI_CORE_VIDEO_CONFIG */
++static void hdmi_core_video_config(struct hdmi_core_data *core,
++                              struct hdmi_core_video_config *cfg)
++{
++      u32 r = 0;
++      void __iomem *core_sys_base = core->base;
++      void __iomem *core_av_base = hdmi_av_base(core);
++
++      /* sys_ctrl1 default configuration not tunable */
++      r = hdmi_read_reg(core_sys_base, HDMI_CORE_SYS_SYS_CTRL1);
++      r = FLD_MOD(r, HDMI_CORE_SYS_SYS_CTRL1_VEN_FOLLOWVSYNC, 5, 5);
++      r = FLD_MOD(r, HDMI_CORE_SYS_SYS_CTRL1_HEN_FOLLOWHSYNC, 4, 4);
++      r = FLD_MOD(r, HDMI_CORE_SYS_SYS_CTRL1_BSEL_24BITBUS, 2, 2);
++      r = FLD_MOD(r, HDMI_CORE_SYS_SYS_CTRL1_EDGE_RISINGEDGE, 1, 1);
++      hdmi_write_reg(core_sys_base, HDMI_CORE_SYS_SYS_CTRL1, r);
++
++      REG_FLD_MOD(core_sys_base,
++                      HDMI_CORE_SYS_VID_ACEN, cfg->ip_bus_width, 7, 6);
++
++      /* Vid_Mode */
++      r = hdmi_read_reg(core_sys_base, HDMI_CORE_SYS_VID_MODE);
++
++      /* dither truncation configuration */
++      if (cfg->op_dither_truc > HDMI_OUTPUTTRUNCATION_12BIT) {
++              r = FLD_MOD(r, cfg->op_dither_truc - 3, 7, 6);
++              r = FLD_MOD(r, 1, 5, 5);
++      } else {
++              r = FLD_MOD(r, cfg->op_dither_truc, 7, 6);
++              r = FLD_MOD(r, 0, 5, 5);
++      }
++      hdmi_write_reg(core_sys_base, HDMI_CORE_SYS_VID_MODE, r);
++
++      /* HDMI_Ctrl */
++      r = hdmi_read_reg(core_av_base, HDMI_CORE_AV_HDMI_CTRL);
++      r = FLD_MOD(r, cfg->deep_color_pkt, 6, 6);
++      r = FLD_MOD(r, cfg->pkt_mode, 5, 3);
++      r = FLD_MOD(r, cfg->hdmi_dvi, 0, 0);
++      hdmi_write_reg(core_av_base, HDMI_CORE_AV_HDMI_CTRL, r);
++
++      /* TMDS_CTRL */
++      REG_FLD_MOD(core_sys_base,
++                      HDMI_CORE_SYS_TMDS_CTRL, cfg->tclk_sel_clkmult, 6, 5);
++}
++
++static void hdmi_core_aux_infoframe_avi_config(struct hdmi_core_data *core)
++{
++      u32 val;
++      char sum = 0, checksum = 0;
++      void __iomem *av_base = hdmi_av_base(core);
++      struct hdmi_core_infoframe_avi info_avi = core->avi_cfg;
++
++      sum += 0x82 + 0x002 + 0x00D;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_TYPE, 0x082);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_VERS, 0x002);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_LEN, 0x00D);
++
++      val = (info_avi.db1_format << 5) |
++              (info_avi.db1_active_info << 4) |
++              (info_avi.db1_bar_info_dv << 2) |
++              (info_avi.db1_scan_info);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(0), val);
++      sum += val;
++
++      val = (info_avi.db2_colorimetry << 6) |
++              (info_avi.db2_aspect_ratio << 4) |
++              (info_avi.db2_active_fmt_ar);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(1), val);
++      sum += val;
++
++      val = (info_avi.db3_itc << 7) |
++              (info_avi.db3_ec << 4) |
++              (info_avi.db3_q_range << 2) |
++              (info_avi.db3_nup_scaling);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(2), val);
++      sum += val;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(3),
++                                      info_avi.db4_videocode);
++      sum += info_avi.db4_videocode;
++
++      val = info_avi.db5_pixel_repeat;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(4), val);
++      sum += val;
++
++      val = info_avi.db6_7_line_eoftop & 0x00FF;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(5), val);
++      sum += val;
++
++      val = ((info_avi.db6_7_line_eoftop >> 8) & 0x00FF);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(6), val);
++      sum += val;
++
++      val = info_avi.db8_9_line_sofbottom & 0x00FF;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(7), val);
++      sum += val;
++
++      val = ((info_avi.db8_9_line_sofbottom >> 8) & 0x00FF);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(8), val);
++      sum += val;
++
++      val = info_avi.db10_11_pixel_eofleft & 0x00FF;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(9), val);
++      sum += val;
++
++      val = ((info_avi.db10_11_pixel_eofleft >> 8) & 0x00FF);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(10), val);
++      sum += val;
++
++      val = info_avi.db12_13_pixel_sofright & 0x00FF;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(11), val);
++      sum += val;
++
++      val = ((info_avi.db12_13_pixel_sofright >> 8) & 0x00FF);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(12), val);
++      sum += val;
++
++      checksum = 0x100 - sum;
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_CHSUM, checksum);
++}
++
++static void hdmi_core_av_packet_config(struct hdmi_core_data *core,
++              struct hdmi_core_packet_enable_repeat repeat_cfg)
++{
++      /* enable/repeat the infoframe */
++      hdmi_write_reg(hdmi_av_base(core), HDMI_CORE_AV_PB_CTRL1,
++              (repeat_cfg.audio_pkt << 5) |
++              (repeat_cfg.audio_pkt_repeat << 4) |
++              (repeat_cfg.avi_infoframe << 1) |
++              (repeat_cfg.avi_infoframe_repeat));
++
++      /* enable/repeat the packet */
++      hdmi_write_reg(hdmi_av_base(core), HDMI_CORE_AV_PB_CTRL2,
++              (repeat_cfg.gen_cntrl_pkt << 3) |
++              (repeat_cfg.gen_cntrl_pkt_repeat << 2) |
++              (repeat_cfg.generic_pkt << 1) |
++              (repeat_cfg.generic_pkt_repeat));
++}
++
++void hdmi4_configure(struct hdmi_core_data *core,
++      struct hdmi_wp_data *wp, struct hdmi_config *cfg)
++{
++      /* HDMI */
++      struct omap_video_timings video_timing;
++      struct hdmi_video_format video_format;
++      /* HDMI core */
++      struct hdmi_core_infoframe_avi *avi_cfg = &core->avi_cfg;
++      struct hdmi_core_video_config v_core_cfg;
++      struct hdmi_core_packet_enable_repeat repeat_cfg;
++
++      hdmi_core_init(&v_core_cfg, avi_cfg, &repeat_cfg);
++
++      hdmi_wp_init_vid_fmt_timings(&video_format, &video_timing, cfg);
++
++      hdmi_wp_video_config_timing(wp, &video_timing);
++
++      /* video config */
++      video_format.packing_mode = HDMI_PACK_24b_RGB_YUV444_YUV422;
++
++      hdmi_wp_video_config_format(wp, &video_format);
++
++      hdmi_wp_video_config_interface(wp, &video_timing);
++
++      /*
++       * configure core video part
++       * set software reset in the core
++       */
++      hdmi_core_swreset_assert(core);
++
++      /* power down off */
++      hdmi_core_powerdown_disable(core);
++
++      v_core_cfg.pkt_mode = HDMI_PACKETMODE24BITPERPIXEL;
++      v_core_cfg.hdmi_dvi = cfg->cm.mode;
++
++      hdmi_core_video_config(core, &v_core_cfg);
++
++      /* release software reset in the core */
++      hdmi_core_swreset_release(core);
++
++      /*
++       * configure packet
++       * info frame video see doc CEA861-D page 65
++       */
++      avi_cfg->db1_format = HDMI_INFOFRAME_AVI_DB1Y_RGB;
++      avi_cfg->db1_active_info =
++                      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_OFF;
++      avi_cfg->db1_bar_info_dv = HDMI_INFOFRAME_AVI_DB1B_NO;
++      avi_cfg->db1_scan_info = HDMI_INFOFRAME_AVI_DB1S_0;
++      avi_cfg->db2_colorimetry = HDMI_INFOFRAME_AVI_DB2C_NO;
++      avi_cfg->db2_aspect_ratio = HDMI_INFOFRAME_AVI_DB2M_NO;
++      avi_cfg->db2_active_fmt_ar = HDMI_INFOFRAME_AVI_DB2R_SAME;
++      avi_cfg->db3_itc = HDMI_INFOFRAME_AVI_DB3ITC_NO;
++      avi_cfg->db3_ec = HDMI_INFOFRAME_AVI_DB3EC_XVYUV601;
++      avi_cfg->db3_q_range = HDMI_INFOFRAME_AVI_DB3Q_DEFAULT;
++      avi_cfg->db3_nup_scaling = HDMI_INFOFRAME_AVI_DB3SC_NO;
++      avi_cfg->db4_videocode = cfg->cm.code;
++      avi_cfg->db5_pixel_repeat = HDMI_INFOFRAME_AVI_DB5PR_NO;
++      avi_cfg->db6_7_line_eoftop = 0;
++      avi_cfg->db8_9_line_sofbottom = 0;
++      avi_cfg->db10_11_pixel_eofleft = 0;
++      avi_cfg->db12_13_pixel_sofright = 0;
++
++      hdmi_core_aux_infoframe_avi_config(core);
++
++      /* enable/repeat the infoframe */
++      repeat_cfg.avi_infoframe = HDMI_PACKETENABLE;
++      repeat_cfg.avi_infoframe_repeat = HDMI_PACKETREPEATON;
++      /* wakeup */
++      repeat_cfg.audio_pkt = HDMI_PACKETENABLE;
++      repeat_cfg.audio_pkt_repeat = HDMI_PACKETREPEATON;
++      hdmi_core_av_packet_config(core, repeat_cfg);
++}
++
++void hdmi4_core_dump(struct hdmi_core_data *core, struct seq_file *s)
++{
++      int i;
++
++#define CORE_REG(i, name) name(i)
++#define DUMPCORE(r) seq_printf(s, "%-35s %08x\n", #r,\
++              hdmi_read_reg(core->base, r))
++#define DUMPCOREAV(r) seq_printf(s, "%-35s %08x\n", #r,\
++              hdmi_read_reg(hdmi_av_base(core), r))
++#define DUMPCOREAV2(i, r) seq_printf(s, "%s[%d]%*s %08x\n", #r, i, \
++              (i < 10) ? 32 - (int)strlen(#r) : 31 - (int)strlen(#r), " ", \
++              hdmi_read_reg(hdmi_av_base(core), CORE_REG(i, r)))
++
++      DUMPCORE(HDMI_CORE_SYS_VND_IDL);
++      DUMPCORE(HDMI_CORE_SYS_DEV_IDL);
++      DUMPCORE(HDMI_CORE_SYS_DEV_IDH);
++      DUMPCORE(HDMI_CORE_SYS_DEV_REV);
++      DUMPCORE(HDMI_CORE_SYS_SRST);
++      DUMPCORE(HDMI_CORE_SYS_SYS_CTRL1);
++      DUMPCORE(HDMI_CORE_SYS_SYS_STAT);
++      DUMPCORE(HDMI_CORE_SYS_SYS_CTRL3);
++      DUMPCORE(HDMI_CORE_SYS_DE_DLY);
++      DUMPCORE(HDMI_CORE_SYS_DE_CTRL);
++      DUMPCORE(HDMI_CORE_SYS_DE_TOP);
++      DUMPCORE(HDMI_CORE_SYS_DE_CNTL);
++      DUMPCORE(HDMI_CORE_SYS_DE_CNTH);
++      DUMPCORE(HDMI_CORE_SYS_DE_LINL);
++      DUMPCORE(HDMI_CORE_SYS_DE_LINH_1);
++      DUMPCORE(HDMI_CORE_SYS_HRES_L);
++      DUMPCORE(HDMI_CORE_SYS_HRES_H);
++      DUMPCORE(HDMI_CORE_SYS_VRES_L);
++      DUMPCORE(HDMI_CORE_SYS_VRES_H);
++      DUMPCORE(HDMI_CORE_SYS_IADJUST);
++      DUMPCORE(HDMI_CORE_SYS_POLDETECT);
++      DUMPCORE(HDMI_CORE_SYS_HWIDTH1);
++      DUMPCORE(HDMI_CORE_SYS_HWIDTH2);
++      DUMPCORE(HDMI_CORE_SYS_VWIDTH);
++      DUMPCORE(HDMI_CORE_SYS_VID_CTRL);
++      DUMPCORE(HDMI_CORE_SYS_VID_ACEN);
++      DUMPCORE(HDMI_CORE_SYS_VID_MODE);
++      DUMPCORE(HDMI_CORE_SYS_VID_BLANK1);
++      DUMPCORE(HDMI_CORE_SYS_VID_BLANK3);
++      DUMPCORE(HDMI_CORE_SYS_VID_BLANK1);
++      DUMPCORE(HDMI_CORE_SYS_DC_HEADER);
++      DUMPCORE(HDMI_CORE_SYS_VID_DITHER);
++      DUMPCORE(HDMI_CORE_SYS_RGB2XVYCC_CT);
++      DUMPCORE(HDMI_CORE_SYS_R2Y_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_R2Y_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_G2Y_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_G2Y_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_B2Y_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_B2Y_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_R2CB_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_R2CB_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_G2CB_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_G2CB_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_B2CB_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_B2CB_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_R2CR_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_R2CR_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_G2CR_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_G2CR_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_B2CR_COEFF_LOW);
++      DUMPCORE(HDMI_CORE_SYS_B2CR_COEFF_UP);
++      DUMPCORE(HDMI_CORE_SYS_RGB_OFFSET_LOW);
++      DUMPCORE(HDMI_CORE_SYS_RGB_OFFSET_UP);
++      DUMPCORE(HDMI_CORE_SYS_Y_OFFSET_LOW);
++      DUMPCORE(HDMI_CORE_SYS_Y_OFFSET_UP);
++      DUMPCORE(HDMI_CORE_SYS_CBCR_OFFSET_LOW);
++      DUMPCORE(HDMI_CORE_SYS_CBCR_OFFSET_UP);
++      DUMPCORE(HDMI_CORE_SYS_INTR_STATE);
++      DUMPCORE(HDMI_CORE_SYS_INTR1);
++      DUMPCORE(HDMI_CORE_SYS_INTR2);
++      DUMPCORE(HDMI_CORE_SYS_INTR3);
++      DUMPCORE(HDMI_CORE_SYS_INTR4);
++      DUMPCORE(HDMI_CORE_SYS_INTR_UNMASK1);
++      DUMPCORE(HDMI_CORE_SYS_INTR_UNMASK2);
++      DUMPCORE(HDMI_CORE_SYS_INTR_UNMASK3);
++      DUMPCORE(HDMI_CORE_SYS_INTR_UNMASK4);
++      DUMPCORE(HDMI_CORE_SYS_INTR_CTRL);
++      DUMPCORE(HDMI_CORE_SYS_TMDS_CTRL);
++
++      DUMPCORE(HDMI_CORE_DDC_ADDR);
++      DUMPCORE(HDMI_CORE_DDC_SEGM);
++      DUMPCORE(HDMI_CORE_DDC_OFFSET);
++      DUMPCORE(HDMI_CORE_DDC_COUNT1);
++      DUMPCORE(HDMI_CORE_DDC_COUNT2);
++      DUMPCORE(HDMI_CORE_DDC_STATUS);
++      DUMPCORE(HDMI_CORE_DDC_CMD);
++      DUMPCORE(HDMI_CORE_DDC_DATA);
++
++      DUMPCOREAV(HDMI_CORE_AV_ACR_CTRL);
++      DUMPCOREAV(HDMI_CORE_AV_FREQ_SVAL);
++      DUMPCOREAV(HDMI_CORE_AV_N_SVAL1);
++      DUMPCOREAV(HDMI_CORE_AV_N_SVAL2);
++      DUMPCOREAV(HDMI_CORE_AV_N_SVAL3);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL1);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL2);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL3);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL1);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL2);
++      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL3);
++      DUMPCOREAV(HDMI_CORE_AV_AUD_MODE);
++      DUMPCOREAV(HDMI_CORE_AV_SPDIF_CTRL);
++      DUMPCOREAV(HDMI_CORE_AV_HW_SPDIF_FS);
++      DUMPCOREAV(HDMI_CORE_AV_SWAP_I2S);
++      DUMPCOREAV(HDMI_CORE_AV_SPDIF_ERTH);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_MAP);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_CTRL);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST0);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST1);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST2);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST4);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST5);
++      DUMPCOREAV(HDMI_CORE_AV_ASRC);
++      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_LEN);
++      DUMPCOREAV(HDMI_CORE_AV_HDMI_CTRL);
++      DUMPCOREAV(HDMI_CORE_AV_AUDO_TXSTAT);
++      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_1);
++      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_2);
++      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_3);
++      DUMPCOREAV(HDMI_CORE_AV_TEST_TXCTRL);
++      DUMPCOREAV(HDMI_CORE_AV_DPD);
++      DUMPCOREAV(HDMI_CORE_AV_PB_CTRL1);
++      DUMPCOREAV(HDMI_CORE_AV_PB_CTRL2);
++      DUMPCOREAV(HDMI_CORE_AV_AVI_TYPE);
++      DUMPCOREAV(HDMI_CORE_AV_AVI_VERS);
++      DUMPCOREAV(HDMI_CORE_AV_AVI_LEN);
++      DUMPCOREAV(HDMI_CORE_AV_AVI_CHSUM);
++
++      for (i = 0; i < HDMI_CORE_AV_AVI_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_AVI_DBYTE);
++
++      DUMPCOREAV(HDMI_CORE_AV_SPD_TYPE);
++      DUMPCOREAV(HDMI_CORE_AV_SPD_VERS);
++      DUMPCOREAV(HDMI_CORE_AV_SPD_LEN);
++      DUMPCOREAV(HDMI_CORE_AV_SPD_CHSUM);
++
++      for (i = 0; i < HDMI_CORE_AV_SPD_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_SPD_DBYTE);
++
++      DUMPCOREAV(HDMI_CORE_AV_AUDIO_TYPE);
++      DUMPCOREAV(HDMI_CORE_AV_AUDIO_VERS);
++      DUMPCOREAV(HDMI_CORE_AV_AUDIO_LEN);
++      DUMPCOREAV(HDMI_CORE_AV_AUDIO_CHSUM);
++
++      for (i = 0; i < HDMI_CORE_AV_AUD_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_AUD_DBYTE);
++
++      DUMPCOREAV(HDMI_CORE_AV_MPEG_TYPE);
++      DUMPCOREAV(HDMI_CORE_AV_MPEG_VERS);
++      DUMPCOREAV(HDMI_CORE_AV_MPEG_LEN);
++      DUMPCOREAV(HDMI_CORE_AV_MPEG_CHSUM);
++
++      for (i = 0; i < HDMI_CORE_AV_MPEG_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_MPEG_DBYTE);
++
++      for (i = 0; i < HDMI_CORE_AV_GEN_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_GEN_DBYTE);
++
++      DUMPCOREAV(HDMI_CORE_AV_CP_BYTE1);
++
++      for (i = 0; i < HDMI_CORE_AV_GEN2_DBYTE_NELEMS; i++)
++              DUMPCOREAV2(i, HDMI_CORE_AV_GEN2_DBYTE);
++
++      DUMPCOREAV(HDMI_CORE_AV_CEC_ADDR_ID);
++}
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
++static void hdmi_core_audio_config(struct hdmi_core_data *core,
++                                      struct hdmi_core_audio_config *cfg)
++{
++      u32 r;
++      void __iomem *av_base = hdmi_av_base(core);
++
++      /*
++       * Parameters for generation of Audio Clock Recovery packets
++       */
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL1, cfg->n, 7, 0);
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL2, cfg->n >> 8, 7, 0);
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL3, cfg->n >> 16, 7, 0);
++
++      if (cfg->cts_mode == HDMI_AUDIO_CTS_MODE_SW) {
++              REG_FLD_MOD(av_base, HDMI_CORE_AV_CTS_SVAL1, cfg->cts, 7, 0);
++              REG_FLD_MOD(av_base,
++                              HDMI_CORE_AV_CTS_SVAL2, cfg->cts >> 8, 7, 0);
++              REG_FLD_MOD(av_base,
++                              HDMI_CORE_AV_CTS_SVAL3, cfg->cts >> 16, 7, 0);
++      } else {
++              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_1,
++                              cfg->aud_par_busclk, 7, 0);
++              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_2,
++                              (cfg->aud_par_busclk >> 8), 7, 0);
++              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_3,
++                              (cfg->aud_par_busclk >> 16), 7, 0);
++      }
++
++      /* Set ACR clock divisor */
++      REG_FLD_MOD(av_base,
++                      HDMI_CORE_AV_FREQ_SVAL, cfg->mclk_mode, 2, 0);
++
++      r = hdmi_read_reg(av_base, HDMI_CORE_AV_ACR_CTRL);
++      /*
++       * Use TMDS clock for ACR packets. For devices that use
++       * the MCLK, this is the first part of the MCLK initialization.
++       */
++      r = FLD_MOD(r, 0, 2, 2);
++
++      r = FLD_MOD(r, cfg->en_acr_pkt, 1, 1);
++      r = FLD_MOD(r, cfg->cts_mode, 0, 0);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_ACR_CTRL, r);
++
++      /* For devices using MCLK, this completes its initialization. */
++      if (cfg->use_mclk)
++              REG_FLD_MOD(av_base, HDMI_CORE_AV_ACR_CTRL, 1, 2, 2);
++
++      /* Override of SPDIF sample frequency with value in I2S_CHST4 */
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_SPDIF_CTRL,
++                                              cfg->fs_override, 1, 1);
++
++      /*
++       * Set IEC-60958-3 channel status word. It is passed to the IP
++       * just as it is received. The user of the driver is responsible
++       * for its contents.
++       */
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST0,
++                     cfg->iec60958_cfg->status[0]);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST1,
++                     cfg->iec60958_cfg->status[1]);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST2,
++                     cfg->iec60958_cfg->status[2]);
++      /* yes, this is correct: status[3] goes to CHST4 register */
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST4,
++                     cfg->iec60958_cfg->status[3]);
++      /* yes, this is correct: status[4] goes to CHST5 register */
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST5,
++                     cfg->iec60958_cfg->status[4]);
++
++      /* set I2S parameters */
++      r = hdmi_read_reg(av_base, HDMI_CORE_AV_I2S_IN_CTRL);
++      r = FLD_MOD(r, cfg->i2s_cfg.sck_edge_mode, 6, 6);
++      r = FLD_MOD(r, cfg->i2s_cfg.vbit, 4, 4);
++      r = FLD_MOD(r, cfg->i2s_cfg.justification, 2, 2);
++      r = FLD_MOD(r, cfg->i2s_cfg.direction, 1, 1);
++      r = FLD_MOD(r, cfg->i2s_cfg.shift, 0, 0);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_IN_CTRL, r);
++
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_I2S_IN_LEN,
++                      cfg->i2s_cfg.in_length_bits, 3, 0);
++
++      /* Audio channels and mode parameters */
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_HDMI_CTRL, cfg->layout, 2, 1);
++      r = hdmi_read_reg(av_base, HDMI_CORE_AV_AUD_MODE);
++      r = FLD_MOD(r, cfg->i2s_cfg.active_sds, 7, 4);
++      r = FLD_MOD(r, cfg->en_dsd_audio, 3, 3);
++      r = FLD_MOD(r, cfg->en_parallel_aud_input, 2, 2);
++      r = FLD_MOD(r, cfg->en_spdif, 1, 1);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_MODE, r);
++
++      /* Audio channel mappings */
++      /* TODO: Make channel mapping dynamic. For now, map channels
++       * in the ALSA order: FL/FR/RL/RR/C/LFE/SL/SR. Remapping is needed as
++       * HDMI speaker order is different. See CEA-861 Section 6.6.2.
++       */
++      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_IN_MAP, 0x78);
++      REG_FLD_MOD(av_base, HDMI_CORE_AV_SWAP_I2S, 1, 5, 5);
++}
++
++static void hdmi_core_audio_infoframe_cfg(struct hdmi_core_data *core,
++              struct snd_cea_861_aud_if *info_aud)
++{
++      u8 sum = 0, checksum = 0;
++      void __iomem *av_base = hdmi_av_base(core);
++
++      /*
++       * Set audio info frame type, version and length as
++       * described in HDMI 1.4a Section 8.2.2 specification.
++       * Checksum calculation is defined in Section 5.3.5.
++       */
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_TYPE, 0x84);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_VERS, 0x01);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_LEN, 0x0a);
++      sum += 0x84 + 0x001 + 0x00a;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(0),
++                     info_aud->db1_ct_cc);
++      sum += info_aud->db1_ct_cc;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(1),
++                     info_aud->db2_sf_ss);
++      sum += info_aud->db2_sf_ss;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(2), info_aud->db3);
++      sum += info_aud->db3;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(3), info_aud->db4_ca);
++      sum += info_aud->db4_ca;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(4),
++                     info_aud->db5_dminh_lsv);
++      sum += info_aud->db5_dminh_lsv;
++
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(5), 0x00);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(6), 0x00);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(7), 0x00);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(8), 0x00);
++      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(9), 0x00);
++
++      checksum = 0x100 - sum;
++      hdmi_write_reg(av_base,
++                                      HDMI_CORE_AV_AUDIO_CHSUM, checksum);
++
++      /*
++       * TODO: Add MPEG and SPD enable and repeat cfg when EDID parsing
++       * is available.
++       */
++}
++
++int hdmi4_audio_config(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++              struct omap_dss_audio *audio, u32 pclk)
++{
++      struct hdmi_audio_format audio_format;
++      struct hdmi_audio_dma audio_dma;
++      struct hdmi_core_audio_config acore;
++      int err, n, cts, channel_count;
++      unsigned int fs_nr;
++      bool word_length_16b = false;
++
++      if (!audio || !audio->iec || !audio->cea || !core)
++              return -EINVAL;
++
++      acore.iec60958_cfg = audio->iec;
++      /*
++       * In the IEC-60958 status word, check if the audio sample word length
++       * is 16-bit as several optimizations can be performed in such case.
++       */
++      if (!(audio->iec->status[4] & IEC958_AES4_CON_MAX_WORDLEN_24))
++              if (audio->iec->status[4] & IEC958_AES4_CON_WORDLEN_20_16)
++                      word_length_16b = true;
++
++      /* I2S configuration. See Phillips' specification */
++      if (word_length_16b)
++              acore.i2s_cfg.justification = HDMI_AUDIO_JUSTIFY_LEFT;
++      else
++              acore.i2s_cfg.justification = HDMI_AUDIO_JUSTIFY_RIGHT;
++      /*
++       * The I2S input word length is twice the lenght given in the IEC-60958
++       * status word. If the word size is greater than
++       * 20 bits, increment by one.
++       */
++      acore.i2s_cfg.in_length_bits = audio->iec->status[4]
++              & IEC958_AES4_CON_WORDLEN;
++      if (audio->iec->status[4] & IEC958_AES4_CON_MAX_WORDLEN_24)
++              acore.i2s_cfg.in_length_bits++;
++      acore.i2s_cfg.sck_edge_mode = HDMI_AUDIO_I2S_SCK_EDGE_RISING;
++      acore.i2s_cfg.vbit = HDMI_AUDIO_I2S_VBIT_FOR_PCM;
++      acore.i2s_cfg.direction = HDMI_AUDIO_I2S_MSB_SHIFTED_FIRST;
++      acore.i2s_cfg.shift = HDMI_AUDIO_I2S_FIRST_BIT_SHIFT;
++
++      /* convert sample frequency to a number */
++      switch (audio->iec->status[3] & IEC958_AES3_CON_FS) {
++      case IEC958_AES3_CON_FS_32000:
++              fs_nr = 32000;
++              break;
++      case IEC958_AES3_CON_FS_44100:
++              fs_nr = 44100;
++              break;
++      case IEC958_AES3_CON_FS_48000:
++              fs_nr = 48000;
++              break;
++      case IEC958_AES3_CON_FS_88200:
++              fs_nr = 88200;
++              break;
++      case IEC958_AES3_CON_FS_96000:
++              fs_nr = 96000;
++              break;
++      case IEC958_AES3_CON_FS_176400:
++              fs_nr = 176400;
++              break;
++      case IEC958_AES3_CON_FS_192000:
++              fs_nr = 192000;
++              break;
++      default:
++              return -EINVAL;
++      }
++
++      err = hdmi_compute_acr(pclk, fs_nr, &n, &cts);
++
++      /* Audio clock regeneration settings */
++      acore.n = n;
++      acore.cts = cts;
++      if (dss_has_feature(FEAT_HDMI_CTS_SWMODE)) {
++              acore.aud_par_busclk = 0;
++              acore.cts_mode = HDMI_AUDIO_CTS_MODE_SW;
++              acore.use_mclk = dss_has_feature(FEAT_HDMI_AUDIO_USE_MCLK);
++      } else {
++              acore.aud_par_busclk = (((128 * 31) - 1) << 8);
++              acore.cts_mode = HDMI_AUDIO_CTS_MODE_HW;
++              acore.use_mclk = true;
++      }
++
++      if (acore.use_mclk)
++              acore.mclk_mode = HDMI_AUDIO_MCLK_128FS;
++
++      /* Audio channels settings */
++      channel_count = (audio->cea->db1_ct_cc &
++                       CEA861_AUDIO_INFOFRAME_DB1CC) + 1;
++
++      switch (channel_count) {
++      case 2:
++              audio_format.active_chnnls_msk = 0x03;
++              break;
++      case 3:
++              audio_format.active_chnnls_msk = 0x07;
++              break;
++      case 4:
++              audio_format.active_chnnls_msk = 0x0f;
++              break;
++      case 5:
++              audio_format.active_chnnls_msk = 0x1f;
++              break;
++      case 6:
++              audio_format.active_chnnls_msk = 0x3f;
++              break;
++      case 7:
++              audio_format.active_chnnls_msk = 0x7f;
++              break;
++      case 8:
++              audio_format.active_chnnls_msk = 0xff;
++              break;
++      default:
++              return -EINVAL;
++      }
++
++      /*
++       * the HDMI IP needs to enable four stereo channels when transmitting
++       * more than 2 audio channels
++       */
++      if (channel_count == 2) {
++              audio_format.stereo_channels = HDMI_AUDIO_STEREO_ONECHANNEL;
++              acore.i2s_cfg.active_sds = HDMI_AUDIO_I2S_SD0_EN;
++              acore.layout = HDMI_AUDIO_LAYOUT_2CH;
++      } else {
++              audio_format.stereo_channels = HDMI_AUDIO_STEREO_FOURCHANNELS;
++              acore.i2s_cfg.active_sds = HDMI_AUDIO_I2S_SD0_EN |
++                              HDMI_AUDIO_I2S_SD1_EN | HDMI_AUDIO_I2S_SD2_EN |
++                              HDMI_AUDIO_I2S_SD3_EN;
++              acore.layout = HDMI_AUDIO_LAYOUT_8CH;
++      }
++
++      acore.en_spdif = false;
++      /* use sample frequency from channel status word */
++      acore.fs_override = true;
++      /* enable ACR packets */
++      acore.en_acr_pkt = true;
++      /* disable direct streaming digital audio */
++      acore.en_dsd_audio = false;
++      /* use parallel audio interface */
++      acore.en_parallel_aud_input = true;
++
++      /* DMA settings */
++      if (word_length_16b)
++              audio_dma.transfer_size = 0x10;
++      else
++              audio_dma.transfer_size = 0x20;
++      audio_dma.block_size = 0xC0;
++      audio_dma.mode = HDMI_AUDIO_TRANSF_DMA;
++      audio_dma.fifo_threshold = 0x20; /* in number of samples */
++
++      /* audio FIFO format settings */
++      if (word_length_16b) {
++              audio_format.samples_per_word = HDMI_AUDIO_ONEWORD_TWOSAMPLES;
++              audio_format.sample_size = HDMI_AUDIO_SAMPLE_16BITS;
++              audio_format.justification = HDMI_AUDIO_JUSTIFY_LEFT;
++      } else {
++              audio_format.samples_per_word = HDMI_AUDIO_ONEWORD_ONESAMPLE;
++              audio_format.sample_size = HDMI_AUDIO_SAMPLE_24BITS;
++              audio_format.justification = HDMI_AUDIO_JUSTIFY_RIGHT;
++      }
++      audio_format.type = HDMI_AUDIO_TYPE_LPCM;
++      audio_format.sample_order = HDMI_AUDIO_SAMPLE_LEFT_FIRST;
++      /* disable start/stop signals of IEC 60958 blocks */
++      audio_format.en_sig_blk_strt_end = HDMI_AUDIO_BLOCK_SIG_STARTEND_ON;
++
++      /* configure DMA and audio FIFO format*/
++      hdmi_wp_audio_config_dma(wp, &audio_dma);
++      hdmi_wp_audio_config_format(wp, &audio_format);
++
++      /* configure the core*/
++      hdmi_core_audio_config(core, &acore);
++
++      /* configure CEA 861 audio infoframe*/
++      hdmi_core_audio_infoframe_cfg(core, audio->cea);
++
++      return 0;
++}
++
++int hdmi4_audio_start(struct hdmi_core_data *core, struct hdmi_wp_data *wp)
++{
++      REG_FLD_MOD(hdmi_av_base(core),
++                  HDMI_CORE_AV_AUD_MODE, true, 0, 0);
++
++      hdmi_wp_audio_core_req_enable(wp, true);
++
++      return 0;
++}
++
++void hdmi4_audio_stop(struct hdmi_core_data *core, struct hdmi_wp_data *wp)
++{
++      REG_FLD_MOD(hdmi_av_base(core),
++                  HDMI_CORE_AV_AUD_MODE, false, 0, 0);
++
++      hdmi_wp_audio_core_req_enable(wp, false);
++}
++
++int hdmi4_audio_get_dma_port(u32 *offset, u32 *size)
++{
++      if (!offset || !size)
++              return -EINVAL;
++      *offset = HDMI_WP_AUDIO_DATA;
++      *size = 4;
++      return 0;
++}
++
++#endif
++
++int hdmi4_core_init(struct platform_device *pdev, struct hdmi_core_data *core)
++{
++      struct resource *res;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hdmi_core");
++      if (!res) {
++              DSSERR("can't get CORE IORESOURCE_MEM HDMI\n");
++              return -EINVAL;
++      }
++
++      core->base = devm_request_and_ioremap(&pdev->dev, res);
++      if (!core->base) {
++              DSSERR("can't ioremap HDMI core\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi4_core.h
+@@ -0,0 +1,276 @@
++/*
++ * HDMI header definition for OMAP4 HDMI core IP
++ *
++ * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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/>.
++ */
++
++#ifndef _HDMI4_CORE_H_
++#define _HDMI4_CORE_H_
++
++#include "hdmi.h"
++
++/* OMAP4 HDMI IP Core System */
++
++#define HDMI_CORE_SYS_VND_IDL                 0x0
++#define HDMI_CORE_SYS_DEV_IDL                 0x8
++#define HDMI_CORE_SYS_DEV_IDH                 0xC
++#define HDMI_CORE_SYS_DEV_REV                 0x10
++#define HDMI_CORE_SYS_SRST                    0x14
++#define HDMI_CORE_SYS_SYS_CTRL1                       0x20
++#define HDMI_CORE_SYS_SYS_STAT                        0x24
++#define HDMI_CORE_SYS_SYS_CTRL3                       0x28
++#define HDMI_CORE_SYS_DCTL                    0x34
++#define HDMI_CORE_SYS_DE_DLY                  0xC8
++#define HDMI_CORE_SYS_DE_CTRL                 0xCC
++#define HDMI_CORE_SYS_DE_TOP                  0xD0
++#define HDMI_CORE_SYS_DE_CNTL                 0xD8
++#define HDMI_CORE_SYS_DE_CNTH                 0xDC
++#define HDMI_CORE_SYS_DE_LINL                 0xE0
++#define HDMI_CORE_SYS_DE_LINH_1                       0xE4
++#define HDMI_CORE_SYS_HRES_L                  0xE8
++#define HDMI_CORE_SYS_HRES_H                  0xEC
++#define HDMI_CORE_SYS_VRES_L                  0xF0
++#define HDMI_CORE_SYS_VRES_H                  0xF4
++#define HDMI_CORE_SYS_IADJUST                 0xF8
++#define HDMI_CORE_SYS_POLDETECT                       0xFC
++#define HDMI_CORE_SYS_HWIDTH1                 0x110
++#define HDMI_CORE_SYS_HWIDTH2                 0x114
++#define HDMI_CORE_SYS_VWIDTH                  0x11C
++#define HDMI_CORE_SYS_VID_CTRL                        0x120
++#define HDMI_CORE_SYS_VID_ACEN                        0x124
++#define HDMI_CORE_SYS_VID_MODE                        0x128
++#define HDMI_CORE_SYS_VID_BLANK1              0x12C
++#define HDMI_CORE_SYS_VID_BLANK2              0x130
++#define HDMI_CORE_SYS_VID_BLANK3              0x134
++#define HDMI_CORE_SYS_DC_HEADER                       0x138
++#define HDMI_CORE_SYS_VID_DITHER              0x13C
++#define HDMI_CORE_SYS_RGB2XVYCC_CT            0x140
++#define HDMI_CORE_SYS_R2Y_COEFF_LOW           0x144
++#define HDMI_CORE_SYS_R2Y_COEFF_UP            0x148
++#define HDMI_CORE_SYS_G2Y_COEFF_LOW           0x14C
++#define HDMI_CORE_SYS_G2Y_COEFF_UP            0x150
++#define HDMI_CORE_SYS_B2Y_COEFF_LOW           0x154
++#define HDMI_CORE_SYS_B2Y_COEFF_UP            0x158
++#define HDMI_CORE_SYS_R2CB_COEFF_LOW          0x15C
++#define HDMI_CORE_SYS_R2CB_COEFF_UP           0x160
++#define HDMI_CORE_SYS_G2CB_COEFF_LOW          0x164
++#define HDMI_CORE_SYS_G2CB_COEFF_UP           0x168
++#define HDMI_CORE_SYS_B2CB_COEFF_LOW          0x16C
++#define HDMI_CORE_SYS_B2CB_COEFF_UP           0x170
++#define HDMI_CORE_SYS_R2CR_COEFF_LOW          0x174
++#define HDMI_CORE_SYS_R2CR_COEFF_UP           0x178
++#define HDMI_CORE_SYS_G2CR_COEFF_LOW          0x17C
++#define HDMI_CORE_SYS_G2CR_COEFF_UP           0x180
++#define HDMI_CORE_SYS_B2CR_COEFF_LOW          0x184
++#define HDMI_CORE_SYS_B2CR_COEFF_UP           0x188
++#define HDMI_CORE_SYS_RGB_OFFSET_LOW          0x18C
++#define HDMI_CORE_SYS_RGB_OFFSET_UP           0x190
++#define HDMI_CORE_SYS_Y_OFFSET_LOW            0x194
++#define HDMI_CORE_SYS_Y_OFFSET_UP             0x198
++#define HDMI_CORE_SYS_CBCR_OFFSET_LOW         0x19C
++#define HDMI_CORE_SYS_CBCR_OFFSET_UP          0x1A0
++#define HDMI_CORE_SYS_INTR_STATE              0x1C0
++#define HDMI_CORE_SYS_INTR1                   0x1C4
++#define HDMI_CORE_SYS_INTR2                   0x1C8
++#define HDMI_CORE_SYS_INTR3                   0x1CC
++#define HDMI_CORE_SYS_INTR4                   0x1D0
++#define HDMI_CORE_SYS_INTR_UNMASK1            0x1D4
++#define HDMI_CORE_SYS_INTR_UNMASK2            0x1D8
++#define HDMI_CORE_SYS_INTR_UNMASK3            0x1DC
++#define HDMI_CORE_SYS_INTR_UNMASK4            0x1E0
++#define HDMI_CORE_SYS_INTR_CTRL                       0x1E4
++#define HDMI_CORE_SYS_TMDS_CTRL                       0x208
++
++/* value definitions for HDMI_CORE_SYS_SYS_CTRL1 fields */
++#define HDMI_CORE_SYS_SYS_CTRL1_VEN_FOLLOWVSYNC       0x1
++#define HDMI_CORE_SYS_SYS_CTRL1_HEN_FOLLOWHSYNC       0x1
++#define HDMI_CORE_SYS_SYS_CTRL1_BSEL_24BITBUS 0x1
++#define HDMI_CORE_SYS_SYS_CTRL1_EDGE_RISINGEDGE       0x1
++
++/* HDMI DDC E-DID */
++#define HDMI_CORE_DDC_ADDR                    0x3B4
++#define HDMI_CORE_DDC_SEGM                    0x3B8
++#define HDMI_CORE_DDC_OFFSET                  0x3BC
++#define HDMI_CORE_DDC_COUNT1                  0x3C0
++#define HDMI_CORE_DDC_COUNT2                  0x3C4
++#define HDMI_CORE_DDC_STATUS                  0x3C8
++#define HDMI_CORE_DDC_CMD                     0x3CC
++#define HDMI_CORE_DDC_DATA                    0x3D0
++
++/* HDMI IP Core Audio Video */
++
++#define HDMI_CORE_AV_ACR_CTRL                 0x4
++#define HDMI_CORE_AV_FREQ_SVAL                        0x8
++#define HDMI_CORE_AV_N_SVAL1                  0xC
++#define HDMI_CORE_AV_N_SVAL2                  0x10
++#define HDMI_CORE_AV_N_SVAL3                  0x14
++#define HDMI_CORE_AV_CTS_SVAL1                        0x18
++#define HDMI_CORE_AV_CTS_SVAL2                        0x1C
++#define HDMI_CORE_AV_CTS_SVAL3                        0x20
++#define HDMI_CORE_AV_CTS_HVAL1                        0x24
++#define HDMI_CORE_AV_CTS_HVAL2                        0x28
++#define HDMI_CORE_AV_CTS_HVAL3                        0x2C
++#define HDMI_CORE_AV_AUD_MODE                 0x50
++#define HDMI_CORE_AV_SPDIF_CTRL                       0x54
++#define HDMI_CORE_AV_HW_SPDIF_FS              0x60
++#define HDMI_CORE_AV_SWAP_I2S                 0x64
++#define HDMI_CORE_AV_SPDIF_ERTH                       0x6C
++#define HDMI_CORE_AV_I2S_IN_MAP                       0x70
++#define HDMI_CORE_AV_I2S_IN_CTRL              0x74
++#define HDMI_CORE_AV_I2S_CHST0                        0x78
++#define HDMI_CORE_AV_I2S_CHST1                        0x7C
++#define HDMI_CORE_AV_I2S_CHST2                        0x80
++#define HDMI_CORE_AV_I2S_CHST4                        0x84
++#define HDMI_CORE_AV_I2S_CHST5                        0x88
++#define HDMI_CORE_AV_ASRC                     0x8C
++#define HDMI_CORE_AV_I2S_IN_LEN                       0x90
++#define HDMI_CORE_AV_HDMI_CTRL                        0xBC
++#define HDMI_CORE_AV_AUDO_TXSTAT              0xC0
++#define HDMI_CORE_AV_AUD_PAR_BUSCLK_1         0xCC
++#define HDMI_CORE_AV_AUD_PAR_BUSCLK_2         0xD0
++#define HDMI_CORE_AV_AUD_PAR_BUSCLK_3         0xD4
++#define HDMI_CORE_AV_TEST_TXCTRL              0xF0
++#define HDMI_CORE_AV_DPD                      0xF4
++#define HDMI_CORE_AV_PB_CTRL1                 0xF8
++#define HDMI_CORE_AV_PB_CTRL2                 0xFC
++#define HDMI_CORE_AV_AVI_TYPE                 0x100
++#define HDMI_CORE_AV_AVI_VERS                 0x104
++#define HDMI_CORE_AV_AVI_LEN                  0x108
++#define HDMI_CORE_AV_AVI_CHSUM                        0x10C
++#define HDMI_CORE_AV_AVI_DBYTE(n)             (n * 4 + 0x110)
++#define HDMI_CORE_AV_SPD_TYPE                 0x180
++#define HDMI_CORE_AV_SPD_VERS                 0x184
++#define HDMI_CORE_AV_SPD_LEN                  0x188
++#define HDMI_CORE_AV_SPD_CHSUM                        0x18C
++#define HDMI_CORE_AV_SPD_DBYTE(n)             (n * 4 + 0x190)
++#define HDMI_CORE_AV_AUDIO_TYPE                       0x200
++#define HDMI_CORE_AV_AUDIO_VERS                       0x204
++#define HDMI_CORE_AV_AUDIO_LEN                        0x208
++#define HDMI_CORE_AV_AUDIO_CHSUM              0x20C
++#define HDMI_CORE_AV_AUD_DBYTE(n)             (n * 4 + 0x210)
++#define HDMI_CORE_AV_MPEG_TYPE                        0x280
++#define HDMI_CORE_AV_MPEG_VERS                        0x284
++#define HDMI_CORE_AV_MPEG_LEN                 0x288
++#define HDMI_CORE_AV_MPEG_CHSUM                       0x28C
++#define HDMI_CORE_AV_MPEG_DBYTE(n)            (n * 4 + 0x290)
++#define HDMI_CORE_AV_GEN_DBYTE(n)             (n * 4 + 0x300)
++#define HDMI_CORE_AV_CP_BYTE1                 0x37C
++#define HDMI_CORE_AV_GEN2_DBYTE(n)            (n * 4 + 0x380)
++#define HDMI_CORE_AV_CEC_ADDR_ID              0x3FC
++
++#define HDMI_CORE_AV_SPD_DBYTE_ELSIZE         0x4
++#define HDMI_CORE_AV_GEN2_DBYTE_ELSIZE                0x4
++#define HDMI_CORE_AV_MPEG_DBYTE_ELSIZE                0x4
++#define HDMI_CORE_AV_GEN_DBYTE_ELSIZE         0x4
++
++#define HDMI_CORE_AV_AVI_DBYTE_NELEMS         15
++#define HDMI_CORE_AV_SPD_DBYTE_NELEMS         27
++#define HDMI_CORE_AV_AUD_DBYTE_NELEMS         10
++#define HDMI_CORE_AV_MPEG_DBYTE_NELEMS                27
++#define HDMI_CORE_AV_GEN_DBYTE_NELEMS         31
++#define HDMI_CORE_AV_GEN2_DBYTE_NELEMS                31
++
++enum hdmi_core_inputbus_width {
++      HDMI_INPUT_8BIT = 0,
++      HDMI_INPUT_10BIT = 1,
++      HDMI_INPUT_12BIT = 2
++};
++
++enum hdmi_core_dither_trunc {
++      HDMI_OUTPUTTRUNCATION_8BIT = 0,
++      HDMI_OUTPUTTRUNCATION_10BIT = 1,
++      HDMI_OUTPUTTRUNCATION_12BIT = 2,
++      HDMI_OUTPUTDITHER_8BIT = 3,
++      HDMI_OUTPUTDITHER_10BIT = 4,
++      HDMI_OUTPUTDITHER_12BIT = 5
++};
++
++enum hdmi_core_deepcolor_ed {
++      HDMI_DEEPCOLORPACKECTDISABLE = 0,
++      HDMI_DEEPCOLORPACKECTENABLE = 1
++};
++
++enum hdmi_core_packet_mode {
++      HDMI_PACKETMODERESERVEDVALUE = 0,
++      HDMI_PACKETMODE24BITPERPIXEL = 4,
++      HDMI_PACKETMODE30BITPERPIXEL = 5,
++      HDMI_PACKETMODE36BITPERPIXEL = 6,
++      HDMI_PACKETMODE48BITPERPIXEL = 7
++};
++
++enum hdmi_core_tclkselclkmult {
++      HDMI_FPLL05IDCK = 0,
++      HDMI_FPLL10IDCK = 1,
++      HDMI_FPLL20IDCK = 2,
++      HDMI_FPLL40IDCK = 3
++};
++
++enum hdmi_core_packet_ctrl {
++      HDMI_PACKETENABLE = 1,
++      HDMI_PACKETDISABLE = 0,
++      HDMI_PACKETREPEATON = 1,
++      HDMI_PACKETREPEATOFF = 0
++};
++
++enum hdmi_audio_i2s_config {
++      HDMI_AUDIO_I2S_MSB_SHIFTED_FIRST = 0,
++      HDMI_AUDIO_I2S_LSB_SHIFTED_FIRST = 1,
++      HDMI_AUDIO_I2S_SCK_EDGE_FALLING = 0,
++      HDMI_AUDIO_I2S_SCK_EDGE_RISING = 1,
++      HDMI_AUDIO_I2S_VBIT_FOR_PCM = 0,
++      HDMI_AUDIO_I2S_VBIT_FOR_COMPRESSED = 1,
++      HDMI_AUDIO_I2S_FIRST_BIT_SHIFT = 0,
++      HDMI_AUDIO_I2S_FIRST_BIT_NO_SHIFT = 1,
++      HDMI_AUDIO_I2S_SD0_EN = 1,
++      HDMI_AUDIO_I2S_SD1_EN = 1 << 1,
++      HDMI_AUDIO_I2S_SD2_EN = 1 << 2,
++      HDMI_AUDIO_I2S_SD3_EN = 1 << 3,
++};
++
++struct hdmi_core_video_config {
++      enum hdmi_core_inputbus_width   ip_bus_width;
++      enum hdmi_core_dither_trunc     op_dither_truc;
++      enum hdmi_core_deepcolor_ed     deep_color_pkt;
++      enum hdmi_core_packet_mode      pkt_mode;
++      enum hdmi_core_hdmi_dvi         hdmi_dvi;
++      enum hdmi_core_tclkselclkmult   tclk_sel_clkmult;
++};
++
++struct hdmi_core_packet_enable_repeat {
++      u32     audio_pkt;
++      u32     audio_pkt_repeat;
++      u32     avi_infoframe;
++      u32     avi_infoframe_repeat;
++      u32     gen_cntrl_pkt;
++      u32     gen_cntrl_pkt_repeat;
++      u32     generic_pkt;
++      u32     generic_pkt_repeat;
++};
++
++int hdmi4_read_edid(struct hdmi_core_data *core, u8 *edid, int len);
++void hdmi4_configure(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++              struct hdmi_config *cfg);
++void hdmi4_core_dump(struct hdmi_core_data *core, struct seq_file *s);
++int hdmi4_core_init(struct platform_device *pdev, struct hdmi_core_data *core);
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
++int hdmi4_audio_start(struct hdmi_core_data *core, struct hdmi_wp_data *wp);
++void hdmi4_audio_stop(struct hdmi_core_data *core, struct hdmi_wp_data *wp);
++int hdmi4_audio_config(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++              struct omap_dss_audio *audio, u32 pclk);
++int hdmi4_audio_get_dma_port(u32 *offset, u32 *size);
++#endif
++
++#endif
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi5.c
+@@ -0,0 +1,786 @@
++/*
++ * hdmi.c
++ *
++ * HDMI interface DSS driver setting for TI's OMAP4 family of processor.
++ * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
++ * Authors: Yong Zhi
++ *    Mythri pk <mythripk@ti.com>
++ *
++ * 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 "HDMI"
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/interrupt.h>
++#include <linux/mutex.h>
++#include <linux/delay.h>
++#include <linux/string.h>
++#include <linux/platform_device.h>
++#include <linux/pm_runtime.h>
++#include <linux/clk.h>
++#include <linux/gpio.h>
++#include <linux/regulator/consumer.h>
++#include <video/omapdss.h>
++
++#include "hdmi5_core.h"
++#include "dss.h"
++#include "dss_features.h"
++
++static struct {
++      struct mutex lock;
++      struct platform_device *pdev;
++
++      struct hdmi_wp_data     wp;
++      struct hdmi_pll_data    pll;
++      struct hdmi_phy_data    phy;
++      struct hdmi_core_data   core;
++
++      struct hdmi_config cfg;
++
++      struct clk *sys_clk;
++      struct regulator *vdda_hdmi_dac_reg;
++
++      bool core_enabled;
++
++      struct omap_dss_device output;
++} hdmi;
++
++static int hdmi_runtime_get(void)
++{
++      int r;
++
++      DSSDBG("hdmi_runtime_get\n");
++
++      r = pm_runtime_get_sync(&hdmi.pdev->dev);
++      WARN_ON(r < 0);
++      if (r < 0)
++              return r;
++
++      return 0;
++}
++
++static void hdmi_runtime_put(void)
++{
++      int r;
++
++      DSSDBG("hdmi_runtime_put\n");
++
++      r = pm_runtime_put_sync(&hdmi.pdev->dev);
++      WARN_ON(r < 0 && r != -ENOSYS);
++}
++
++static irqreturn_t hdmi_irq_handler(int irq, void *data)
++{
++      struct hdmi_wp_data *wp = data;
++      u32 irqstatus;
++
++      irqstatus = hdmi_wp_get_irqstatus(wp);
++      hdmi_wp_set_irqstatus(wp, irqstatus);
++
++      if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
++                      irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
++              u32 v;
++              /*
++               * If we get both connect and disconnect interrupts at the same
++               * time, turn off the PHY, clear interrupts, and restart, which
++               * raises connect interrupt if a cable is connected, or nothing
++               * if cable is not connected.
++               */
++
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_OFF);
++
++              /*
++               * We always get bogus CONNECT & DISCONNECT interrupts when
++               * setting the PHY to LDOON. To ignore those, we force the RXDET
++               * line to 0 until the PHY power state has been changed.
++               */
++              v = hdmi_read_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL);
++              v = FLD_MOD(v, 1, 15, 15); /* FORCE_RXDET_HIGH */
++              v = FLD_MOD(v, 0, 14, 7); /* RXDET_LINE */
++              hdmi_write_reg(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, v);
++
++              hdmi_wp_set_irqstatus(wp, HDMI_IRQ_LINK_CONNECT |
++                              HDMI_IRQ_LINK_DISCONNECT);
++
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
++
++              REG_FLD_MOD(hdmi.phy.base, HDMI_TXPHY_PAD_CFG_CTRL, 0, 15, 15);
++
++      } else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_TXON);
++      } else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
++              hdmi_wp_set_phy_pwr(wp, HDMI_PHYPWRCMD_LDOON);
++      }
++
++      return IRQ_HANDLED;
++}
++
++static int hdmi_init_regulator(void)
++{
++      int r;
++      struct regulator *reg;
++
++      if (hdmi.vdda_hdmi_dac_reg != NULL)
++              return 0;
++
++      reg = devm_regulator_get(&hdmi.pdev->dev, "vdda_hdmi_dac");
++      if (IS_ERR(reg)) {
++              DSSERR("can't get VDDA_HDMI_DAC regulator\n");
++              return PTR_ERR(reg);
++      }
++
++      r = regulator_set_voltage(reg, 1500000, 1800000);
++      if (r)
++              DSSWARN("can't set the regulator voltage");
++
++      hdmi.vdda_hdmi_dac_reg = reg;
++
++      return 0;
++}
++
++static int hdmi_power_on_core(struct omap_dss_device *dssdev)
++{
++      int r;
++
++      r = regulator_enable(hdmi.vdda_hdmi_dac_reg);
++      if (r)
++              return r;
++
++      r = hdmi_runtime_get();
++      if (r)
++              goto err_runtime_get;
++
++      /* Make selection of HDMI in DSS */
++      dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);
++
++      hdmi.core_enabled = true;
++
++      return 0;
++
++err_runtime_get:
++      regulator_disable(hdmi.vdda_hdmi_dac_reg);
++
++      return r;
++}
++
++static void hdmi_power_off_core(struct omap_dss_device *dssdev)
++{
++      hdmi.core_enabled = false;
++
++      hdmi_runtime_put();
++      regulator_disable(hdmi.vdda_hdmi_dac_reg);
++}
++
++static int hdmi_power_on_full(struct omap_dss_device *dssdev)
++{
++      int r;
++      struct omap_video_timings *p;
++      struct omap_overlay_manager *mgr = hdmi.output.manager;
++      unsigned long phy;
++
++      r = hdmi_power_on_core(dssdev);
++      if (r)
++              return r;
++
++      p = &hdmi.cfg.timings;
++
++      DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
++
++      phy = p->pixel_clock;
++
++      hdmi_pll_compute(&hdmi.pll, clk_get_rate(hdmi.sys_clk), phy);
++
++      /* disable and clear irqs */
++      hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
++      hdmi_wp_set_irqstatus(&hdmi.wp,
++                      hdmi_wp_get_irqstatus(&hdmi.wp));
++
++      /* config the PLL and PHY hdmi_set_pll_pwrfirst */
++      r = hdmi_pll_enable(&hdmi.pll, &hdmi.wp);
++      if (r) {
++              DSSDBG("Failed to lock PLL\n");
++              goto err_pll_enable;
++      }
++
++      r = hdmi_phy_configure(&hdmi.phy, &hdmi.cfg);
++      if (r) {
++              DSSDBG("Failed to start PHY\n");
++              goto err_phy_cfg;
++      }
++
++      r = hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_LDOON);
++      if (r)
++              goto err_phy_pwr;
++
++      hdmi5_configure(&hdmi.core, &hdmi.wp, &hdmi.cfg);
++
++      /* bypass TV gamma table */
++      dispc_enable_gamma_table(0);
++
++      /* tv size */
++      dss_mgr_set_timings(mgr, p);
++
++      r = hdmi_wp_video_start(&hdmi.wp);
++      if (r)
++              goto err_vid_enable;
++
++      r = dss_mgr_enable(mgr);
++      if (r)
++              goto err_mgr_enable;
++
++      hdmi_wp_set_irqenable(&hdmi.wp,
++                      HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
++
++      return 0;
++
++err_mgr_enable:
++      hdmi_wp_video_stop(&hdmi.wp);
++err_vid_enable:
++      hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
++err_phy_pwr:
++err_phy_cfg:
++      hdmi_pll_disable(&hdmi.pll, &hdmi.wp);
++err_pll_enable:
++      hdmi_power_off_core(dssdev);
++      return -EIO;
++}
++
++static void hdmi_power_off_full(struct omap_dss_device *dssdev)
++{
++      struct omap_overlay_manager *mgr = hdmi.output.manager;
++
++      hdmi_wp_clear_irqenable(&hdmi.wp, 0xffffffff);
++
++      dss_mgr_disable(mgr);
++
++      hdmi_wp_video_stop(&hdmi.wp);
++
++      hdmi_wp_set_phy_pwr(&hdmi.wp, HDMI_PHYPWRCMD_OFF);
++
++      hdmi_pll_disable(&hdmi.pll, &hdmi.wp);
++
++      hdmi_power_off_core(dssdev);
++}
++
++static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
++                                      struct omap_video_timings *timings)
++{
++      struct hdmi_cm cm;
++
++      cm = hdmi_get_code(timings);
++      if (cm.code == -1) {
++              return -EINVAL;
++      }
++
++      return 0;
++
++}
++
++static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      struct hdmi_cm cm;
++      const struct hdmi_config *t;
++
++      mutex_lock(&hdmi.lock);
++
++      cm = hdmi_get_code(timings);
++      hdmi.cfg.cm = cm;
++
++      t = hdmi_get_timings(cm.mode, cm.code);
++      if (t != NULL) {
++              hdmi.cfg = *t;
++
++              dispc_set_tv_pclk(t->timings.pixel_clock * 1000);
++      }
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
++              struct omap_video_timings *timings)
++{
++      const struct hdmi_config *cfg;
++      struct hdmi_cm cm = hdmi.cfg.cm;
++
++      cfg = hdmi_get_timings(cm.mode, cm.code);
++      if (cfg == NULL)
++              cfg = hdmi_default_timing();
++
++      memcpy(timings, &cfg->timings, sizeof(cfg->timings));
++}
++
++static void hdmi_dump_regs(struct seq_file *s)
++{
++      mutex_lock(&hdmi.lock);
++
++      if (hdmi_runtime_get()) {
++              mutex_unlock(&hdmi.lock);
++              return;
++      }
++
++      hdmi_wp_dump(&hdmi.wp, s);
++      hdmi_pll_dump(&hdmi.pll, s);
++      hdmi_phy_dump(&hdmi.phy, s);
++      hdmi5_core_dump(&hdmi.core, s);
++
++      hdmi_runtime_put();
++      mutex_unlock(&hdmi.lock);
++}
++
++static int read_edid(u8 *buf, int len)
++{
++      int r;
++      int idlemode;
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_runtime_get();
++      BUG_ON(r);
++
++      idlemode = REG_GET(hdmi.wp.base, HDMI_WP_SYSCONFIG, 3, 2);
++      /* No-idle mode */
++      REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, 1, 3, 2);
++
++      r = hdmi5_read_edid(&hdmi.core,  buf, len);
++
++      REG_FLD_MOD(hdmi.wp.base, HDMI_WP_SYSCONFIG, idlemode, 3, 2);
++
++      hdmi_runtime_put();
++      mutex_unlock(&hdmi.lock);
++
++      return r;
++}
++
++static int hdmi_display_enable(struct omap_dss_device *dssdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++      int r = 0;
++
++      DSSDBG("ENTER hdmi_display_enable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      if (out == NULL || out->manager == NULL) {
++              DSSERR("failed to enable display: no output/manager\n");
++              r = -ENODEV;
++              goto err0;
++      }
++
++      r = hdmi_power_on_full(dssdev);
++      if (r) {
++              DSSERR("failed to power on device\n");
++              goto err0;
++      }
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err0:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_display_disable(struct omap_dss_device *dssdev)
++{
++      DSSDBG("Enter hdmi_display_disable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      hdmi_power_off_full(dssdev);
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static int hdmi_core_enable(struct omap_dss_device *dssdev)
++{
++      int r = 0;
++
++      DSSDBG("ENTER omapdss_hdmi_core_enable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_power_on_core(dssdev);
++      if (r) {
++              DSSERR("failed to power on device\n");
++              goto err0;
++      }
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err0:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_core_disable(struct omap_dss_device *dssdev)
++{
++      DSSDBG("Enter omapdss_hdmi_core_disable\n");
++
++      mutex_lock(&hdmi.lock);
++
++      hdmi_power_off_core(dssdev);
++
++      mutex_unlock(&hdmi.lock);
++}
++
++static int hdmi_get_clocks(struct platform_device *pdev)
++{
++      struct clk *clk;
++
++      clk = devm_clk_get(&pdev->dev, "sys_clk");
++      if (IS_ERR(clk)) {
++              DSSERR("can't get sys_clk\n");
++              return PTR_ERR(clk);
++      }
++
++      hdmi.sys_clk = clk;
++
++      return 0;
++}
++
++static int hdmi_connect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      struct omap_overlay_manager *mgr;
++      int r;
++
++      r = hdmi_init_regulator();
++      if (r)
++              return r;
++
++      mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
++      if (!mgr)
++              return -ENODEV;
++
++      r = dss_mgr_connect(mgr, dssdev);
++      if (r)
++              return r;
++
++      r = omapdss_output_set_device(dssdev, dst);
++      if (r) {
++              DSSERR("failed to connect output to new device: %s\n",
++                              dst->name);
++              dss_mgr_disconnect(mgr, dssdev);
++              return r;
++      }
++
++      return 0;
++}
++
++static void hdmi_disconnect(struct omap_dss_device *dssdev,
++              struct omap_dss_device *dst)
++{
++      WARN_ON(dst != dssdev->dst);
++
++      if (dst != dssdev->dst)
++              return;
++
++      omapdss_output_unset_device(dssdev);
++
++      if (dssdev->manager)
++              dss_mgr_disconnect(dssdev->manager, dssdev);
++}
++
++static int hdmi_read_edid(struct omap_dss_device *dssdev,
++              u8 *edid, int len)
++{
++      bool need_enable;
++      int r;
++
++      need_enable = hdmi.core_enabled == false;
++
++      if (need_enable) {
++              r = hdmi_core_enable(dssdev);
++              if (r)
++                      return r;
++      }
++
++      r = read_edid(edid, len);
++
++      if (need_enable)
++              hdmi_core_disable(dssdev);
++
++      return r;
++}
++
++#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++static int hdmi_audio_enable(struct omap_dss_device *dssdev)
++{
++      int r;
++
++      mutex_lock(&hdmi.lock);
++
++      if (!hdmi_mode_has_audio(hdmi.cfg.cm.mode)) {
++              r = -EPERM;
++              goto err;
++      }
++
++      r = hdmi_wp_audio_enable(&hdmi.wp, true);
++      if (r)
++              goto err;
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static void hdmi_audio_disable(struct omap_dss_device *dssdev)
++{
++      hdmi_wp_audio_enable(&hdmi.wp, false);
++}
++
++static int hdmi_audio_start(struct omap_dss_device *dssdev)
++{
++      return hdmi_wp_audio_core_req_enable(&hdmi.wp, true);
++}
++
++static void hdmi_audio_stop(struct omap_dss_device *dssdev)
++{
++      hdmi_wp_audio_core_req_enable(&hdmi.wp, false);
++}
++
++static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
++{
++      bool r;
++
++      mutex_lock(&hdmi.lock);
++
++      r = hdmi_mode_has_audio(hdmi.cfg.cm.mode);
++
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++
++static int hdmi_audio_config(struct omap_dss_device *dssdev,
++              struct omap_dss_audio *audio)
++{
++      int r;
++      u32 pclk = hdmi.cfg.timings.pixel_clock;
++
++      mutex_lock(&hdmi.lock);
++
++      if (!hdmi_mode_has_audio(hdmi.cfg.cm.mode)) {
++              r = -EPERM;
++              goto err;
++      }
++
++      r = hdmi5_audio_config(&hdmi.core, &hdmi.wp, audio, pclk);
++      if (r)
++              goto err;
++
++      mutex_unlock(&hdmi.lock);
++      return 0;
++
++err:
++      mutex_unlock(&hdmi.lock);
++      return r;
++}
++#else
++static int hdmi_audio_enable(struct omap_dss_device *dssdev)
++{
++      return -EPERM;
++}
++
++static void hdmi_audio_disable(struct omap_dss_device *dssdev)
++{
++}
++
++static int hdmi_audio_start(struct omap_dss_device *dssdev)
++{
++      return -EPERM;
++}
++
++static void hdmi_audio_stop(struct omap_dss_device *dssdev)
++{
++}
++
++static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
++{
++      return false;
++}
++
++static int hdmi_audio_config(struct omap_dss_device *dssdev,
++              struct omap_dss_audio *audio)
++{
++      return -EPERM;
++}
++#endif
++
++static const struct omapdss_hdmi_ops hdmi_ops = {
++      .connect                = hdmi_connect,
++      .disconnect             = hdmi_disconnect,
++
++      .enable                 = hdmi_display_enable,
++      .disable                = hdmi_display_disable,
++
++      .check_timings          = hdmi_display_check_timing,
++      .set_timings            = hdmi_display_set_timing,
++      .get_timings            = hdmi_display_get_timings,
++
++      .read_edid              = hdmi_read_edid,
++
++      .audio_enable           = hdmi_audio_enable,
++      .audio_disable          = hdmi_audio_disable,
++      .audio_start            = hdmi_audio_start,
++      .audio_stop             = hdmi_audio_stop,
++      .audio_supported        = hdmi_audio_supported,
++      .audio_config           = hdmi_audio_config,
++};
++
++static void hdmi_init_output(struct platform_device *pdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++
++      out->dev = &pdev->dev;
++      out->id = OMAP_DSS_OUTPUT_HDMI;
++      out->output_type = OMAP_DISPLAY_TYPE_HDMI;
++      out->name = "hdmi.0";
++      out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
++      out->ops.hdmi = &hdmi_ops;
++      out->owner = THIS_MODULE;
++
++      omapdss_register_output(out);
++}
++
++static void __exit hdmi_uninit_output(struct platform_device *pdev)
++{
++      struct omap_dss_device *out = &hdmi.output;
++
++      omapdss_unregister_output(out);
++}
++
++/* HDMI HW IP initialisation */
++static int omapdss_hdmihw_probe(struct platform_device *pdev)
++{
++      int r;
++      int irq;
++
++      hdmi.pdev = pdev;
++
++      mutex_init(&hdmi.lock);
++
++      r = hdmi_wp_init(pdev, &hdmi.wp);
++      if (r)
++              return r;
++
++      r = hdmi_pll_init(pdev, &hdmi.pll);
++      if (r)
++              return r;
++
++      r = hdmi_phy_init(pdev, &hdmi.phy);
++      if (r)
++              return r;
++
++      r = hdmi5_core_init(pdev, &hdmi.core);
++      if (r)
++              return r;
++
++      r = hdmi_get_clocks(pdev);
++      if (r) {
++              DSSERR("can't get clocks\n");
++              return r;
++      }
++
++      irq = platform_get_irq(pdev, 0);
++      if (irq < 0) {
++              DSSERR("platform_get_irq failed\n");
++              return -ENODEV;
++      }
++
++      r = devm_request_threaded_irq(&pdev->dev, irq,
++                      NULL, hdmi_irq_handler,
++                      IRQF_ONESHOT, "OMAP HDMI", &hdmi.wp);
++      if (r) {
++              DSSERR("HDMI IRQ request failed\n");
++              return r;
++      }
++
++      pm_runtime_enable(&pdev->dev);
++
++      hdmi_init_output(pdev);
++
++      dss_debugfs_create_file("hdmi", hdmi_dump_regs);
++
++      return 0;
++}
++
++static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
++{
++      hdmi_uninit_output(pdev);
++
++      pm_runtime_disable(&pdev->dev);
++
++      return 0;
++}
++
++static int hdmi_runtime_suspend(struct device *dev)
++{
++      clk_disable_unprepare(hdmi.sys_clk);
++
++      dispc_runtime_put();
++
++      return 0;
++}
++
++static int hdmi_runtime_resume(struct device *dev)
++{
++      int r;
++
++      r = dispc_runtime_get();
++      if (r < 0)
++              return r;
++
++      clk_prepare_enable(hdmi.sys_clk);
++
++      return 0;
++}
++
++static const struct dev_pm_ops hdmi_pm_ops = {
++      .runtime_suspend = hdmi_runtime_suspend,
++      .runtime_resume = hdmi_runtime_resume,
++};
++
++static const struct of_device_id hdmi_of_match[] = {
++      { .compatible = "ti,omap5-hdmi", },
++      {},
++};
++
++static struct platform_driver omapdss_hdmihw_driver = {
++      .probe          = omapdss_hdmihw_probe,
++      .remove         = __exit_p(omapdss_hdmihw_remove),
++      .driver         = {
++              .name   = "omapdss_hdmi5",
++              .owner  = THIS_MODULE,
++              .pm     = &hdmi_pm_ops,
++              .of_match_table = hdmi_of_match,
++      },
++};
++
++int __init hdmi5_init_platform_driver(void)
++{
++      return platform_driver_register(&omapdss_hdmihw_driver);
++}
++
++void __exit hdmi5_uninit_platform_driver(void)
++{
++      platform_driver_unregister(&omapdss_hdmihw_driver);
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi5_core.c
+@@ -0,0 +1,915 @@
++/*
++ * OMAP5 HDMI CORE IP driver Library
++ * Copyright (C) 2011-2012 Texas Instruments Incorporated - http://www.ti.com/
++ * Author: Mythri pk <mythripk@ti.com>
++ * 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/>.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/delay.h>
++#include <linux/string.h>
++#include <linux/seq_file.h>
++#include <drm/drm_edid.h>
++#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++#include <sound/asound.h>
++#include <sound/asoundef.h>
++#endif
++
++#include "hdmi5_core.h"
++
++/* only 24 bit color depth used for now */
++static const struct csc_table csc_table_deepcolor[] = {
++      /* HDMI_DEEP_COLOR_24BIT */
++      [0] = { 7036, 0, 0, 32, 0, 7036, 0, 32, 0, 0, 7036, 32, },
++      /* HDMI_DEEP_COLOR_30BIT */
++      [1] = { 7015, 0, 0, 128, 0, 7015, 0, 128, 0, 0, 7015, 128, },
++      /* HDMI_DEEP_COLOR_36BIT */
++      [2] = { 7010, 0, 0, 512, 0, 7010, 0, 512, 0, 0, 7010, 512, },
++      /* FULL RANGE */
++      [3] = { 8192, 0, 0, 0, 0, 8192, 0, 0, 0, 0, 8192, 0, },
++};
++
++static void hdmi_core_ddc_init(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++      const unsigned long long iclk = 266000000;      /* DSS L3 ICLK */
++      const unsigned ss_scl_high = 4000;              /* ns */
++      const unsigned ss_scl_low = 4700;               /* ns */
++      const unsigned fs_scl_high = 600;               /* ns */
++      const unsigned fs_scl_low = 1300;               /* ns */
++      const unsigned sda_hold = 300;                  /* ns */
++      const unsigned sfr_div = 10;
++      unsigned long long sfr;
++      unsigned v;
++
++      sfr = iclk / sfr_div;   /* SFR_DIV */
++      sfr /= 1000;            /* SFR clock in kHz */
++
++      /* Reset */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SOFTRSTZ, 0, 0, 0);
++      if (hdmi_wait_for_bit_change(base, HDMI_CORE_I2CM_SOFTRSTZ,
++                              0, 0, 1) != 1)
++              DSSERR("HDMI I2CM reset failed\n");
++
++      /* Standard (0) or Fast (1) Mode */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_DIV, 0, 3, 3);
++
++      /* Standard Mode SCL High counter */
++      v = DIV_ROUND_UP_ULL(ss_scl_high * sfr, 1000000);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SS_SCL_HCNT_1_ADDR,
++                      (v >> 8) & 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SS_SCL_HCNT_0_ADDR,
++                      v & 0xff, 7, 0);
++
++      /* Standard Mode SCL Low counter */
++      v = DIV_ROUND_UP_ULL(ss_scl_low * sfr, 1000000);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SS_SCL_LCNT_1_ADDR,
++                      (v >> 8) & 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SS_SCL_LCNT_0_ADDR,
++                      v & 0xff, 7, 0);
++
++      /* Fast Mode SCL High Counter */
++      v = DIV_ROUND_UP_ULL(fs_scl_high * sfr, 1000000);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_FS_SCL_HCNT_1_ADDR,
++                      (v >> 8) & 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_FS_SCL_HCNT_0_ADDR,
++                      v & 0xff, 7, 0);
++
++      /* Fast Mode SCL Low Counter */
++      v = DIV_ROUND_UP_ULL(fs_scl_low * sfr, 1000000);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_FS_SCL_LCNT_1_ADDR,
++                      (v >> 8) & 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_FS_SCL_LCNT_0_ADDR,
++                      v & 0xff, 7, 0);
++
++      /* SDA Hold Time */
++      v = DIV_ROUND_UP_ULL(sda_hold * sfr, 1000000);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SDA_HOLD_ADDR, v & 0xff, 7, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SLAVE, 0x50, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SEGADDR, 0x30, 6, 0);
++
++      /* NACK_POL to high */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 7, 7);
++
++      /* NACK_MASK to unmasked */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x0, 6, 6);
++
++      /* ARBITRATION_POL to high */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 3, 3);
++
++      /* ARBITRATION_MASK to unmasked */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x0, 2, 2);
++
++      /* DONE_POL to high */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_INT, 0x1, 3, 3);
++
++      /* DONE_MASK to unmasked */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_INT, 0x0, 2, 2);
++}
++
++static void hdmi_core_ddc_uninit(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++
++      /* Mask I2C interrupts */
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 6, 6);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 2, 2);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_INT, 0x1, 2, 2);
++}
++
++static int hdmi_core_ddc_edid(struct hdmi_core_data *core, u8 *pedid, u8 ext)
++{
++      void __iomem *base = core->base;
++      u8 cur_addr;
++      char checksum = 0;
++      const int retries = 1000;
++      u8 seg_ptr = ext / 2;
++      u8 edidbase = ((ext % 2) * 0x80);
++
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_SEGPTR, seg_ptr, 7, 0);
++
++      /*
++       * TODO: We use polling here, although we probably should use proper
++       * interrupts.
++       */
++      for (cur_addr = 0; cur_addr < 128; ++cur_addr) {
++              int i;
++
++              /* clear ERROR and DONE */
++              REG_FLD_MOD(base, HDMI_CORE_IH_I2CM_STAT0, 0x3, 1, 0);
++
++              REG_FLD_MOD(base, HDMI_CORE_I2CM_ADDRESS,
++                              edidbase + cur_addr, 7, 0);
++
++              if (seg_ptr)
++                      REG_FLD_MOD(base, HDMI_CORE_I2CM_OPERATION, 1, 1, 1);
++              else
++                      REG_FLD_MOD(base, HDMI_CORE_I2CM_OPERATION, 1, 0, 0);
++
++              for (i = 0; i < retries; ++i) {
++                      u32 stat;
++
++                      stat = REG_GET(base, HDMI_CORE_IH_I2CM_STAT0, 1, 0);
++
++                      /* I2CM_ERROR */
++                      if (stat & 1) {
++                              DSSERR("HDMI I2C Master Error\n");
++                              return -EIO;
++                      }
++
++                      /* I2CM_DONE */
++                      if (stat & (1 << 1))
++                              break;
++
++                      usleep_range(250, 1000);
++              }
++
++              if (i == retries) {
++                      DSSERR("HDMI I2C timeout reading EDID\n");
++                      return -EIO;
++              }
++
++              pedid[cur_addr] = REG_GET(base, HDMI_CORE_I2CM_DATAI, 7, 0);
++              checksum += pedid[cur_addr];
++      }
++
++      return 0;
++
++}
++
++int hdmi5_read_edid(struct hdmi_core_data *core, u8 *edid, int len)
++{
++      int r, n, i;
++      int max_ext_blocks = (len / 128) - 1;
++
++      if (len < 128)
++              return -EINVAL;
++
++      hdmi_core_ddc_init(core);
++
++      r = hdmi_core_ddc_edid(core, edid, 0);
++      if (r)
++              goto out;
++
++      n = edid[0x7e];
++
++      if (n > max_ext_blocks)
++              n = max_ext_blocks;
++
++      for (i = 1; i <= n; i++) {
++              r = hdmi_core_ddc_edid(core, edid + i * EDID_LENGTH, i);
++              if (r)
++                      goto out;
++      }
++
++out:
++      hdmi_core_ddc_uninit(core);
++
++      return r;
++}
++
++void hdmi5_core_dump(struct hdmi_core_data *core, struct seq_file *s)
++{
++
++#define DUMPCORE(r) seq_printf(s, "%-35s %08x\n", #r,\
++              hdmi_read_reg(core->base, r))
++
++      DUMPCORE(HDMI_CORE_FC_INVIDCONF);
++      DUMPCORE(HDMI_CORE_FC_INHACTIV0);
++      DUMPCORE(HDMI_CORE_FC_INHACTIV1);
++      DUMPCORE(HDMI_CORE_FC_INHBLANK0);
++      DUMPCORE(HDMI_CORE_FC_INHBLANK1);
++      DUMPCORE(HDMI_CORE_FC_INVACTIV0);
++      DUMPCORE(HDMI_CORE_FC_INVACTIV1);
++      DUMPCORE(HDMI_CORE_FC_INVBLANK);
++      DUMPCORE(HDMI_CORE_FC_HSYNCINDELAY0);
++      DUMPCORE(HDMI_CORE_FC_HSYNCINDELAY1);
++      DUMPCORE(HDMI_CORE_FC_HSYNCINWIDTH0);
++      DUMPCORE(HDMI_CORE_FC_HSYNCINWIDTH1);
++      DUMPCORE(HDMI_CORE_FC_VSYNCINDELAY);
++      DUMPCORE(HDMI_CORE_FC_VSYNCINWIDTH);
++      DUMPCORE(HDMI_CORE_FC_CTRLDUR);
++      DUMPCORE(HDMI_CORE_FC_EXCTRLDUR);
++      DUMPCORE(HDMI_CORE_FC_EXCTRLSPAC);
++      DUMPCORE(HDMI_CORE_FC_CH0PREAM);
++      DUMPCORE(HDMI_CORE_FC_CH1PREAM);
++      DUMPCORE(HDMI_CORE_FC_CH2PREAM);
++      DUMPCORE(HDMI_CORE_FC_AVICONF0);
++      DUMPCORE(HDMI_CORE_FC_AVICONF1);
++      DUMPCORE(HDMI_CORE_FC_AVICONF2);
++      DUMPCORE(HDMI_CORE_FC_AVIVID);
++      DUMPCORE(HDMI_CORE_FC_PRCONF);
++
++      DUMPCORE(HDMI_CORE_MC_CLKDIS);
++      DUMPCORE(HDMI_CORE_MC_SWRSTZREQ);
++      DUMPCORE(HDMI_CORE_MC_FLOWCTRL);
++      DUMPCORE(HDMI_CORE_MC_PHYRSTZ);
++      DUMPCORE(HDMI_CORE_MC_LOCKONCLOCK);
++
++      DUMPCORE(HDMI_CORE_I2CM_SLAVE);
++      DUMPCORE(HDMI_CORE_I2CM_ADDRESS);
++      DUMPCORE(HDMI_CORE_I2CM_DATAO);
++      DUMPCORE(HDMI_CORE_I2CM_DATAI);
++      DUMPCORE(HDMI_CORE_I2CM_OPERATION);
++      DUMPCORE(HDMI_CORE_I2CM_INT);
++      DUMPCORE(HDMI_CORE_I2CM_CTLINT);
++      DUMPCORE(HDMI_CORE_I2CM_DIV);
++      DUMPCORE(HDMI_CORE_I2CM_SEGADDR);
++      DUMPCORE(HDMI_CORE_I2CM_SOFTRSTZ);
++      DUMPCORE(HDMI_CORE_I2CM_SEGPTR);
++      DUMPCORE(HDMI_CORE_I2CM_SS_SCL_HCNT_1_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_SS_SCL_HCNT_0_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_SS_SCL_LCNT_1_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_SS_SCL_LCNT_0_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_FS_SCL_HCNT_1_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_FS_SCL_HCNT_0_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_FS_SCL_LCNT_1_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_FS_SCL_LCNT_0_ADDR);
++      DUMPCORE(HDMI_CORE_I2CM_SDA_HOLD_ADDR);
++}
++
++static void hdmi_core_init(struct hdmi_core_vid_config *video_cfg,
++                      struct hdmi_core_infoframe_avi *avi_cfg,
++                      struct hdmi_config *cfg)
++{
++      DSSDBG("hdmi_core_init\n");
++
++      /* video core */
++      video_cfg->data_enable_pol = 1; /* It is always 1*/
++      video_cfg->v_fc_config.timings.hsync_level = cfg->timings.hsync_level;
++      video_cfg->v_fc_config.timings.x_res = cfg->timings.x_res;
++      video_cfg->v_fc_config.timings.hsw = cfg->timings.hsw - 1;
++      video_cfg->v_fc_config.timings.hbp = cfg->timings.hbp;
++      video_cfg->v_fc_config.timings.hfp = cfg->timings.hfp;
++      video_cfg->hblank = cfg->timings.hfp +
++                              cfg->timings.hbp + cfg->timings.hsw - 1;
++      video_cfg->v_fc_config.timings.vsync_level = cfg->timings.vsync_level;
++      video_cfg->v_fc_config.timings.y_res = cfg->timings.y_res;
++      video_cfg->v_fc_config.timings.vsw = cfg->timings.vsw;
++      video_cfg->v_fc_config.timings.vfp = cfg->timings.vfp;
++      video_cfg->v_fc_config.timings.vbp = cfg->timings.vbp;
++      video_cfg->vblank_osc = 0; /* Always 0 - need to confirm */
++      video_cfg->vblank = cfg->timings.vsw +
++                              cfg->timings.vfp + cfg->timings.vbp;
++      video_cfg->v_fc_config.cm.mode = cfg->cm.mode;
++      video_cfg->v_fc_config.timings.interlace = cfg->timings.interlace;
++
++      /* info frame */
++      avi_cfg->db1_format = 0;
++      avi_cfg->db1_active_info = 0;
++      avi_cfg->db1_bar_info_dv = 0;
++      avi_cfg->db1_scan_info = 0;
++      avi_cfg->db2_colorimetry = 0;
++      avi_cfg->db2_aspect_ratio = 0;
++      avi_cfg->db2_active_fmt_ar = 0;
++      avi_cfg->db3_itc = 0;
++      avi_cfg->db3_ec = 0;
++      avi_cfg->db3_q_range = 0;
++      avi_cfg->db3_nup_scaling = 0;
++      avi_cfg->db4_videocode = 0;
++      avi_cfg->db5_pixel_repeat = 0;
++      avi_cfg->db6_7_line_eoftop = 0 ;
++      avi_cfg->db8_9_line_sofbottom = 0;
++      avi_cfg->db10_11_pixel_eofleft = 0;
++      avi_cfg->db12_13_pixel_sofright = 0;
++}
++
++/* DSS_HDMI_CORE_VIDEO_CONFIG */
++static void hdmi_core_video_config(struct hdmi_core_data *core,
++                      struct hdmi_core_vid_config *cfg)
++{
++      void __iomem *base = core->base;
++      unsigned char r = 0;
++      bool vsync_pol, hsync_pol;
++
++      vsync_pol =
++              cfg->v_fc_config.timings.vsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
++      hsync_pol =
++              cfg->v_fc_config.timings.hsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
++
++      /* Set hsync, vsync and data-enable polarity  */
++      r = hdmi_read_reg(base, HDMI_CORE_FC_INVIDCONF);
++      r = FLD_MOD(r, vsync_pol, 6, 6);
++      r = FLD_MOD(r, hsync_pol, 5, 5);
++      r = FLD_MOD(r, cfg->data_enable_pol, 4, 4);
++      r = FLD_MOD(r, cfg->vblank_osc, 1, 1);
++      r = FLD_MOD(r, cfg->v_fc_config.timings.interlace, 0, 0);
++      hdmi_write_reg(base, HDMI_CORE_FC_INVIDCONF, r);
++
++      /* set x resolution */
++      REG_FLD_MOD(base, HDMI_CORE_FC_INHACTIV1,
++                      cfg->v_fc_config.timings.x_res >> 8, 4, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_INHACTIV0,
++                      cfg->v_fc_config.timings.x_res & 0xFF, 7, 0);
++
++      /* set y resolution */
++      REG_FLD_MOD(base, HDMI_CORE_FC_INVACTIV1,
++                      cfg->v_fc_config.timings.y_res >> 8, 4, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_INVACTIV0,
++                      cfg->v_fc_config.timings.y_res & 0xFF, 7, 0);
++
++      /* set horizontal blanking pixels */
++      REG_FLD_MOD(base, HDMI_CORE_FC_INHBLANK1, cfg->hblank >> 8, 4, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_INHBLANK0, cfg->hblank & 0xFF, 7, 0);
++
++      /* set vertial blanking pixels */
++      REG_FLD_MOD(base, HDMI_CORE_FC_INVBLANK, cfg->vblank, 7, 0);
++
++      /* set horizontal sync offset */
++      REG_FLD_MOD(base, HDMI_CORE_FC_HSYNCINDELAY1,
++                      cfg->v_fc_config.timings.hfp >> 8, 4, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_HSYNCINDELAY0,
++                      cfg->v_fc_config.timings.hfp & 0xFF, 7, 0);
++
++      /* set vertical sync offset */
++      REG_FLD_MOD(base, HDMI_CORE_FC_VSYNCINDELAY,
++                      cfg->v_fc_config.timings.vfp, 7, 0);
++
++      /* set horizontal sync pulse width */
++      REG_FLD_MOD(base, HDMI_CORE_FC_HSYNCINWIDTH1,
++                      (cfg->v_fc_config.timings.hsw >> 8), 1, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_HSYNCINWIDTH0,
++                      cfg->v_fc_config.timings.hsw & 0xFF, 7, 0);
++
++      /*  set vertical sync pulse width */
++      REG_FLD_MOD(base, HDMI_CORE_FC_VSYNCINWIDTH,
++                      cfg->v_fc_config.timings.vsw, 5, 0);
++
++      /* select DVI mode */
++      REG_FLD_MOD(base, HDMI_CORE_FC_INVIDCONF,
++                      cfg->v_fc_config.cm.mode, 3, 3);
++}
++
++static void hdmi_core_config_video_packetizer(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++      int clr_depth = 0;      /* 24 bit color depth */
++
++      /* COLOR_DEPTH */
++      REG_FLD_MOD(base, HDMI_CORE_VP_PR_CD, clr_depth, 7, 4);
++      /* BYPASS_EN */
++      REG_FLD_MOD(base, HDMI_CORE_VP_CONF, clr_depth ? 0 : 1, 6, 6);
++      /* PP_EN */
++      REG_FLD_MOD(base, HDMI_CORE_VP_CONF, clr_depth ? 1 : 0, 5, 5);
++      /* YCC422_EN */
++      REG_FLD_MOD(base, HDMI_CORE_VP_CONF, 0, 3, 3);
++      /* PP_STUFFING */
++      REG_FLD_MOD(base, HDMI_CORE_VP_STUFF, clr_depth ? 1 : 0, 1, 1);
++      /* YCC422_STUFFING */
++      REG_FLD_MOD(base, HDMI_CORE_VP_STUFF, 1, 2, 2);
++      /* OUTPUT_SELECTOR */
++      REG_FLD_MOD(base, HDMI_CORE_VP_CONF, clr_depth ? 0 : 2, 1, 0);
++}
++
++static void hdmi_core_config_csc(struct hdmi_core_data *core)
++{
++      int clr_depth = 0;      /* 24 bit color depth */
++
++      /* CSC_COLORDEPTH */
++      REG_FLD_MOD(core->base, HDMI_CORE_CSC_SCALE, clr_depth, 7, 4);
++}
++
++static void hdmi_core_config_video_sampler(struct hdmi_core_data *core)
++{
++      int video_mapping = 1;  /* for 24 bit color depth */
++
++      /* VIDEO_MAPPING */
++      REG_FLD_MOD(core->base, HDMI_CORE_TX_INVID0, video_mapping, 4, 0);
++}
++
++static void hdmi_core_aux_infoframe_avi_config(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++      struct hdmi_core_infoframe_avi avi = core->avi_cfg;
++
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF0, avi.db1_format, 1, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF0, avi.db1_active_info, 6, 6);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF0, avi.db1_bar_info_dv, 3, 2);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF0, avi.db1_scan_info, 5, 4);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF1, avi.db2_colorimetry, 7, 6);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF1, avi.db2_aspect_ratio, 5, 4);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF1, avi.db2_active_fmt_ar, 3, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF2, avi.db3_itc, 7, 7);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF2, avi.db3_ec, 6, 4);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF2, avi.db3_q_range, 3, 2);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVICONF2, avi.db3_nup_scaling, 1, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AVIVID, avi.db4_videocode, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_PRCONF, avi.db5_pixel_repeat, 3, 0);
++}
++
++static void hdmi_core_csc_config(struct hdmi_core_data *core,
++              struct csc_table csc_coeff)
++{
++      void __iomem *base = core->base;
++
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A1_MSB, csc_coeff.a1 >> 8 , 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A1_LSB, csc_coeff.a1, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A2_MSB, csc_coeff.a2 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A2_LSB, csc_coeff.a2, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A3_MSB, csc_coeff.a3 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A3_LSB, csc_coeff.a3, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A4_MSB, csc_coeff.a4 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_A4_LSB, csc_coeff.a4, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B1_MSB, csc_coeff.b1 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B1_LSB, csc_coeff.b1, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B2_MSB, csc_coeff.b2 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B2_LSB, csc_coeff.b2, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B3_MSB, csc_coeff.b3 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B3_LSB, csc_coeff.b3, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B4_MSB, csc_coeff.b4 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_B4_LSB, csc_coeff.b4, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C1_MSB, csc_coeff.c1 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C1_LSB, csc_coeff.c1, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C2_MSB, csc_coeff.c2 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C2_LSB, csc_coeff.c2, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C3_MSB, csc_coeff.c3 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C3_LSB, csc_coeff.c3, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C4_MSB, csc_coeff.c4 >> 8, 6, 0);
++      REG_FLD_MOD(base, HDMI_CORE_CSC_COEF_C4_LSB, csc_coeff.c4, 7, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_MC_FLOWCTRL, 0x1, 0, 0);
++}
++
++static void hdmi_core_configure_range(struct hdmi_core_data *core)
++{
++      struct csc_table csc_coeff = { 0 };
++
++      /* support limited range with 24 bit color depth for now */
++      csc_coeff = csc_table_deepcolor[0];
++      core->avi_cfg.db3_q_range = HDMI_INFOFRAME_AVI_DB3Q_LR;
++
++      hdmi_core_csc_config(core, csc_coeff);
++      hdmi_core_aux_infoframe_avi_config(core);
++}
++
++static void hdmi_core_enable_video_path(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++
++      DSSDBG("hdmi_core_enable_video_path\n");
++
++      REG_FLD_MOD(base, HDMI_CORE_FC_CTRLDUR, 0x0C, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_EXCTRLDUR, 0x20, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_EXCTRLSPAC, 0x01, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_CH0PREAM, 0x0B, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_CH1PREAM, 0x16, 5, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_CH2PREAM, 0x21, 5, 0);
++      REG_FLD_MOD(base, HDMI_CORE_MC_CLKDIS, 0x00, 0, 0);
++      REG_FLD_MOD(base, HDMI_CORE_MC_CLKDIS, 0x00, 1, 1);
++}
++
++static void hdmi_core_mask_interrupts(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++
++      /* Master IRQ mask */
++      REG_FLD_MOD(base, HDMI_CORE_IH_MUTE, 0x3, 1, 0);
++
++      /* Mask all the interrupts in HDMI core */
++
++      REG_FLD_MOD(base, HDMI_CORE_VP_MASK, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_MASK0, 0xe7, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_MASK1, 0xfb, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_MASK2, 0x3, 1, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_AUD_INT, 0x3, 3, 2);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_GP_MASK, 0x3, 1, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_CEC_MASK, 0x7f, 6, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 6, 6);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_CTLINT, 0x1, 2, 2);
++      REG_FLD_MOD(base, HDMI_CORE_I2CM_INT, 0x1, 2, 2);
++
++      REG_FLD_MOD(base, HDMI_CORE_PHY_MASK0, 0xf3, 7, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_PHY_STAT0, 0xff, 7, 0);
++
++      /* Clear all the current interrupt bits */
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_VP_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT0, 0xe7, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT1, 0xfb, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT2, 0x3, 1, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_AS_STAT0, 0x7, 2, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_CEC_STAT0, 0x7f, 6, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_I2CM_STAT0, 0x3, 1, 0);
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_PHY_STAT0, 0xff, 7, 0);
++}
++
++static void hdmi_core_enable_interrupts(struct hdmi_core_data *core)
++{
++      /* Unmute interrupts */
++      REG_FLD_MOD(core->base, HDMI_CORE_IH_MUTE, 0x0, 1, 0);
++}
++
++int hdmi5_core_handle_irqs(struct hdmi_core_data *core)
++{
++      void __iomem *base = core->base;
++
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT1, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_FC_STAT2, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_AS_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_PHY_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_I2CM_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_CEC_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_VP_STAT0, 0xff, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_IH_I2CMPHY_STAT0, 0xff, 7, 0);
++
++      return 0;
++}
++
++void hdmi5_configure(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++              struct hdmi_config *cfg)
++{
++      struct omap_video_timings video_timing;
++      struct hdmi_video_format video_format;
++      struct hdmi_core_vid_config v_core_cfg;
++      struct hdmi_core_infoframe_avi *avi_cfg = &core->avi_cfg;
++
++      hdmi_core_mask_interrupts(core);
++
++      hdmi_core_init(&v_core_cfg, avi_cfg, cfg);
++
++      hdmi_wp_init_vid_fmt_timings(&video_format, &video_timing, cfg);
++
++      hdmi_wp_video_config_timing(wp, &video_timing);
++
++      /* video config */
++      video_format.packing_mode = HDMI_PACK_24b_RGB_YUV444_YUV422;
++
++      hdmi_wp_video_config_format(wp, &video_format);
++
++      hdmi_wp_video_config_interface(wp, &video_timing);
++
++      hdmi_core_configure_range(core);
++
++      /*
++       * configure core video part, set software reset in the core
++       */
++      v_core_cfg.packet_mode = HDMI_PACKETMODE24BITPERPIXEL;
++
++      hdmi_core_video_config(core, &v_core_cfg);
++
++      hdmi_core_config_video_packetizer(core);
++      hdmi_core_config_csc(core);
++      hdmi_core_config_video_sampler(core);
++
++      /*
++       * configure packet info frame video see doc CEA861-D page 65
++       */
++      avi_cfg->db1_format = HDMI_INFOFRAME_AVI_DB1Y_RGB;
++      avi_cfg->db1_active_info =
++                      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_OFF;
++      avi_cfg->db1_bar_info_dv = HDMI_INFOFRAME_AVI_DB1B_NO;
++      avi_cfg->db1_scan_info = HDMI_INFOFRAME_AVI_DB1S_0;
++      avi_cfg->db2_colorimetry = HDMI_INFOFRAME_AVI_DB2C_NO;
++      avi_cfg->db2_aspect_ratio = HDMI_INFOFRAME_AVI_DB2M_NO;
++      avi_cfg->db2_active_fmt_ar = HDMI_INFOFRAME_AVI_DB2R_SAME;
++      avi_cfg->db3_itc = HDMI_INFOFRAME_AVI_DB3ITC_NO;
++      avi_cfg->db3_ec = HDMI_INFOFRAME_AVI_DB3EC_XVYUV601;
++      avi_cfg->db3_q_range = HDMI_INFOFRAME_AVI_DB3Q_DEFAULT;
++      avi_cfg->db3_nup_scaling = HDMI_INFOFRAME_AVI_DB3SC_NO;
++      avi_cfg->db4_videocode = cfg->cm.code;
++      avi_cfg->db5_pixel_repeat = HDMI_INFOFRAME_AVI_DB5PR_NO;
++      avi_cfg->db6_7_line_eoftop = 0;
++      avi_cfg->db8_9_line_sofbottom = 0;
++      avi_cfg->db10_11_pixel_eofleft = 0;
++      avi_cfg->db12_13_pixel_sofright = 0;
++
++      hdmi_core_aux_infoframe_avi_config(core);
++
++      hdmi_core_enable_video_path(core);
++
++      hdmi_core_enable_interrupts(core);
++}
++
++
++#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++
++static void hdmi5_core_audio_config(struct hdmi_core_data *core,
++                      struct hdmi_core_audio_config *cfg)
++{
++      void __iomem *base = core->base;
++      u8 val;
++
++      /* Mute audio before configuring */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCONF, 0xf, 7, 4);
++
++      /* Set the N parameter */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_N1, cfg->n, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_N2, cfg->n >> 8, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_N3, cfg->n >> 16, 3, 0);
++
++      /*
++       * CTS manual mode. Automatic mode is not supported when using audio
++       * parallel interface.
++       */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_CTS3, 1, 4, 4);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_CTS1, cfg->cts, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_CTS2, cfg->cts >> 8, 7, 0);
++      REG_FLD_MOD(base, HDMI_CORE_AUD_CTS3, cfg->cts >> 16, 3, 0);
++
++      /* Layout of Audio Sample Packets: 2-channel or multichannels */
++      if (cfg->layout == HDMI_AUDIO_LAYOUT_2CH)
++              REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCONF, 0, 0, 0);
++      else
++              REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCONF, 1, 0, 0);
++
++      /* Configure IEC-609580 Validity bits */
++      /* Channel 0 is valid */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, 0, 0, 0);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, 0, 4, 4);
++
++      if (cfg->layout == HDMI_AUDIO_LAYOUT_2CH)
++              val = 1;
++      else
++              val = 0;
++
++      /* Channels 1, 2 setting */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 1, 1);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 5, 5);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 2, 2);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 6, 6);
++      /* Channel 3 setting */
++      if (cfg->layout == HDMI_AUDIO_LAYOUT_6CH)
++              val = 1;
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 3, 3);
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSV, val, 7, 7);
++
++      /* Configure IEC-60958 User bits */
++      /* TODO: should be set by user. */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSU, 0, 7, 0);
++
++      /* Configure IEC-60958 Channel Status word */
++      /* CGMSA */
++      val = cfg->iec60958_cfg->status[5] & IEC958_AES5_CON_CGMSA;
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(0), val, 5, 4);
++
++      /* Copyright */
++      val = (cfg->iec60958_cfg->status[0] &
++                      IEC958_AES0_CON_NOT_COPYRIGHT) >> 2;
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(0), val, 0, 0);
++
++      /* Category */
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDSCHNLS(1),
++              cfg->iec60958_cfg->status[1]);
++
++      /* PCM audio mode */
++      val = (cfg->iec60958_cfg->status[0] & IEC958_AES0_CON_MODE) >> 6;
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(2), val, 6, 4);
++
++      /* Source number */
++      val = cfg->iec60958_cfg->status[2] & IEC958_AES2_CON_SOURCE;
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(2), val, 3, 4);
++
++      /* Channel number right 0  */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(3), 2, 3, 0);
++      /* Channel number right 1*/
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(3), 4, 7, 4);
++      /* Channel number right 2  */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(4), 6, 3, 0);
++      /* Channel number right 3*/
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(4), 8, 7, 4);
++      /* Channel number left 0  */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(5), 1, 3, 0);
++      /* Channel number left 1*/
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(5), 3, 7, 4);
++      /* Channel number left 2  */
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(6), 5, 3, 0);
++      /* Channel number left 3*/
++      REG_FLD_MOD(base, HDMI_CORE_FC_AUDSCHNLS(6), 7, 7, 4);
++
++      /* Clock accuracy and sample rate */
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDSCHNLS(7),
++              cfg->iec60958_cfg->status[3]);
++
++      /* Original sample rate and word length */
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDSCHNLS(8),
++              cfg->iec60958_cfg->status[4]);
++
++      /* Enable FIFO empty and full interrupts */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_INT, 3, 3, 2);
++
++      /* Configure GPA */
++      /* select HBR/SPDIF interfaces */
++      if (cfg->layout == HDMI_AUDIO_LAYOUT_2CH) {
++              /* select HBR/SPDIF interfaces */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_CONF0, 0, 5, 5);
++              /* enable two channels in GPA */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_GP_CONF1, 3, 7, 0);
++      } else if (cfg->layout == HDMI_AUDIO_LAYOUT_6CH) {
++              /* select HBR/SPDIF interfaces */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_CONF0, 0, 5, 5);
++              /* enable six channels in GPA */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_GP_CONF1, 0x3F, 7, 0);
++      } else {
++              /* select HBR/SPDIF interfaces */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_CONF0, 0, 5, 5);
++              /* enable eight channels in GPA */
++              REG_FLD_MOD(base, HDMI_CORE_AUD_GP_CONF1, 0xFF, 7, 0);
++      }
++
++      /* disable HBR */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_GP_CONF2, 0, 0, 0);
++      /* enable PCUV */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_GP_CONF2, 1, 1, 1);
++      /* enable GPA FIFO full and empty mask */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_GP_MASK, 3, 1, 0);
++      /* set polarity of GPA FIFO empty interrupts */
++      REG_FLD_MOD(base, HDMI_CORE_AUD_GP_POL, 1, 0, 0);
++
++      /* unmute audio */
++      REG_FLD_MOD(core_sys_base, HDMI_CORE_FC_AUDSCONF, 0, 7, 4);
++}
++
++static void hdmi5_core_audio_infoframe_cfg(struct hdmi_core_data *core,
++       struct snd_cea_861_aud_if *info_aud)
++{
++      void __iomem *base = core->base;
++
++      /* channel count and coding type fields in AUDICONF0 are swapped */
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDICONF0,
++              (info_aud->db1_ct_cc & CEA861_AUDIO_INFOFRAME_DB1CC) << 4 |
++              (info_aud->db1_ct_cc & CEA861_AUDIO_INFOFRAME_DB1CT) >> 4);
++
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDICONF1, info_aud->db2_sf_ss);
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDICONF2, info_aud->db4_ca);
++      hdmi_write_reg(base, HDMI_CORE_FC_AUDICONF3, info_aud->db5_dminh_lsv);
++}
++
++int hdmi5_audio_config(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++                      struct omap_dss_audio *audio, u32 pclk)
++{
++      struct hdmi_audio_format audio_format;
++      struct hdmi_audio_dma audio_dma;
++      struct hdmi_core_audio_config core_cfg;
++      int err, n, cts, channel_count;
++      unsigned int fs_nr;
++      bool word_length_16b = false;
++
++      if (!audio || !audio->iec || !audio->cea || !core)
++              return -EINVAL;
++
++      core_cfg.iec60958_cfg = audio->iec;
++
++      if (!(audio->iec->status[4] & IEC958_AES4_CON_MAX_WORDLEN_24) &&
++              (audio->iec->status[4] & IEC958_AES4_CON_WORDLEN_20_16))
++                      word_length_16b = true;
++
++      /* only 16-bit word length supported atm */
++      if (!word_length_16b)
++              return -EINVAL;
++
++      switch (audio->iec->status[3] & IEC958_AES3_CON_FS) {
++      case IEC958_AES3_CON_FS_32000:
++              fs_nr = 32000;
++              break;
++      case IEC958_AES3_CON_FS_44100:
++              fs_nr = 44100;
++              break;
++      case IEC958_AES3_CON_FS_48000:
++              fs_nr = 48000;
++              break;
++      case IEC958_AES3_CON_FS_88200:
++              fs_nr = 88200;
++              break;
++      case IEC958_AES3_CON_FS_96000:
++              fs_nr = 96000;
++              break;
++      case IEC958_AES3_CON_FS_176400:
++              fs_nr = 176400;
++              break;
++      case IEC958_AES3_CON_FS_192000:
++              fs_nr = 192000;
++              break;
++      default:
++              return -EINVAL;
++      }
++
++      err = hdmi_compute_acr(pclk, fs_nr, &n, &cts);
++      core_cfg.n = n;
++      core_cfg.cts = cts;
++
++      /* Audio channels settings */
++      channel_count = (audio->cea->db1_ct_cc & CEA861_AUDIO_INFOFRAME_DB1CC)
++                              + 1;
++
++      if (channel_count == 2)
++              core_cfg.layout = HDMI_AUDIO_LAYOUT_2CH;
++      else if (channel_count == 6)
++              core_cfg.layout = HDMI_AUDIO_LAYOUT_6CH;
++      else
++              core_cfg.layout = HDMI_AUDIO_LAYOUT_8CH;
++
++      /* DMA settings */
++      if (word_length_16b)
++              audio_dma.transfer_size = 0x10;
++      else
++              audio_dma.transfer_size = 0x20;
++      audio_dma.block_size = 0xC0;
++      audio_dma.mode = HDMI_AUDIO_TRANSF_DMA;
++      audio_dma.fifo_threshold = 0x20; /* in number of samples */
++
++      /* audio FIFO format settings for 16-bit samples*/
++      audio_format.samples_per_word = HDMI_AUDIO_ONEWORD_TWOSAMPLES;
++      audio_format.sample_size = HDMI_AUDIO_SAMPLE_16BITS;
++      audio_format.justification = HDMI_AUDIO_JUSTIFY_LEFT;
++
++      /* only LPCM atm */
++      audio_format.type = HDMI_AUDIO_TYPE_LPCM;
++
++      /* disable start/stop signals of IEC 60958 blocks */
++      audio_format.en_sig_blk_strt_end = HDMI_AUDIO_BLOCK_SIG_STARTEND_ON;
++
++      /* configure DMA and audio FIFO format*/
++      hdmi_wp_audio_config_dma(wp, &audio_dma);
++      hdmi_wp_audio_config_format(wp, &audio_format);
++
++      /* configure the core */
++      hdmi5_core_audio_config(core, &core_cfg);
++
++      /* configure CEA 861 audio infoframe */
++      hdmi5_core_audio_infoframe_cfg(core, audio->cea);
++
++      return 0;
++}
++#endif
++
++int hdmi5_core_init(struct platform_device *pdev, struct hdmi_core_data *core)
++{
++      struct resource *res;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hdmi_core");
++      if (!res) {
++              DSSERR("can't get CORE IORESOURCE_MEM HDMI\n");
++              return -EINVAL;
++      }
++
++      core->base = devm_request_and_ioremap(&pdev->dev, res);
++      if (!core->base) {
++              DSSERR("can't ioremap HDMI core\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi5_core.h
+@@ -0,0 +1,306 @@
++/*
++ * HDMI driver definition for TI OMAP5 processors.
++ *
++ * Copyright (C) 2011-2012 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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/>.
++ */
++
++#ifndef _HDMI5_CORE_H_
++#define _HDMI5_CORE_H_
++
++#include "hdmi.h"
++
++/* HDMI IP Core System */
++
++/* HDMI Identification */
++#define HDMI_CORE_DESIGN_ID                   0x00000
++#define HDMI_CORE_REVISION_ID                 0x00004
++#define HDMI_CORE_PRODUCT_ID0                 0x00008
++#define HDMI_CORE_PRODUCT_ID1                 0x0000C
++#define HDMI_CORE_CONFIG0_ID                  0x00010
++#define HDMI_CORE_CONFIG1_ID                  0x00014
++#define HDMI_CORE_CONFIG2_ID                  0x00018
++#define HDMI_CORE_CONFIG3_ID                  0x0001C
++
++/* HDMI Interrupt */
++#define HDMI_CORE_IH_FC_STAT0                 0x00400
++#define HDMI_CORE_IH_FC_STAT1                 0x00404
++#define HDMI_CORE_IH_FC_STAT2                 0x00408
++#define HDMI_CORE_IH_AS_STAT0                 0x0040C
++#define HDMI_CORE_IH_PHY_STAT0                        0x00410
++#define HDMI_CORE_IH_I2CM_STAT0                       0x00414
++#define HDMI_CORE_IH_CEC_STAT0                        0x00418
++#define HDMI_CORE_IH_VP_STAT0                 0x0041C
++#define HDMI_CORE_IH_I2CMPHY_STAT0            0x00420
++#define HDMI_CORE_IH_MUTE                     0x007FC
++
++/* HDMI Video Sampler */
++#define HDMI_CORE_TX_INVID0                   0x00800
++#define HDMI_CORE_TX_INSTUFFING                       0x00804
++#define HDMI_CORE_TX_RGYDATA0                 0x00808
++#define HDMI_CORE_TX_RGYDATA1                 0x0080C
++#define HDMI_CORE_TX_RCRDATA0                 0x00810
++#define HDMI_CORE_TX_RCRDATA1                 0x00814
++#define HDMI_CORE_TX_BCBDATA0                 0x00818
++#define HDMI_CORE_TX_BCBDATA1                 0x0081C
++
++/* HDMI Video Packetizer */
++#define HDMI_CORE_VP_STATUS                   0x02000
++#define HDMI_CORE_VP_PR_CD                    0x02004
++#define HDMI_CORE_VP_STUFF                    0x02008
++#define HDMI_CORE_VP_REMAP                    0x0200C
++#define HDMI_CORE_VP_CONF                     0x02010
++#define HDMI_CORE_VP_STAT                     0x02014
++#define HDMI_CORE_VP_INT                      0x02018
++#define HDMI_CORE_VP_MASK                     0x0201C
++#define HDMI_CORE_VP_POL                      0x02020
++
++/* Frame Composer */
++#define HDMI_CORE_FC_INVIDCONF                        0x04000
++#define HDMI_CORE_FC_INHACTIV0                        0x04004
++#define HDMI_CORE_FC_INHACTIV1                        0x04008
++#define HDMI_CORE_FC_INHBLANK0                        0x0400C
++#define HDMI_CORE_FC_INHBLANK1                        0x04010
++#define HDMI_CORE_FC_INVACTIV0                        0x04014
++#define HDMI_CORE_FC_INVACTIV1                        0x04018
++#define HDMI_CORE_FC_INVBLANK                 0x0401C
++#define HDMI_CORE_FC_HSYNCINDELAY0            0x04020
++#define HDMI_CORE_FC_HSYNCINDELAY1            0x04024
++#define HDMI_CORE_FC_HSYNCINWIDTH0            0x04028
++#define HDMI_CORE_FC_HSYNCINWIDTH1            0x0402C
++#define HDMI_CORE_FC_VSYNCINDELAY             0x04030
++#define HDMI_CORE_FC_VSYNCINWIDTH             0x04034
++#define HDMI_CORE_FC_INFREQ0                  0x04038
++#define HDMI_CORE_FC_INFREQ1                  0x0403C
++#define HDMI_CORE_FC_INFREQ2                  0x04040
++#define HDMI_CORE_FC_CTRLDUR                  0x04044
++#define HDMI_CORE_FC_EXCTRLDUR                        0x04048
++#define HDMI_CORE_FC_EXCTRLSPAC                       0x0404C
++#define HDMI_CORE_FC_CH0PREAM                 0x04050
++#define HDMI_CORE_FC_CH1PREAM                 0x04054
++#define HDMI_CORE_FC_CH2PREAM                 0x04058
++#define HDMI_CORE_FC_AVICONF3                 0x0405C
++#define HDMI_CORE_FC_GCP                      0x04060
++#define HDMI_CORE_FC_AVICONF0                 0x04064
++#define HDMI_CORE_FC_AVICONF1                 0x04068
++#define HDMI_CORE_FC_AVICONF2                 0x0406C
++#define HDMI_CORE_FC_AVIVID                   0x04070
++#define HDMI_CORE_FC_AVIETB0                  0x04074
++#define HDMI_CORE_FC_AVIETB1                  0x04078
++#define HDMI_CORE_FC_AVISBB0                  0x0407C
++#define HDMI_CORE_FC_AVISBB1                  0x04080
++#define HDMI_CORE_FC_AVIELB0                  0x04084
++#define HDMI_CORE_FC_AVIELB1                  0x04088
++#define HDMI_CORE_FC_AVISRB0                  0x0408C
++#define HDMI_CORE_FC_AVISRB1                  0x04090
++#define HDMI_CORE_FC_AUDICONF0                        0x04094
++#define HDMI_CORE_FC_AUDICONF1                        0x04098
++#define HDMI_CORE_FC_AUDICONF2                        0x0409C
++#define HDMI_CORE_FC_AUDICONF3                        0x040A0
++#define HDMI_CORE_FC_VSDIEEEID0                       0x040A4
++#define HDMI_CORE_FC_VSDSIZE                  0x040A8
++#define HDMI_CORE_FC_VSDIEEEID1                       0x040C0
++#define HDMI_CORE_FC_VSDIEEEID2                       0x040C4
++#define HDMI_CORE_FC_VSDPAYLOAD(n)            (n * 4 + 0x040C8)
++#define HDMI_CORE_FC_SPDVENDORNAME(n)         (n * 4 + 0x04128)
++#define HDMI_CORE_FC_SPDPRODUCTNAME(n)                (n * 4 + 0x04148)
++#define HDMI_CORE_FC_SPDDEVICEINF             0x04188
++#define HDMI_CORE_FC_AUDSCONF                 0x0418C
++#define HDMI_CORE_FC_AUDSSTAT                 0x04190
++#define HDMI_CORE_FC_AUDSV                    0x04194
++#define HDMI_CORE_FC_AUDSU                    0x04198
++#define HDMI_CORE_FC_AUDSCHNLS(n)             (n * 4 + 0x0419C)
++#define HDMI_CORE_FC_CTRLQHIGH                        0x041CC
++#define HDMI_CORE_FC_CTRLQLOW                 0x041D0
++#define HDMI_CORE_FC_ACP0                     0x041D4
++#define HDMI_CORE_FC_ACP(n)                   ((16-n) * 4 + 0x04208)
++#define HDMI_CORE_FC_ISCR1_0                  0x04248
++#define HDMI_CORE_FC_ISCR1(n)                 ((16-n) * 4 + 0x0424C)
++#define HDMI_CORE_FC_ISCR2(n)                 ((15-n) * 4 + 0x0428C)
++#define HDMI_CORE_FC_DATAUTO0                 0x042CC
++#define HDMI_CORE_FC_DATAUTO1                 0x042D0
++#define HDMI_CORE_FC_DATAUTO2                 0x042D4
++#define HDMI_CORE_FC_DATMAN                   0x042D8
++#define HDMI_CORE_FC_DATAUTO3                 0x042DC
++#define HDMI_CORE_FC_RDRB(n)                  (n * 4 + 0x042E0)
++#define HDMI_CORE_FC_STAT0                    0x04340
++#define HDMI_CORE_FC_INT0                     0x04344
++#define HDMI_CORE_FC_MASK0                    0x04348
++#define HDMI_CORE_FC_POL0                     0x0434C
++#define HDMI_CORE_FC_STAT1                    0x04350
++#define HDMI_CORE_FC_INT1                     0x04354
++#define HDMI_CORE_FC_MASK1                    0x04358
++#define HDMI_CORE_FC_POL1                     0x0435C
++#define HDMI_CORE_FC_STAT2                    0x04360
++#define HDMI_CORE_FC_INT2                     0x04364
++#define HDMI_CORE_FC_MASK2                    0x04368
++#define HDMI_CORE_FC_POL2                     0x0436C
++#define HDMI_CORE_FC_PRCONF                   0x04380
++#define HDMI_CORE_FC_GMD_STAT                 0x04400
++#define HDMI_CORE_FC_GMD_EN                   0x04404
++#define HDMI_CORE_FC_GMD_UP                   0x04408
++#define HDMI_CORE_FC_GMD_CONF                 0x0440C
++#define HDMI_CORE_FC_GMD_HB                   0x04410
++#define HDMI_CORE_FC_GMD_PB(n)                        (n * 4 + 0x04414)
++#define HDMI_CORE_FC_DBGFORCE                 0x04800
++#define HDMI_CORE_FC_DBGAUD0CH0                       0x04804
++#define HDMI_CORE_FC_DBGAUD1CH0                       0x04808
++#define HDMI_CORE_FC_DBGAUD2CH0                       0x0480C
++#define HDMI_CORE_FC_DBGAUD0CH1                       0x04810
++#define HDMI_CORE_FC_DBGAUD1CH1                       0x04814
++#define HDMI_CORE_FC_DBGAUD2CH1                       0x04818
++#define HDMI_CORE_FC_DBGAUD0CH2                       0x0481C
++#define HDMI_CORE_FC_DBGAUD1CH2                       0x04820
++#define HDMI_CORE_FC_DBGAUD2CH2                       0x04824
++#define HDMI_CORE_FC_DBGAUD0CH3                       0x04828
++#define HDMI_CORE_FC_DBGAUD1CH3                       0x0482C
++#define HDMI_CORE_FC_DBGAUD2CH3                       0x04830
++#define HDMI_CORE_FC_DBGAUD0CH4                       0x04834
++#define HDMI_CORE_FC_DBGAUD1CH4                       0x04838
++#define HDMI_CORE_FC_DBGAUD2CH4                       0x0483C
++#define HDMI_CORE_FC_DBGAUD0CH5                       0x04840
++#define HDMI_CORE_FC_DBGAUD1CH5                       0x04844
++#define HDMI_CORE_FC_DBGAUD2CH5                       0x04848
++#define HDMI_CORE_FC_DBGAUD0CH6                       0x0484C
++#define HDMI_CORE_FC_DBGAUD1CH6                       0x04850
++#define HDMI_CORE_FC_DBGAUD2CH6                       0x04854
++#define HDMI_CORE_FC_DBGAUD0CH7                       0x04858
++#define HDMI_CORE_FC_DBGAUD1CH7                       0x0485C
++#define HDMI_CORE_FC_DBGAUD2CH7                       0x04860
++#define HDMI_CORE_FC_DBGTMDS0                 0x04864
++#define HDMI_CORE_FC_DBGTMDS1                 0x04868
++#define HDMI_CORE_FC_DBGTMDS2                 0x0486C
++#define HDMI_CORE_PHY_MASK0                   0x0C018
++#define HDMI_CORE_PHY_I2CM_INT_ADDR           0x0C09C
++#define HDMI_CORE_PHY_I2CM_CTLINT_ADDR                0x0C0A0
++
++/* HDMI Audio */
++#define HDMI_CORE_AUD_CONF0                   0x0C400
++#define HDMI_CORE_AUD_CONF1                   0x0C404
++#define HDMI_CORE_AUD_INT                     0x0C408
++#define HDMI_CORE_AUD_N1                      0x0C800
++#define HDMI_CORE_AUD_N2                      0x0C804
++#define HDMI_CORE_AUD_N3                      0x0C808
++#define HDMI_CORE_AUD_CTS1                    0x0C80C
++#define HDMI_CORE_AUD_CTS2                    0x0C810
++#define HDMI_CORE_AUD_CTS3                    0x0C814
++#define HDMI_CORE_AUD_INCLKFS                 0x0C818
++#define HDMI_CORE_AUD_CC08                    0x0CC08
++#define HDMI_CORE_AUD_GP_CONF0                        0x0D400
++#define HDMI_CORE_AUD_GP_CONF1                        0x0D404
++#define HDMI_CORE_AUD_GP_CONF2                        0x0D408
++#define HDMI_CORE_AUD_D010                    0x0D010
++#define HDMI_CORE_AUD_GP_STAT                 0x0D40C
++#define HDMI_CORE_AUD_GP_INT                  0x0D410
++#define HDMI_CORE_AUD_GP_POL                  0x0D414
++#define HDMI_CORE_AUD_GP_MASK                 0x0D418
++
++/* HDMI Main Controller */
++#define HDMI_CORE_MC_CLKDIS                   0x10004
++#define HDMI_CORE_MC_SWRSTZREQ                        0x10008
++#define HDMI_CORE_MC_FLOWCTRL                 0x10010
++#define HDMI_CORE_MC_PHYRSTZ                  0x10014
++#define HDMI_CORE_MC_LOCKONCLOCK              0x10018
++
++/* HDMI COLOR SPACE CONVERTER */
++#define HDMI_CORE_CSC_CFG                     0x10400
++#define HDMI_CORE_CSC_SCALE                   0x10404
++#define HDMI_CORE_CSC_COEF_A1_MSB             0x10408
++#define HDMI_CORE_CSC_COEF_A1_LSB             0x1040C
++#define HDMI_CORE_CSC_COEF_A2_MSB             0x10410
++#define HDMI_CORE_CSC_COEF_A2_LSB             0x10414
++#define HDMI_CORE_CSC_COEF_A3_MSB             0x10418
++#define HDMI_CORE_CSC_COEF_A3_LSB             0x1041C
++#define HDMI_CORE_CSC_COEF_A4_MSB             0x10420
++#define HDMI_CORE_CSC_COEF_A4_LSB             0x10424
++#define HDMI_CORE_CSC_COEF_B1_MSB             0x10428
++#define HDMI_CORE_CSC_COEF_B1_LSB             0x1042C
++#define HDMI_CORE_CSC_COEF_B2_MSB             0x10430
++#define HDMI_CORE_CSC_COEF_B2_LSB             0x10434
++#define HDMI_CORE_CSC_COEF_B3_MSB             0x10438
++#define HDMI_CORE_CSC_COEF_B3_LSB             0x1043C
++#define HDMI_CORE_CSC_COEF_B4_MSB             0x10440
++#define HDMI_CORE_CSC_COEF_B4_LSB             0x10444
++#define HDMI_CORE_CSC_COEF_C1_MSB             0x10448
++#define HDMI_CORE_CSC_COEF_C1_LSB             0x1044C
++#define HDMI_CORE_CSC_COEF_C2_MSB             0x10450
++#define HDMI_CORE_CSC_COEF_C2_LSB             0x10454
++#define HDMI_CORE_CSC_COEF_C3_MSB             0x10458
++#define HDMI_CORE_CSC_COEF_C3_LSB             0x1045C
++#define HDMI_CORE_CSC_COEF_C4_MSB             0x10460
++#define HDMI_CORE_CSC_COEF_C4_LSB             0x10464
++
++/* HDMI HDCP */
++#define HDMI_CORE_HDCP_MASK                   0x14020
++
++/* HDMI CEC */
++#define HDMI_CORE_CEC_MASK                    0x17408
++
++/* HDMI I2C Master */
++#define HDMI_CORE_I2CM_SLAVE                  0x157C8
++#define HDMI_CORE_I2CM_ADDRESS                        0x157CC
++#define HDMI_CORE_I2CM_DATAO                  0x157D0
++#define HDMI_CORE_I2CM_DATAI                  0X157D4
++#define HDMI_CORE_I2CM_OPERATION              0x157D8
++#define HDMI_CORE_I2CM_INT                    0x157DC
++#define HDMI_CORE_I2CM_CTLINT                 0x157E0
++#define HDMI_CORE_I2CM_DIV                    0x157E4
++#define HDMI_CORE_I2CM_SEGADDR                        0x157E8
++#define HDMI_CORE_I2CM_SOFTRSTZ                       0x157EC
++#define HDMI_CORE_I2CM_SEGPTR                 0x157F0
++#define HDMI_CORE_I2CM_SS_SCL_HCNT_1_ADDR     0x157F4
++#define HDMI_CORE_I2CM_SS_SCL_HCNT_0_ADDR     0x157F8
++#define HDMI_CORE_I2CM_SS_SCL_LCNT_1_ADDR     0x157FC
++#define HDMI_CORE_I2CM_SS_SCL_LCNT_0_ADDR     0x15800
++#define HDMI_CORE_I2CM_FS_SCL_HCNT_1_ADDR     0x15804
++#define HDMI_CORE_I2CM_FS_SCL_HCNT_0_ADDR     0x15808
++#define HDMI_CORE_I2CM_FS_SCL_LCNT_1_ADDR     0x1580C
++#define HDMI_CORE_I2CM_FS_SCL_LCNT_0_ADDR     0x15810
++#define HDMI_CORE_I2CM_SDA_HOLD_ADDR          0x15814
++
++enum hdmi_core_packet_mode {
++      HDMI_PACKETMODERESERVEDVALUE = 0,
++      HDMI_PACKETMODE24BITPERPIXEL = 4,
++      HDMI_PACKETMODE30BITPERPIXEL = 5,
++      HDMI_PACKETMODE36BITPERPIXEL = 6,
++      HDMI_PACKETMODE48BITPERPIXEL = 7,
++};
++
++struct hdmi_core_vid_config {
++      struct hdmi_config v_fc_config;
++      enum hdmi_core_packet_mode packet_mode;
++      int data_enable_pol;
++      int vblank_osc;
++      int hblank;
++      int vblank;
++};
++
++struct csc_table {
++      u16 a1, a2, a3, a4;
++      u16 b1, b2, b3, b4;
++      u16 c1, c2, c3, c4;
++};
++
++int hdmi5_read_edid(struct hdmi_core_data *core, u8 *edid, int len);
++void hdmi5_core_dump(struct hdmi_core_data *core, struct seq_file *s);
++int hdmi5_core_handle_irqs(struct hdmi_core_data *core);
++void hdmi5_configure(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++                      struct hdmi_config *cfg);
++int hdmi5_core_init(struct platform_device *pdev, struct hdmi_core_data *core);
++
++#if defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++int hdmi5_audio_config(struct hdmi_core_data *core, struct hdmi_wp_data *wp,
++                      struct omap_dss_audio *audio, u32 pclk);
++#endif
++#endif
+--- a/drivers/video/omap2/dss/hdmi.c
++++ /dev/null
+@@ -1,1184 +0,0 @@
+-/*
+- * hdmi.c
+- *
+- * HDMI interface DSS driver setting for TI's OMAP4 family of processor.
+- * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
+- * Authors: Yong Zhi
+- *    Mythri pk <mythripk@ti.com>
+- *
+- * 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 "HDMI"
+-
+-#include <linux/kernel.h>
+-#include <linux/module.h>
+-#include <linux/err.h>
+-#include <linux/io.h>
+-#include <linux/interrupt.h>
+-#include <linux/mutex.h>
+-#include <linux/delay.h>
+-#include <linux/string.h>
+-#include <linux/platform_device.h>
+-#include <linux/pm_runtime.h>
+-#include <linux/clk.h>
+-#include <linux/gpio.h>
+-#include <linux/regulator/consumer.h>
+-#include <video/omapdss.h>
+-
+-#include "ti_hdmi.h"
+-#include "dss.h"
+-#include "dss_features.h"
+-
+-#define HDMI_WP                       0x0
+-#define HDMI_CORE_SYS         0x400
+-#define HDMI_CORE_AV          0x900
+-#define HDMI_PLLCTRL          0x200
+-#define HDMI_PHY              0x300
+-
+-/* HDMI EDID Length move this */
+-#define HDMI_EDID_MAX_LENGTH                  256
+-#define EDID_TIMING_DESCRIPTOR_SIZE           0x12
+-#define EDID_DESCRIPTOR_BLOCK0_ADDRESS                0x36
+-#define EDID_DESCRIPTOR_BLOCK1_ADDRESS                0x80
+-#define EDID_SIZE_BLOCK0_TIMING_DESCRIPTOR    4
+-#define EDID_SIZE_BLOCK1_TIMING_DESCRIPTOR    4
+-
+-#define HDMI_DEFAULT_REGN 16
+-#define HDMI_DEFAULT_REGM2 1
+-
+-static struct {
+-      struct mutex lock;
+-      struct platform_device *pdev;
+-
+-      struct hdmi_ip_data ip_data;
+-
+-      struct clk *sys_clk;
+-      struct regulator *vdda_hdmi_dac_reg;
+-
+-      bool core_enabled;
+-
+-      struct omap_dss_device output;
+-} hdmi;
+-
+-/*
+- * Logic for the below structure :
+- * user enters the CEA or VESA timings by specifying the HDMI/DVI code.
+- * There is a correspondence between CEA/VESA timing and code, please
+- * refer to section 6.3 in HDMI 1.3 specification for timing code.
+- *
+- * In the below structure, cea_vesa_timings corresponds to all OMAP4
+- * supported CEA and VESA timing values.code_cea corresponds to the CEA
+- * code, It is used to get the timing from cea_vesa_timing array.Similarly
+- * with code_vesa. Code_index is used for back mapping, that is once EDID
+- * is read from the TV, EDID is parsed to find the timing values and then
+- * map it to corresponding CEA or VESA index.
+- */
+-
+-static const struct hdmi_config cea_timings[] = {
+-      {
+-              { 640, 480, 25200, 96, 16, 48, 2, 10, 33,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 1, HDMI_HDMI },
+-      },
+-      {
+-              { 720, 480, 27027, 62, 16, 60, 6, 9, 30,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 2, HDMI_HDMI },
+-      },
+-      {
+-              { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 4, HDMI_HDMI },
+-      },
+-      {
+-              { 1920, 540, 74250, 44, 88, 148, 5, 2, 15,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      true, },
+-              { 5, HDMI_HDMI },
+-      },
+-      {
+-              { 1440, 240, 27027, 124, 38, 114, 3, 4, 15,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      true, },
+-              { 6, HDMI_HDMI },
+-      },
+-      {
+-              { 1920, 1080, 148500, 44, 88, 148, 5, 4, 36,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 16, HDMI_HDMI },
+-      },
+-      {
+-              { 720, 576, 27000, 64, 12, 68, 5, 5, 39,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 17, HDMI_HDMI },
+-      },
+-      {
+-              { 1280, 720, 74250, 40, 440, 220, 5, 5, 20,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 19, HDMI_HDMI },
+-      },
+-      {
+-              { 1920, 540, 74250, 44, 528, 148, 5, 2, 15,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      true, },
+-              { 20, HDMI_HDMI },
+-      },
+-      {
+-              { 1440, 288, 27000, 126, 24, 138, 3, 2, 19,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      true, },
+-              { 21, HDMI_HDMI },
+-      },
+-      {
+-              { 1440, 576, 54000, 128, 24, 136, 5, 5, 39,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 29, HDMI_HDMI },
+-      },
+-      {
+-              { 1920, 1080, 148500, 44, 528, 148, 5, 4, 36,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 31, HDMI_HDMI },
+-      },
+-      {
+-              { 1920, 1080, 74250, 44, 638, 148, 5, 4, 36,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 32, HDMI_HDMI },
+-      },
+-      {
+-              { 2880, 480, 108108, 248, 64, 240, 6, 9, 30,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 35, HDMI_HDMI },
+-      },
+-      {
+-              { 2880, 576, 108000, 256, 48, 272, 5, 5, 39,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 37, HDMI_HDMI },
+-      },
+-};
+-
+-static const struct hdmi_config vesa_timings[] = {
+-/* VESA From Here */
+-      {
+-              { 640, 480, 25175, 96, 16, 48, 2, 11, 31,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 4, HDMI_DVI },
+-      },
+-      {
+-              { 800, 600, 40000, 128, 40, 88, 4, 1, 23,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 9, HDMI_DVI },
+-      },
+-      {
+-              { 848, 480, 33750, 112, 16, 112, 8, 6, 23,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0xE, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 768, 79500, 128, 64, 192, 7, 3, 20,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x17, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 800, 83500, 128, 72, 200, 6, 3, 22,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x1C, HDMI_DVI },
+-      },
+-      {
+-              { 1360, 768, 85500, 112, 64, 256, 6, 3, 18,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x27, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 960, 108000, 112, 96, 312, 3, 1, 36,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x20, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 1024, 108000, 112, 48, 248, 3, 1, 38,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x23, HDMI_DVI },
+-      },
+-      {
+-              { 1024, 768, 65000, 136, 24, 160, 6, 3, 29,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x10, HDMI_DVI },
+-      },
+-      {
+-              { 1400, 1050, 121750, 144, 88, 232, 4, 3, 32,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x2A, HDMI_DVI },
+-      },
+-      {
+-              { 1440, 900, 106500, 152, 80, 232, 6, 3, 25,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x2F, HDMI_DVI },
+-      },
+-      {
+-              { 1680, 1050, 146250, 176 , 104, 280, 6, 3, 30,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
+-                      false, },
+-              { 0x3A, HDMI_DVI },
+-      },
+-      {
+-              { 1366, 768, 85500, 143, 70, 213, 3, 3, 24,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x51, HDMI_DVI },
+-      },
+-      {
+-              { 1920, 1080, 148500, 44, 148, 80, 5, 4, 36,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x52, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 768, 68250, 32, 48, 80, 7, 3, 12,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x16, HDMI_DVI },
+-      },
+-      {
+-              { 1400, 1050, 101000, 32, 48, 80, 4, 3, 23,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x29, HDMI_DVI },
+-      },
+-      {
+-              { 1680, 1050, 119000, 32, 48, 80, 6, 3, 21,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x39, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 800, 79500, 32, 48, 80, 6, 3, 14,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x1B, HDMI_DVI },
+-      },
+-      {
+-              { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
+-                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x55, HDMI_DVI },
+-      },
+-      {
+-              { 1920, 1200, 154000, 32, 48, 80, 6, 3, 26,
+-                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
+-                      false, },
+-              { 0x44, HDMI_DVI },
+-      },
+-};
+-
+-static int hdmi_runtime_get(void)
+-{
+-      int r;
+-
+-      DSSDBG("hdmi_runtime_get\n");
+-
+-      r = pm_runtime_get_sync(&hdmi.pdev->dev);
+-      WARN_ON(r < 0);
+-      if (r < 0)
+-              return r;
+-
+-      return 0;
+-}
+-
+-static void hdmi_runtime_put(void)
+-{
+-      int r;
+-
+-      DSSDBG("hdmi_runtime_put\n");
+-
+-      r = pm_runtime_put_sync(&hdmi.pdev->dev);
+-      WARN_ON(r < 0 && r != -ENOSYS);
+-}
+-
+-static int hdmi_init_regulator(void)
+-{
+-      struct regulator *reg;
+-
+-      if (hdmi.vdda_hdmi_dac_reg != NULL)
+-              return 0;
+-
+-      reg = devm_regulator_get(&hdmi.pdev->dev, "vdda_hdmi_dac");
+-
+-      /* DT HACK: try VDAC to make omapdss work for o4 sdp/panda */
+-      if (IS_ERR(reg))
+-              reg = devm_regulator_get(&hdmi.pdev->dev, "VDAC");
+-
+-      if (IS_ERR(reg)) {
+-              DSSERR("can't get VDDA_HDMI_DAC regulator\n");
+-              return PTR_ERR(reg);
+-      }
+-
+-      hdmi.vdda_hdmi_dac_reg = reg;
+-
+-      return 0;
+-}
+-
+-static const struct hdmi_config *hdmi_find_timing(
+-                                      const struct hdmi_config *timings_arr,
+-                                      int len)
+-{
+-      int i;
+-
+-      for (i = 0; i < len; i++) {
+-              if (timings_arr[i].cm.code == hdmi.ip_data.cfg.cm.code)
+-                      return &timings_arr[i];
+-      }
+-      return NULL;
+-}
+-
+-static const struct hdmi_config *hdmi_get_timings(void)
+-{
+-       const struct hdmi_config *arr;
+-       int len;
+-
+-       if (hdmi.ip_data.cfg.cm.mode == HDMI_DVI) {
+-               arr = vesa_timings;
+-               len = ARRAY_SIZE(vesa_timings);
+-       } else {
+-               arr = cea_timings;
+-               len = ARRAY_SIZE(cea_timings);
+-       }
+-
+-       return hdmi_find_timing(arr, len);
+-}
+-
+-static bool hdmi_timings_compare(struct omap_video_timings *timing1,
+-                              const struct omap_video_timings *timing2)
+-{
+-      int timing1_vsync, timing1_hsync, timing2_vsync, timing2_hsync;
+-
+-      if ((DIV_ROUND_CLOSEST(timing2->pixel_clock, 1000) ==
+-                      DIV_ROUND_CLOSEST(timing1->pixel_clock, 1000)) &&
+-              (timing2->x_res == timing1->x_res) &&
+-              (timing2->y_res == timing1->y_res)) {
+-
+-              timing2_hsync = timing2->hfp + timing2->hsw + timing2->hbp;
+-              timing1_hsync = timing1->hfp + timing1->hsw + timing1->hbp;
+-              timing2_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
+-              timing1_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
+-
+-              DSSDBG("timing1_hsync = %d timing1_vsync = %d"\
+-                      "timing2_hsync = %d timing2_vsync = %d\n",
+-                      timing1_hsync, timing1_vsync,
+-                      timing2_hsync, timing2_vsync);
+-
+-              if ((timing1_hsync == timing2_hsync) &&
+-                      (timing1_vsync == timing2_vsync)) {
+-                      return true;
+-              }
+-      }
+-      return false;
+-}
+-
+-static struct hdmi_cm hdmi_get_code(struct omap_video_timings *timing)
+-{
+-      int i;
+-      struct hdmi_cm cm = {-1};
+-      DSSDBG("hdmi_get_code\n");
+-
+-      for (i = 0; i < ARRAY_SIZE(cea_timings); i++) {
+-              if (hdmi_timings_compare(timing, &cea_timings[i].timings)) {
+-                      cm = cea_timings[i].cm;
+-                      goto end;
+-              }
+-      }
+-      for (i = 0; i < ARRAY_SIZE(vesa_timings); i++) {
+-              if (hdmi_timings_compare(timing, &vesa_timings[i].timings)) {
+-                      cm = vesa_timings[i].cm;
+-                      goto end;
+-              }
+-      }
+-
+-end:  return cm;
+-
+-}
+-
+-static void hdmi_compute_pll(struct omap_dss_device *dssdev, int phy,
+-              struct hdmi_pll_info *pi)
+-{
+-      unsigned long clkin, refclk;
+-      u32 mf;
+-
+-      clkin = clk_get_rate(hdmi.sys_clk) / 10000;
+-      /*
+-       * Input clock is predivided by N + 1
+-       * out put of which is reference clk
+-       */
+-
+-      pi->regn = HDMI_DEFAULT_REGN;
+-
+-      refclk = clkin / pi->regn;
+-
+-      pi->regm2 = HDMI_DEFAULT_REGM2;
+-
+-      /*
+-       * multiplier is pixel_clk/ref_clk
+-       * Multiplying by 100 to avoid fractional part removal
+-       */
+-      pi->regm = phy * pi->regm2 / refclk;
+-
+-      /*
+-       * fractional multiplier is remainder of the difference between
+-       * multiplier and actual phy(required pixel clock thus should be
+-       * multiplied by 2^18(262144) divided by the reference clock
+-       */
+-      mf = (phy - pi->regm / pi->regm2 * refclk) * 262144;
+-      pi->regmf = pi->regm2 * mf / refclk;
+-
+-      /*
+-       * Dcofreq should be set to 1 if required pixel clock
+-       * is greater than 1000MHz
+-       */
+-      pi->dcofreq = phy > 1000 * 100;
+-      pi->regsd = ((pi->regm * clkin / 10) / (pi->regn * 250) + 5) / 10;
+-
+-      /* Set the reference clock to sysclk reference */
+-      pi->refsel = HDMI_REFSEL_SYSCLK;
+-
+-      DSSDBG("M = %d Mf = %d\n", pi->regm, pi->regmf);
+-      DSSDBG("range = %d sd = %d\n", pi->dcofreq, pi->regsd);
+-}
+-
+-static int hdmi_power_on_core(struct omap_dss_device *dssdev)
+-{
+-      int r;
+-
+-      r = regulator_enable(hdmi.vdda_hdmi_dac_reg);
+-      if (r)
+-              return r;
+-
+-      r = hdmi_runtime_get();
+-      if (r)
+-              goto err_runtime_get;
+-
+-      /* Make selection of HDMI in DSS */
+-      dss_select_hdmi_venc_clk_source(DSS_HDMI_M_PCLK);
+-
+-      hdmi.core_enabled = true;
+-
+-      return 0;
+-
+-err_runtime_get:
+-      regulator_disable(hdmi.vdda_hdmi_dac_reg);
+-
+-      return r;
+-}
+-
+-static void hdmi_power_off_core(struct omap_dss_device *dssdev)
+-{
+-      hdmi.core_enabled = false;
+-
+-      hdmi_runtime_put();
+-      regulator_disable(hdmi.vdda_hdmi_dac_reg);
+-}
+-
+-static int hdmi_power_on_full(struct omap_dss_device *dssdev)
+-{
+-      int r;
+-      struct omap_video_timings *p;
+-      struct omap_overlay_manager *mgr = hdmi.output.manager;
+-      unsigned long phy;
+-
+-      r = hdmi_power_on_core(dssdev);
+-      if (r)
+-              return r;
+-
+-      dss_mgr_disable(mgr);
+-
+-      p = &hdmi.ip_data.cfg.timings;
+-
+-      DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
+-
+-      phy = p->pixel_clock;
+-
+-      hdmi_compute_pll(dssdev, phy, &hdmi.ip_data.pll_data);
+-
+-      hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
+-
+-      /* config the PLL and PHY hdmi_set_pll_pwrfirst */
+-      r = hdmi.ip_data.ops->pll_enable(&hdmi.ip_data);
+-      if (r) {
+-              DSSDBG("Failed to lock PLL\n");
+-              goto err_pll_enable;
+-      }
+-
+-      r = hdmi.ip_data.ops->phy_enable(&hdmi.ip_data);
+-      if (r) {
+-              DSSDBG("Failed to start PHY\n");
+-              goto err_phy_enable;
+-      }
+-
+-      hdmi.ip_data.ops->video_configure(&hdmi.ip_data);
+-
+-      /* bypass TV gamma table */
+-      dispc_enable_gamma_table(0);
+-
+-      /* tv size */
+-      dss_mgr_set_timings(mgr, p);
+-
+-      r = hdmi.ip_data.ops->video_enable(&hdmi.ip_data);
+-      if (r)
+-              goto err_vid_enable;
+-
+-      r = dss_mgr_enable(mgr);
+-      if (r)
+-              goto err_mgr_enable;
+-
+-      return 0;
+-
+-err_mgr_enable:
+-      hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
+-err_vid_enable:
+-      hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
+-err_phy_enable:
+-      hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
+-err_pll_enable:
+-      hdmi_power_off_core(dssdev);
+-      return -EIO;
+-}
+-
+-static void hdmi_power_off_full(struct omap_dss_device *dssdev)
+-{
+-      struct omap_overlay_manager *mgr = hdmi.output.manager;
+-
+-      dss_mgr_disable(mgr);
+-
+-      hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
+-      hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
+-      hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
+-
+-      hdmi_power_off_core(dssdev);
+-}
+-
+-static int hdmi_display_check_timing(struct omap_dss_device *dssdev,
+-                                      struct omap_video_timings *timings)
+-{
+-      struct hdmi_cm cm;
+-
+-      cm = hdmi_get_code(timings);
+-      if (cm.code == -1) {
+-              return -EINVAL;
+-      }
+-
+-      return 0;
+-
+-}
+-
+-static void hdmi_display_set_timing(struct omap_dss_device *dssdev,
+-              struct omap_video_timings *timings)
+-{
+-      struct hdmi_cm cm;
+-      const struct hdmi_config *t;
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      cm = hdmi_get_code(timings);
+-      hdmi.ip_data.cfg.cm = cm;
+-
+-      t = hdmi_get_timings();
+-      if (t != NULL) {
+-              hdmi.ip_data.cfg = *t;
+-
+-              dispc_set_tv_pclk(t->timings.pixel_clock * 1000);
+-      }
+-
+-      mutex_unlock(&hdmi.lock);
+-}
+-
+-static void hdmi_display_get_timings(struct omap_dss_device *dssdev,
+-              struct omap_video_timings *timings)
+-{
+-      const struct hdmi_config *cfg;
+-
+-      cfg = hdmi_get_timings();
+-      if (cfg == NULL)
+-              cfg = &vesa_timings[0];
+-
+-      memcpy(timings, &cfg->timings, sizeof(cfg->timings));
+-}
+-
+-static void hdmi_dump_regs(struct seq_file *s)
+-{
+-      mutex_lock(&hdmi.lock);
+-
+-      if (hdmi_runtime_get()) {
+-              mutex_unlock(&hdmi.lock);
+-              return;
+-      }
+-
+-      hdmi.ip_data.ops->dump_wrapper(&hdmi.ip_data, s);
+-      hdmi.ip_data.ops->dump_pll(&hdmi.ip_data, s);
+-      hdmi.ip_data.ops->dump_phy(&hdmi.ip_data, s);
+-      hdmi.ip_data.ops->dump_core(&hdmi.ip_data, s);
+-
+-      hdmi_runtime_put();
+-      mutex_unlock(&hdmi.lock);
+-}
+-
+-static int read_edid(u8 *buf, int len)
+-{
+-      int r;
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      r = hdmi_runtime_get();
+-      BUG_ON(r);
+-
+-      r = hdmi.ip_data.ops->read_edid(&hdmi.ip_data, buf, len);
+-
+-      hdmi_runtime_put();
+-      mutex_unlock(&hdmi.lock);
+-
+-      return r;
+-}
+-
+-static int hdmi_display_enable(struct omap_dss_device *dssdev)
+-{
+-      struct omap_dss_device *out = &hdmi.output;
+-      int r = 0;
+-
+-      DSSDBG("ENTER hdmi_display_enable\n");
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      if (out == NULL || out->manager == NULL) {
+-              DSSERR("failed to enable display: no output/manager\n");
+-              r = -ENODEV;
+-              goto err0;
+-      }
+-
+-      r = hdmi_power_on_full(dssdev);
+-      if (r) {
+-              DSSERR("failed to power on device\n");
+-              goto err0;
+-      }
+-
+-      mutex_unlock(&hdmi.lock);
+-      return 0;
+-
+-err0:
+-      mutex_unlock(&hdmi.lock);
+-      return r;
+-}
+-
+-static void hdmi_display_disable(struct omap_dss_device *dssdev)
+-{
+-      DSSDBG("Enter hdmi_display_disable\n");
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      hdmi_power_off_full(dssdev);
+-
+-      mutex_unlock(&hdmi.lock);
+-}
+-
+-static int hdmi_core_enable(struct omap_dss_device *dssdev)
+-{
+-      int r = 0;
+-
+-      DSSDBG("ENTER omapdss_hdmi_core_enable\n");
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      r = hdmi_power_on_core(dssdev);
+-      if (r) {
+-              DSSERR("failed to power on device\n");
+-              goto err0;
+-      }
+-
+-      mutex_unlock(&hdmi.lock);
+-      return 0;
+-
+-err0:
+-      mutex_unlock(&hdmi.lock);
+-      return r;
+-}
+-
+-static void hdmi_core_disable(struct omap_dss_device *dssdev)
+-{
+-      DSSDBG("Enter omapdss_hdmi_core_disable\n");
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      hdmi_power_off_core(dssdev);
+-
+-      mutex_unlock(&hdmi.lock);
+-}
+-
+-static int hdmi_get_clocks(struct platform_device *pdev)
+-{
+-      struct clk *clk;
+-
+-      clk = devm_clk_get(&pdev->dev, "sys_clk");
+-      if (IS_ERR(clk)) {
+-              DSSERR("can't get sys_clk\n");
+-              return PTR_ERR(clk);
+-      }
+-
+-      hdmi.sys_clk = clk;
+-
+-      return 0;
+-}
+-
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-int hdmi_compute_acr(u32 sample_freq, u32 *n, u32 *cts)
+-{
+-      u32 deep_color;
+-      bool deep_color_correct = false;
+-      u32 pclk = hdmi.ip_data.cfg.timings.pixel_clock;
+-
+-      if (n == NULL || cts == NULL)
+-              return -EINVAL;
+-
+-      /* TODO: When implemented, query deep color mode here. */
+-      deep_color = 100;
+-
+-      /*
+-       * When using deep color, the default N value (as in the HDMI
+-       * specification) yields to an non-integer CTS. Hence, we
+-       * modify it while keeping the restrictions described in
+-       * section 7.2.1 of the HDMI 1.4a specification.
+-       */
+-      switch (sample_freq) {
+-      case 32000:
+-      case 48000:
+-      case 96000:
+-      case 192000:
+-              if (deep_color == 125)
+-                      if (pclk == 27027 || pclk == 74250)
+-                              deep_color_correct = true;
+-              if (deep_color == 150)
+-                      if (pclk == 27027)
+-                              deep_color_correct = true;
+-              break;
+-      case 44100:
+-      case 88200:
+-      case 176400:
+-              if (deep_color == 125)
+-                      if (pclk == 27027)
+-                              deep_color_correct = true;
+-              break;
+-      default:
+-              return -EINVAL;
+-      }
+-
+-      if (deep_color_correct) {
+-              switch (sample_freq) {
+-              case 32000:
+-                      *n = 8192;
+-                      break;
+-              case 44100:
+-                      *n = 12544;
+-                      break;
+-              case 48000:
+-                      *n = 8192;
+-                      break;
+-              case 88200:
+-                      *n = 25088;
+-                      break;
+-              case 96000:
+-                      *n = 16384;
+-                      break;
+-              case 176400:
+-                      *n = 50176;
+-                      break;
+-              case 192000:
+-                      *n = 32768;
+-                      break;
+-              default:
+-                      return -EINVAL;
+-              }
+-      } else {
+-              switch (sample_freq) {
+-              case 32000:
+-                      *n = 4096;
+-                      break;
+-              case 44100:
+-                      *n = 6272;
+-                      break;
+-              case 48000:
+-                      *n = 6144;
+-                      break;
+-              case 88200:
+-                      *n = 12544;
+-                      break;
+-              case 96000:
+-                      *n = 12288;
+-                      break;
+-              case 176400:
+-                      *n = 25088;
+-                      break;
+-              case 192000:
+-                      *n = 24576;
+-                      break;
+-              default:
+-                      return -EINVAL;
+-              }
+-      }
+-      /* Calculate CTS. See HDMI 1.3a or 1.4a specifications */
+-      *cts = pclk * (*n / 128) * deep_color / (sample_freq / 10);
+-
+-      return 0;
+-}
+-
+-static bool hdmi_mode_has_audio(void)
+-{
+-      if (hdmi.ip_data.cfg.cm.mode == HDMI_HDMI)
+-              return true;
+-      else
+-              return false;
+-}
+-
+-#endif
+-
+-static int hdmi_connect(struct omap_dss_device *dssdev,
+-              struct omap_dss_device *dst)
+-{
+-      struct omap_overlay_manager *mgr;
+-      int r;
+-
+-      dss_init_hdmi_ip_ops(&hdmi.ip_data, omapdss_get_version());
+-
+-      r = hdmi_init_regulator();
+-      if (r)
+-              return r;
+-
+-      mgr = omap_dss_get_overlay_manager(dssdev->dispc_channel);
+-      if (!mgr)
+-              return -ENODEV;
+-
+-      r = dss_mgr_connect(mgr, dssdev);
+-      if (r)
+-              return r;
+-
+-      r = omapdss_output_set_device(dssdev, dst);
+-      if (r) {
+-              DSSERR("failed to connect output to new device: %s\n",
+-                              dst->name);
+-              dss_mgr_disconnect(mgr, dssdev);
+-              return r;
+-      }
+-
+-      return 0;
+-}
+-
+-static void hdmi_disconnect(struct omap_dss_device *dssdev,
+-              struct omap_dss_device *dst)
+-{
+-      WARN_ON(dst != dssdev->dst);
+-
+-      if (dst != dssdev->dst)
+-              return;
+-
+-      omapdss_output_unset_device(dssdev);
+-
+-      if (dssdev->manager)
+-              dss_mgr_disconnect(dssdev->manager, dssdev);
+-}
+-
+-static int hdmi_read_edid(struct omap_dss_device *dssdev,
+-              u8 *edid, int len)
+-{
+-      bool need_enable;
+-      int r;
+-
+-      need_enable = hdmi.core_enabled == false;
+-
+-      if (need_enable) {
+-              r = hdmi_core_enable(dssdev);
+-              if (r)
+-                      return r;
+-      }
+-
+-      r = read_edid(edid, len);
+-
+-      if (need_enable)
+-              hdmi_core_disable(dssdev);
+-
+-      return r;
+-}
+-
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-static int hdmi_audio_enable(struct omap_dss_device *dssdev)
+-{
+-      int r;
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      if (!hdmi_mode_has_audio()) {
+-              r = -EPERM;
+-              goto err;
+-      }
+-
+-
+-      r = hdmi.ip_data.ops->audio_enable(&hdmi.ip_data);
+-      if (r)
+-              goto err;
+-
+-      mutex_unlock(&hdmi.lock);
+-      return 0;
+-
+-err:
+-      mutex_unlock(&hdmi.lock);
+-      return r;
+-}
+-
+-static void hdmi_audio_disable(struct omap_dss_device *dssdev)
+-{
+-      hdmi.ip_data.ops->audio_disable(&hdmi.ip_data);
+-}
+-
+-static int hdmi_audio_start(struct omap_dss_device *dssdev)
+-{
+-      return hdmi.ip_data.ops->audio_start(&hdmi.ip_data);
+-}
+-
+-static void hdmi_audio_stop(struct omap_dss_device *dssdev)
+-{
+-      hdmi.ip_data.ops->audio_stop(&hdmi.ip_data);
+-}
+-
+-static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
+-{
+-      bool r;
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      r = hdmi_mode_has_audio();
+-
+-      mutex_unlock(&hdmi.lock);
+-      return r;
+-}
+-
+-static int hdmi_audio_config(struct omap_dss_device *dssdev,
+-              struct omap_dss_audio *audio)
+-{
+-      int r;
+-
+-      mutex_lock(&hdmi.lock);
+-
+-      if (!hdmi_mode_has_audio()) {
+-              r = -EPERM;
+-              goto err;
+-      }
+-
+-      r = hdmi.ip_data.ops->audio_config(&hdmi.ip_data, audio);
+-      if (r)
+-              goto err;
+-
+-      mutex_unlock(&hdmi.lock);
+-      return 0;
+-
+-err:
+-      mutex_unlock(&hdmi.lock);
+-      return r;
+-}
+-#else
+-static int hdmi_audio_enable(struct omap_dss_device *dssdev)
+-{
+-      return -EPERM;
+-}
+-
+-static void hdmi_audio_disable(struct omap_dss_device *dssdev)
+-{
+-}
+-
+-static int hdmi_audio_start(struct omap_dss_device *dssdev)
+-{
+-      return -EPERM;
+-}
+-
+-static void hdmi_audio_stop(struct omap_dss_device *dssdev)
+-{
+-}
+-
+-static bool hdmi_audio_supported(struct omap_dss_device *dssdev)
+-{
+-      return false;
+-}
+-
+-static int hdmi_audio_config(struct omap_dss_device *dssdev,
+-              struct omap_dss_audio *audio)
+-{
+-      return -EPERM;
+-}
+-#endif
+-
+-static const struct omapdss_hdmi_ops hdmi_ops = {
+-      .connect                = hdmi_connect,
+-      .disconnect             = hdmi_disconnect,
+-
+-      .enable                 = hdmi_display_enable,
+-      .disable                = hdmi_display_disable,
+-
+-      .check_timings          = hdmi_display_check_timing,
+-      .set_timings            = hdmi_display_set_timing,
+-      .get_timings            = hdmi_display_get_timings,
+-
+-      .read_edid              = hdmi_read_edid,
+-
+-      .audio_enable           = hdmi_audio_enable,
+-      .audio_disable          = hdmi_audio_disable,
+-      .audio_start            = hdmi_audio_start,
+-      .audio_stop             = hdmi_audio_stop,
+-      .audio_supported        = hdmi_audio_supported,
+-      .audio_config           = hdmi_audio_config,
+-};
+-
+-static void hdmi_init_output(struct platform_device *pdev)
+-{
+-      struct omap_dss_device *out = &hdmi.output;
+-
+-      out->dev = &pdev->dev;
+-      out->id = OMAP_DSS_OUTPUT_HDMI;
+-      out->output_type = OMAP_DISPLAY_TYPE_HDMI;
+-      out->name = "hdmi.0";
+-      out->dispc_channel = OMAP_DSS_CHANNEL_DIGIT;
+-      out->ops.hdmi = &hdmi_ops;
+-      out->owner = THIS_MODULE;
+-
+-      omapdss_register_output(out);
+-}
+-
+-static void __exit hdmi_uninit_output(struct platform_device *pdev)
+-{
+-      struct omap_dss_device *out = &hdmi.output;
+-
+-      omapdss_unregister_output(out);
+-}
+-
+-/* HDMI HW IP initialisation */
+-static int omapdss_hdmihw_probe(struct platform_device *pdev)
+-{
+-      struct resource *res;
+-      int r;
+-
+-      hdmi.pdev = pdev;
+-
+-      mutex_init(&hdmi.lock);
+-      mutex_init(&hdmi.ip_data.lock);
+-
+-      res = platform_get_resource(hdmi.pdev, IORESOURCE_MEM, 0);
+-
+-      /* Base address taken from platform */
+-      hdmi.ip_data.base_wp = devm_ioremap_resource(&pdev->dev, res);
+-      if (IS_ERR(hdmi.ip_data.base_wp))
+-              return PTR_ERR(hdmi.ip_data.base_wp);
+-
+-      hdmi.ip_data.irq = platform_get_irq(pdev, 0);
+-      if (hdmi.ip_data.irq < 0) {
+-              DSSERR("platform_get_irq failed\n");
+-              return -ENODEV;
+-      }
+-
+-      r = hdmi_get_clocks(pdev);
+-      if (r) {
+-              DSSERR("can't get clocks\n");
+-              return r;
+-      }
+-
+-      pm_runtime_enable(&pdev->dev);
+-
+-      hdmi.ip_data.core_sys_offset = HDMI_CORE_SYS;
+-      hdmi.ip_data.core_av_offset = HDMI_CORE_AV;
+-      hdmi.ip_data.pll_offset = HDMI_PLLCTRL;
+-      hdmi.ip_data.phy_offset = HDMI_PHY;
+-
+-      hdmi_init_output(pdev);
+-
+-      dss_debugfs_create_file("hdmi", hdmi_dump_regs);
+-
+-      return 0;
+-}
+-
+-static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
+-{
+-      hdmi_uninit_output(pdev);
+-
+-      pm_runtime_disable(&pdev->dev);
+-
+-      return 0;
+-}
+-
+-static int hdmi_runtime_suspend(struct device *dev)
+-{
+-      clk_disable_unprepare(hdmi.sys_clk);
+-
+-      dispc_runtime_put();
+-
+-      return 0;
+-}
+-
+-static int hdmi_runtime_resume(struct device *dev)
+-{
+-      int r;
+-
+-      r = dispc_runtime_get();
+-      if (r < 0)
+-              return r;
+-
+-      clk_prepare_enable(hdmi.sys_clk);
+-
+-      return 0;
+-}
+-
+-static const struct dev_pm_ops hdmi_pm_ops = {
+-      .runtime_suspend = hdmi_runtime_suspend,
+-      .runtime_resume = hdmi_runtime_resume,
+-};
+-
+-static struct platform_driver omapdss_hdmihw_driver = {
+-      .probe          = omapdss_hdmihw_probe,
+-      .remove         = __exit_p(omapdss_hdmihw_remove),
+-      .driver         = {
+-              .name   = "omapdss_hdmi",
+-              .owner  = THIS_MODULE,
+-              .pm     = &hdmi_pm_ops,
+-      },
+-};
+-
+-int __init hdmi_init_platform_driver(void)
+-{
+-      return platform_driver_register(&omapdss_hdmihw_driver);
+-}
+-
+-void __exit hdmi_uninit_platform_driver(void)
+-{
+-      platform_driver_unregister(&omapdss_hdmihw_driver);
+-}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi_common.c
+@@ -0,0 +1,423 @@
++
++/*
++ * Logic for the below structure :
++ * user enters the CEA or VESA timings by specifying the HDMI/DVI code.
++ * There is a correspondence between CEA/VESA timing and code, please
++ * refer to section 6.3 in HDMI 1.3 specification for timing code.
++ *
++ * In the below structure, cea_vesa_timings corresponds to all OMAP4
++ * supported CEA and VESA timing values.code_cea corresponds to the CEA
++ * code, It is used to get the timing from cea_vesa_timing array.Similarly
++ * with code_vesa. Code_index is used for back mapping, that is once EDID
++ * is read from the TV, EDID is parsed to find the timing values and then
++ * map it to corresponding CEA or VESA index.
++ */
++
++#include <linux/kernel.h>
++#include <linux/err.h>
++#include <video/omapdss.h>
++
++#include "hdmi.h"
++
++static const struct hdmi_config cea_timings[] = {
++      {
++              { 640, 480, 25200, 96, 16, 48, 2, 10, 33,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 1, HDMI_HDMI },
++      },
++      {
++              { 720, 480, 27027, 62, 16, 60, 6, 9, 30,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 2, HDMI_HDMI },
++      },
++      {
++              { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 4, HDMI_HDMI },
++      },
++      {
++              { 1920, 540, 74250, 44, 88, 148, 5, 2, 15,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      true, },
++              { 5, HDMI_HDMI },
++      },
++      {
++              { 1440, 240, 27027, 124, 38, 114, 3, 4, 15,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      true, },
++              { 6, HDMI_HDMI },
++      },
++      {
++              { 1920, 1080, 148500, 44, 88, 148, 5, 4, 36,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 16, HDMI_HDMI },
++      },
++      {
++              { 720, 576, 27000, 64, 12, 68, 5, 5, 39,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 17, HDMI_HDMI },
++      },
++      {
++              { 1280, 720, 74250, 40, 440, 220, 5, 5, 20,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 19, HDMI_HDMI },
++      },
++      {
++              { 1920, 540, 74250, 44, 528, 148, 5, 2, 15,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      true, },
++              { 20, HDMI_HDMI },
++      },
++      {
++              { 1440, 288, 27000, 126, 24, 138, 3, 2, 19,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      true, },
++              { 21, HDMI_HDMI },
++      },
++      {
++              { 1440, 576, 54000, 128, 24, 136, 5, 5, 39,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 29, HDMI_HDMI },
++      },
++      {
++              { 1920, 1080, 148500, 44, 528, 148, 5, 4, 36,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 31, HDMI_HDMI },
++      },
++      {
++              { 1920, 1080, 74250, 44, 638, 148, 5, 4, 36,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 32, HDMI_HDMI },
++      },
++      {
++              { 2880, 480, 108108, 248, 64, 240, 6, 9, 30,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 35, HDMI_HDMI },
++      },
++      {
++              { 2880, 576, 108000, 256, 48, 272, 5, 5, 39,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 37, HDMI_HDMI },
++      },
++};
++
++static const struct hdmi_config vesa_timings[] = {
++/* VESA From Here */
++      {
++              { 640, 480, 25175, 96, 16, 48, 2, 11, 31,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 4, HDMI_DVI },
++      },
++      {
++              { 800, 600, 40000, 128, 40, 88, 4, 1, 23,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 9, HDMI_DVI },
++      },
++      {
++              { 848, 480, 33750, 112, 16, 112, 8, 6, 23,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0xE, HDMI_DVI },
++      },
++      {
++              { 1280, 768, 79500, 128, 64, 192, 7, 3, 20,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x17, HDMI_DVI },
++      },
++      {
++              { 1280, 800, 83500, 128, 72, 200, 6, 3, 22,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x1C, HDMI_DVI },
++      },
++      {
++              { 1360, 768, 85500, 112, 64, 256, 6, 3, 18,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x27, HDMI_DVI },
++      },
++      {
++              { 1280, 960, 108000, 112, 96, 312, 3, 1, 36,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x20, HDMI_DVI },
++      },
++      {
++              { 1280, 1024, 108000, 112, 48, 248, 3, 1, 38,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x23, HDMI_DVI },
++      },
++      {
++              { 1024, 768, 65000, 136, 24, 160, 6, 3, 29,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x10, HDMI_DVI },
++      },
++      {
++              { 1400, 1050, 121750, 144, 88, 232, 4, 3, 32,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x2A, HDMI_DVI },
++      },
++      {
++              { 1440, 900, 106500, 152, 80, 232, 6, 3, 25,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x2F, HDMI_DVI },
++      },
++      {
++              { 1680, 1050, 146250, 176 , 104, 280, 6, 3, 30,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_LOW,
++                      false, },
++              { 0x3A, HDMI_DVI },
++      },
++      {
++              { 1366, 768, 85500, 143, 70, 213, 3, 3, 24,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x51, HDMI_DVI },
++      },
++      {
++              { 1920, 1080, 148500, 44, 148, 80, 5, 4, 36,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x52, HDMI_DVI },
++      },
++      {
++              { 1280, 768, 68250, 32, 48, 80, 7, 3, 12,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x16, HDMI_DVI },
++      },
++      {
++              { 1400, 1050, 101000, 32, 48, 80, 4, 3, 23,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x29, HDMI_DVI },
++      },
++      {
++              { 1680, 1050, 119000, 32, 48, 80, 6, 3, 21,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x39, HDMI_DVI },
++      },
++      {
++              { 1280, 800, 79500, 32, 48, 80, 6, 3, 14,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x1B, HDMI_DVI },
++      },
++      {
++              { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
++                      OMAPDSS_SIG_ACTIVE_HIGH, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x55, HDMI_DVI },
++      },
++      {
++              { 1920, 1200, 154000, 32, 48, 80, 6, 3, 26,
++                      OMAPDSS_SIG_ACTIVE_LOW, OMAPDSS_SIG_ACTIVE_HIGH,
++                      false, },
++              { 0x44, HDMI_DVI },
++      },
++};
++
++const struct hdmi_config *hdmi_default_timing(void)
++{
++      return &vesa_timings[0];
++}
++
++static const struct hdmi_config *hdmi_find_timing(int code,
++                      const struct hdmi_config *timings_arr, int len)
++{
++      int i;
++
++      for (i = 0; i < len; i++) {
++              if (timings_arr[i].cm.code == code)
++                      return &timings_arr[i];
++      }
++
++      return NULL;
++}
++
++const struct hdmi_config *hdmi_get_timings(int mode, int code)
++{
++      const struct hdmi_config *arr;
++      int len;
++
++      if (mode == HDMI_DVI) {
++              arr = vesa_timings;
++              len = ARRAY_SIZE(vesa_timings);
++      } else {
++              arr = cea_timings;
++              len = ARRAY_SIZE(cea_timings);
++      }
++
++      return hdmi_find_timing(code, arr, len);
++}
++
++static bool hdmi_timings_compare(struct omap_video_timings *timing1,
++                      const struct omap_video_timings *timing2)
++{
++      int timing1_vsync, timing1_hsync, timing2_vsync, timing2_hsync;
++
++      if ((DIV_ROUND_CLOSEST(timing2->pixel_clock, 1000) ==
++                      DIV_ROUND_CLOSEST(timing1->pixel_clock, 1000)) &&
++              (timing2->x_res == timing1->x_res) &&
++              (timing2->y_res == timing1->y_res)) {
++
++              timing2_hsync = timing2->hfp + timing2->hsw + timing2->hbp;
++              timing1_hsync = timing1->hfp + timing1->hsw + timing1->hbp;
++              timing2_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
++              timing1_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
++
++              DSSDBG("timing1_hsync = %d timing1_vsync = %d"\
++                      "timing2_hsync = %d timing2_vsync = %d\n",
++                      timing1_hsync, timing1_vsync,
++                      timing2_hsync, timing2_vsync);
++
++              if ((timing1_hsync == timing2_hsync) &&
++                      (timing1_vsync == timing2_vsync)) {
++                      return true;
++              }
++      }
++      return false;
++}
++
++struct hdmi_cm hdmi_get_code(struct omap_video_timings *timing)
++{
++      int i;
++      struct hdmi_cm cm = {-1};
++      DSSDBG("hdmi_get_code\n");
++
++      for (i = 0; i < ARRAY_SIZE(cea_timings); i++) {
++              if (hdmi_timings_compare(timing, &cea_timings[i].timings)) {
++                      cm = cea_timings[i].cm;
++                      goto end;
++              }
++      }
++      for (i = 0; i < ARRAY_SIZE(vesa_timings); i++) {
++              if (hdmi_timings_compare(timing, &vesa_timings[i].timings)) {
++                      cm = vesa_timings[i].cm;
++                      goto end;
++              }
++      }
++
++end:
++      return cm;
++}
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
++int hdmi_compute_acr(u32 pclk, u32 sample_freq, u32 *n, u32 *cts)
++{
++      u32 deep_color;
++      bool deep_color_correct = false;
++
++      if (n == NULL || cts == NULL)
++              return -EINVAL;
++
++      /* TODO: When implemented, query deep color mode here. */
++      deep_color = 100;
++
++      /*
++       * When using deep color, the default N value (as in the HDMI
++       * specification) yields to an non-integer CTS. Hence, we
++       * modify it while keeping the restrictions described in
++       * section 7.2.1 of the HDMI 1.4a specification.
++       */
++      switch (sample_freq) {
++      case 32000:
++      case 48000:
++      case 96000:
++      case 192000:
++              if (deep_color == 125)
++                      if (pclk == 27027 || pclk == 74250)
++                              deep_color_correct = true;
++              if (deep_color == 150)
++                      if (pclk == 27027)
++                              deep_color_correct = true;
++              break;
++      case 44100:
++      case 88200:
++      case 176400:
++              if (deep_color == 125)
++                      if (pclk == 27027)
++                              deep_color_correct = true;
++              break;
++      default:
++              return -EINVAL;
++      }
++
++      if (deep_color_correct) {
++              switch (sample_freq) {
++              case 32000:
++                      *n = 8192;
++                      break;
++              case 44100:
++                      *n = 12544;
++                      break;
++              case 48000:
++                      *n = 8192;
++                      break;
++              case 88200:
++                      *n = 25088;
++                      break;
++              case 96000:
++                      *n = 16384;
++                      break;
++              case 176400:
++                      *n = 50176;
++                      break;
++              case 192000:
++                      *n = 32768;
++                      break;
++              default:
++                      return -EINVAL;
++              }
++      } else {
++              switch (sample_freq) {
++              case 32000:
++                      *n = 4096;
++                      break;
++              case 44100:
++                      *n = 6272;
++                      break;
++              case 48000:
++                      *n = 6144;
++                      break;
++              case 88200:
++                      *n = 12544;
++                      break;
++              case 96000:
++                      *n = 12288;
++                      break;
++              case 176400:
++                      *n = 25088;
++                      break;
++              case 192000:
++                      *n = 24576;
++                      break;
++              default:
++                      return -EINVAL;
++              }
++      }
++      /* Calculate CTS. See HDMI 1.3a or 1.4a specifications */
++      *cts = pclk * (*n / 128) * deep_color / (sample_freq / 10);
++
++      return 0;
++}
++#endif
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi.h
+@@ -0,0 +1,441 @@
++/*
++ * HDMI driver definition for TI OMAP4 Processor.
++ *
++ * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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/>.
++ */
++
++#ifndef _HDMI_H
++#define _HDMI_H
++
++#include <linux/delay.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <video/omapdss.h>
++
++#include "dss.h"
++
++/* HDMI Wrapper */
++
++#define HDMI_WP_REVISION                      0x0
++#define HDMI_WP_SYSCONFIG                     0x10
++#define HDMI_WP_IRQSTATUS_RAW                 0x24
++#define HDMI_WP_IRQSTATUS                     0x28
++#define HDMI_WP_IRQENABLE_SET                 0x2C
++#define HDMI_WP_IRQENABLE_CLR                 0x30
++#define HDMI_WP_IRQWAKEEN                     0x34
++#define HDMI_WP_PWR_CTRL                      0x40
++#define HDMI_WP_DEBOUNCE                      0x44
++#define HDMI_WP_VIDEO_CFG                     0x50
++#define HDMI_WP_VIDEO_SIZE                    0x60
++#define HDMI_WP_VIDEO_TIMING_H                        0x68
++#define HDMI_WP_VIDEO_TIMING_V                        0x6C
++#define HDMI_WP_CLK                           0x70
++#define HDMI_WP_AUDIO_CFG                     0x80
++#define HDMI_WP_AUDIO_CFG2                    0x84
++#define HDMI_WP_AUDIO_CTRL                    0x88
++#define HDMI_WP_AUDIO_DATA                    0x8C
++
++/* HDMI WP IRQ flags */
++#define HDMI_IRQ_CORE                         (1 << 0)
++#define HDMI_IRQ_OCP_TIMEOUT                  (1 << 4)
++#define HDMI_IRQ_AUDIO_FIFO_UNDERFLOW         (1 << 8)
++#define HDMI_IRQ_AUDIO_FIFO_OVERFLOW          (1 << 9)
++#define HDMI_IRQ_AUDIO_FIFO_SAMPLE_REQ                (1 << 10)
++#define HDMI_IRQ_VIDEO_VSYNC                  (1 << 16)
++#define HDMI_IRQ_VIDEO_FRAME_DONE             (1 << 17)
++#define HDMI_IRQ_PHY_LINE5V_ASSERT            (1 << 24)
++#define HDMI_IRQ_LINK_CONNECT                 (1 << 25)
++#define HDMI_IRQ_LINK_DISCONNECT              (1 << 26)
++#define HDMI_IRQ_PLL_LOCK                     (1 << 29)
++#define HDMI_IRQ_PLL_UNLOCK                   (1 << 30)
++#define HDMI_IRQ_PLL_RECAL                    (1 << 31)
++
++/* HDMI PLL */
++
++#define PLLCTRL_PLL_CONTROL                   0x0
++#define PLLCTRL_PLL_STATUS                    0x4
++#define PLLCTRL_PLL_GO                                0x8
++#define PLLCTRL_CFG1                          0xC
++#define PLLCTRL_CFG2                          0x10
++#define PLLCTRL_CFG3                          0x14
++#define PLLCTRL_SSC_CFG1                      0x18
++#define PLLCTRL_SSC_CFG2                      0x1C
++#define PLLCTRL_CFG4                          0x20
++
++/* HDMI PHY */
++
++#define HDMI_TXPHY_TX_CTRL                    0x0
++#define HDMI_TXPHY_DIGITAL_CTRL                       0x4
++#define HDMI_TXPHY_POWER_CTRL                 0x8
++#define HDMI_TXPHY_PAD_CFG_CTRL                       0xC
++#define HDMI_TXPHY_BIST_CONTROL                       0x1C
++
++enum hdmi_pll_pwr {
++      HDMI_PLLPWRCMD_ALLOFF = 0,
++      HDMI_PLLPWRCMD_PLLONLY = 1,
++      HDMI_PLLPWRCMD_BOTHON_ALLCLKS = 2,
++      HDMI_PLLPWRCMD_BOTHON_NOPHYCLK = 3
++};
++
++enum hdmi_phy_pwr {
++      HDMI_PHYPWRCMD_OFF = 0,
++      HDMI_PHYPWRCMD_LDOON = 1,
++      HDMI_PHYPWRCMD_TXON = 2
++};
++
++enum hdmi_core_hdmi_dvi {
++      HDMI_DVI = 0,
++      HDMI_HDMI = 1
++};
++
++enum hdmi_clk_refsel {
++      HDMI_REFSEL_PCLK = 0,
++      HDMI_REFSEL_REF1 = 1,
++      HDMI_REFSEL_REF2 = 2,
++      HDMI_REFSEL_SYSCLK = 3
++};
++
++enum hdmi_packing_mode {
++      HDMI_PACK_10b_RGB_YUV444 = 0,
++      HDMI_PACK_24b_RGB_YUV444_YUV422 = 1,
++      HDMI_PACK_20b_YUV422 = 2,
++      HDMI_PACK_ALREADYPACKED = 7
++};
++
++enum hdmi_stereo_channels {
++      HDMI_AUDIO_STEREO_NOCHANNELS = 0,
++      HDMI_AUDIO_STEREO_ONECHANNEL = 1,
++      HDMI_AUDIO_STEREO_TWOCHANNELS = 2,
++      HDMI_AUDIO_STEREO_THREECHANNELS = 3,
++      HDMI_AUDIO_STEREO_FOURCHANNELS = 4
++};
++
++enum hdmi_audio_type {
++      HDMI_AUDIO_TYPE_LPCM = 0,
++      HDMI_AUDIO_TYPE_IEC = 1
++};
++
++enum hdmi_audio_justify {
++      HDMI_AUDIO_JUSTIFY_LEFT = 0,
++      HDMI_AUDIO_JUSTIFY_RIGHT = 1
++};
++
++enum hdmi_audio_sample_order {
++      HDMI_AUDIO_SAMPLE_RIGHT_FIRST = 0,
++      HDMI_AUDIO_SAMPLE_LEFT_FIRST = 1
++};
++
++enum hdmi_audio_samples_perword {
++      HDMI_AUDIO_ONEWORD_ONESAMPLE = 0,
++      HDMI_AUDIO_ONEWORD_TWOSAMPLES = 1
++};
++
++enum hdmi_audio_sample_size {
++      HDMI_AUDIO_SAMPLE_16BITS = 0,
++      HDMI_AUDIO_SAMPLE_24BITS = 1
++};
++
++enum hdmi_audio_transf_mode {
++      HDMI_AUDIO_TRANSF_DMA = 0,
++      HDMI_AUDIO_TRANSF_IRQ = 1
++};
++
++enum hdmi_audio_blk_strt_end_sig {
++      HDMI_AUDIO_BLOCK_SIG_STARTEND_ON = 0,
++      HDMI_AUDIO_BLOCK_SIG_STARTEND_OFF = 1
++};
++
++enum hdmi_core_audio_layout {
++      HDMI_AUDIO_LAYOUT_2CH = 0,
++      HDMI_AUDIO_LAYOUT_8CH = 1
++};
++
++enum hdmi_core_cts_mode {
++      HDMI_AUDIO_CTS_MODE_HW = 0,
++      HDMI_AUDIO_CTS_MODE_SW = 1
++};
++
++enum hdmi_audio_mclk_mode {
++      HDMI_AUDIO_MCLK_128FS = 0,
++      HDMI_AUDIO_MCLK_256FS = 1,
++      HDMI_AUDIO_MCLK_384FS = 2,
++      HDMI_AUDIO_MCLK_512FS = 3,
++      HDMI_AUDIO_MCLK_768FS = 4,
++      HDMI_AUDIO_MCLK_1024FS = 5,
++      HDMI_AUDIO_MCLK_1152FS = 6,
++      HDMI_AUDIO_MCLK_192FS = 7
++};
++
++/* INFOFRAME_AVI_ and INFOFRAME_AUDIO_ definitions */
++enum hdmi_core_infoframe {
++      HDMI_INFOFRAME_AVI_DB1Y_RGB = 0,
++      HDMI_INFOFRAME_AVI_DB1Y_YUV422 = 1,
++      HDMI_INFOFRAME_AVI_DB1Y_YUV444 = 2,
++      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_OFF = 0,
++      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_ON =  1,
++      HDMI_INFOFRAME_AVI_DB1B_NO = 0,
++      HDMI_INFOFRAME_AVI_DB1B_VERT = 1,
++      HDMI_INFOFRAME_AVI_DB1B_HORI = 2,
++      HDMI_INFOFRAME_AVI_DB1B_VERTHORI = 3,
++      HDMI_INFOFRAME_AVI_DB1S_0 = 0,
++      HDMI_INFOFRAME_AVI_DB1S_1 = 1,
++      HDMI_INFOFRAME_AVI_DB1S_2 = 2,
++      HDMI_INFOFRAME_AVI_DB2C_NO = 0,
++      HDMI_INFOFRAME_AVI_DB2C_ITU601 = 1,
++      HDMI_INFOFRAME_AVI_DB2C_ITU709 = 2,
++      HDMI_INFOFRAME_AVI_DB2C_EC_EXTENDED = 3,
++      HDMI_INFOFRAME_AVI_DB2M_NO = 0,
++      HDMI_INFOFRAME_AVI_DB2M_43 = 1,
++      HDMI_INFOFRAME_AVI_DB2M_169 = 2,
++      HDMI_INFOFRAME_AVI_DB2R_SAME = 8,
++      HDMI_INFOFRAME_AVI_DB2R_43 = 9,
++      HDMI_INFOFRAME_AVI_DB2R_169 = 10,
++      HDMI_INFOFRAME_AVI_DB2R_149 = 11,
++      HDMI_INFOFRAME_AVI_DB3ITC_NO = 0,
++      HDMI_INFOFRAME_AVI_DB3ITC_YES = 1,
++      HDMI_INFOFRAME_AVI_DB3EC_XVYUV601 = 0,
++      HDMI_INFOFRAME_AVI_DB3EC_XVYUV709 = 1,
++      HDMI_INFOFRAME_AVI_DB3Q_DEFAULT = 0,
++      HDMI_INFOFRAME_AVI_DB3Q_LR = 1,
++      HDMI_INFOFRAME_AVI_DB3Q_FR = 2,
++      HDMI_INFOFRAME_AVI_DB3SC_NO = 0,
++      HDMI_INFOFRAME_AVI_DB3SC_HORI = 1,
++      HDMI_INFOFRAME_AVI_DB3SC_VERT = 2,
++      HDMI_INFOFRAME_AVI_DB3SC_HORIVERT = 3,
++      HDMI_INFOFRAME_AVI_DB5PR_NO = 0,
++      HDMI_INFOFRAME_AVI_DB5PR_2 = 1,
++      HDMI_INFOFRAME_AVI_DB5PR_3 = 2,
++      HDMI_INFOFRAME_AVI_DB5PR_4 = 3,
++      HDMI_INFOFRAME_AVI_DB5PR_5 = 4,
++      HDMI_INFOFRAME_AVI_DB5PR_6 = 5,
++      HDMI_INFOFRAME_AVI_DB5PR_7 = 6,
++      HDMI_INFOFRAME_AVI_DB5PR_8 = 7,
++      HDMI_INFOFRAME_AVI_DB5PR_9 = 8,
++      HDMI_INFOFRAME_AVI_DB5PR_10 = 9,
++};
++
++struct hdmi_cm {
++      int     code;
++      int     mode;
++};
++
++struct hdmi_video_format {
++      enum hdmi_packing_mode  packing_mode;
++      u32                     y_res;  /* Line per panel */
++      u32                     x_res;  /* pixel per line */
++};
++
++struct hdmi_config {
++      struct omap_video_timings timings;
++      struct hdmi_cm cm;
++};
++
++/* HDMI PLL structure */
++struct hdmi_pll_info {
++      u16 regn;
++      u16 regm;
++      u32 regmf;
++      u16 regm2;
++      u16 regsd;
++      u16 dcofreq;
++      enum hdmi_clk_refsel refsel;
++};
++
++struct hdmi_audio_format {
++      enum hdmi_stereo_channels               stereo_channels;
++      u8                                      active_chnnls_msk;
++      enum hdmi_audio_type                    type;
++      enum hdmi_audio_justify                 justification;
++      enum hdmi_audio_sample_order            sample_order;
++      enum hdmi_audio_samples_perword         samples_per_word;
++      enum hdmi_audio_sample_size             sample_size;
++      enum hdmi_audio_blk_strt_end_sig        en_sig_blk_strt_end;
++};
++
++struct hdmi_audio_dma {
++      u8                              transfer_size;
++      u8                              block_size;
++      enum hdmi_audio_transf_mode     mode;
++      u16                             fifo_threshold;
++};
++
++struct hdmi_core_audio_i2s_config {
++      u8 in_length_bits;
++      u8 justification;
++      u8 sck_edge_mode;
++      u8 vbit;
++      u8 direction;
++      u8 shift;
++      u8 active_sds;
++};
++
++struct hdmi_core_audio_config {
++      struct hdmi_core_audio_i2s_config       i2s_cfg;
++      struct snd_aes_iec958                   *iec60958_cfg;
++      bool                                    fs_override;
++      u32                                     n;
++      u32                                     cts;
++      u32                                     aud_par_busclk;
++      enum hdmi_core_audio_layout             layout;
++      enum hdmi_core_cts_mode                 cts_mode;
++      bool                                    use_mclk;
++      enum hdmi_audio_mclk_mode               mclk_mode;
++      bool                                    en_acr_pkt;
++      bool                                    en_dsd_audio;
++      bool                                    en_parallel_aud_input;
++      bool                                    en_spdif;
++};
++
++/*
++ * Refer to section 8.2 in HDMI 1.3 specification for
++ * details about infoframe databytes
++ */
++struct hdmi_core_infoframe_avi {
++      /* Y0, Y1 rgb,yCbCr */
++      u8      db1_format;
++      /* A0  Active information Present */
++      u8      db1_active_info;
++      /* B0, B1 Bar info data valid */
++      u8      db1_bar_info_dv;
++      /* S0, S1 scan information */
++      u8      db1_scan_info;
++      /* C0, C1 colorimetry */
++      u8      db2_colorimetry;
++      /* M0, M1 Aspect ratio (4:3, 16:9) */
++      u8      db2_aspect_ratio;
++      /* R0...R3 Active format aspect ratio */
++      u8      db2_active_fmt_ar;
++      /* ITC IT content. */
++      u8      db3_itc;
++      /* EC0, EC1, EC2 Extended colorimetry */
++      u8      db3_ec;
++      /* Q1, Q0 Quantization range */
++      u8      db3_q_range;
++      /* SC1, SC0 Non-uniform picture scaling */
++      u8      db3_nup_scaling;
++      /* VIC0..6 Video format identification */
++      u8      db4_videocode;
++      /* PR0..PR3 Pixel repetition factor */
++      u8      db5_pixel_repeat;
++      /* Line number end of top bar */
++      u16     db6_7_line_eoftop;
++      /* Line number start of bottom bar */
++      u16     db8_9_line_sofbottom;
++      /* Pixel number end of left bar */
++      u16     db10_11_pixel_eofleft;
++      /* Pixel number start of right bar */
++      u16     db12_13_pixel_sofright;
++};
++
++struct hdmi_wp_data {
++      void __iomem *base;
++};
++
++struct hdmi_pll_data {
++      void __iomem *base;
++
++      struct hdmi_pll_info info;
++};
++
++struct hdmi_phy_data {
++      void __iomem *base;
++};
++
++struct hdmi_core_data {
++      void __iomem *base;
++
++      struct hdmi_core_infoframe_avi avi_cfg;
++};
++
++static inline void hdmi_write_reg(void __iomem *base_addr, const u32 idx,
++              u32 val)
++{
++      __raw_writel(val, base_addr + idx);
++}
++
++static inline u32 hdmi_read_reg(void __iomem *base_addr, const u32 idx)
++{
++      return __raw_readl(base_addr + idx);
++}
++
++#define REG_FLD_MOD(base, idx, val, start, end) \
++      hdmi_write_reg(base, idx, FLD_MOD(hdmi_read_reg(base, idx),\
++                                                      val, start, end))
++#define REG_GET(base, idx, start, end) \
++      FLD_GET(hdmi_read_reg(base, idx), start, end)
++
++static inline int hdmi_wait_for_bit_change(void __iomem *base_addr,
++              const u32 idx, int b2, int b1, u32 val)
++{
++      u32 t = 0, v;
++      while (val != (v = REG_GET(base_addr, idx, b2, b1))) {
++              if (t++ > 10000)
++                      return v;
++              udelay(1);
++      }
++      return v;
++}
++
++/* HDMI wrapper funcs */
++int hdmi_wp_video_start(struct hdmi_wp_data *wp);
++void hdmi_wp_video_stop(struct hdmi_wp_data *wp);
++void hdmi_wp_dump(struct hdmi_wp_data *wp, struct seq_file *s);
++u32 hdmi_wp_get_irqstatus(struct hdmi_wp_data *wp);
++void hdmi_wp_set_irqstatus(struct hdmi_wp_data *wp, u32 irqstatus);
++void hdmi_wp_set_irqenable(struct hdmi_wp_data *wp, u32 mask);
++void hdmi_wp_clear_irqenable(struct hdmi_wp_data *wp, u32 mask);
++int hdmi_wp_set_phy_pwr(struct hdmi_wp_data *wp, enum hdmi_phy_pwr val);
++int hdmi_wp_set_pll_pwr(struct hdmi_wp_data *wp, enum hdmi_pll_pwr val);
++void hdmi_wp_video_config_format(struct hdmi_wp_data *wp,
++              struct hdmi_video_format *video_fmt);
++void hdmi_wp_video_config_interface(struct hdmi_wp_data *wp,
++              struct omap_video_timings *timings);
++void hdmi_wp_video_config_timing(struct hdmi_wp_data *wp,
++              struct omap_video_timings *timings);
++void hdmi_wp_init_vid_fmt_timings(struct hdmi_video_format *video_fmt,
++              struct omap_video_timings *timings, struct hdmi_config *param);
++int hdmi_wp_init(struct platform_device *pdev, struct hdmi_wp_data *wp);
++
++/* HDMI PLL funcs */
++int hdmi_pll_enable(struct hdmi_pll_data *pll, struct hdmi_wp_data *wp);
++void hdmi_pll_disable(struct hdmi_pll_data *pll, struct hdmi_wp_data *wp);
++void hdmi_pll_dump(struct hdmi_pll_data *pll, struct seq_file *s);
++void hdmi_pll_compute(struct hdmi_pll_data *pll, unsigned long clkin, int phy);
++int hdmi_pll_init(struct platform_device *pdev, struct hdmi_pll_data *pll);
++
++/* HDMI PHY funcs */
++int hdmi_phy_configure(struct hdmi_phy_data *phy, struct hdmi_config *cfg);
++void hdmi_phy_dump(struct hdmi_phy_data *phy, struct seq_file *s);
++int hdmi_phy_init(struct platform_device *pdev, struct hdmi_phy_data *phy);
++
++/* HDMI common funcs */
++const struct hdmi_config *hdmi_default_timing(void);
++const struct hdmi_config *hdmi_get_timings(int mode, int code);
++struct hdmi_cm hdmi_get_code(struct omap_video_timings *timing);
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO) || defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++int hdmi_compute_acr(u32 pclk, u32 sample_freq, u32 *n, u32 *cts);
++int hdmi_wp_audio_enable(struct hdmi_wp_data *wp, bool enable);
++int hdmi_wp_audio_core_req_enable(struct hdmi_wp_data *wp, bool enable);
++void hdmi_wp_audio_config_format(struct hdmi_wp_data *wp,
++              struct hdmi_audio_format *aud_fmt);
++void hdmi_wp_audio_config_dma(struct hdmi_wp_data *wp,
++              struct hdmi_audio_dma *aud_dma);
++static inline bool hdmi_mode_has_audio(int mode)
++{
++      return mode == HDMI_HDMI ? true : false;
++}
++#endif
++#endif
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi_phy.c
+@@ -0,0 +1,167 @@
++/*
++ * HDMI PHY
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <linux/slab.h>
++#include <video/omapdss.h>
++
++#include "dss.h"
++#include "hdmi.h"
++
++struct hdmi_phy_features {
++      bool bist_ctrl;
++      bool calc_freqout;
++      bool ldo_voltage;
++      unsigned long dcofreq_min;      /* in KHz */
++      unsigned long max_phy;          /* in KHz */
++};
++
++static const struct hdmi_phy_features *phy_feat;
++
++void hdmi_phy_dump(struct hdmi_phy_data *phy, struct seq_file *s)
++{
++#define DUMPPHY(r) seq_printf(s, "%-35s %08x\n", #r,\
++              hdmi_read_reg(phy->base, r))
++
++      DUMPPHY(HDMI_TXPHY_TX_CTRL);
++      DUMPPHY(HDMI_TXPHY_DIGITAL_CTRL);
++      DUMPPHY(HDMI_TXPHY_POWER_CTRL);
++      DUMPPHY(HDMI_TXPHY_PAD_CFG_CTRL);
++      if (phy_feat->bist_ctrl)
++              DUMPPHY(HDMI_TXPHY_BIST_CONTROL);
++}
++
++int hdmi_phy_configure(struct hdmi_phy_data *phy, struct hdmi_config *cfg)
++{
++      u8 freqout;
++
++      /*
++       * Read address 0 in order to get the SCP reset done completed
++       * Dummy access performed to make sure reset is done
++       */
++      hdmi_read_reg(phy->base, HDMI_TXPHY_TX_CTRL);
++
++      /*
++       * In OMAP5+, the HFBITCLK must be divided by 2 before issuing the
++       * HDMI_PHYPWRCMD_LDOON command.
++      */
++      if (phy_feat->bist_ctrl)
++              REG_FLD_MOD(phy->base, HDMI_TXPHY_BIST_CONTROL, 1, 11, 11);
++
++      if (phy_feat->calc_freqout) {
++              /* DCOCLK/10 is pixel clock, compare pclk with DCOCLK_MIN/10 */
++              u32 dco_min = phy_feat->dcofreq_min / 10;
++              u32 pclk = cfg->timings.pixel_clock;
++
++              if (pclk < dco_min) {
++                      freqout = 0;
++              } else if ((pclk >= dco_min) && (pclk < phy_feat->max_phy)) {
++                      freqout = 1;
++              } else {
++                      freqout = 2;
++              }
++      } else {
++              freqout = 1;
++      }
++
++      /*
++       * Write to phy address 0 to configure the clock
++       * use HFBITCLK write HDMI_TXPHY_TX_CONTROL_FREQOUT field
++       */
++      REG_FLD_MOD(phy->base, HDMI_TXPHY_TX_CTRL, freqout, 31, 30);
++
++      /* Write to phy address 1 to start HDMI line (TXVALID and TMDSCLKEN) */
++      hdmi_write_reg(phy->base, HDMI_TXPHY_DIGITAL_CTRL, 0xF0000000);
++
++      /* Setup max LDO voltage */
++      if (phy_feat->ldo_voltage)
++              REG_FLD_MOD(phy->base, HDMI_TXPHY_POWER_CTRL, 0xB, 3, 0);
++
++      /* Write to phy address 3 to change the polarity control */
++      REG_FLD_MOD(phy->base, HDMI_TXPHY_PAD_CFG_CTRL, 0x1, 27, 27);
++
++      return 0;
++}
++
++static const struct hdmi_phy_features omap44xx_phy_feats = {
++      .bist_ctrl      =       false,
++      .calc_freqout   =       false,
++      .ldo_voltage    =       true,
++      .dcofreq_min    =       500000,
++      .max_phy        =       185675,
++};
++
++static const struct hdmi_phy_features omap54xx_phy_feats = {
++      .bist_ctrl      =       true,
++      .calc_freqout   =       true,
++      .ldo_voltage    =       false,
++      .dcofreq_min    =       750000,
++      .max_phy        =       186000,
++};
++
++static int hdmi_phy_init_features(struct platform_device *pdev)
++{
++      struct hdmi_phy_features *dst;
++      const struct hdmi_phy_features *src;
++
++      dst = devm_kzalloc(&pdev->dev, sizeof(*dst), GFP_KERNEL);
++      if (!dst) {
++              dev_err(&pdev->dev, "Failed to allocate HDMI PHY Features\n");
++              return -ENOMEM;
++      }
++
++      switch (omapdss_get_version()) {
++      case OMAPDSS_VER_OMAP4430_ES1:
++      case OMAPDSS_VER_OMAP4430_ES2:
++      case OMAPDSS_VER_OMAP4:
++              src = &omap44xx_phy_feats;
++              break;
++
++      case OMAPDSS_VER_OMAP5:
++      case OMAPDSS_VER_DRA7xx:
++              src = &omap54xx_phy_feats;
++              break;
++
++      default:
++              return -ENODEV;
++      }
++
++      memcpy(dst, src, sizeof(*dst));
++      phy_feat = dst;
++
++      return 0;
++}
++
++int hdmi_phy_init(struct platform_device *pdev, struct hdmi_phy_data *phy)
++{
++      int r;
++      struct resource *res;
++
++      r = hdmi_phy_init_features(pdev);
++      if (r)
++              return r;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hdmi_txphy");
++      if (!res) {
++              DSSERR("can't get PLL CTRL IORESOURCE_MEM HDMI\n");
++              return -EINVAL;
++      }
++
++      phy->base = devm_request_and_ioremap(&pdev->dev, res);
++      if (!phy->base) {
++              DSSERR("can't ioremap PLL ctrl\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi_pll.c
+@@ -0,0 +1,315 @@
++/*
++ * HDMI PLL
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/module.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <video/omapdss.h>
++
++#include "dss.h"
++#include "hdmi.h"
++
++#define HDMI_DEFAULT_REGN 16
++#define HDMI_DEFAULT_REGM2 1
++
++struct hdmi_pll_features {
++      bool sys_reset;
++      /* this is a hack, need to replace it with a better computation of M2 */
++      bool bound_dcofreq;
++      bool ext_mux_ctrl;
++
++      unsigned long fint_min, fint_max;
++      u16 regm_max;
++      unsigned long dcofreq_low_min, dcofreq_low_max;
++      unsigned long dcofreq_high_min, dcofreq_high_max;
++};
++
++static const struct hdmi_pll_features *pll_feat;
++
++void hdmi_pll_dump(struct hdmi_pll_data *pll, struct seq_file *s)
++{
++#define DUMPPLL(r) seq_printf(s, "%-35s %08x\n", #r,\
++              hdmi_read_reg(pll->base, r))
++
++      DUMPPLL(PLLCTRL_PLL_CONTROL);
++      DUMPPLL(PLLCTRL_PLL_STATUS);
++      DUMPPLL(PLLCTRL_PLL_GO);
++      DUMPPLL(PLLCTRL_CFG1);
++      DUMPPLL(PLLCTRL_CFG2);
++      DUMPPLL(PLLCTRL_CFG3);
++      DUMPPLL(PLLCTRL_SSC_CFG1);
++      DUMPPLL(PLLCTRL_SSC_CFG2);
++      DUMPPLL(PLLCTRL_CFG4);
++}
++
++void hdmi_pll_compute(struct hdmi_pll_data *pll, unsigned long clkin, int phy)
++{
++      struct hdmi_pll_info *pi = &pll->info;
++      unsigned long refclk;
++      u32 mf;
++
++      /* use our funky units */
++      clkin /= 10000;
++
++      /*
++       * Input clock is predivided by N + 1
++       * out put of which is reference clk
++       */
++
++      pi->regn = HDMI_DEFAULT_REGN;
++
++      refclk = clkin / pi->regn;
++
++      /* temorary hack to make sure DCO freq isn't calculated too low */
++      if (pll_feat->bound_dcofreq && phy <= 65000)
++              pi->regm2 = 3;
++      else
++              pi->regm2 = HDMI_DEFAULT_REGM2;
++
++      /*
++       * multiplier is pixel_clk/ref_clk
++       * Multiplying by 100 to avoid fractional part removal
++       */
++      pi->regm = phy * pi->regm2 / refclk;
++
++      /*
++       * fractional multiplier is remainder of the difference between
++       * multiplier and actual phy(required pixel clock thus should be
++       * multiplied by 2^18(262144) divided by the reference clock
++       */
++      mf = (phy - pi->regm / pi->regm2 * refclk) * 262144;
++      pi->regmf = pi->regm2 * mf / refclk;
++
++      /*
++       * Dcofreq should be set to 1 if required pixel clock
++       * is greater than 1000MHz
++       */
++      pi->dcofreq = phy > 1000 * 100;
++      pi->regsd = ((pi->regm * clkin / 10) / (pi->regn * 250) + 5) / 10;
++
++      /* Set the reference clock to sysclk reference */
++      pi->refsel = HDMI_REFSEL_SYSCLK;
++
++      DSSDBG("M = %d Mf = %d\n", pi->regm, pi->regmf);
++      DSSDBG("range = %d sd = %d\n", pi->dcofreq, pi->regsd);
++}
++
++
++static int hdmi_pll_config(struct hdmi_pll_data *pll)
++{
++      u32 r;
++      struct hdmi_pll_info *fmt = &pll->info;
++
++      /* PLL start always use manual mode */
++      REG_FLD_MOD(pll->base, PLLCTRL_PLL_CONTROL, 0x0, 0, 0);
++
++      r = hdmi_read_reg(pll->base, PLLCTRL_CFG1);
++      r = FLD_MOD(r, fmt->regm, 20, 9);       /* CFG1_PLL_REGM */
++      r = FLD_MOD(r, fmt->regn - 1, 8, 1);    /* CFG1_PLL_REGN */
++      hdmi_write_reg(pll->base, PLLCTRL_CFG1, r);
++
++      r = hdmi_read_reg(pll->base, PLLCTRL_CFG2);
++
++      r = FLD_MOD(r, 0x0, 12, 12);    /* PLL_HIGHFREQ divide by 2 */
++      r = FLD_MOD(r, 0x1, 13, 13);    /* PLL_REFEN */
++      r = FLD_MOD(r, 0x0, 14, 14);    /* PHY_CLKINEN de-assert during locking */
++      r = FLD_MOD(r, fmt->refsel, 22, 21);    /* REFSEL */
++
++      if (fmt->dcofreq) {
++              /* divider programming for frequency beyond 1000Mhz */
++              REG_FLD_MOD(pll->base, PLLCTRL_CFG3, fmt->regsd, 17, 10);
++              r = FLD_MOD(r, 0x4, 3, 1);      /* 1000MHz and 2000MHz */
++      } else {
++              r = FLD_MOD(r, 0x2, 3, 1);      /* 500MHz and 1000MHz */
++      }
++
++      hdmi_write_reg(pll->base, PLLCTRL_CFG2, r);
++
++      r = hdmi_read_reg(pll->base, PLLCTRL_CFG4);
++      r = FLD_MOD(r, fmt->regm2, 24, 18);
++      r = FLD_MOD(r, fmt->regmf, 17, 0);
++      hdmi_write_reg(pll->base, PLLCTRL_CFG4, r);
++
++      /* go now */
++      REG_FLD_MOD(pll->base, PLLCTRL_PLL_GO, 0x1, 0, 0);
++
++      /* wait for bit change */
++      if (hdmi_wait_for_bit_change(pll->base, PLLCTRL_PLL_GO,
++                      0, 0, 1) != 1) {
++              pr_err("PLL GO bit not set\n");
++              return -ETIMEDOUT;
++      }
++
++      /* Wait till the lock bit is set in PLL status */
++      if (hdmi_wait_for_bit_change(pll->base,
++                      PLLCTRL_PLL_STATUS, 1, 1, 1) != 1) {
++              pr_err("cannot lock PLL\n");
++              pr_err("CFG1 0x%x\n",
++                      hdmi_read_reg(pll->base, PLLCTRL_CFG1));
++              pr_err("CFG2 0x%x\n",
++                      hdmi_read_reg(pll->base, PLLCTRL_CFG2));
++              pr_err("CFG4 0x%x\n",
++                      hdmi_read_reg(pll->base, PLLCTRL_CFG4));
++              return -ETIMEDOUT;
++      }
++
++      pr_debug("PLL locked!\n");
++
++      return 0;
++}
++
++static int hdmi_pll_reset(struct hdmi_pll_data *pll)
++{
++      /* SYSRESET  controlled by power FSM */
++      REG_FLD_MOD(pll->base, PLLCTRL_PLL_CONTROL, pll_feat->sys_reset, 3, 3);
++
++      /* READ 0x0 reset is in progress */
++      if (hdmi_wait_for_bit_change(pll->base, PLLCTRL_PLL_STATUS, 0, 0, 1)
++                      != 1) {
++              pr_err("Failed to sysreset PLL\n");
++              return -ETIMEDOUT;
++      }
++
++      return 0;
++}
++
++int hdmi_pll_enable(struct hdmi_pll_data *pll, struct hdmi_wp_data *wp)
++{
++      u16 r = 0;
++
++      if (pll_feat->ext_mux_ctrl)
++              dss_dpll_enable_ctrl(DSS_DPLL_HDMI, true);
++
++      r = hdmi_wp_set_pll_pwr(wp, HDMI_PLLPWRCMD_ALLOFF);
++      if (r)
++              return r;
++
++      r = hdmi_wp_set_pll_pwr(wp, HDMI_PLLPWRCMD_BOTHON_ALLCLKS);
++      if (r)
++              return r;
++
++      r = hdmi_pll_reset(pll);
++      if (r)
++              return r;
++
++      r = hdmi_pll_config(pll);
++      if (r)
++              return r;
++
++      return 0;
++}
++
++void hdmi_pll_disable(struct hdmi_pll_data *pll, struct hdmi_wp_data *wp)
++{
++      if (pll_feat->ext_mux_ctrl)
++              dss_dpll_enable_ctrl(DSS_DPLL_HDMI, false);
++
++      hdmi_wp_set_pll_pwr(wp, HDMI_PLLPWRCMD_ALLOFF);
++}
++
++static const struct hdmi_pll_features omap44xx_pll_feats = {
++      .sys_reset              =       false,
++      .bound_dcofreq          =       false,
++      .ext_mux_ctrl           =       false,
++      .fint_min               =       500000,
++      .fint_max               =       2500000,
++      .regm_max               =       4095,
++      .dcofreq_low_min        =       500000000,
++      .dcofreq_low_max        =       1000000000,
++      .dcofreq_high_min       =       1000000000,
++      .dcofreq_high_max       =       2000000000,
++};
++
++static const struct hdmi_pll_features omap54xx_pll_feats = {
++      .sys_reset              =       true,
++      .bound_dcofreq          =       true,
++      .ext_mux_ctrl           =       false,
++      .fint_min               =       620000,
++      .fint_max               =       2500000,
++      .regm_max               =       2046,
++      .dcofreq_low_min        =       750000000,
++      .dcofreq_low_max        =       1500000000,
++      .dcofreq_high_min       =       1250000000,
++      .dcofreq_high_max       =       2500000000UL,
++};
++
++static const struct hdmi_pll_features dra7xx_pll_feats = {
++      .sys_reset              =       true,
++      .bound_dcofreq          =       true,
++      .ext_mux_ctrl           =       true,
++      .fint_min               =       620000,
++      .fint_max               =       2500000,
++      .regm_max               =       2046,
++      .dcofreq_low_min        =       750000000,
++      .dcofreq_low_max        =       1500000000,
++      .dcofreq_high_min       =       1250000000,
++      .dcofreq_high_max       =       2500000000UL,
++};
++
++static int hdmi_pll_init_features(struct platform_device *pdev)
++{
++      struct hdmi_pll_features *dst;
++      const struct hdmi_pll_features *src;
++
++      dst = devm_kzalloc(&pdev->dev, sizeof(*dst), GFP_KERNEL);
++      if (!dst) {
++              dev_err(&pdev->dev, "Failed to allocate HDMI PHY Features\n");
++              return -ENOMEM;
++      }
++
++      switch (omapdss_get_version()) {
++      case OMAPDSS_VER_OMAP4430_ES1:
++      case OMAPDSS_VER_OMAP4430_ES2:
++      case OMAPDSS_VER_OMAP4:
++              src = &omap44xx_pll_feats;
++              break;
++
++      case OMAPDSS_VER_OMAP5:
++              src = &omap54xx_pll_feats;
++              break;
++      case OMAPDSS_VER_DRA7xx:
++              src = &dra7xx_pll_feats;
++              break;
++
++      default:
++              return -ENODEV;
++      }
++
++      memcpy(dst, src, sizeof(*dst));
++      pll_feat = dst;
++
++      return 0;
++}
++
++int hdmi_pll_init(struct platform_device *pdev, struct hdmi_pll_data *pll)
++{
++      int r;
++      struct resource *res;
++
++      r = hdmi_pll_init_features(pdev);
++      if (r)
++              return r;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hdmi_pllctrl");
++      if (!res) {
++              DSSERR("can't get PLL CTRL IORESOURCE_MEM HDMI\n");
++              return -EINVAL;
++      }
++
++      pll->base = devm_request_and_ioremap(&pdev->dev, res);
++      if (!pll->base) {
++              DSSERR("can't ioremap PLL ctrl\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
+--- /dev/null
++++ b/drivers/video/omap2/dss/hdmi_wp.c
+@@ -0,0 +1,254 @@
++/*
++ * HDMI wrapper
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated
++ *
++ * 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.
++ */
++
++#include <linux/kernel.h>
++#include <linux/err.h>
++#include <linux/io.h>
++#include <linux/platform_device.h>
++#include <video/omapdss.h>
++
++#include "dss.h"
++#include "hdmi.h"
++
++void hdmi_wp_dump(struct hdmi_wp_data *wp, struct seq_file *s)
++{
++#define DUMPREG(r) seq_printf(s, "%-35s %08x\n", #r, hdmi_read_reg(wp->base, r))
++
++      DUMPREG(HDMI_WP_REVISION);
++      DUMPREG(HDMI_WP_SYSCONFIG);
++      DUMPREG(HDMI_WP_IRQSTATUS_RAW);
++      DUMPREG(HDMI_WP_IRQSTATUS);
++      DUMPREG(HDMI_WP_IRQENABLE_SET);
++      DUMPREG(HDMI_WP_IRQENABLE_CLR);
++      DUMPREG(HDMI_WP_IRQWAKEEN);
++      DUMPREG(HDMI_WP_PWR_CTRL);
++      DUMPREG(HDMI_WP_DEBOUNCE);
++      DUMPREG(HDMI_WP_VIDEO_CFG);
++      DUMPREG(HDMI_WP_VIDEO_SIZE);
++      DUMPREG(HDMI_WP_VIDEO_TIMING_H);
++      DUMPREG(HDMI_WP_VIDEO_TIMING_V);
++      DUMPREG(HDMI_WP_CLK);
++      DUMPREG(HDMI_WP_AUDIO_CFG);
++      DUMPREG(HDMI_WP_AUDIO_CFG2);
++      DUMPREG(HDMI_WP_AUDIO_CTRL);
++      DUMPREG(HDMI_WP_AUDIO_DATA);
++}
++
++u32 hdmi_wp_get_irqstatus(struct hdmi_wp_data *wp)
++{
++      return hdmi_read_reg(wp->base, HDMI_WP_IRQSTATUS);
++}
++
++void hdmi_wp_set_irqstatus(struct hdmi_wp_data *wp, u32 irqstatus)
++{
++      hdmi_write_reg(wp->base, HDMI_WP_IRQSTATUS, irqstatus);
++      /* flush posted write */
++      hdmi_read_reg(wp->base, HDMI_WP_IRQSTATUS);
++}
++
++void hdmi_wp_set_irqenable(struct hdmi_wp_data *wp, u32 mask)
++{
++      hdmi_write_reg(wp->base, HDMI_WP_IRQENABLE_SET, mask);
++}
++
++void hdmi_wp_clear_irqenable(struct hdmi_wp_data *wp, u32 mask)
++{
++      hdmi_write_reg(wp->base, HDMI_WP_IRQENABLE_CLR, mask);
++}
++
++/* PHY_PWR_CMD */
++int hdmi_wp_set_phy_pwr(struct hdmi_wp_data *wp, enum hdmi_phy_pwr val)
++{
++      /* Return if already the state */
++      if (REG_GET(wp->base, HDMI_WP_PWR_CTRL, 5, 4) == val)
++              return 0;
++
++      /* Command for power control of HDMI PHY */
++      REG_FLD_MOD(wp->base, HDMI_WP_PWR_CTRL, val, 7, 6);
++
++      /* Status of the power control of HDMI PHY */
++      if (hdmi_wait_for_bit_change(wp->base, HDMI_WP_PWR_CTRL, 5, 4, val)
++                      != val) {
++              pr_err("Failed to set PHY power mode to %d\n", val);
++              return -ETIMEDOUT;
++      }
++
++      return 0;
++}
++
++/* PLL_PWR_CMD */
++int hdmi_wp_set_pll_pwr(struct hdmi_wp_data *wp, enum hdmi_pll_pwr val)
++{
++      /* Command for power control of HDMI PLL */
++      REG_FLD_MOD(wp->base, HDMI_WP_PWR_CTRL, val, 3, 2);
++
++      /* wait till PHY_PWR_STATUS is set */
++      if (hdmi_wait_for_bit_change(wp->base, HDMI_WP_PWR_CTRL, 1, 0, val)
++                      != val) {
++              pr_err("Failed to set PLL_PWR_STATUS\n");
++              return -ETIMEDOUT;
++      }
++
++      return 0;
++}
++
++int hdmi_wp_video_start(struct hdmi_wp_data *wp)
++{
++      REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, true, 31, 31);
++
++      return 0;
++}
++
++void hdmi_wp_video_stop(struct hdmi_wp_data *wp)
++{
++      REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, false, 31, 31);
++}
++
++void hdmi_wp_video_config_format(struct hdmi_wp_data *wp,
++              struct hdmi_video_format *video_fmt)
++{
++      u32 l = 0;
++
++      REG_FLD_MOD(wp->base, HDMI_WP_VIDEO_CFG, video_fmt->packing_mode,
++              10, 8);
++
++      l |= FLD_VAL(video_fmt->y_res, 31, 16);
++      l |= FLD_VAL(video_fmt->x_res, 15, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_VIDEO_SIZE, l);
++}
++
++void hdmi_wp_video_config_interface(struct hdmi_wp_data *wp,
++              struct omap_video_timings *timings)
++{
++      u32 r;
++      bool vsync_pol, hsync_pol;
++      pr_debug("Enter hdmi_wp_video_config_interface\n");
++
++      vsync_pol = timings->vsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
++      hsync_pol = timings->hsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
++
++      r = hdmi_read_reg(wp->base, HDMI_WP_VIDEO_CFG);
++      r = FLD_MOD(r, vsync_pol, 7, 7);
++      r = FLD_MOD(r, hsync_pol, 6, 6);
++      r = FLD_MOD(r, timings->interlace, 3, 3);
++      r = FLD_MOD(r, 1, 1, 0); /* HDMI_TIMING_MASTER_24BIT */
++      hdmi_write_reg(wp->base, HDMI_WP_VIDEO_CFG, r);
++}
++
++void hdmi_wp_video_config_timing(struct hdmi_wp_data *wp,
++              struct omap_video_timings *timings)
++{
++      u32 timing_h = 0;
++      u32 timing_v = 0;
++
++      pr_debug("Enter hdmi_wp_video_config_timing\n");
++
++      timing_h |= FLD_VAL(timings->hbp, 31, 20);
++      timing_h |= FLD_VAL(timings->hfp, 19, 8);
++      timing_h |= FLD_VAL(timings->hsw, 7, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_VIDEO_TIMING_H, timing_h);
++
++      timing_v |= FLD_VAL(timings->vbp, 31, 20);
++      timing_v |= FLD_VAL(timings->vfp, 19, 8);
++      timing_v |= FLD_VAL(timings->vsw, 7, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_VIDEO_TIMING_V, timing_v);
++}
++
++void hdmi_wp_init_vid_fmt_timings(struct hdmi_video_format *video_fmt,
++              struct omap_video_timings *timings, struct hdmi_config *param)
++{
++      pr_debug("Enter hdmi_wp_video_init_format\n");
++
++      video_fmt->packing_mode = HDMI_PACK_10b_RGB_YUV444;
++      video_fmt->y_res = param->timings.y_res;
++      video_fmt->x_res = param->timings.x_res;
++
++      timings->hbp = param->timings.hbp;
++      timings->hfp = param->timings.hfp;
++      timings->hsw = param->timings.hsw;
++      timings->vbp = param->timings.vbp;
++      timings->vfp = param->timings.vfp;
++      timings->vsw = param->timings.vsw;
++      timings->vsync_level = param->timings.vsync_level;
++      timings->hsync_level = param->timings.hsync_level;
++      timings->interlace = param->timings.interlace;
++}
++
++#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO) || defined(CONFIG_OMAP5_DSS_HDMI_AUDIO)
++void hdmi_wp_audio_config_format(struct hdmi_wp_data *wp,
++              struct hdmi_audio_format *aud_fmt)
++{
++      u32 r;
++
++      DSSDBG("Enter hdmi_wp_audio_config_format\n");
++
++      r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CFG);
++      r = FLD_MOD(r, aud_fmt->stereo_channels, 26, 24);
++      r = FLD_MOD(r, aud_fmt->active_chnnls_msk, 23, 16);
++      r = FLD_MOD(r, aud_fmt->en_sig_blk_strt_end, 5, 5);
++      r = FLD_MOD(r, aud_fmt->type, 4, 4);
++      r = FLD_MOD(r, aud_fmt->justification, 3, 3);
++      r = FLD_MOD(r, aud_fmt->sample_order, 2, 2);
++      r = FLD_MOD(r, aud_fmt->samples_per_word, 1, 1);
++      r = FLD_MOD(r, aud_fmt->sample_size, 0, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CFG, r);
++}
++
++void hdmi_wp_audio_config_dma(struct hdmi_wp_data *wp,
++              struct hdmi_audio_dma *aud_dma)
++{
++      u32 r;
++
++      DSSDBG("Enter hdmi_wp_audio_config_dma\n");
++
++      r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CFG2);
++      r = FLD_MOD(r, aud_dma->transfer_size, 15, 8);
++      r = FLD_MOD(r, aud_dma->block_size, 7, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CFG2, r);
++
++      r = hdmi_read_reg(wp->base, HDMI_WP_AUDIO_CTRL);
++      r = FLD_MOD(r, aud_dma->mode, 9, 9);
++      r = FLD_MOD(r, aud_dma->fifo_threshold, 8, 0);
++      hdmi_write_reg(wp->base, HDMI_WP_AUDIO_CTRL, r);
++}
++
++int hdmi_wp_audio_enable(struct hdmi_wp_data *wp, bool enable)
++{
++      REG_FLD_MOD(wp->base, HDMI_WP_AUDIO_CTRL, enable, 31, 31);
++
++      return 0;
++}
++
++int hdmi_wp_audio_core_req_enable(struct hdmi_wp_data *wp, bool enable)
++{
++      REG_FLD_MOD(wp->base, HDMI_WP_AUDIO_CTRL, enable, 30, 30);
++
++      return 0;
++}
++#endif
++
++int hdmi_wp_init(struct platform_device *pdev, struct hdmi_wp_data *wp)
++{
++      struct resource *res;
++
++      res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "hdmi_wp");
++      if (!res) {
++              DSSERR("can't get WP IORESOURCE_MEM HDMI\n");
++              return -EINVAL;
++      }
++
++      wp->base = devm_request_and_ioremap(&pdev->dev, res);
++      if (!wp->base) {
++              DSSERR("can't ioremap HDMI wrapper\n");
++              return -ENOMEM;
++      }
++
++      return 0;
++}
+--- a/drivers/video/omap2/dss/Kconfig
++++ b/drivers/video/omap2/dss/Kconfig
+@@ -40,6 +40,12 @@ config OMAP2_DSS_DPI
+       help
+         DPI Interface. This is the Parallel Display Interface.
++config OMAP2_DSS_DRA7XX_DPI
++      bool "DRA75X DPI support"
++      default y
++      help
++        Vayu DPI Interface. This is the Parallel Display Interface.
++
+ config OMAP2_DSS_RFBI
+       bool "RFBI support"
+       depends on BROKEN
+@@ -69,6 +75,18 @@ config OMAP4_DSS_HDMI
+ config OMAP4_DSS_HDMI_AUDIO
+       bool
++config OMAP5_DSS_HDMI
++      bool "OMAP5 HDMI support"
++        default y
++      help
++        HDMI Interface for OMAP5 and similar cores. This adds the High
++        Definition Multimedia Interface. See http://www.hdmi.org/ for HDMI
++        specification.
++
++config OMAP5_DSS_HDMI_AUDIO
++      depends on OMAP5_DSS_HDMI
++      bool
++
+ config OMAP2_DSS_SDI
+       bool "SDI support"
+         default n
+--- a/drivers/video/omap2/dss/Makefile
++++ b/drivers/video/omap2/dss/Makefile
+@@ -1,14 +1,18 @@
+ obj-$(CONFIG_OMAP2_DSS) += omapdss.o
+ # Core DSS files
+-omapdss-y := core.o dss.o dss_features.o dispc.o dispc_coefs.o display.o \
+-      output.o
++omapdss-y := core.o dss.o dss_dpll.o dss_features.o dispc.o dispc_coefs.o \
++      display.o output.o
+ # DSS compat layer files
+ omapdss-y += manager.o manager-sysfs.o overlay.o overlay-sysfs.o apply.o \
+       dispc-compat.o display-sysfs.o
+ omapdss-$(CONFIG_OMAP2_DSS_DPI) += dpi.o
++omapdss-$(CONFIG_OMAP2_DSS_DRA7XX_DPI) += dra7xx_dpi.o
+ omapdss-$(CONFIG_OMAP2_DSS_RFBI) += rfbi.o
+ omapdss-$(CONFIG_OMAP2_DSS_VENC) += venc.o
+ omapdss-$(CONFIG_OMAP2_DSS_SDI) += sdi.o
+ omapdss-$(CONFIG_OMAP2_DSS_DSI) += dsi.o
+-omapdss-$(CONFIG_OMAP4_DSS_HDMI) += hdmi.o ti_hdmi_4xxx_ip.o
++omapdss-$(CONFIG_OMAP4_DSS_HDMI) += hdmi4.o hdmi_common.o hdmi_wp.o hdmi_pll.o \
++      hdmi_phy.o hdmi4_core.o
++omapdss-$(CONFIG_OMAP5_DSS_HDMI) += hdmi5.o hdmi_common.o hdmi_wp.o hdmi_pll.o \
++      hdmi_phy.o hdmi5_core.o
+ ccflags-$(CONFIG_OMAP2_DSS_DEBUG) += -DDEBUG
+--- a/drivers/video/omap2/dss/ti_hdmi_4xxx_ip.c
++++ /dev/null
+@@ -1,1427 +0,0 @@
+-/*
+- * ti_hdmi_4xxx_ip.c
+- *
+- * HDMI TI81xx, TI38xx, TI OMAP4 etc IP driver Library
+- * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
+- * Authors: Yong Zhi
+- *    Mythri pk <mythripk@ti.com>
+- *
+- * 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/>.
+- */
+-
+-#include <linux/kernel.h>
+-#include <linux/module.h>
+-#include <linux/err.h>
+-#include <linux/io.h>
+-#include <linux/interrupt.h>
+-#include <linux/mutex.h>
+-#include <linux/delay.h>
+-#include <linux/string.h>
+-#include <linux/seq_file.h>
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-#include <sound/asound.h>
+-#include <sound/asoundef.h>
+-#endif
+-
+-#include "ti_hdmi_4xxx_ip.h"
+-#include "dss.h"
+-#include "dss_features.h"
+-
+-#define HDMI_IRQ_LINK_CONNECT         (1 << 25)
+-#define HDMI_IRQ_LINK_DISCONNECT      (1 << 26)
+-
+-static inline void hdmi_write_reg(void __iomem *base_addr,
+-                              const u16 idx, u32 val)
+-{
+-      __raw_writel(val, base_addr + idx);
+-}
+-
+-static inline u32 hdmi_read_reg(void __iomem *base_addr,
+-                              const u16 idx)
+-{
+-      return __raw_readl(base_addr + idx);
+-}
+-
+-static inline void __iomem *hdmi_wp_base(struct hdmi_ip_data *ip_data)
+-{
+-      return ip_data->base_wp;
+-}
+-
+-static inline void __iomem *hdmi_phy_base(struct hdmi_ip_data *ip_data)
+-{
+-      return ip_data->base_wp + ip_data->phy_offset;
+-}
+-
+-static inline void __iomem *hdmi_pll_base(struct hdmi_ip_data *ip_data)
+-{
+-      return ip_data->base_wp + ip_data->pll_offset;
+-}
+-
+-static inline void __iomem *hdmi_av_base(struct hdmi_ip_data *ip_data)
+-{
+-      return ip_data->base_wp + ip_data->core_av_offset;
+-}
+-
+-static inline void __iomem *hdmi_core_sys_base(struct hdmi_ip_data *ip_data)
+-{
+-      return ip_data->base_wp + ip_data->core_sys_offset;
+-}
+-
+-static inline int hdmi_wait_for_bit_change(void __iomem *base_addr,
+-                              const u16 idx,
+-                              int b2, int b1, u32 val)
+-{
+-      u32 t = 0;
+-      while (val != REG_GET(base_addr, idx, b2, b1)) {
+-              udelay(1);
+-              if (t++ > 10000)
+-                      return !val;
+-      }
+-      return val;
+-}
+-
+-static int hdmi_pll_init(struct hdmi_ip_data *ip_data)
+-{
+-      u32 r;
+-      void __iomem *pll_base = hdmi_pll_base(ip_data);
+-      struct hdmi_pll_info *fmt = &ip_data->pll_data;
+-
+-      /* PLL start always use manual mode */
+-      REG_FLD_MOD(pll_base, PLLCTRL_PLL_CONTROL, 0x0, 0, 0);
+-
+-      r = hdmi_read_reg(pll_base, PLLCTRL_CFG1);
+-      r = FLD_MOD(r, fmt->regm, 20, 9); /* CFG1_PLL_REGM */
+-      r = FLD_MOD(r, fmt->regn - 1, 8, 1);  /* CFG1_PLL_REGN */
+-
+-      hdmi_write_reg(pll_base, PLLCTRL_CFG1, r);
+-
+-      r = hdmi_read_reg(pll_base, PLLCTRL_CFG2);
+-
+-      r = FLD_MOD(r, 0x0, 12, 12); /* PLL_HIGHFREQ divide by 2 */
+-      r = FLD_MOD(r, 0x1, 13, 13); /* PLL_REFEN */
+-      r = FLD_MOD(r, 0x0, 14, 14); /* PHY_CLKINEN de-assert during locking */
+-      r = FLD_MOD(r, fmt->refsel, 22, 21); /* REFSEL */
+-
+-      if (fmt->dcofreq) {
+-              /* divider programming for frequency beyond 1000Mhz */
+-              REG_FLD_MOD(pll_base, PLLCTRL_CFG3, fmt->regsd, 17, 10);
+-              r = FLD_MOD(r, 0x4, 3, 1); /* 1000MHz and 2000MHz */
+-      } else {
+-              r = FLD_MOD(r, 0x2, 3, 1); /* 500MHz and 1000MHz */
+-      }
+-
+-      hdmi_write_reg(pll_base, PLLCTRL_CFG2, r);
+-
+-      r = hdmi_read_reg(pll_base, PLLCTRL_CFG4);
+-      r = FLD_MOD(r, fmt->regm2, 24, 18);
+-      r = FLD_MOD(r, fmt->regmf, 17, 0);
+-
+-      hdmi_write_reg(pll_base, PLLCTRL_CFG4, r);
+-
+-      /* go now */
+-      REG_FLD_MOD(pll_base, PLLCTRL_PLL_GO, 0x1, 0, 0);
+-
+-      /* wait for bit change */
+-      if (hdmi_wait_for_bit_change(pll_base, PLLCTRL_PLL_GO,
+-                                                      0, 0, 1) != 1) {
+-              pr_err("PLL GO bit not set\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      /* Wait till the lock bit is set in PLL status */
+-      if (hdmi_wait_for_bit_change(pll_base,
+-                              PLLCTRL_PLL_STATUS, 1, 1, 1) != 1) {
+-              pr_err("cannot lock PLL\n");
+-              pr_err("CFG1 0x%x\n",
+-                      hdmi_read_reg(pll_base, PLLCTRL_CFG1));
+-              pr_err("CFG2 0x%x\n",
+-                      hdmi_read_reg(pll_base, PLLCTRL_CFG2));
+-              pr_err("CFG4 0x%x\n",
+-                      hdmi_read_reg(pll_base, PLLCTRL_CFG4));
+-              return -ETIMEDOUT;
+-      }
+-
+-      pr_debug("PLL locked!\n");
+-
+-      return 0;
+-}
+-
+-/* PHY_PWR_CMD */
+-static int hdmi_set_phy_pwr(struct hdmi_ip_data *ip_data, enum hdmi_phy_pwr val)
+-{
+-      /* Return if already the state */
+-      if (REG_GET(hdmi_wp_base(ip_data), HDMI_WP_PWR_CTRL, 5, 4) == val)
+-              return 0;
+-
+-      /* Command for power control of HDMI PHY */
+-      REG_FLD_MOD(hdmi_wp_base(ip_data), HDMI_WP_PWR_CTRL, val, 7, 6);
+-
+-      /* Status of the power control of HDMI PHY */
+-      if (hdmi_wait_for_bit_change(hdmi_wp_base(ip_data),
+-                              HDMI_WP_PWR_CTRL, 5, 4, val) != val) {
+-              pr_err("Failed to set PHY power mode to %d\n", val);
+-              return -ETIMEDOUT;
+-      }
+-
+-      return 0;
+-}
+-
+-/* PLL_PWR_CMD */
+-static int hdmi_set_pll_pwr(struct hdmi_ip_data *ip_data, enum hdmi_pll_pwr val)
+-{
+-      /* Command for power control of HDMI PLL */
+-      REG_FLD_MOD(hdmi_wp_base(ip_data), HDMI_WP_PWR_CTRL, val, 3, 2);
+-
+-      /* wait till PHY_PWR_STATUS is set */
+-      if (hdmi_wait_for_bit_change(hdmi_wp_base(ip_data), HDMI_WP_PWR_CTRL,
+-                                              1, 0, val) != val) {
+-              pr_err("Failed to set PLL_PWR_STATUS\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      return 0;
+-}
+-
+-static int hdmi_pll_reset(struct hdmi_ip_data *ip_data)
+-{
+-      /* SYSRESET  controlled by power FSM */
+-      REG_FLD_MOD(hdmi_pll_base(ip_data), PLLCTRL_PLL_CONTROL, 0x0, 3, 3);
+-
+-      /* READ 0x0 reset is in progress */
+-      if (hdmi_wait_for_bit_change(hdmi_pll_base(ip_data),
+-                              PLLCTRL_PLL_STATUS, 0, 0, 1) != 1) {
+-              pr_err("Failed to sysreset PLL\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      return 0;
+-}
+-
+-int ti_hdmi_4xxx_pll_enable(struct hdmi_ip_data *ip_data)
+-{
+-      u16 r = 0;
+-
+-      r = hdmi_set_pll_pwr(ip_data, HDMI_PLLPWRCMD_ALLOFF);
+-      if (r)
+-              return r;
+-
+-      r = hdmi_set_pll_pwr(ip_data, HDMI_PLLPWRCMD_BOTHON_ALLCLKS);
+-      if (r)
+-              return r;
+-
+-      r = hdmi_pll_reset(ip_data);
+-      if (r)
+-              return r;
+-
+-      r = hdmi_pll_init(ip_data);
+-      if (r)
+-              return r;
+-
+-      return 0;
+-}
+-
+-void ti_hdmi_4xxx_pll_disable(struct hdmi_ip_data *ip_data)
+-{
+-      hdmi_set_pll_pwr(ip_data, HDMI_PLLPWRCMD_ALLOFF);
+-}
+-
+-static irqreturn_t hdmi_irq_handler(int irq, void *data)
+-{
+-      struct hdmi_ip_data *ip_data = data;
+-      void __iomem *wp_base = hdmi_wp_base(ip_data);
+-      u32 irqstatus;
+-
+-      irqstatus = hdmi_read_reg(wp_base, HDMI_WP_IRQSTATUS);
+-      hdmi_write_reg(wp_base, HDMI_WP_IRQSTATUS, irqstatus);
+-      /* flush posted write */
+-      hdmi_read_reg(wp_base, HDMI_WP_IRQSTATUS);
+-
+-      if ((irqstatus & HDMI_IRQ_LINK_CONNECT) &&
+-                      irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
+-              /*
+-               * If we get both connect and disconnect interrupts at the same
+-               * time, turn off the PHY, clear interrupts, and restart, which
+-               * raises connect interrupt if a cable is connected, or nothing
+-               * if cable is not connected.
+-               */
+-              hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_OFF);
+-
+-              hdmi_write_reg(wp_base, HDMI_WP_IRQSTATUS,
+-                      HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
+-              /* flush posted write */
+-              hdmi_read_reg(wp_base, HDMI_WP_IRQSTATUS);
+-
+-              hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_LDOON);
+-      } else if (irqstatus & HDMI_IRQ_LINK_CONNECT) {
+-              hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_TXON);
+-      } else if (irqstatus & HDMI_IRQ_LINK_DISCONNECT) {
+-              hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_LDOON);
+-      }
+-
+-      return IRQ_HANDLED;
+-}
+-
+-int ti_hdmi_4xxx_phy_enable(struct hdmi_ip_data *ip_data)
+-{
+-      u16 r = 0;
+-      void __iomem *phy_base = hdmi_phy_base(ip_data);
+-
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_IRQENABLE_CLR,
+-                      0xffffffff);
+-
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_IRQSTATUS,
+-                      HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
+-
+-      r = hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_LDOON);
+-      if (r)
+-              return r;
+-
+-      /*
+-       * Read address 0 in order to get the SCP reset done completed
+-       * Dummy access performed to make sure reset is done
+-       */
+-      hdmi_read_reg(phy_base, HDMI_TXPHY_TX_CTRL);
+-
+-      /*
+-       * Write to phy address 0 to configure the clock
+-       * use HFBITCLK write HDMI_TXPHY_TX_CONTROL_FREQOUT field
+-       */
+-      REG_FLD_MOD(phy_base, HDMI_TXPHY_TX_CTRL, 0x1, 31, 30);
+-
+-      /* Write to phy address 1 to start HDMI line (TXVALID and TMDSCLKEN) */
+-      hdmi_write_reg(phy_base, HDMI_TXPHY_DIGITAL_CTRL, 0xF0000000);
+-
+-      /* Setup max LDO voltage */
+-      REG_FLD_MOD(phy_base, HDMI_TXPHY_POWER_CTRL, 0xB, 3, 0);
+-
+-      /* Write to phy address 3 to change the polarity control */
+-      REG_FLD_MOD(phy_base, HDMI_TXPHY_PAD_CFG_CTRL, 0x1, 27, 27);
+-
+-      r = request_threaded_irq(ip_data->irq, NULL, hdmi_irq_handler,
+-                               IRQF_ONESHOT, "OMAP HDMI", ip_data);
+-      if (r) {
+-              DSSERR("HDMI IRQ request failed\n");
+-              hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_OFF);
+-              return r;
+-      }
+-
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_IRQENABLE_SET,
+-                      HDMI_IRQ_LINK_CONNECT | HDMI_IRQ_LINK_DISCONNECT);
+-
+-      return 0;
+-}
+-
+-void ti_hdmi_4xxx_phy_disable(struct hdmi_ip_data *ip_data)
+-{
+-      free_irq(ip_data->irq, ip_data);
+-
+-      hdmi_set_phy_pwr(ip_data, HDMI_PHYPWRCMD_OFF);
+-}
+-
+-static int hdmi_core_ddc_init(struct hdmi_ip_data *ip_data)
+-{
+-      void __iomem *base = hdmi_core_sys_base(ip_data);
+-
+-      /* Turn on CLK for DDC */
+-      REG_FLD_MOD(base, HDMI_CORE_AV_DPD, 0x7, 2, 0);
+-
+-      /* IN_PROG */
+-      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 4, 4) == 1) {
+-              /* Abort transaction */
+-              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0xf, 3, 0);
+-              /* IN_PROG */
+-              if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
+-                                      4, 4, 0) != 0) {
+-                      DSSERR("Timeout aborting DDC transaction\n");
+-                      return -ETIMEDOUT;
+-              }
+-      }
+-
+-      /* Clk SCL Devices */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0xA, 3, 0);
+-
+-      /* HDMI_CORE_DDC_STATUS_IN_PROG */
+-      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
+-                              4, 4, 0) != 0) {
+-              DSSERR("Timeout starting SCL clock\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      /* Clear FIFO */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x9, 3, 0);
+-
+-      /* HDMI_CORE_DDC_STATUS_IN_PROG */
+-      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
+-                              4, 4, 0) != 0) {
+-              DSSERR("Timeout clearing DDC fifo\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      return 0;
+-}
+-
+-static int hdmi_core_ddc_edid(struct hdmi_ip_data *ip_data,
+-              u8 *pedid, int ext)
+-{
+-      void __iomem *base = hdmi_core_sys_base(ip_data);
+-      u32 i;
+-      char checksum;
+-      u32 offset = 0;
+-
+-      /* HDMI_CORE_DDC_STATUS_IN_PROG */
+-      if (hdmi_wait_for_bit_change(base, HDMI_CORE_DDC_STATUS,
+-                              4, 4, 0) != 0) {
+-              DSSERR("Timeout waiting DDC to be ready\n");
+-              return -ETIMEDOUT;
+-      }
+-
+-      if (ext % 2 != 0)
+-              offset = 0x80;
+-
+-      /* Load Segment Address Register */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_SEGM, ext / 2, 7, 0);
+-
+-      /* Load Slave Address Register */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_ADDR, 0xA0 >> 1, 7, 1);
+-
+-      /* Load Offset Address Register */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_OFFSET, offset, 7, 0);
+-
+-      /* Load Byte Count */
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_COUNT1, 0x80, 7, 0);
+-      REG_FLD_MOD(base, HDMI_CORE_DDC_COUNT2, 0x0, 1, 0);
+-
+-      /* Set DDC_CMD */
+-      if (ext)
+-              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x4, 3, 0);
+-      else
+-              REG_FLD_MOD(base, HDMI_CORE_DDC_CMD, 0x2, 3, 0);
+-
+-      /* HDMI_CORE_DDC_STATUS_BUS_LOW */
+-      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 6, 6) == 1) {
+-              pr_err("I2C Bus Low?\n");
+-              return -EIO;
+-      }
+-      /* HDMI_CORE_DDC_STATUS_NO_ACK */
+-      if (REG_GET(base, HDMI_CORE_DDC_STATUS, 5, 5) == 1) {
+-              pr_err("I2C No Ack\n");
+-              return -EIO;
+-      }
+-
+-      for (i = 0; i < 0x80; ++i) {
+-              int t;
+-
+-              /* IN_PROG */
+-              if (REG_GET(base, HDMI_CORE_DDC_STATUS, 4, 4) == 0) {
+-                      DSSERR("operation stopped when reading edid\n");
+-                      return -EIO;
+-              }
+-
+-              t = 0;
+-              /* FIFO_EMPTY */
+-              while (REG_GET(base, HDMI_CORE_DDC_STATUS, 2, 2) == 1) {
+-                      if (t++ > 10000) {
+-                              DSSERR("timeout reading edid\n");
+-                              return -ETIMEDOUT;
+-                      }
+-                      udelay(1);
+-              }
+-
+-              pedid[i] = REG_GET(base, HDMI_CORE_DDC_DATA, 7, 0);
+-      }
+-
+-      checksum = 0;
+-      for (i = 0; i < 0x80; ++i)
+-              checksum += pedid[i];
+-
+-      if (checksum != 0) {
+-              pr_err("E-EDID checksum failed!!\n");
+-              return -EIO;
+-      }
+-
+-      return 0;
+-}
+-
+-int ti_hdmi_4xxx_read_edid(struct hdmi_ip_data *ip_data,
+-                              u8 *edid, int len)
+-{
+-      int r, l;
+-
+-      if (len < 128)
+-              return -EINVAL;
+-
+-      r = hdmi_core_ddc_init(ip_data);
+-      if (r)
+-              return r;
+-
+-      r = hdmi_core_ddc_edid(ip_data, edid, 0);
+-      if (r)
+-              return r;
+-
+-      l = 128;
+-
+-      if (len >= 128 * 2 && edid[0x7e] > 0) {
+-              r = hdmi_core_ddc_edid(ip_data, edid + 0x80, 1);
+-              if (r)
+-                      return r;
+-              l += 128;
+-      }
+-
+-      return l;
+-}
+-
+-static void hdmi_core_init(struct hdmi_core_video_config *video_cfg,
+-                      struct hdmi_core_infoframe_avi *avi_cfg,
+-                      struct hdmi_core_packet_enable_repeat *repeat_cfg)
+-{
+-      pr_debug("Enter hdmi_core_init\n");
+-
+-      /* video core */
+-      video_cfg->ip_bus_width = HDMI_INPUT_8BIT;
+-      video_cfg->op_dither_truc = HDMI_OUTPUTTRUNCATION_8BIT;
+-      video_cfg->deep_color_pkt = HDMI_DEEPCOLORPACKECTDISABLE;
+-      video_cfg->pkt_mode = HDMI_PACKETMODERESERVEDVALUE;
+-      video_cfg->hdmi_dvi = HDMI_DVI;
+-      video_cfg->tclk_sel_clkmult = HDMI_FPLL10IDCK;
+-
+-      /* info frame */
+-      avi_cfg->db1_format = 0;
+-      avi_cfg->db1_active_info = 0;
+-      avi_cfg->db1_bar_info_dv = 0;
+-      avi_cfg->db1_scan_info = 0;
+-      avi_cfg->db2_colorimetry = 0;
+-      avi_cfg->db2_aspect_ratio = 0;
+-      avi_cfg->db2_active_fmt_ar = 0;
+-      avi_cfg->db3_itc = 0;
+-      avi_cfg->db3_ec = 0;
+-      avi_cfg->db3_q_range = 0;
+-      avi_cfg->db3_nup_scaling = 0;
+-      avi_cfg->db4_videocode = 0;
+-      avi_cfg->db5_pixel_repeat = 0;
+-      avi_cfg->db6_7_line_eoftop = 0 ;
+-      avi_cfg->db8_9_line_sofbottom = 0;
+-      avi_cfg->db10_11_pixel_eofleft = 0;
+-      avi_cfg->db12_13_pixel_sofright = 0;
+-
+-      /* packet enable and repeat */
+-      repeat_cfg->audio_pkt = 0;
+-      repeat_cfg->audio_pkt_repeat = 0;
+-      repeat_cfg->avi_infoframe = 0;
+-      repeat_cfg->avi_infoframe_repeat = 0;
+-      repeat_cfg->gen_cntrl_pkt = 0;
+-      repeat_cfg->gen_cntrl_pkt_repeat = 0;
+-      repeat_cfg->generic_pkt = 0;
+-      repeat_cfg->generic_pkt_repeat = 0;
+-}
+-
+-static void hdmi_core_powerdown_disable(struct hdmi_ip_data *ip_data)
+-{
+-      pr_debug("Enter hdmi_core_powerdown_disable\n");
+-      REG_FLD_MOD(hdmi_core_sys_base(ip_data), HDMI_CORE_CTRL1, 0x0, 0, 0);
+-}
+-
+-static void hdmi_core_swreset_release(struct hdmi_ip_data *ip_data)
+-{
+-      pr_debug("Enter hdmi_core_swreset_release\n");
+-      REG_FLD_MOD(hdmi_core_sys_base(ip_data), HDMI_CORE_SYS_SRST, 0x0, 0, 0);
+-}
+-
+-static void hdmi_core_swreset_assert(struct hdmi_ip_data *ip_data)
+-{
+-      pr_debug("Enter hdmi_core_swreset_assert\n");
+-      REG_FLD_MOD(hdmi_core_sys_base(ip_data), HDMI_CORE_SYS_SRST, 0x1, 0, 0);
+-}
+-
+-/* HDMI_CORE_VIDEO_CONFIG */
+-static void hdmi_core_video_config(struct hdmi_ip_data *ip_data,
+-                              struct hdmi_core_video_config *cfg)
+-{
+-      u32 r = 0;
+-      void __iomem *core_sys_base = hdmi_core_sys_base(ip_data);
+-
+-      /* sys_ctrl1 default configuration not tunable */
+-      r = hdmi_read_reg(core_sys_base, HDMI_CORE_CTRL1);
+-      r = FLD_MOD(r, HDMI_CORE_CTRL1_VEN_FOLLOWVSYNC, 5, 5);
+-      r = FLD_MOD(r, HDMI_CORE_CTRL1_HEN_FOLLOWHSYNC, 4, 4);
+-      r = FLD_MOD(r, HDMI_CORE_CTRL1_BSEL_24BITBUS, 2, 2);
+-      r = FLD_MOD(r, HDMI_CORE_CTRL1_EDGE_RISINGEDGE, 1, 1);
+-      hdmi_write_reg(core_sys_base, HDMI_CORE_CTRL1, r);
+-
+-      REG_FLD_MOD(core_sys_base,
+-                      HDMI_CORE_SYS_VID_ACEN, cfg->ip_bus_width, 7, 6);
+-
+-      /* Vid_Mode */
+-      r = hdmi_read_reg(core_sys_base, HDMI_CORE_SYS_VID_MODE);
+-
+-      /* dither truncation configuration */
+-      if (cfg->op_dither_truc > HDMI_OUTPUTTRUNCATION_12BIT) {
+-              r = FLD_MOD(r, cfg->op_dither_truc - 3, 7, 6);
+-              r = FLD_MOD(r, 1, 5, 5);
+-      } else {
+-              r = FLD_MOD(r, cfg->op_dither_truc, 7, 6);
+-              r = FLD_MOD(r, 0, 5, 5);
+-      }
+-      hdmi_write_reg(core_sys_base, HDMI_CORE_SYS_VID_MODE, r);
+-
+-      /* HDMI_Ctrl */
+-      r = hdmi_read_reg(hdmi_av_base(ip_data), HDMI_CORE_AV_HDMI_CTRL);
+-      r = FLD_MOD(r, cfg->deep_color_pkt, 6, 6);
+-      r = FLD_MOD(r, cfg->pkt_mode, 5, 3);
+-      r = FLD_MOD(r, cfg->hdmi_dvi, 0, 0);
+-      hdmi_write_reg(hdmi_av_base(ip_data), HDMI_CORE_AV_HDMI_CTRL, r);
+-
+-      /* TMDS_CTRL */
+-      REG_FLD_MOD(core_sys_base,
+-                      HDMI_CORE_SYS_TMDS_CTRL, cfg->tclk_sel_clkmult, 6, 5);
+-}
+-
+-static void hdmi_core_aux_infoframe_avi_config(struct hdmi_ip_data *ip_data)
+-{
+-      u32 val;
+-      char sum = 0, checksum = 0;
+-      void __iomem *av_base = hdmi_av_base(ip_data);
+-      struct hdmi_core_infoframe_avi info_avi = ip_data->avi_cfg;
+-
+-      sum += 0x82 + 0x002 + 0x00D;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_TYPE, 0x082);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_VERS, 0x002);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_LEN, 0x00D);
+-
+-      val = (info_avi.db1_format << 5) |
+-              (info_avi.db1_active_info << 4) |
+-              (info_avi.db1_bar_info_dv << 2) |
+-              (info_avi.db1_scan_info);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(0), val);
+-      sum += val;
+-
+-      val = (info_avi.db2_colorimetry << 6) |
+-              (info_avi.db2_aspect_ratio << 4) |
+-              (info_avi.db2_active_fmt_ar);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(1), val);
+-      sum += val;
+-
+-      val = (info_avi.db3_itc << 7) |
+-              (info_avi.db3_ec << 4) |
+-              (info_avi.db3_q_range << 2) |
+-              (info_avi.db3_nup_scaling);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(2), val);
+-      sum += val;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(3),
+-                                      info_avi.db4_videocode);
+-      sum += info_avi.db4_videocode;
+-
+-      val = info_avi.db5_pixel_repeat;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(4), val);
+-      sum += val;
+-
+-      val = info_avi.db6_7_line_eoftop & 0x00FF;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(5), val);
+-      sum += val;
+-
+-      val = ((info_avi.db6_7_line_eoftop >> 8) & 0x00FF);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(6), val);
+-      sum += val;
+-
+-      val = info_avi.db8_9_line_sofbottom & 0x00FF;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(7), val);
+-      sum += val;
+-
+-      val = ((info_avi.db8_9_line_sofbottom >> 8) & 0x00FF);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(8), val);
+-      sum += val;
+-
+-      val = info_avi.db10_11_pixel_eofleft & 0x00FF;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(9), val);
+-      sum += val;
+-
+-      val = ((info_avi.db10_11_pixel_eofleft >> 8) & 0x00FF);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(10), val);
+-      sum += val;
+-
+-      val = info_avi.db12_13_pixel_sofright & 0x00FF;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(11), val);
+-      sum += val;
+-
+-      val = ((info_avi.db12_13_pixel_sofright >> 8) & 0x00FF);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_DBYTE(12), val);
+-      sum += val;
+-
+-      checksum = 0x100 - sum;
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AVI_CHSUM, checksum);
+-}
+-
+-static void hdmi_core_av_packet_config(struct hdmi_ip_data *ip_data,
+-              struct hdmi_core_packet_enable_repeat repeat_cfg)
+-{
+-      /* enable/repeat the infoframe */
+-      hdmi_write_reg(hdmi_av_base(ip_data), HDMI_CORE_AV_PB_CTRL1,
+-              (repeat_cfg.audio_pkt << 5) |
+-              (repeat_cfg.audio_pkt_repeat << 4) |
+-              (repeat_cfg.avi_infoframe << 1) |
+-              (repeat_cfg.avi_infoframe_repeat));
+-
+-      /* enable/repeat the packet */
+-      hdmi_write_reg(hdmi_av_base(ip_data), HDMI_CORE_AV_PB_CTRL2,
+-              (repeat_cfg.gen_cntrl_pkt << 3) |
+-              (repeat_cfg.gen_cntrl_pkt_repeat << 2) |
+-              (repeat_cfg.generic_pkt << 1) |
+-              (repeat_cfg.generic_pkt_repeat));
+-}
+-
+-static void hdmi_wp_init(struct omap_video_timings *timings,
+-                      struct hdmi_video_format *video_fmt)
+-{
+-      pr_debug("Enter hdmi_wp_init\n");
+-
+-      timings->hbp = 0;
+-      timings->hfp = 0;
+-      timings->hsw = 0;
+-      timings->vbp = 0;
+-      timings->vfp = 0;
+-      timings->vsw = 0;
+-
+-      video_fmt->packing_mode = HDMI_PACK_10b_RGB_YUV444;
+-      video_fmt->y_res = 0;
+-      video_fmt->x_res = 0;
+-
+-}
+-
+-int ti_hdmi_4xxx_wp_video_start(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_CFG, true, 31, 31);
+-      return 0;
+-}
+-
+-void ti_hdmi_4xxx_wp_video_stop(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_CFG, false, 31, 31);
+-}
+-
+-static void hdmi_wp_video_init_format(struct hdmi_video_format *video_fmt,
+-      struct omap_video_timings *timings, struct hdmi_config *param)
+-{
+-      pr_debug("Enter hdmi_wp_video_init_format\n");
+-
+-      video_fmt->y_res = param->timings.y_res;
+-      video_fmt->x_res = param->timings.x_res;
+-
+-      timings->hbp = param->timings.hbp;
+-      timings->hfp = param->timings.hfp;
+-      timings->hsw = param->timings.hsw;
+-      timings->vbp = param->timings.vbp;
+-      timings->vfp = param->timings.vfp;
+-      timings->vsw = param->timings.vsw;
+-}
+-
+-static void hdmi_wp_video_config_format(struct hdmi_ip_data *ip_data,
+-              struct hdmi_video_format *video_fmt)
+-{
+-      u32 l = 0;
+-
+-      REG_FLD_MOD(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_CFG,
+-                      video_fmt->packing_mode, 10, 8);
+-
+-      l |= FLD_VAL(video_fmt->y_res, 31, 16);
+-      l |= FLD_VAL(video_fmt->x_res, 15, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_SIZE, l);
+-}
+-
+-static void hdmi_wp_video_config_interface(struct hdmi_ip_data *ip_data)
+-{
+-      u32 r;
+-      bool vsync_pol, hsync_pol;
+-      pr_debug("Enter hdmi_wp_video_config_interface\n");
+-
+-      vsync_pol = ip_data->cfg.timings.vsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
+-      hsync_pol = ip_data->cfg.timings.hsync_level == OMAPDSS_SIG_ACTIVE_HIGH;
+-
+-      r = hdmi_read_reg(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_CFG);
+-      r = FLD_MOD(r, vsync_pol, 7, 7);
+-      r = FLD_MOD(r, hsync_pol, 6, 6);
+-      r = FLD_MOD(r, ip_data->cfg.timings.interlace, 3, 3);
+-      r = FLD_MOD(r, 1, 1, 0); /* HDMI_TIMING_MASTER_24BIT */
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_CFG, r);
+-}
+-
+-static void hdmi_wp_video_config_timing(struct hdmi_ip_data *ip_data,
+-              struct omap_video_timings *timings)
+-{
+-      u32 timing_h = 0;
+-      u32 timing_v = 0;
+-
+-      pr_debug("Enter hdmi_wp_video_config_timing\n");
+-
+-      timing_h |= FLD_VAL(timings->hbp, 31, 20);
+-      timing_h |= FLD_VAL(timings->hfp, 19, 8);
+-      timing_h |= FLD_VAL(timings->hsw, 7, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_TIMING_H, timing_h);
+-
+-      timing_v |= FLD_VAL(timings->vbp, 31, 20);
+-      timing_v |= FLD_VAL(timings->vfp, 19, 8);
+-      timing_v |= FLD_VAL(timings->vsw, 7, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_VIDEO_TIMING_V, timing_v);
+-}
+-
+-void ti_hdmi_4xxx_basic_configure(struct hdmi_ip_data *ip_data)
+-{
+-      /* HDMI */
+-      struct omap_video_timings video_timing;
+-      struct hdmi_video_format video_format;
+-      /* HDMI core */
+-      struct hdmi_core_infoframe_avi *avi_cfg = &ip_data->avi_cfg;
+-      struct hdmi_core_video_config v_core_cfg;
+-      struct hdmi_core_packet_enable_repeat repeat_cfg;
+-      struct hdmi_config *cfg = &ip_data->cfg;
+-
+-      hdmi_wp_init(&video_timing, &video_format);
+-
+-      hdmi_core_init(&v_core_cfg, avi_cfg, &repeat_cfg);
+-
+-      hdmi_wp_video_init_format(&video_format, &video_timing, cfg);
+-
+-      hdmi_wp_video_config_timing(ip_data, &video_timing);
+-
+-      /* video config */
+-      video_format.packing_mode = HDMI_PACK_24b_RGB_YUV444_YUV422;
+-
+-      hdmi_wp_video_config_format(ip_data, &video_format);
+-
+-      hdmi_wp_video_config_interface(ip_data);
+-
+-      /*
+-       * configure core video part
+-       * set software reset in the core
+-       */
+-      hdmi_core_swreset_assert(ip_data);
+-
+-      /* power down off */
+-      hdmi_core_powerdown_disable(ip_data);
+-
+-      v_core_cfg.pkt_mode = HDMI_PACKETMODE24BITPERPIXEL;
+-      v_core_cfg.hdmi_dvi = cfg->cm.mode;
+-
+-      hdmi_core_video_config(ip_data, &v_core_cfg);
+-
+-      /* release software reset in the core */
+-      hdmi_core_swreset_release(ip_data);
+-
+-      /*
+-       * configure packet
+-       * info frame video see doc CEA861-D page 65
+-       */
+-      avi_cfg->db1_format = HDMI_INFOFRAME_AVI_DB1Y_RGB;
+-      avi_cfg->db1_active_info =
+-                      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_OFF;
+-      avi_cfg->db1_bar_info_dv = HDMI_INFOFRAME_AVI_DB1B_NO;
+-      avi_cfg->db1_scan_info = HDMI_INFOFRAME_AVI_DB1S_0;
+-      avi_cfg->db2_colorimetry = HDMI_INFOFRAME_AVI_DB2C_NO;
+-      avi_cfg->db2_aspect_ratio = HDMI_INFOFRAME_AVI_DB2M_NO;
+-      avi_cfg->db2_active_fmt_ar = HDMI_INFOFRAME_AVI_DB2R_SAME;
+-      avi_cfg->db3_itc = HDMI_INFOFRAME_AVI_DB3ITC_NO;
+-      avi_cfg->db3_ec = HDMI_INFOFRAME_AVI_DB3EC_XVYUV601;
+-      avi_cfg->db3_q_range = HDMI_INFOFRAME_AVI_DB3Q_DEFAULT;
+-      avi_cfg->db3_nup_scaling = HDMI_INFOFRAME_AVI_DB3SC_NO;
+-      avi_cfg->db4_videocode = cfg->cm.code;
+-      avi_cfg->db5_pixel_repeat = HDMI_INFOFRAME_AVI_DB5PR_NO;
+-      avi_cfg->db6_7_line_eoftop = 0;
+-      avi_cfg->db8_9_line_sofbottom = 0;
+-      avi_cfg->db10_11_pixel_eofleft = 0;
+-      avi_cfg->db12_13_pixel_sofright = 0;
+-
+-      hdmi_core_aux_infoframe_avi_config(ip_data);
+-
+-      /* enable/repeat the infoframe */
+-      repeat_cfg.avi_infoframe = HDMI_PACKETENABLE;
+-      repeat_cfg.avi_infoframe_repeat = HDMI_PACKETREPEATON;
+-      /* wakeup */
+-      repeat_cfg.audio_pkt = HDMI_PACKETENABLE;
+-      repeat_cfg.audio_pkt_repeat = HDMI_PACKETREPEATON;
+-      hdmi_core_av_packet_config(ip_data, repeat_cfg);
+-}
+-
+-void ti_hdmi_4xxx_wp_dump(struct hdmi_ip_data *ip_data, struct seq_file *s)
+-{
+-#define DUMPREG(r) seq_printf(s, "%-35s %08x\n", #r,\
+-              hdmi_read_reg(hdmi_wp_base(ip_data), r))
+-
+-      DUMPREG(HDMI_WP_REVISION);
+-      DUMPREG(HDMI_WP_SYSCONFIG);
+-      DUMPREG(HDMI_WP_IRQSTATUS_RAW);
+-      DUMPREG(HDMI_WP_IRQSTATUS);
+-      DUMPREG(HDMI_WP_PWR_CTRL);
+-      DUMPREG(HDMI_WP_IRQENABLE_SET);
+-      DUMPREG(HDMI_WP_VIDEO_CFG);
+-      DUMPREG(HDMI_WP_VIDEO_SIZE);
+-      DUMPREG(HDMI_WP_VIDEO_TIMING_H);
+-      DUMPREG(HDMI_WP_VIDEO_TIMING_V);
+-      DUMPREG(HDMI_WP_WP_CLK);
+-      DUMPREG(HDMI_WP_AUDIO_CFG);
+-      DUMPREG(HDMI_WP_AUDIO_CFG2);
+-      DUMPREG(HDMI_WP_AUDIO_CTRL);
+-      DUMPREG(HDMI_WP_AUDIO_DATA);
+-}
+-
+-void ti_hdmi_4xxx_pll_dump(struct hdmi_ip_data *ip_data, struct seq_file *s)
+-{
+-#define DUMPPLL(r) seq_printf(s, "%-35s %08x\n", #r,\
+-              hdmi_read_reg(hdmi_pll_base(ip_data), r))
+-
+-      DUMPPLL(PLLCTRL_PLL_CONTROL);
+-      DUMPPLL(PLLCTRL_PLL_STATUS);
+-      DUMPPLL(PLLCTRL_PLL_GO);
+-      DUMPPLL(PLLCTRL_CFG1);
+-      DUMPPLL(PLLCTRL_CFG2);
+-      DUMPPLL(PLLCTRL_CFG3);
+-      DUMPPLL(PLLCTRL_CFG4);
+-}
+-
+-void ti_hdmi_4xxx_core_dump(struct hdmi_ip_data *ip_data, struct seq_file *s)
+-{
+-      int i;
+-
+-#define CORE_REG(i, name) name(i)
+-#define DUMPCORE(r) seq_printf(s, "%-35s %08x\n", #r,\
+-              hdmi_read_reg(hdmi_core_sys_base(ip_data), r))
+-#define DUMPCOREAV(r) seq_printf(s, "%-35s %08x\n", #r,\
+-              hdmi_read_reg(hdmi_av_base(ip_data), r))
+-#define DUMPCOREAV2(i, r) seq_printf(s, "%s[%d]%*s %08x\n", #r, i, \
+-              (i < 10) ? 32 - (int)strlen(#r) : 31 - (int)strlen(#r), " ", \
+-              hdmi_read_reg(hdmi_av_base(ip_data), CORE_REG(i, r)))
+-
+-      DUMPCORE(HDMI_CORE_SYS_VND_IDL);
+-      DUMPCORE(HDMI_CORE_SYS_DEV_IDL);
+-      DUMPCORE(HDMI_CORE_SYS_DEV_IDH);
+-      DUMPCORE(HDMI_CORE_SYS_DEV_REV);
+-      DUMPCORE(HDMI_CORE_SYS_SRST);
+-      DUMPCORE(HDMI_CORE_CTRL1);
+-      DUMPCORE(HDMI_CORE_SYS_SYS_STAT);
+-      DUMPCORE(HDMI_CORE_SYS_DE_DLY);
+-      DUMPCORE(HDMI_CORE_SYS_DE_CTRL);
+-      DUMPCORE(HDMI_CORE_SYS_DE_TOP);
+-      DUMPCORE(HDMI_CORE_SYS_DE_CNTL);
+-      DUMPCORE(HDMI_CORE_SYS_DE_CNTH);
+-      DUMPCORE(HDMI_CORE_SYS_DE_LINL);
+-      DUMPCORE(HDMI_CORE_SYS_DE_LINH_1);
+-      DUMPCORE(HDMI_CORE_SYS_VID_ACEN);
+-      DUMPCORE(HDMI_CORE_SYS_VID_MODE);
+-      DUMPCORE(HDMI_CORE_SYS_INTR_STATE);
+-      DUMPCORE(HDMI_CORE_SYS_INTR1);
+-      DUMPCORE(HDMI_CORE_SYS_INTR2);
+-      DUMPCORE(HDMI_CORE_SYS_INTR3);
+-      DUMPCORE(HDMI_CORE_SYS_INTR4);
+-      DUMPCORE(HDMI_CORE_SYS_UMASK1);
+-      DUMPCORE(HDMI_CORE_SYS_TMDS_CTRL);
+-
+-      DUMPCORE(HDMI_CORE_DDC_ADDR);
+-      DUMPCORE(HDMI_CORE_DDC_SEGM);
+-      DUMPCORE(HDMI_CORE_DDC_OFFSET);
+-      DUMPCORE(HDMI_CORE_DDC_COUNT1);
+-      DUMPCORE(HDMI_CORE_DDC_COUNT2);
+-      DUMPCORE(HDMI_CORE_DDC_STATUS);
+-      DUMPCORE(HDMI_CORE_DDC_CMD);
+-      DUMPCORE(HDMI_CORE_DDC_DATA);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_ACR_CTRL);
+-      DUMPCOREAV(HDMI_CORE_AV_FREQ_SVAL);
+-      DUMPCOREAV(HDMI_CORE_AV_N_SVAL1);
+-      DUMPCOREAV(HDMI_CORE_AV_N_SVAL2);
+-      DUMPCOREAV(HDMI_CORE_AV_N_SVAL3);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL1);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL2);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_SVAL3);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL1);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL2);
+-      DUMPCOREAV(HDMI_CORE_AV_CTS_HVAL3);
+-      DUMPCOREAV(HDMI_CORE_AV_AUD_MODE);
+-      DUMPCOREAV(HDMI_CORE_AV_SPDIF_CTRL);
+-      DUMPCOREAV(HDMI_CORE_AV_HW_SPDIF_FS);
+-      DUMPCOREAV(HDMI_CORE_AV_SWAP_I2S);
+-      DUMPCOREAV(HDMI_CORE_AV_SPDIF_ERTH);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_MAP);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_CTRL);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST0);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST1);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST2);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST4);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_CHST5);
+-      DUMPCOREAV(HDMI_CORE_AV_ASRC);
+-      DUMPCOREAV(HDMI_CORE_AV_I2S_IN_LEN);
+-      DUMPCOREAV(HDMI_CORE_AV_HDMI_CTRL);
+-      DUMPCOREAV(HDMI_CORE_AV_AUDO_TXSTAT);
+-      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_1);
+-      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_2);
+-      DUMPCOREAV(HDMI_CORE_AV_AUD_PAR_BUSCLK_3);
+-      DUMPCOREAV(HDMI_CORE_AV_TEST_TXCTRL);
+-      DUMPCOREAV(HDMI_CORE_AV_DPD);
+-      DUMPCOREAV(HDMI_CORE_AV_PB_CTRL1);
+-      DUMPCOREAV(HDMI_CORE_AV_PB_CTRL2);
+-      DUMPCOREAV(HDMI_CORE_AV_AVI_TYPE);
+-      DUMPCOREAV(HDMI_CORE_AV_AVI_VERS);
+-      DUMPCOREAV(HDMI_CORE_AV_AVI_LEN);
+-      DUMPCOREAV(HDMI_CORE_AV_AVI_CHSUM);
+-
+-      for (i = 0; i < HDMI_CORE_AV_AVI_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_AVI_DBYTE);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_SPD_TYPE);
+-      DUMPCOREAV(HDMI_CORE_AV_SPD_VERS);
+-      DUMPCOREAV(HDMI_CORE_AV_SPD_LEN);
+-      DUMPCOREAV(HDMI_CORE_AV_SPD_CHSUM);
+-
+-      for (i = 0; i < HDMI_CORE_AV_SPD_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_SPD_DBYTE);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_AUDIO_TYPE);
+-      DUMPCOREAV(HDMI_CORE_AV_AUDIO_VERS);
+-      DUMPCOREAV(HDMI_CORE_AV_AUDIO_LEN);
+-      DUMPCOREAV(HDMI_CORE_AV_AUDIO_CHSUM);
+-
+-      for (i = 0; i < HDMI_CORE_AV_AUD_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_AUD_DBYTE);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_MPEG_TYPE);
+-      DUMPCOREAV(HDMI_CORE_AV_MPEG_VERS);
+-      DUMPCOREAV(HDMI_CORE_AV_MPEG_LEN);
+-      DUMPCOREAV(HDMI_CORE_AV_MPEG_CHSUM);
+-
+-      for (i = 0; i < HDMI_CORE_AV_MPEG_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_MPEG_DBYTE);
+-
+-      for (i = 0; i < HDMI_CORE_AV_GEN_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_GEN_DBYTE);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_CP_BYTE1);
+-
+-      for (i = 0; i < HDMI_CORE_AV_GEN2_DBYTE_NELEMS; i++)
+-              DUMPCOREAV2(i, HDMI_CORE_AV_GEN2_DBYTE);
+-
+-      DUMPCOREAV(HDMI_CORE_AV_CEC_ADDR_ID);
+-}
+-
+-void ti_hdmi_4xxx_phy_dump(struct hdmi_ip_data *ip_data, struct seq_file *s)
+-{
+-#define DUMPPHY(r) seq_printf(s, "%-35s %08x\n", #r,\
+-              hdmi_read_reg(hdmi_phy_base(ip_data), r))
+-
+-      DUMPPHY(HDMI_TXPHY_TX_CTRL);
+-      DUMPPHY(HDMI_TXPHY_DIGITAL_CTRL);
+-      DUMPPHY(HDMI_TXPHY_POWER_CTRL);
+-      DUMPPHY(HDMI_TXPHY_PAD_CFG_CTRL);
+-}
+-
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-static void ti_hdmi_4xxx_wp_audio_config_format(struct hdmi_ip_data *ip_data,
+-                                      struct hdmi_audio_format *aud_fmt)
+-{
+-      u32 r;
+-
+-      DSSDBG("Enter hdmi_wp_audio_config_format\n");
+-
+-      r = hdmi_read_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CFG);
+-      r = FLD_MOD(r, aud_fmt->stereo_channels, 26, 24);
+-      r = FLD_MOD(r, aud_fmt->active_chnnls_msk, 23, 16);
+-      r = FLD_MOD(r, aud_fmt->en_sig_blk_strt_end, 5, 5);
+-      r = FLD_MOD(r, aud_fmt->type, 4, 4);
+-      r = FLD_MOD(r, aud_fmt->justification, 3, 3);
+-      r = FLD_MOD(r, aud_fmt->sample_order, 2, 2);
+-      r = FLD_MOD(r, aud_fmt->samples_per_word, 1, 1);
+-      r = FLD_MOD(r, aud_fmt->sample_size, 0, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CFG, r);
+-}
+-
+-static void ti_hdmi_4xxx_wp_audio_config_dma(struct hdmi_ip_data *ip_data,
+-                                      struct hdmi_audio_dma *aud_dma)
+-{
+-      u32 r;
+-
+-      DSSDBG("Enter hdmi_wp_audio_config_dma\n");
+-
+-      r = hdmi_read_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CFG2);
+-      r = FLD_MOD(r, aud_dma->transfer_size, 15, 8);
+-      r = FLD_MOD(r, aud_dma->block_size, 7, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CFG2, r);
+-
+-      r = hdmi_read_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CTRL);
+-      r = FLD_MOD(r, aud_dma->mode, 9, 9);
+-      r = FLD_MOD(r, aud_dma->fifo_threshold, 8, 0);
+-      hdmi_write_reg(hdmi_wp_base(ip_data), HDMI_WP_AUDIO_CTRL, r);
+-}
+-
+-static void ti_hdmi_4xxx_core_audio_config(struct hdmi_ip_data *ip_data,
+-                                      struct hdmi_core_audio_config *cfg)
+-{
+-      u32 r;
+-      void __iomem *av_base = hdmi_av_base(ip_data);
+-
+-      /*
+-       * Parameters for generation of Audio Clock Recovery packets
+-       */
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL1, cfg->n, 7, 0);
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL2, cfg->n >> 8, 7, 0);
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_N_SVAL3, cfg->n >> 16, 7, 0);
+-
+-      if (cfg->cts_mode == HDMI_AUDIO_CTS_MODE_SW) {
+-              REG_FLD_MOD(av_base, HDMI_CORE_AV_CTS_SVAL1, cfg->cts, 7, 0);
+-              REG_FLD_MOD(av_base,
+-                              HDMI_CORE_AV_CTS_SVAL2, cfg->cts >> 8, 7, 0);
+-              REG_FLD_MOD(av_base,
+-                              HDMI_CORE_AV_CTS_SVAL3, cfg->cts >> 16, 7, 0);
+-      } else {
+-              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_1,
+-                              cfg->aud_par_busclk, 7, 0);
+-              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_2,
+-                              (cfg->aud_par_busclk >> 8), 7, 0);
+-              REG_FLD_MOD(av_base, HDMI_CORE_AV_AUD_PAR_BUSCLK_3,
+-                              (cfg->aud_par_busclk >> 16), 7, 0);
+-      }
+-
+-      /* Set ACR clock divisor */
+-      REG_FLD_MOD(av_base,
+-                      HDMI_CORE_AV_FREQ_SVAL, cfg->mclk_mode, 2, 0);
+-
+-      r = hdmi_read_reg(av_base, HDMI_CORE_AV_ACR_CTRL);
+-      /*
+-       * Use TMDS clock for ACR packets. For devices that use
+-       * the MCLK, this is the first part of the MCLK initialization.
+-       */
+-      r = FLD_MOD(r, 0, 2, 2);
+-
+-      r = FLD_MOD(r, cfg->en_acr_pkt, 1, 1);
+-      r = FLD_MOD(r, cfg->cts_mode, 0, 0);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_ACR_CTRL, r);
+-
+-      /* For devices using MCLK, this completes its initialization. */
+-      if (cfg->use_mclk)
+-              REG_FLD_MOD(av_base, HDMI_CORE_AV_ACR_CTRL, 1, 2, 2);
+-
+-      /* Override of SPDIF sample frequency with value in I2S_CHST4 */
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_SPDIF_CTRL,
+-                                              cfg->fs_override, 1, 1);
+-
+-      /*
+-       * Set IEC-60958-3 channel status word. It is passed to the IP
+-       * just as it is received. The user of the driver is responsible
+-       * for its contents.
+-       */
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST0,
+-                     cfg->iec60958_cfg->status[0]);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST1,
+-                     cfg->iec60958_cfg->status[1]);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST2,
+-                     cfg->iec60958_cfg->status[2]);
+-      /* yes, this is correct: status[3] goes to CHST4 register */
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST4,
+-                     cfg->iec60958_cfg->status[3]);
+-      /* yes, this is correct: status[4] goes to CHST5 register */
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_CHST5,
+-                     cfg->iec60958_cfg->status[4]);
+-
+-      /* set I2S parameters */
+-      r = hdmi_read_reg(av_base, HDMI_CORE_AV_I2S_IN_CTRL);
+-      r = FLD_MOD(r, cfg->i2s_cfg.sck_edge_mode, 6, 6);
+-      r = FLD_MOD(r, cfg->i2s_cfg.vbit, 4, 4);
+-      r = FLD_MOD(r, cfg->i2s_cfg.justification, 2, 2);
+-      r = FLD_MOD(r, cfg->i2s_cfg.direction, 1, 1);
+-      r = FLD_MOD(r, cfg->i2s_cfg.shift, 0, 0);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_IN_CTRL, r);
+-
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_I2S_IN_LEN,
+-                      cfg->i2s_cfg.in_length_bits, 3, 0);
+-
+-      /* Audio channels and mode parameters */
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_HDMI_CTRL, cfg->layout, 2, 1);
+-      r = hdmi_read_reg(av_base, HDMI_CORE_AV_AUD_MODE);
+-      r = FLD_MOD(r, cfg->i2s_cfg.active_sds, 7, 4);
+-      r = FLD_MOD(r, cfg->en_dsd_audio, 3, 3);
+-      r = FLD_MOD(r, cfg->en_parallel_aud_input, 2, 2);
+-      r = FLD_MOD(r, cfg->en_spdif, 1, 1);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_MODE, r);
+-
+-      /* Audio channel mappings */
+-      /* TODO: Make channel mapping dynamic. For now, map channels
+-       * in the ALSA order: FL/FR/RL/RR/C/LFE/SL/SR. Remapping is needed as
+-       * HDMI speaker order is different. See CEA-861 Section 6.6.2.
+-       */
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_I2S_IN_MAP, 0x78);
+-      REG_FLD_MOD(av_base, HDMI_CORE_AV_SWAP_I2S, 1, 5, 5);
+-}
+-
+-static void ti_hdmi_4xxx_core_audio_infoframe_cfg(struct hdmi_ip_data *ip_data,
+-              struct snd_cea_861_aud_if *info_aud)
+-{
+-      u8 sum = 0, checksum = 0;
+-      void __iomem *av_base = hdmi_av_base(ip_data);
+-
+-      /*
+-       * Set audio info frame type, version and length as
+-       * described in HDMI 1.4a Section 8.2.2 specification.
+-       * Checksum calculation is defined in Section 5.3.5.
+-       */
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_TYPE, 0x84);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_VERS, 0x01);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUDIO_LEN, 0x0a);
+-      sum += 0x84 + 0x001 + 0x00a;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(0),
+-                     info_aud->db1_ct_cc);
+-      sum += info_aud->db1_ct_cc;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(1),
+-                     info_aud->db2_sf_ss);
+-      sum += info_aud->db2_sf_ss;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(2), info_aud->db3);
+-      sum += info_aud->db3;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(3), info_aud->db4_ca);
+-      sum += info_aud->db4_ca;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(4),
+-                     info_aud->db5_dminh_lsv);
+-      sum += info_aud->db5_dminh_lsv;
+-
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(5), 0x00);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(6), 0x00);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(7), 0x00);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(8), 0x00);
+-      hdmi_write_reg(av_base, HDMI_CORE_AV_AUD_DBYTE(9), 0x00);
+-
+-      checksum = 0x100 - sum;
+-      hdmi_write_reg(av_base,
+-                                      HDMI_CORE_AV_AUDIO_CHSUM, checksum);
+-
+-      /*
+-       * TODO: Add MPEG and SPD enable and repeat cfg when EDID parsing
+-       * is available.
+-       */
+-}
+-
+-int ti_hdmi_4xxx_audio_config(struct hdmi_ip_data *ip_data,
+-              struct omap_dss_audio *audio)
+-{
+-      struct hdmi_audio_format audio_format;
+-      struct hdmi_audio_dma audio_dma;
+-      struct hdmi_core_audio_config core;
+-      int err, n, cts, channel_count;
+-      unsigned int fs_nr;
+-      bool word_length_16b = false;
+-
+-      if (!audio || !audio->iec || !audio->cea || !ip_data)
+-              return -EINVAL;
+-
+-      core.iec60958_cfg = audio->iec;
+-      /*
+-       * In the IEC-60958 status word, check if the audio sample word length
+-       * is 16-bit as several optimizations can be performed in such case.
+-       */
+-      if (!(audio->iec->status[4] & IEC958_AES4_CON_MAX_WORDLEN_24))
+-              if (audio->iec->status[4] & IEC958_AES4_CON_WORDLEN_20_16)
+-                      word_length_16b = true;
+-
+-      /* I2S configuration. See Phillips' specification */
+-      if (word_length_16b)
+-              core.i2s_cfg.justification = HDMI_AUDIO_JUSTIFY_LEFT;
+-      else
+-              core.i2s_cfg.justification = HDMI_AUDIO_JUSTIFY_RIGHT;
+-      /*
+-       * The I2S input word length is twice the lenght given in the IEC-60958
+-       * status word. If the word size is greater than
+-       * 20 bits, increment by one.
+-       */
+-      core.i2s_cfg.in_length_bits = audio->iec->status[4]
+-              & IEC958_AES4_CON_WORDLEN;
+-      if (audio->iec->status[4] & IEC958_AES4_CON_MAX_WORDLEN_24)
+-              core.i2s_cfg.in_length_bits++;
+-      core.i2s_cfg.sck_edge_mode = HDMI_AUDIO_I2S_SCK_EDGE_RISING;
+-      core.i2s_cfg.vbit = HDMI_AUDIO_I2S_VBIT_FOR_PCM;
+-      core.i2s_cfg.direction = HDMI_AUDIO_I2S_MSB_SHIFTED_FIRST;
+-      core.i2s_cfg.shift = HDMI_AUDIO_I2S_FIRST_BIT_SHIFT;
+-
+-      /* convert sample frequency to a number */
+-      switch (audio->iec->status[3] & IEC958_AES3_CON_FS) {
+-      case IEC958_AES3_CON_FS_32000:
+-              fs_nr = 32000;
+-              break;
+-      case IEC958_AES3_CON_FS_44100:
+-              fs_nr = 44100;
+-              break;
+-      case IEC958_AES3_CON_FS_48000:
+-              fs_nr = 48000;
+-              break;
+-      case IEC958_AES3_CON_FS_88200:
+-              fs_nr = 88200;
+-              break;
+-      case IEC958_AES3_CON_FS_96000:
+-              fs_nr = 96000;
+-              break;
+-      case IEC958_AES3_CON_FS_176400:
+-              fs_nr = 176400;
+-              break;
+-      case IEC958_AES3_CON_FS_192000:
+-              fs_nr = 192000;
+-              break;
+-      default:
+-              return -EINVAL;
+-      }
+-
+-      err = hdmi_compute_acr(fs_nr, &n, &cts);
+-
+-      /* Audio clock regeneration settings */
+-      core.n = n;
+-      core.cts = cts;
+-      if (dss_has_feature(FEAT_HDMI_CTS_SWMODE)) {
+-              core.aud_par_busclk = 0;
+-              core.cts_mode = HDMI_AUDIO_CTS_MODE_SW;
+-              core.use_mclk = dss_has_feature(FEAT_HDMI_AUDIO_USE_MCLK);
+-      } else {
+-              core.aud_par_busclk = (((128 * 31) - 1) << 8);
+-              core.cts_mode = HDMI_AUDIO_CTS_MODE_HW;
+-              core.use_mclk = true;
+-      }
+-
+-      if (core.use_mclk)
+-              core.mclk_mode = HDMI_AUDIO_MCLK_128FS;
+-
+-      /* Audio channels settings */
+-      channel_count = (audio->cea->db1_ct_cc &
+-                       CEA861_AUDIO_INFOFRAME_DB1CC) + 1;
+-
+-      switch (channel_count) {
+-      case 2:
+-              audio_format.active_chnnls_msk = 0x03;
+-              break;
+-      case 3:
+-              audio_format.active_chnnls_msk = 0x07;
+-              break;
+-      case 4:
+-              audio_format.active_chnnls_msk = 0x0f;
+-              break;
+-      case 5:
+-              audio_format.active_chnnls_msk = 0x1f;
+-              break;
+-      case 6:
+-              audio_format.active_chnnls_msk = 0x3f;
+-              break;
+-      case 7:
+-              audio_format.active_chnnls_msk = 0x7f;
+-              break;
+-      case 8:
+-              audio_format.active_chnnls_msk = 0xff;
+-              break;
+-      default:
+-              return -EINVAL;
+-      }
+-
+-      /*
+-       * the HDMI IP needs to enable four stereo channels when transmitting
+-       * more than 2 audio channels
+-       */
+-      if (channel_count == 2) {
+-              audio_format.stereo_channels = HDMI_AUDIO_STEREO_ONECHANNEL;
+-              core.i2s_cfg.active_sds = HDMI_AUDIO_I2S_SD0_EN;
+-              core.layout = HDMI_AUDIO_LAYOUT_2CH;
+-      } else {
+-              audio_format.stereo_channels = HDMI_AUDIO_STEREO_FOURCHANNELS;
+-              core.i2s_cfg.active_sds = HDMI_AUDIO_I2S_SD0_EN |
+-                              HDMI_AUDIO_I2S_SD1_EN | HDMI_AUDIO_I2S_SD2_EN |
+-                              HDMI_AUDIO_I2S_SD3_EN;
+-              core.layout = HDMI_AUDIO_LAYOUT_8CH;
+-      }
+-
+-      core.en_spdif = false;
+-      /* use sample frequency from channel status word */
+-      core.fs_override = true;
+-      /* enable ACR packets */
+-      core.en_acr_pkt = true;
+-      /* disable direct streaming digital audio */
+-      core.en_dsd_audio = false;
+-      /* use parallel audio interface */
+-      core.en_parallel_aud_input = true;
+-
+-      /* DMA settings */
+-      if (word_length_16b)
+-              audio_dma.transfer_size = 0x10;
+-      else
+-              audio_dma.transfer_size = 0x20;
+-      audio_dma.block_size = 0xC0;
+-      audio_dma.mode = HDMI_AUDIO_TRANSF_DMA;
+-      audio_dma.fifo_threshold = 0x20; /* in number of samples */
+-
+-      /* audio FIFO format settings */
+-      if (word_length_16b) {
+-              audio_format.samples_per_word = HDMI_AUDIO_ONEWORD_TWOSAMPLES;
+-              audio_format.sample_size = HDMI_AUDIO_SAMPLE_16BITS;
+-              audio_format.justification = HDMI_AUDIO_JUSTIFY_LEFT;
+-      } else {
+-              audio_format.samples_per_word = HDMI_AUDIO_ONEWORD_ONESAMPLE;
+-              audio_format.sample_size = HDMI_AUDIO_SAMPLE_24BITS;
+-              audio_format.justification = HDMI_AUDIO_JUSTIFY_RIGHT;
+-      }
+-      audio_format.type = HDMI_AUDIO_TYPE_LPCM;
+-      audio_format.sample_order = HDMI_AUDIO_SAMPLE_LEFT_FIRST;
+-      /* disable start/stop signals of IEC 60958 blocks */
+-      audio_format.en_sig_blk_strt_end = HDMI_AUDIO_BLOCK_SIG_STARTEND_ON;
+-
+-      /* configure DMA and audio FIFO format*/
+-      ti_hdmi_4xxx_wp_audio_config_dma(ip_data, &audio_dma);
+-      ti_hdmi_4xxx_wp_audio_config_format(ip_data, &audio_format);
+-
+-      /* configure the core*/
+-      ti_hdmi_4xxx_core_audio_config(ip_data, &core);
+-
+-      /* configure CEA 861 audio infoframe*/
+-      ti_hdmi_4xxx_core_audio_infoframe_cfg(ip_data, audio->cea);
+-
+-      return 0;
+-}
+-
+-int ti_hdmi_4xxx_wp_audio_enable(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_wp_base(ip_data),
+-                  HDMI_WP_AUDIO_CTRL, true, 31, 31);
+-      return 0;
+-}
+-
+-void ti_hdmi_4xxx_wp_audio_disable(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_wp_base(ip_data),
+-                  HDMI_WP_AUDIO_CTRL, false, 31, 31);
+-}
+-
+-int ti_hdmi_4xxx_audio_start(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_av_base(ip_data),
+-                  HDMI_CORE_AV_AUD_MODE, true, 0, 0);
+-      REG_FLD_MOD(hdmi_wp_base(ip_data),
+-                  HDMI_WP_AUDIO_CTRL, true, 30, 30);
+-      return 0;
+-}
+-
+-void ti_hdmi_4xxx_audio_stop(struct hdmi_ip_data *ip_data)
+-{
+-      REG_FLD_MOD(hdmi_av_base(ip_data),
+-                  HDMI_CORE_AV_AUD_MODE, false, 0, 0);
+-      REG_FLD_MOD(hdmi_wp_base(ip_data),
+-                  HDMI_WP_AUDIO_CTRL, false, 30, 30);
+-}
+-
+-int ti_hdmi_4xxx_audio_get_dma_port(u32 *offset, u32 *size)
+-{
+-      if (!offset || !size)
+-              return -EINVAL;
+-      *offset = HDMI_WP_AUDIO_DATA;
+-      *size = 4;
+-      return 0;
+-}
+-#endif
+--- a/drivers/video/omap2/dss/ti_hdmi_4xxx_ip.h
++++ /dev/null
+@@ -1,437 +0,0 @@
+-/*
+- * ti_hdmi_4xxx_ip.h
+- *
+- * HDMI header definition for DM81xx, DM38xx, TI OMAP4 etc processors.
+- *
+- * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
+- *
+- * 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/>.
+- */
+-
+-#ifndef _HDMI_TI_4xxx_H_
+-#define _HDMI_TI_4xxx_H_
+-
+-#include <linux/string.h>
+-#include <video/omapdss.h>
+-#include "ti_hdmi.h"
+-
+-/* HDMI Wrapper */
+-
+-#define HDMI_WP_REVISION                      0x0
+-#define HDMI_WP_SYSCONFIG                     0x10
+-#define HDMI_WP_IRQSTATUS_RAW                 0x24
+-#define HDMI_WP_IRQSTATUS                     0x28
+-#define HDMI_WP_PWR_CTRL                      0x40
+-#define HDMI_WP_IRQENABLE_SET                 0x2C
+-#define HDMI_WP_IRQENABLE_CLR                 0x30
+-#define HDMI_WP_VIDEO_CFG                     0x50
+-#define HDMI_WP_VIDEO_SIZE                    0x60
+-#define HDMI_WP_VIDEO_TIMING_H                        0x68
+-#define HDMI_WP_VIDEO_TIMING_V                        0x6C
+-#define HDMI_WP_WP_CLK                                0x70
+-#define HDMI_WP_AUDIO_CFG                     0x80
+-#define HDMI_WP_AUDIO_CFG2                    0x84
+-#define HDMI_WP_AUDIO_CTRL                    0x88
+-#define HDMI_WP_AUDIO_DATA                    0x8C
+-
+-/* HDMI IP Core System */
+-
+-#define HDMI_CORE_SYS_VND_IDL                 0x0
+-#define HDMI_CORE_SYS_DEV_IDL                 0x8
+-#define HDMI_CORE_SYS_DEV_IDH                 0xC
+-#define HDMI_CORE_SYS_DEV_REV                 0x10
+-#define HDMI_CORE_SYS_SRST                    0x14
+-#define HDMI_CORE_CTRL1                               0x20
+-#define HDMI_CORE_SYS_SYS_STAT                        0x24
+-#define HDMI_CORE_SYS_DE_DLY                  0xC8
+-#define HDMI_CORE_SYS_DE_CTRL                 0xCC
+-#define HDMI_CORE_SYS_DE_TOP                  0xD0
+-#define HDMI_CORE_SYS_DE_CNTL                 0xD8
+-#define HDMI_CORE_SYS_DE_CNTH                 0xDC
+-#define HDMI_CORE_SYS_DE_LINL                 0xE0
+-#define HDMI_CORE_SYS_DE_LINH_1                       0xE4
+-#define HDMI_CORE_SYS_VID_ACEN                        0x124
+-#define HDMI_CORE_SYS_VID_MODE                        0x128
+-#define HDMI_CORE_SYS_INTR_STATE              0x1C0
+-#define HDMI_CORE_SYS_INTR1                   0x1C4
+-#define HDMI_CORE_SYS_INTR2                   0x1C8
+-#define HDMI_CORE_SYS_INTR3                   0x1CC
+-#define HDMI_CORE_SYS_INTR4                   0x1D0
+-#define HDMI_CORE_SYS_UMASK1                  0x1D4
+-#define HDMI_CORE_SYS_TMDS_CTRL                       0x208
+-
+-#define HDMI_CORE_CTRL1_VEN_FOLLOWVSYNC       0x1
+-#define HDMI_CORE_CTRL1_HEN_FOLLOWHSYNC       0x1
+-#define HDMI_CORE_CTRL1_BSEL_24BITBUS 0x1
+-#define HDMI_CORE_CTRL1_EDGE_RISINGEDGE       0x1
+-
+-/* HDMI DDC E-DID */
+-#define HDMI_CORE_DDC_ADDR                    0x3B4
+-#define HDMI_CORE_DDC_SEGM                    0x3B8
+-#define HDMI_CORE_DDC_OFFSET                  0x3BC
+-#define HDMI_CORE_DDC_COUNT1                  0x3C0
+-#define HDMI_CORE_DDC_COUNT2                  0x3C4
+-#define HDMI_CORE_DDC_STATUS                  0x3C8
+-#define HDMI_CORE_DDC_CMD                     0x3CC
+-#define HDMI_CORE_DDC_DATA                    0x3D0
+-
+-/* HDMI IP Core Audio Video */
+-
+-#define HDMI_CORE_AV_ACR_CTRL                 0x4
+-#define HDMI_CORE_AV_FREQ_SVAL                        0x8
+-#define HDMI_CORE_AV_N_SVAL1                  0xC
+-#define HDMI_CORE_AV_N_SVAL2                  0x10
+-#define HDMI_CORE_AV_N_SVAL3                  0x14
+-#define HDMI_CORE_AV_CTS_SVAL1                        0x18
+-#define HDMI_CORE_AV_CTS_SVAL2                        0x1C
+-#define HDMI_CORE_AV_CTS_SVAL3                        0x20
+-#define HDMI_CORE_AV_CTS_HVAL1                        0x24
+-#define HDMI_CORE_AV_CTS_HVAL2                        0x28
+-#define HDMI_CORE_AV_CTS_HVAL3                        0x2C
+-#define HDMI_CORE_AV_AUD_MODE                 0x50
+-#define HDMI_CORE_AV_SPDIF_CTRL                       0x54
+-#define HDMI_CORE_AV_HW_SPDIF_FS              0x60
+-#define HDMI_CORE_AV_SWAP_I2S                 0x64
+-#define HDMI_CORE_AV_SPDIF_ERTH                       0x6C
+-#define HDMI_CORE_AV_I2S_IN_MAP                       0x70
+-#define HDMI_CORE_AV_I2S_IN_CTRL              0x74
+-#define HDMI_CORE_AV_I2S_CHST0                        0x78
+-#define HDMI_CORE_AV_I2S_CHST1                        0x7C
+-#define HDMI_CORE_AV_I2S_CHST2                        0x80
+-#define HDMI_CORE_AV_I2S_CHST4                        0x84
+-#define HDMI_CORE_AV_I2S_CHST5                        0x88
+-#define HDMI_CORE_AV_ASRC                     0x8C
+-#define HDMI_CORE_AV_I2S_IN_LEN                       0x90
+-#define HDMI_CORE_AV_HDMI_CTRL                        0xBC
+-#define HDMI_CORE_AV_AUDO_TXSTAT              0xC0
+-#define HDMI_CORE_AV_AUD_PAR_BUSCLK_1         0xCC
+-#define HDMI_CORE_AV_AUD_PAR_BUSCLK_2         0xD0
+-#define HDMI_CORE_AV_AUD_PAR_BUSCLK_3         0xD4
+-#define HDMI_CORE_AV_TEST_TXCTRL              0xF0
+-#define HDMI_CORE_AV_DPD                      0xF4
+-#define HDMI_CORE_AV_PB_CTRL1                 0xF8
+-#define HDMI_CORE_AV_PB_CTRL2                 0xFC
+-#define HDMI_CORE_AV_AVI_TYPE                 0x100
+-#define HDMI_CORE_AV_AVI_VERS                 0x104
+-#define HDMI_CORE_AV_AVI_LEN                  0x108
+-#define HDMI_CORE_AV_AVI_CHSUM                        0x10C
+-#define HDMI_CORE_AV_AVI_DBYTE(n)             (n * 4 + 0x110)
+-#define HDMI_CORE_AV_SPD_TYPE                 0x180
+-#define HDMI_CORE_AV_SPD_VERS                 0x184
+-#define HDMI_CORE_AV_SPD_LEN                  0x188
+-#define HDMI_CORE_AV_SPD_CHSUM                        0x18C
+-#define HDMI_CORE_AV_SPD_DBYTE(n)             (n * 4 + 0x190)
+-#define HDMI_CORE_AV_AUDIO_TYPE                       0x200
+-#define HDMI_CORE_AV_AUDIO_VERS                       0x204
+-#define HDMI_CORE_AV_AUDIO_LEN                        0x208
+-#define HDMI_CORE_AV_AUDIO_CHSUM              0x20C
+-#define HDMI_CORE_AV_AUD_DBYTE(n)             (n * 4 + 0x210)
+-#define HDMI_CORE_AV_MPEG_TYPE                        0x280
+-#define HDMI_CORE_AV_MPEG_VERS                        0x284
+-#define HDMI_CORE_AV_MPEG_LEN                 0x288
+-#define HDMI_CORE_AV_MPEG_CHSUM                       0x28C
+-#define HDMI_CORE_AV_MPEG_DBYTE(n)            (n * 4 + 0x290)
+-#define HDMI_CORE_AV_GEN_DBYTE(n)             (n * 4 + 0x300)
+-#define HDMI_CORE_AV_CP_BYTE1                 0x37C
+-#define HDMI_CORE_AV_GEN2_DBYTE(n)            (n * 4 + 0x380)
+-#define HDMI_CORE_AV_CEC_ADDR_ID              0x3FC
+-
+-#define HDMI_CORE_AV_SPD_DBYTE_ELSIZE         0x4
+-#define HDMI_CORE_AV_GEN2_DBYTE_ELSIZE                0x4
+-#define HDMI_CORE_AV_MPEG_DBYTE_ELSIZE                0x4
+-#define HDMI_CORE_AV_GEN_DBYTE_ELSIZE         0x4
+-
+-#define HDMI_CORE_AV_AVI_DBYTE_NELEMS         15
+-#define HDMI_CORE_AV_SPD_DBYTE_NELEMS         27
+-#define HDMI_CORE_AV_AUD_DBYTE_NELEMS         10
+-#define HDMI_CORE_AV_MPEG_DBYTE_NELEMS                27
+-#define HDMI_CORE_AV_GEN_DBYTE_NELEMS         31
+-#define HDMI_CORE_AV_GEN2_DBYTE_NELEMS                31
+-
+-/* PLL */
+-
+-#define PLLCTRL_PLL_CONTROL                   0x0
+-#define PLLCTRL_PLL_STATUS                    0x4
+-#define PLLCTRL_PLL_GO                                0x8
+-#define PLLCTRL_CFG1                          0xC
+-#define PLLCTRL_CFG2                          0x10
+-#define PLLCTRL_CFG3                          0x14
+-#define PLLCTRL_CFG4                          0x20
+-
+-/* HDMI PHY */
+-
+-#define HDMI_TXPHY_TX_CTRL                    0x0
+-#define HDMI_TXPHY_DIGITAL_CTRL                       0x4
+-#define HDMI_TXPHY_POWER_CTRL                 0x8
+-#define HDMI_TXPHY_PAD_CFG_CTRL                       0xC
+-
+-#define REG_FLD_MOD(base, idx, val, start, end) \
+-      hdmi_write_reg(base, idx, FLD_MOD(hdmi_read_reg(base, idx),\
+-                                                      val, start, end))
+-#define REG_GET(base, idx, start, end) \
+-      FLD_GET(hdmi_read_reg(base, idx), start, end)
+-
+-enum hdmi_phy_pwr {
+-      HDMI_PHYPWRCMD_OFF = 0,
+-      HDMI_PHYPWRCMD_LDOON = 1,
+-      HDMI_PHYPWRCMD_TXON = 2
+-};
+-
+-enum hdmi_core_inputbus_width {
+-      HDMI_INPUT_8BIT = 0,
+-      HDMI_INPUT_10BIT = 1,
+-      HDMI_INPUT_12BIT = 2
+-};
+-
+-enum hdmi_core_dither_trunc {
+-      HDMI_OUTPUTTRUNCATION_8BIT = 0,
+-      HDMI_OUTPUTTRUNCATION_10BIT = 1,
+-      HDMI_OUTPUTTRUNCATION_12BIT = 2,
+-      HDMI_OUTPUTDITHER_8BIT = 3,
+-      HDMI_OUTPUTDITHER_10BIT = 4,
+-      HDMI_OUTPUTDITHER_12BIT = 5
+-};
+-
+-enum hdmi_core_deepcolor_ed {
+-      HDMI_DEEPCOLORPACKECTDISABLE = 0,
+-      HDMI_DEEPCOLORPACKECTENABLE = 1
+-};
+-
+-enum hdmi_core_packet_mode {
+-      HDMI_PACKETMODERESERVEDVALUE = 0,
+-      HDMI_PACKETMODE24BITPERPIXEL = 4,
+-      HDMI_PACKETMODE30BITPERPIXEL = 5,
+-      HDMI_PACKETMODE36BITPERPIXEL = 6,
+-      HDMI_PACKETMODE48BITPERPIXEL = 7
+-};
+-
+-enum hdmi_core_tclkselclkmult {
+-      HDMI_FPLL05IDCK = 0,
+-      HDMI_FPLL10IDCK = 1,
+-      HDMI_FPLL20IDCK = 2,
+-      HDMI_FPLL40IDCK = 3
+-};
+-
+-enum hdmi_core_packet_ctrl {
+-      HDMI_PACKETENABLE = 1,
+-      HDMI_PACKETDISABLE = 0,
+-      HDMI_PACKETREPEATON = 1,
+-      HDMI_PACKETREPEATOFF = 0
+-};
+-
+-/* INFOFRAME_AVI_ and INFOFRAME_AUDIO_ definitions */
+-enum hdmi_core_infoframe {
+-      HDMI_INFOFRAME_AVI_DB1Y_RGB = 0,
+-      HDMI_INFOFRAME_AVI_DB1Y_YUV422 = 1,
+-      HDMI_INFOFRAME_AVI_DB1Y_YUV444 = 2,
+-      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_OFF = 0,
+-      HDMI_INFOFRAME_AVI_DB1A_ACTIVE_FORMAT_ON =  1,
+-      HDMI_INFOFRAME_AVI_DB1B_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB1B_VERT = 1,
+-      HDMI_INFOFRAME_AVI_DB1B_HORI = 2,
+-      HDMI_INFOFRAME_AVI_DB1B_VERTHORI = 3,
+-      HDMI_INFOFRAME_AVI_DB1S_0 = 0,
+-      HDMI_INFOFRAME_AVI_DB1S_1 = 1,
+-      HDMI_INFOFRAME_AVI_DB1S_2 = 2,
+-      HDMI_INFOFRAME_AVI_DB2C_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB2C_ITU601 = 1,
+-      HDMI_INFOFRAME_AVI_DB2C_ITU709 = 2,
+-      HDMI_INFOFRAME_AVI_DB2C_EC_EXTENDED = 3,
+-      HDMI_INFOFRAME_AVI_DB2M_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB2M_43 = 1,
+-      HDMI_INFOFRAME_AVI_DB2M_169 = 2,
+-      HDMI_INFOFRAME_AVI_DB2R_SAME = 8,
+-      HDMI_INFOFRAME_AVI_DB2R_43 = 9,
+-      HDMI_INFOFRAME_AVI_DB2R_169 = 10,
+-      HDMI_INFOFRAME_AVI_DB2R_149 = 11,
+-      HDMI_INFOFRAME_AVI_DB3ITC_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB3ITC_YES = 1,
+-      HDMI_INFOFRAME_AVI_DB3EC_XVYUV601 = 0,
+-      HDMI_INFOFRAME_AVI_DB3EC_XVYUV709 = 1,
+-      HDMI_INFOFRAME_AVI_DB3Q_DEFAULT = 0,
+-      HDMI_INFOFRAME_AVI_DB3Q_LR = 1,
+-      HDMI_INFOFRAME_AVI_DB3Q_FR = 2,
+-      HDMI_INFOFRAME_AVI_DB3SC_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB3SC_HORI = 1,
+-      HDMI_INFOFRAME_AVI_DB3SC_VERT = 2,
+-      HDMI_INFOFRAME_AVI_DB3SC_HORIVERT = 3,
+-      HDMI_INFOFRAME_AVI_DB5PR_NO = 0,
+-      HDMI_INFOFRAME_AVI_DB5PR_2 = 1,
+-      HDMI_INFOFRAME_AVI_DB5PR_3 = 2,
+-      HDMI_INFOFRAME_AVI_DB5PR_4 = 3,
+-      HDMI_INFOFRAME_AVI_DB5PR_5 = 4,
+-      HDMI_INFOFRAME_AVI_DB5PR_6 = 5,
+-      HDMI_INFOFRAME_AVI_DB5PR_7 = 6,
+-      HDMI_INFOFRAME_AVI_DB5PR_8 = 7,
+-      HDMI_INFOFRAME_AVI_DB5PR_9 = 8,
+-      HDMI_INFOFRAME_AVI_DB5PR_10 = 9,
+-};
+-
+-enum hdmi_packing_mode {
+-      HDMI_PACK_10b_RGB_YUV444 = 0,
+-      HDMI_PACK_24b_RGB_YUV444_YUV422 = 1,
+-      HDMI_PACK_20b_YUV422 = 2,
+-      HDMI_PACK_ALREADYPACKED = 7
+-};
+-
+-enum hdmi_core_audio_layout {
+-      HDMI_AUDIO_LAYOUT_2CH = 0,
+-      HDMI_AUDIO_LAYOUT_8CH = 1
+-};
+-
+-enum hdmi_core_cts_mode {
+-      HDMI_AUDIO_CTS_MODE_HW = 0,
+-      HDMI_AUDIO_CTS_MODE_SW = 1
+-};
+-
+-enum hdmi_stereo_channels {
+-      HDMI_AUDIO_STEREO_NOCHANNELS = 0,
+-      HDMI_AUDIO_STEREO_ONECHANNEL = 1,
+-      HDMI_AUDIO_STEREO_TWOCHANNELS = 2,
+-      HDMI_AUDIO_STEREO_THREECHANNELS = 3,
+-      HDMI_AUDIO_STEREO_FOURCHANNELS = 4
+-};
+-
+-enum hdmi_audio_type {
+-      HDMI_AUDIO_TYPE_LPCM = 0,
+-      HDMI_AUDIO_TYPE_IEC = 1
+-};
+-
+-enum hdmi_audio_justify {
+-      HDMI_AUDIO_JUSTIFY_LEFT = 0,
+-      HDMI_AUDIO_JUSTIFY_RIGHT = 1
+-};
+-
+-enum hdmi_audio_sample_order {
+-      HDMI_AUDIO_SAMPLE_RIGHT_FIRST = 0,
+-      HDMI_AUDIO_SAMPLE_LEFT_FIRST = 1
+-};
+-
+-enum hdmi_audio_samples_perword {
+-      HDMI_AUDIO_ONEWORD_ONESAMPLE = 0,
+-      HDMI_AUDIO_ONEWORD_TWOSAMPLES = 1
+-};
+-
+-enum hdmi_audio_sample_size {
+-      HDMI_AUDIO_SAMPLE_16BITS = 0,
+-      HDMI_AUDIO_SAMPLE_24BITS = 1
+-};
+-
+-enum hdmi_audio_transf_mode {
+-      HDMI_AUDIO_TRANSF_DMA = 0,
+-      HDMI_AUDIO_TRANSF_IRQ = 1
+-};
+-
+-enum hdmi_audio_blk_strt_end_sig {
+-      HDMI_AUDIO_BLOCK_SIG_STARTEND_ON = 0,
+-      HDMI_AUDIO_BLOCK_SIG_STARTEND_OFF = 1
+-};
+-
+-enum hdmi_audio_i2s_config {
+-      HDMI_AUDIO_I2S_MSB_SHIFTED_FIRST = 0,
+-      HDMI_AUDIO_I2S_LSB_SHIFTED_FIRST = 1,
+-      HDMI_AUDIO_I2S_SCK_EDGE_FALLING = 0,
+-      HDMI_AUDIO_I2S_SCK_EDGE_RISING = 1,
+-      HDMI_AUDIO_I2S_VBIT_FOR_PCM = 0,
+-      HDMI_AUDIO_I2S_VBIT_FOR_COMPRESSED = 1,
+-      HDMI_AUDIO_I2S_FIRST_BIT_SHIFT = 0,
+-      HDMI_AUDIO_I2S_FIRST_BIT_NO_SHIFT = 1,
+-      HDMI_AUDIO_I2S_SD0_EN = 1,
+-      HDMI_AUDIO_I2S_SD1_EN = 1 << 1,
+-      HDMI_AUDIO_I2S_SD2_EN = 1 << 2,
+-      HDMI_AUDIO_I2S_SD3_EN = 1 << 3,
+-};
+-
+-enum hdmi_audio_mclk_mode {
+-      HDMI_AUDIO_MCLK_128FS = 0,
+-      HDMI_AUDIO_MCLK_256FS = 1,
+-      HDMI_AUDIO_MCLK_384FS = 2,
+-      HDMI_AUDIO_MCLK_512FS = 3,
+-      HDMI_AUDIO_MCLK_768FS = 4,
+-      HDMI_AUDIO_MCLK_1024FS = 5,
+-      HDMI_AUDIO_MCLK_1152FS = 6,
+-      HDMI_AUDIO_MCLK_192FS = 7
+-};
+-
+-struct hdmi_core_video_config {
+-      enum hdmi_core_inputbus_width   ip_bus_width;
+-      enum hdmi_core_dither_trunc     op_dither_truc;
+-      enum hdmi_core_deepcolor_ed     deep_color_pkt;
+-      enum hdmi_core_packet_mode      pkt_mode;
+-      enum hdmi_core_hdmi_dvi         hdmi_dvi;
+-      enum hdmi_core_tclkselclkmult   tclk_sel_clkmult;
+-};
+-
+-struct hdmi_core_packet_enable_repeat {
+-      u32     audio_pkt;
+-      u32     audio_pkt_repeat;
+-      u32     avi_infoframe;
+-      u32     avi_infoframe_repeat;
+-      u32     gen_cntrl_pkt;
+-      u32     gen_cntrl_pkt_repeat;
+-      u32     generic_pkt;
+-      u32     generic_pkt_repeat;
+-};
+-
+-struct hdmi_video_format {
+-      enum hdmi_packing_mode  packing_mode;
+-      u32                     y_res;  /* Line per panel */
+-      u32                     x_res;  /* pixel per line */
+-};
+-
+-struct hdmi_audio_format {
+-      enum hdmi_stereo_channels               stereo_channels;
+-      u8                                      active_chnnls_msk;
+-      enum hdmi_audio_type                    type;
+-      enum hdmi_audio_justify                 justification;
+-      enum hdmi_audio_sample_order            sample_order;
+-      enum hdmi_audio_samples_perword         samples_per_word;
+-      enum hdmi_audio_sample_size             sample_size;
+-      enum hdmi_audio_blk_strt_end_sig        en_sig_blk_strt_end;
+-};
+-
+-struct hdmi_audio_dma {
+-      u8                              transfer_size;
+-      u8                              block_size;
+-      enum hdmi_audio_transf_mode     mode;
+-      u16                             fifo_threshold;
+-};
+-
+-struct hdmi_core_audio_i2s_config {
+-      u8 in_length_bits;
+-      u8 justification;
+-      u8 sck_edge_mode;
+-      u8 vbit;
+-      u8 direction;
+-      u8 shift;
+-      u8 active_sds;
+-};
+-
+-struct hdmi_core_audio_config {
+-      struct hdmi_core_audio_i2s_config       i2s_cfg;
+-      struct snd_aes_iec958                   *iec60958_cfg;
+-      bool                                    fs_override;
+-      u32                                     n;
+-      u32                                     cts;
+-      u32                                     aud_par_busclk;
+-      enum hdmi_core_audio_layout             layout;
+-      enum hdmi_core_cts_mode                 cts_mode;
+-      bool                                    use_mclk;
+-      enum hdmi_audio_mclk_mode               mclk_mode;
+-      bool                                    en_acr_pkt;
+-      bool                                    en_dsd_audio;
+-      bool                                    en_parallel_aud_input;
+-      bool                                    en_spdif;
+-};
+-
+-#endif
+--- a/drivers/video/omap2/dss/ti_hdmi.h
++++ /dev/null
+@@ -1,187 +0,0 @@
+-/*
+- * ti_hdmi.h
+- *
+- * HDMI driver definition for TI OMAP4, DM81xx, DM38xx  Processor.
+- *
+- * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
+- *
+- * 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/>.
+- */
+-
+-#ifndef _TI_HDMI_H
+-#define _TI_HDMI_H
+-
+-struct hdmi_ip_data;
+-
+-enum hdmi_pll_pwr {
+-      HDMI_PLLPWRCMD_ALLOFF = 0,
+-      HDMI_PLLPWRCMD_PLLONLY = 1,
+-      HDMI_PLLPWRCMD_BOTHON_ALLCLKS = 2,
+-      HDMI_PLLPWRCMD_BOTHON_NOPHYCLK = 3
+-};
+-
+-enum hdmi_core_hdmi_dvi {
+-      HDMI_DVI = 0,
+-      HDMI_HDMI = 1
+-};
+-
+-enum hdmi_clk_refsel {
+-      HDMI_REFSEL_PCLK = 0,
+-      HDMI_REFSEL_REF1 = 1,
+-      HDMI_REFSEL_REF2 = 2,
+-      HDMI_REFSEL_SYSCLK = 3
+-};
+-
+-struct hdmi_cm {
+-      int     code;
+-      int     mode;
+-};
+-
+-struct hdmi_config {
+-      struct omap_video_timings timings;
+-      struct hdmi_cm cm;
+-};
+-
+-/* HDMI PLL structure */
+-struct hdmi_pll_info {
+-      u16 regn;
+-      u16 regm;
+-      u32 regmf;
+-      u16 regm2;
+-      u16 regsd;
+-      u16 dcofreq;
+-      enum hdmi_clk_refsel refsel;
+-};
+-
+-struct ti_hdmi_ip_ops {
+-
+-      void (*video_configure)(struct hdmi_ip_data *ip_data);
+-
+-      int (*phy_enable)(struct hdmi_ip_data *ip_data);
+-
+-      void (*phy_disable)(struct hdmi_ip_data *ip_data);
+-
+-      int (*read_edid)(struct hdmi_ip_data *ip_data, u8 *edid, int len);
+-
+-      int (*pll_enable)(struct hdmi_ip_data *ip_data);
+-
+-      void (*pll_disable)(struct hdmi_ip_data *ip_data);
+-
+-      int (*video_enable)(struct hdmi_ip_data *ip_data);
+-
+-      void (*video_disable)(struct hdmi_ip_data *ip_data);
+-
+-      void (*dump_wrapper)(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-
+-      void (*dump_core)(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-
+-      void (*dump_pll)(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-
+-      void (*dump_phy)(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-      int (*audio_enable)(struct hdmi_ip_data *ip_data);
+-
+-      void (*audio_disable)(struct hdmi_ip_data *ip_data);
+-
+-      int (*audio_start)(struct hdmi_ip_data *ip_data);
+-
+-      void (*audio_stop)(struct hdmi_ip_data *ip_data);
+-
+-      int (*audio_config)(struct hdmi_ip_data *ip_data,
+-              struct omap_dss_audio *audio);
+-
+-      int (*audio_get_dma_port)(u32 *offset, u32 *size);
+-#endif
+-
+-};
+-
+-/*
+- * Refer to section 8.2 in HDMI 1.3 specification for
+- * details about infoframe databytes
+- */
+-struct hdmi_core_infoframe_avi {
+-      /* Y0, Y1 rgb,yCbCr */
+-      u8      db1_format;
+-      /* A0  Active information Present */
+-      u8      db1_active_info;
+-      /* B0, B1 Bar info data valid */
+-      u8      db1_bar_info_dv;
+-      /* S0, S1 scan information */
+-      u8      db1_scan_info;
+-      /* C0, C1 colorimetry */
+-      u8      db2_colorimetry;
+-      /* M0, M1 Aspect ratio (4:3, 16:9) */
+-      u8      db2_aspect_ratio;
+-      /* R0...R3 Active format aspect ratio */
+-      u8      db2_active_fmt_ar;
+-      /* ITC IT content. */
+-      u8      db3_itc;
+-      /* EC0, EC1, EC2 Extended colorimetry */
+-      u8      db3_ec;
+-      /* Q1, Q0 Quantization range */
+-      u8      db3_q_range;
+-      /* SC1, SC0 Non-uniform picture scaling */
+-      u8      db3_nup_scaling;
+-      /* VIC0..6 Video format identification */
+-      u8      db4_videocode;
+-      /* PR0..PR3 Pixel repetition factor */
+-      u8      db5_pixel_repeat;
+-      /* Line number end of top bar */
+-      u16     db6_7_line_eoftop;
+-      /* Line number start of bottom bar */
+-      u16     db8_9_line_sofbottom;
+-      /* Pixel number end of left bar */
+-      u16     db10_11_pixel_eofleft;
+-      /* Pixel number start of right bar */
+-      u16     db12_13_pixel_sofright;
+-};
+-
+-struct hdmi_ip_data {
+-      void __iomem    *base_wp;       /* HDMI wrapper */
+-      unsigned long   core_sys_offset;
+-      unsigned long   core_av_offset;
+-      unsigned long   pll_offset;
+-      unsigned long   phy_offset;
+-      int             irq;
+-      const struct ti_hdmi_ip_ops *ops;
+-      struct hdmi_config cfg;
+-      struct hdmi_pll_info pll_data;
+-      struct hdmi_core_infoframe_avi avi_cfg;
+-
+-      /* ti_hdmi_4xxx_ip private data. These should be in a separate struct */
+-      struct mutex lock;
+-};
+-int ti_hdmi_4xxx_phy_enable(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_phy_disable(struct hdmi_ip_data *ip_data);
+-int ti_hdmi_4xxx_read_edid(struct hdmi_ip_data *ip_data, u8 *edid, int len);
+-int ti_hdmi_4xxx_wp_video_start(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_wp_video_stop(struct hdmi_ip_data *ip_data);
+-int ti_hdmi_4xxx_pll_enable(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_pll_disable(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_basic_configure(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_wp_dump(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-void ti_hdmi_4xxx_pll_dump(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-void ti_hdmi_4xxx_core_dump(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-void ti_hdmi_4xxx_phy_dump(struct hdmi_ip_data *ip_data, struct seq_file *s);
+-#if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
+-int hdmi_compute_acr(u32 sample_freq, u32 *n, u32 *cts);
+-int ti_hdmi_4xxx_wp_audio_enable(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_wp_audio_disable(struct hdmi_ip_data *ip_data);
+-int ti_hdmi_4xxx_audio_start(struct hdmi_ip_data *ip_data);
+-void ti_hdmi_4xxx_audio_stop(struct hdmi_ip_data *ip_data);
+-int ti_hdmi_4xxx_audio_config(struct hdmi_ip_data *ip_data,
+-              struct omap_dss_audio *audio);
+-int ti_hdmi_4xxx_audio_get_dma_port(u32 *offset, u32 *size);
+-#endif
+-#endif
+--- a/drivers/video/omap2/dss/venc.c
++++ b/drivers/video/omap2/dss/venc.c
+@@ -894,6 +894,12 @@ static const struct dev_pm_ops venc_pm_o
+       .runtime_resume = venc_runtime_resume,
+ };
++
++static const struct of_device_id venc_of_match[] = {
++      { .compatible = "ti,omap3-venc", },
++      {},
++};
++
+ static struct platform_driver omap_venchw_driver = {
+       .probe          = omap_venchw_probe,
+       .remove         = __exit_p(omap_venchw_remove),
+@@ -901,6 +907,7 @@ static struct platform_driver omap_vench
+               .name   = "omapdss_venc",
+               .owner  = THIS_MODULE,
+               .pm     = &venc_pm_ops,
++              .of_match_table = venc_of_match,
+       },
+ };
+--- a/drivers/video/omap2/omapfb/omapfb-main.c
++++ b/drivers/video/omap2/omapfb/omapfb-main.c
+@@ -2407,6 +2407,55 @@ static int omapfb_init_connections(struc
+       return 0;
+ }
++static struct omap_dss_device *
++omapfb_find_default_display(struct omapfb2_device *fbdev)
++{
++      const char *def_name;
++      int i;
++
++      /*
++       * Search with the display name from the user or the board file,
++       * comparing to display names and aliases
++       */
++
++      def_name = omapdss_get_default_display_name();
++
++      if (def_name) {
++              for (i = 0; i < fbdev->num_displays; ++i) {
++                      struct omap_dss_device *dssdev;
++
++                      dssdev = fbdev->displays[i].dssdev;
++
++                      if (dssdev->name && strcmp(def_name, dssdev->name) == 0)
++                              return dssdev;
++
++                      if (strcmp(def_name, dssdev->alias) == 0)
++                              return dssdev;
++              }
++
++              /* def_name given but not found */
++              return NULL;
++      }
++
++      /* then look for DT alias display0 */
++      for (i = 0; i < fbdev->num_displays; ++i) {
++              struct omap_dss_device *dssdev;
++              int id;
++
++              dssdev = fbdev->displays[i].dssdev;
++
++              if (dssdev->dev->of_node == NULL)
++                      continue;
++
++              id = of_alias_get_id(dssdev->dev->of_node, "display");
++              if (id == 0)
++                      return dssdev;
++      }
++
++      /* return the first display we have in the list */
++      return fbdev->displays[0].dssdev;
++}
++
+ static int omapfb_probe(struct platform_device *pdev)
+ {
+       struct omapfb2_device *fbdev = NULL;
+@@ -2484,23 +2533,7 @@ static int omapfb_probe(struct platform_
+       for (i = 0; i < fbdev->num_managers; i++)
+               fbdev->managers[i] = omap_dss_get_overlay_manager(i);
+-      def_display = NULL;
+-
+-      for (i = 0; i < fbdev->num_displays; ++i) {
+-              struct omap_dss_device *dssdev;
+-              const char *def_name;
+-
+-              def_name = omapdss_get_default_display_name();
+-
+-              dssdev = fbdev->displays[i].dssdev;
+-
+-              if (def_name == NULL ||
+-                      (dssdev->name && strcmp(def_name, dssdev->name) == 0)) {
+-                      def_display = dssdev;
+-                      break;
+-              }
+-      }
+-
++      def_display = omapfb_find_default_display(fbdev);
+       if (def_display == NULL) {
+               dev_err(fbdev->dev, "failed to find default display\n");
+               r = -EPROBE_DEFER;
+--- a/drivers/watchdog/omap_wdt.c
++++ b/drivers/watchdog/omap_wdt.c
+@@ -41,7 +41,9 @@
+ #include <linux/io.h>
+ #include <linux/slab.h>
+ #include <linux/pm_runtime.h>
++#include <linux/interrupt.h>
+ #include <linux/platform_data/omap-wd-timer.h>
++#include <linux/of.h>
+ #include "omap_wdt.h"
+@@ -54,6 +56,10 @@ static unsigned timer_margin;
+ module_param(timer_margin, uint, 0);
+ MODULE_PARM_DESC(timer_margin, "initial watchdog timeout (in seconds)");
++static int kernelpet = 1;
++module_param(kernelpet, int, 0);
++MODULE_PARM_DESC(kernelpet, "pet watchdog in kernel via irq");
++
+ struct omap_wdt_dev {
+       void __iomem    *base;          /* physical */
+       struct device   *dev;
+@@ -112,6 +118,7 @@ static void omap_wdt_set_timer(struct om
+                                  unsigned int timeout)
+ {
+       u32 pre_margin = GET_WLDR_VAL(timeout);
++      u32 delay_period = GET_WLDR_VAL(timeout / 2);
+       void __iomem *base = wdev->base;
+       /* just count up at 32 KHz */
+@@ -121,6 +128,26 @@ static void omap_wdt_set_timer(struct om
+       __raw_writel(pre_margin, base + OMAP_WATCHDOG_LDR);
+       while (__raw_readl(base + OMAP_WATCHDOG_WPS) & 0x04)
+               cpu_relax();
++
++      /* Set delay interrupt to half the watchdog interval. */
++      while (__raw_readl(base + OMAP_WATCHDOG_WPS) & 1 << 5)
++              cpu_relax();
++      __raw_writel(delay_period, base + OMAP_WATCHDOG_WDLY);
++}
++
++static irqreturn_t omap_wdt_interrupt(int irq, void *dev_id)
++{
++      struct watchdog_device *wdog = dev_id;
++      struct omap_wdt_dev *wdev = watchdog_get_drvdata(wdog);
++      void __iomem *base = wdev->base;
++      u32 i;
++
++      i = __raw_readl(base + OMAP_WATCHDOG_WIRQSTAT);
++      __raw_writel(i, base + OMAP_WATCHDOG_WIRQSTAT);
++
++      omap_wdt_reload(wdev);
++
++      return IRQ_HANDLED;
+ }
+ static int omap_wdt_start(struct watchdog_device *wdog)
+@@ -144,6 +171,13 @@ static int omap_wdt_start(struct watchdo
+       omap_wdt_set_timer(wdev, wdog->timeout);
+       omap_wdt_reload(wdev); /* trigger loading of new timeout value */
++
++      /* Enable delay interrupt */
++      if (kernelpet) {
++              __raw_writel(0x2, base + OMAP_WATCHDOG_WIRQENSET);
++              __raw_writel(0x2, base + OMAP_WATCHDOG_WIRQWAKEEN);
++      }
++
+       omap_wdt_enable(wdev);
+       mutex_unlock(&wdev->lock);
+@@ -154,9 +188,16 @@ static int omap_wdt_start(struct watchdo
+ static int omap_wdt_stop(struct watchdog_device *wdog)
+ {
+       struct omap_wdt_dev *wdev = watchdog_get_drvdata(wdog);
++      void __iomem *base = wdev->base;
+       mutex_lock(&wdev->lock);
+       omap_wdt_disable(wdev);
++      /* Disable delay interrupt */
++      if (kernelpet) {
++              __raw_writel(0x0, base + OMAP_WATCHDOG_WIRQWAKEEN);
++              __raw_writel(0x2, base + OMAP_WATCHDOG_WIRQENCLR);
++      }
++
+       pm_runtime_put_sync(wdev->dev);
+       wdev->omap_wdt_users = false;
+       mutex_unlock(&wdev->lock);
+@@ -167,6 +208,11 @@ static int omap_wdt_ping(struct watchdog
+ {
+       struct omap_wdt_dev *wdev = watchdog_get_drvdata(wdog);
++      if (kernelpet) {
++              pr_info("Hw ping is enabled,Skipping userspace ping\n");
++              return 0;
++      }
++
+       mutex_lock(&wdev->lock);
+       omap_wdt_reload(wdev);
+       mutex_unlock(&wdev->lock);
+@@ -210,7 +256,7 @@ static int omap_wdt_probe(struct platfor
+       struct resource *res, *mem;
+       struct omap_wdt_dev *wdev;
+       u32 rs;
+-      int ret;
++      int ret, irq;
+       omap_wdt = devm_kzalloc(&pdev->dev, sizeof(*omap_wdt), GFP_KERNEL);
+       if (!omap_wdt)
+@@ -240,6 +286,23 @@ static int omap_wdt_probe(struct platfor
+       if (!wdev->base)
+               return -ENOMEM;
++      if (pdev->dev.of_node) {
++              if (of_device_is_compatible(pdev->dev.of_node, "ti,omap3-wdt"))
++                      kernelpet = 0;
++      } else {
++              if (pdata->ip_rev == WDTIMER2_IP3)
++                      kernelpet = 0;
++      }
++
++      if (kernelpet) {
++              irq = platform_get_irq(pdev, 0);
++              ret = devm_request_irq(&pdev->dev, irq, omap_wdt_interrupt, 0,
++                                     dev_name(&pdev->dev), omap_wdt);
++              if (ret < 0)
++                      dev_err(&pdev->dev, "can't get irq %d, err %d\n",
++                              irq, ret);
++      }
++
+       omap_wdt->info        = &omap_wdt_info;
+       omap_wdt->ops         = &omap_wdt_ops;
+       omap_wdt->min_timeout = TIMER_MARGIN_MIN;
+@@ -280,6 +343,12 @@ static int omap_wdt_probe(struct platfor
+       pm_runtime_put_sync(wdev->dev);
++      if (kernelpet) {
++              ret = omap_wdt_start(omap_wdt);
++              if (ret == 0)
++                      set_bit(WDOG_ACTIVE, &omap_wdt->status);
++      }
++
+       return 0;
+ }
+@@ -300,6 +369,13 @@ static int omap_wdt_remove(struct platfo
+ {
+       struct watchdog_device *wdog = platform_get_drvdata(pdev);
+       struct omap_wdt_dev *wdev = watchdog_get_drvdata(wdog);
++      int ret;
++
++      if (kernelpet) {
++              ret = omap_wdt_stop(wdog);
++              if (ret == 0)
++                      clear_bit(WDOG_ACTIVE, &wdog->status);
++      }
+       pm_runtime_disable(wdev->dev);
+       watchdog_unregister_device(wdog);
+@@ -352,7 +428,8 @@ static int omap_wdt_resume(struct platfo
+ #endif
+ static const struct of_device_id omap_wdt_of_match[] = {
+-      { .compatible = "ti,omap3-wdt", },
++      { .compatible = "ti,omap3-wdt" },
++      { .compatible = "ti,omap4-wdt" },
+       {},
+ };
+ MODULE_DEVICE_TABLE(of, omap_wdt_of_match);
+--- a/drivers/watchdog/omap_wdt.h
++++ b/drivers/watchdog/omap_wdt.h
+@@ -38,7 +38,12 @@
+ #define OMAP_WATCHDOG_LDR             (0x2c)
+ #define OMAP_WATCHDOG_TGR             (0x30)
+ #define OMAP_WATCHDOG_WPS             (0x34)
++#define OMAP_WATCHDOG_WDLY            (0x44)
+ #define OMAP_WATCHDOG_SPR             (0x48)
++#define OMAP_WATCHDOG_WIRQSTAT                (0x58)
++#define OMAP_WATCHDOG_WIRQENSET               (0x5c)
++#define OMAP_WATCHDOG_WIRQENCLR               (0x60)
++#define OMAP_WATCHDOG_WIRQWAKEEN      (0x64)
+ /* Using the prescaler, the OMAP watchdog could go for many
+  * months before firing.  These limits work without scaling,
+--- /dev/null
++++ b/include/dt-bindings/mfd/palmas.h
+@@ -0,0 +1,18 @@
++/*
++ * This header provides macros for Palmas device bindings.
++ *
++ * Copyright (c) 2013, NVIDIA Corporation.
++ *
++ * Author: Laxman Dewangan <ldewangan@nvidia.com>
++ *
++ */
++
++#ifndef __DT_BINDINGS_PALMAS_H__
++#define __DT_BINDINGS_PALMAS_H
++
++/* External control pins */
++#define PALMAS_EXT_CONTROL_PIN_ENABLE1        1
++#define PALMAS_EXT_CONTROL_PIN_ENABLE2        2
++#define PALMAS_EXT_CONTROL_PIN_NSLEEP 3
++
++#endif /* __DT_BINDINGS_PALMAS_H */
+--- /dev/null
++++ b/include/dt-bindings/pinctrl/am43xx.h
+@@ -0,0 +1,30 @@
++/*
++ * This header provides constants specific to AM43XX pinctrl bindings.
++ */
++
++#ifndef _DT_BINDINGS_PINCTRL_AM43XX_H
++#define _DT_BINDINGS_PINCTRL_AM43XX_H
++
++#define MUX_MODE0     0
++#define MUX_MODE1     1
++#define MUX_MODE2     2
++#define MUX_MODE3     3
++#define MUX_MODE4     4
++#define MUX_MODE5     5
++#define MUX_MODE6     6
++#define MUX_MODE7     7
++
++#define PULL_DISABLE          (1 << 16)
++#define PULL_UP                       (1 << 17)
++#define INPUT_EN              (1 << 18)
++#define SLEWCTRL_FAST         (1 << 19)
++#define DS0_PULL_UP_DOWN_EN   (1 << 27)
++
++#define PIN_OUTPUT            (PULL_DISABLE)
++#define PIN_OUTPUT_PULLUP     (PULL_UP)
++#define PIN_OUTPUT_PULLDOWN   0
++#define PIN_INPUT             (INPUT_EN | PULL_DISABLE)
++#define PIN_INPUT_PULLUP      (INPUT_EN | PULL_UP)
++#define PIN_INPUT_PULLDOWN    (INPUT_EN)
++
++#endif
+--- /dev/null
++++ b/include/dt-bindings/pinctrl/dra7xx.h
+@@ -0,0 +1,48 @@
++/*
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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 header provides constants specific to DRA7XX pinctrl bindings.
++ */
++
++#ifndef _DT_BINDINGS_PINCTRL_DRA7XX_H_
++#define _DT_BINDINGS_PINCTRL_DRA7XX_H_
++
++/* dra7xx specific mux bit defines */
++#define MUX_MODE0     0
++#define MUX_MODE1     1
++#define MUX_MODE2     2
++#define MUX_MODE3     3
++#define MUX_MODE4     4
++#define MUX_MODE5     5
++#define MUX_MODE6     6
++#define MUX_MODE7     7
++
++#define PULL_ENA              (1 << 16)
++#define PULL_UP                       (1 << 17)
++#define INPUT_EN              (1 << 18)
++#define SLEWCTRL_FAST         (1 << 19)
++#define WAKEUP_EN             (1 << 24)
++#define WAKEUP_EVENT          (1 << 25)
++
++/* Active pin states */
++#define PIN_OUTPUT            0
++#define PIN_OUTPUT_PULLUP     (PIN_OUTPUT | PULL_ENA | PULL_UP)
++#define PIN_OUTPUT_PULLDOWN   (PIN_OUTPUT | PULL_ENA)
++#define PIN_INPUT             INPUT_EN
++#define PIN_INPUT_PULLUP      (PULL_ENA | INPUT_EN | PULL_UP)
++#define PIN_INPUT_PULLDOWN    (PULL_ENA | INPUT_EN)
++
++/* Off mode states */
++#define PIN_OFF_NONE          0
++#define PIN_OFF_OUTPUT_HIGH   (OFF_EN | OFFOUT_EN | OFFOUT_VAL)
++#define PIN_OFF_OUTPUT_LOW    (OFF_EN | OFFOUT_EN)
++#define PIN_OFF_INPUT_PULLUP  (OFF_EN | OFF_PULL_EN | OFF_PULL_UP)
++#define PIN_OFF_INPUT_PULLDOWN        (OFF_EN | OFF_PULL_EN)
++#define PIN_OFF_WAKEUPENABLE  WAKEUP_EN
++
++#endif
+--- /dev/null
++++ b/include/linux/clk/ti.h
+@@ -0,0 +1,245 @@
++/*
++ * TI clock drivers support
++ *
++ * Copyright (C) 2013 Texas Instruments, Inc.
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether express or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License for more details.
++ */
++#ifndef __LINUX_CLK_TI_H__
++#define __LINUX_CLK_TI_H__
++
++#include <linux/clkdev.h>
++
++/**
++ * struct dpll_data - DPLL registers and integration data
++ * @mult_div1_reg: register containing the DPLL M and N bitfields
++ * @mult_mask: mask of the DPLL M bitfield in @mult_div1_reg
++ * @div1_mask: mask of the DPLL N bitfield in @mult_div1_reg
++ * @clk_bypass: struct clk pointer to the clock's bypass clock input
++ * @clk_ref: struct clk pointer to the clock's reference clock input
++ * @control_reg: register containing the DPLL mode bitfield
++ * @enable_mask: mask of the DPLL mode bitfield in @control_reg
++ * @last_rounded_rate: cache of the last rate result of omap2_dpll_round_rate()
++ * @last_rounded_m: cache of the last M result of omap2_dpll_round_rate()
++ * @last_rounded_m4xen: cache of the last M4X result of
++ *                     omap4_dpll_regm4xen_round_rate()
++ * @last_rounded_lpmode: cache of the last lpmode result of
++ *                      omap4_dpll_lpmode_recalc()
++ * @max_multiplier: maximum valid non-bypass multiplier value (actual)
++ * @last_rounded_n: cache of the last N result of omap2_dpll_round_rate()
++ * @min_divider: minimum valid non-bypass divider value (actual)
++ * @max_divider: maximum valid non-bypass divider value (actual)
++ * @modes: possible values of @enable_mask
++ * @autoidle_reg: register containing the DPLL autoidle mode bitfield
++ * @idlest_reg: register containing the DPLL idle status bitfield
++ * @autoidle_mask: mask of the DPLL autoidle mode bitfield in @autoidle_reg
++ * @freqsel_mask: mask of the DPLL jitter correction bitfield in @control_reg
++ * @idlest_mask: mask of the DPLL idle status bitfield in @idlest_reg
++ * @lpmode_mask: mask of the DPLL low-power mode bitfield in @control_reg
++ * @m4xen_mask: mask of the DPLL M4X multiplier bitfield in @control_reg
++ * @auto_recal_bit: bitshift of the driftguard enable bit in @control_reg
++ * @recal_en_bit: bitshift of the PRM_IRQENABLE_* bit for recalibration IRQs
++ * @recal_st_bit: bitshift of the PRM_IRQSTATUS_* bit for recalibration IRQs
++ * @flags: DPLL type/features (see below)
++ *
++ * Possible values for @flags:
++ * DPLL_J_TYPE: "J-type DPLL" (only some 36xx, 4xxx DPLLs)
++ *
++ * @freqsel_mask is only used on the OMAP34xx family and AM35xx.
++ *
++ * XXX Some DPLLs have multiple bypass inputs, so it's not technically
++ * correct to only have one @clk_bypass pointer.
++ *
++ * XXX The runtime-variable fields (@last_rounded_rate, @last_rounded_m,
++ * @last_rounded_n) should be separated from the runtime-fixed fields
++ * and placed into a different structure, so that the runtime-fixed data
++ * can be placed into read-only space.
++ */
++struct dpll_data {
++      void __iomem            *mult_div1_reg;
++      u32                     mult_mask;
++      u32                     div1_mask;
++      struct clk              *clk_bypass;
++      struct clk              *clk_ref;
++      void __iomem            *control_reg;
++      u32                     enable_mask;
++      unsigned long           last_rounded_rate;
++      u16                     last_rounded_m;
++      u8                      last_rounded_m4xen;
++      u8                      last_rounded_lpmode;
++      u16                     max_multiplier;
++      u8                      last_rounded_n;
++      u8                      min_divider;
++      u16                     max_divider;
++      u8                      modes;
++      void __iomem            *autoidle_reg;
++      void __iomem            *idlest_reg;
++      u32                     autoidle_mask;
++      u32                     freqsel_mask;
++      u32                     idlest_mask;
++      u32                     dco_mask;
++      u32                     sddiv_mask;
++      u32                     lpmode_mask;
++      u32                     m4xen_mask;
++      u8                      auto_recal_bit;
++      u8                      recal_en_bit;
++      u8                      recal_st_bit;
++      u8                      flags;
++};
++
++struct clk_hw_omap_ops;
++
++/**
++ * struct clk_hw_omap - OMAP struct clk
++ * @node: list_head connecting this clock into the full clock list
++ * @enable_reg: register to write to enable the clock (see @enable_bit)
++ * @enable_bit: bitshift to write to enable/disable the clock (see @enable_reg)
++ * @flags: see "struct clk.flags possibilities" above
++ * @clksel_reg: for clksel clks, register va containing src/divisor select
++ * @clksel_mask: bitmask in @clksel_reg for the src/divisor selector
++ * @clksel: for clksel clks, pointer to struct clksel for this clock
++ * @dpll_data: for DPLLs, pointer to struct dpll_data for this clock
++ * @clkdm_name: clockdomain name that this clock is contained in
++ * @clkdm: pointer to struct clockdomain, resolved from @clkdm_name at runtime
++ * @rate_offset: bitshift for rate selection bitfield (OMAP1 only)
++ * @src_offset: bitshift for source selection bitfield (OMAP1 only)
++ *
++ * XXX @rate_offset, @src_offset should probably be removed and OMAP1
++ * clock code converted to use clksel.
++ *
++ */
++struct clk_hw_omap {
++      struct clk_hw           hw;
++      struct list_head        node;
++      unsigned long           fixed_rate;
++      u8                      fixed_div;
++      void __iomem            *enable_reg;
++      u8                      enable_bit;
++      u8                      flags;
++      void __iomem            *clksel_reg;
++      u32                     clksel_mask;
++      const struct clksel     *clksel;
++      struct dpll_data        *dpll_data;
++      const char              *clkdm_name;
++      struct clockdomain      *clkdm;
++      const struct clk_hw_omap_ops    *ops;
++};
++
++/*
++ * struct clk_hw_omap.flags possibilities
++ *
++ * XXX document the rest of the clock flags here
++ *
++ * ENABLE_REG_32BIT: (OMAP1 only) clock control register must be accessed
++ *     with 32bit ops, by default OMAP1 uses 16bit ops.
++ * CLOCK_IDLE_CONTROL: (OMAP1 only) clock has autoidle support.
++ * CLOCK_NO_IDLE_PARENT: (OMAP1 only) when clock is enabled, its parent
++ *     clock is put to no-idle mode.
++ * ENABLE_ON_INIT: Clock is enabled on init.
++ * INVERT_ENABLE: By default, clock enable bit behavior is '1' enable, '0'
++ *     disable. This inverts the behavior making '0' enable and '1' disable.
++ * CLOCK_CLKOUTX2: (OMAP4 only) DPLL CLKOUT and CLKOUTX2 GATE_CTRL
++ *     bits share the same register.  This flag allows the
++ *     omap4_dpllmx*() code to determine which GATE_CTRL bit field
++ *     should be used.  This is a temporary solution - a better approach
++ *     would be to associate clock type-specific data with the clock,
++ *     similar to the struct dpll_data approach.
++ */
++#define ENABLE_REG_32BIT        (1 << 0)        /* Use 32-bit access */
++#define CLOCK_IDLE_CONTROL      (1 << 1)
++#define CLOCK_NO_IDLE_PARENT    (1 << 2)
++#define ENABLE_ON_INIT          (1 << 3)        /* Enable upon framework init */
++#define INVERT_ENABLE           (1 << 4)        /* 0 enables, 1 disables */
++#define CLOCK_CLKOUTX2          (1 << 5)
++
++/* CM_CLKEN_PLL*.EN* bit values - not all are available for every DPLL */
++#define DPLL_LOW_POWER_STOP   0x1
++#define DPLL_LOW_POWER_BYPASS 0x5
++#define DPLL_LOCKED           0x7
++
++/* DPLL Type and DCO Selection Flags */
++#define DPLL_J_TYPE           0x1
++
++/**
++ * struct omap_dt_clk - OMAP DT clock alias declarations
++ * @lk: clock lookup definition
++ * @node_name: clock DT node to map to
++ */
++struct omap_dt_clk {
++      struct clk_lookup               lk;
++      char                            *node_name;
++};
++
++#define DT_CLK(dev, con, name)                \
++      {                               \
++              .lk = {                 \
++                      .dev_id = dev,  \
++                      .con_id = con,  \
++              },                      \
++              .node_name = name,      \
++      }
++
++#define to_clk_hw_omap(_hw) container_of(_hw, struct clk_hw_omap, hw)
++
++void omap2_init_clk_hw_omap_clocks(struct clk *clk);
++int omap3_noncore_dpll_enable(struct clk_hw *hw);
++void omap3_noncore_dpll_disable(struct clk_hw *hw);
++int omap3_noncore_dpll_set_rate(struct clk_hw *hw, unsigned long rate,
++                              unsigned long parent_rate);
++unsigned long omap4_dpll_regm4xen_recalc(struct clk_hw *hw,
++                                       unsigned long parent_rate);
++long omap4_dpll_regm4xen_round_rate(struct clk_hw *hw,
++                                  unsigned long target_rate,
++                                  unsigned long *parent_rate);
++u8 omap2_init_dpll_parent(struct clk_hw *hw);
++unsigned long omap3_dpll_recalc(struct clk_hw *hw, unsigned long parent_rate);
++long omap2_dpll_round_rate(struct clk_hw *hw, unsigned long target_rate,
++                         unsigned long *parent_rate);
++void omap2_init_clk_clkdm(struct clk_hw *clk);
++unsigned long omap3_clkoutx2_recalc(struct clk_hw *hw,
++                                  unsigned long parent_rate);
++int omap2_clkops_enable_clkdm(struct clk_hw *hw);
++void omap2_clkops_disable_clkdm(struct clk_hw *hw);
++int omap2_clk_disable_autoidle_all(void);
++void omap2_clk_enable_init_clocks(const char **clk_names, u8 num_clocks);
++int omap3_dpll4_set_rate(struct clk_hw *clk, unsigned long rate,
++                       unsigned long parent_rate);
++int omap2_dflt_clk_enable(struct clk_hw *hw);
++void omap2_dflt_clk_disable(struct clk_hw *hw);
++int omap2_dflt_clk_is_enabled(struct clk_hw *hw);
++void omap3_clk_lock_dpll5(void);
++
++void omap_dt_clocks_register(struct omap_dt_clk *oclks);
++#ifdef CONFIG_OF
++void of_omap_clk_allow_autoidle_all(void);
++void of_omap_clk_deny_autoidle_all(void);
++#else
++static inline void of_omap_clk_allow_autoidle_all(void) { }
++static inline void of_omap_clk_deny_autoidle_all(void) { }
++#endif
++
++int omap5xxx_clk_init(void);
++int dra7xx_clk_init(void);
++int am43xx_clk_init(void);
++
++extern const struct clk_hw_omap_ops clkhwops_omap3_dpll;
++extern const struct clk_hw_omap_ops clkhwops_omap4_dpllmx;
++extern const struct clk_hw_omap_ops clkhwops_wait;
++extern const struct clk_hw_omap_ops clkhwops_omap3430es2_dss_usbhost_wait;
++extern const struct clk_hw_omap_ops clkhwops_am35xx_ipss_module_wait;
++extern const struct clk_hw_omap_ops clkhwops_am35xx_ipss_wait;
++
++extern const struct clk_hw_omap_ops clkhwops_iclk_wait;
++extern const struct clk_hw_omap_ops clkhwops_iclk;
++extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_ssi_wait;
++extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_dss_usbhost_wait;
++extern const struct clk_hw_omap_ops clkhwops_omap3430es2_iclk_hsotgusb_wait;
++
++#endif
+--- a/include/linux/clk-private.h
++++ b/include/linux/clk-private.h
+@@ -122,7 +122,7 @@ struct clk {
+               },                                              \
+               .reg = _reg,                                    \
+               .shift = _shift,                                \
+-              .width = _width,                                \
++              .mask = ((1 << _width) - 1),                    \
+               .flags = _divider_flags,                        \
+               .table = _table,                                \
+               .lock = _lock,                                  \
+--- a/include/linux/clk-provider.h
++++ b/include/linux/clk-provider.h
+@@ -241,6 +241,8 @@ struct clk *clk_register_gate(struct dev
+               void __iomem *reg, u8 bit_idx,
+               u8 clk_gate_flags, spinlock_t *lock);
++void of_gate_clk_setup(struct device_node *node);
++
+ struct clk_div_table {
+       unsigned int    val;
+       unsigned int    div;
+@@ -280,7 +282,7 @@ struct clk_divider {
+       struct clk_hw   hw;
+       void __iomem    *reg;
+       u8              shift;
+-      u8              width;
++      u32             mask;
+       u8              flags;
+       const struct clk_div_table      *table;
+       spinlock_t      *lock;
+@@ -302,6 +304,8 @@ struct clk *clk_register_divider_table(s
+               u8 clk_divider_flags, const struct clk_div_table *table,
+               spinlock_t *lock);
++void of_divider_clk_setup(struct device_node *node);
++
+ /**
+  * struct clk_mux - multiplexer clock
+  *
+@@ -351,7 +355,7 @@ struct clk *clk_register_mux_table(struc
+               void __iomem *reg, u8 shift, u32 mask,
+               u8 clk_mux_flags, u32 *table, spinlock_t *lock);
+-void of_fixed_factor_clk_setup(struct device_node *node);
++void of_mux_clk_setup(struct device_node *node);
+ /**
+  * struct clk_fixed_factor - fixed multiplier and divider clock
+@@ -372,10 +376,13 @@ struct clk_fixed_factor {
+ };
+ extern struct clk_ops clk_fixed_factor_ops;
++
+ struct clk *clk_register_fixed_factor(struct device *dev, const char *name,
+               const char *parent_name, unsigned long flags,
+               unsigned int mult, unsigned int div);
++void of_fixed_factor_clk_setup(struct device_node *node);
++
+ /***
+  * struct clk_composite - aggregate clock of mux, divider and gate clocks
+  *
+@@ -472,6 +479,7 @@ void of_clk_del_provider(struct device_n
+ struct clk *of_clk_src_simple_get(struct of_phandle_args *clkspec,
+                                 void *data);
+ struct clk *of_clk_src_onecell_get(struct of_phandle_args *clkspec, void *data);
++int of_clk_get_parent_count(struct device_node *np);
+ const char *of_clk_get_parent_name(struct device_node *np, int index);
+ void of_clk_init(const struct of_device_id *matches);
+--- /dev/null
++++ b/include/linux/crossbar.h
+@@ -0,0 +1,71 @@
++/*
++ * IRQ/DMA CROSSBAR DRIVER
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com/
++ *    Sricharan <r.sricharan@ti.com>
++ *
++ * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307
++ * USA
++ */
++#include <linux/io.h>
++#include <linux/of.h>
++#include <linux/of_irq.h>
++#include <linux/of_address.h>
++#include <linux/list.h>
++#include <linux/err.h>
++#include <linux/gfp.h>
++#include <linux/platform_device.h>
++
++/*
++ * @base: base address of the crossbar device
++ * @dev:  device ptr
++ * @name: name of the crossbar device
++ * @node: list node for the crossbar devices linked list
++ * @cb_entries: list of entries that belong to the crossbar
++ * @cb_lock: mutex
++ * @regmap pointer
++ */
++struct cb_device {
++      void __iomem *base;
++      struct device *dev;
++      const char *name;
++      struct list_head node;
++      struct list_head cb_entries;
++      struct mutex cb_lock;
++      struct regmap *cb_regmap;
++};
++
++/*
++ * @cb_name: name of crossbar target to which this line is mapped
++ * @dev_name: mapped device input request name
++ * @cb_no: crossbar device input number
++ * @int_no: request number to which this input should be routed
++ * @offset: register offset address
++ */
++struct cb_line {
++      const char *cb_name;
++      const char *dev_name;
++      unsigned cb_no;
++      unsigned int_no;
++      unsigned offset;
++};
++
++struct cb_entry {
++      struct cb_line line;
++      struct list_head cb_list;
++};
++
++int crossbar_map(struct device_node *cbdev_node);
++int crossbar_unmap(struct device_node *cbdev_node, unsigned index);
+--- a/include/linux/i2c/twl.h
++++ b/include/linux/i2c/twl.h
+@@ -26,6 +26,7 @@
+ #define __TWL_H_
+ #include <linux/types.h>
++#include <linux/phy/phy.h>
+ #include <linux/input/matrix_keypad.h>
+ /*
+@@ -615,6 +616,7 @@ enum twl4030_usb_mode {
+ struct twl4030_usb_data {
+       enum twl4030_usb_mode   usb_mode;
+       unsigned long           features;
++      struct phy_init_data    *init_data;
+       int             (*phy_init)(struct device *dev);
+       int             (*phy_exit)(struct device *dev);
+--- a/include/linux/input/pixcir_ts.h
++++ b/include/linux/input/pixcir_ts.h
+@@ -1,10 +1,63 @@
+ #ifndef       _PIXCIR_I2C_TS_H
+ #define       _PIXCIR_I2C_TS_H
++/*
++ * Register map
++ */
++#define PIXCIR_REG_POWER_MODE 51
++#define PIXCIR_REG_INT_MODE   52
++
++/*
++ * Power modes:
++ * active: max scan speed
++ * idle: lower scan speed with automatic transition to active on touch
++ * halt: datasheet says sleep but this is more like halt as the chip
++ *       clocks are cut and it can only be brought out of this mode
++ *     using the RESET pin.
++ */
++enum pixcir_power_mode {
++      PIXCIR_POWER_ACTIVE,
++      PIXCIR_POWER_IDLE,
++      PIXCIR_POWER_HALT,
++};
++
++#define PIXCIR_POWER_MODE_MASK        0x03
++#define PIXCIR_POWER_ALLOW_IDLE (1UL << 2)
++
++/*
++ * Interrupt modes:
++ * periodical: interrupt is asserted periodicaly
++ * diff coordinates: interrupt is asserted when coordinates change
++ * level on touch: interrupt level asserted during touch
++ * pulse on touch: interrupt pulse asserted druing touch
++ *
++ */
++enum pixcir_int_mode {
++      PIXCIR_INT_PERIODICAL,
++      PIXCIR_INT_DIFF_COORD,
++      PIXCIR_INT_LEVEL_TOUCH,
++      PIXCIR_INT_PULSE_TOUCH,
++};
++
++#define PIXCIR_INT_MODE_MASK  0x03
++#define PIXCIR_INT_ENABLE     (1UL << 3)
++#define PIXCIR_INT_POL_HIGH   (1UL << 2)
++
++/**
++ * struct pixcir_irc_chip_data - chip related data
++ * @num_report_ids:     Max number of finger ids reported simultaneously.
++ *                      if 0 it means chip doesn't support finger id reporting
++ *                      and driver will resort to Type A Multi-Touch reporting.
++ */
++struct pixcir_i2c_chip_data {
++      u8 num_report_ids;
++};
++
+ struct pixcir_ts_platform_data {
+-      int (*attb_read_val)(void);
+-      int x_max;
+-      int y_max;
++      unsigned int x_size;    /* X axis resolution */
++      unsigned int y_size;    /* Y axis resolution */
++      int gpio_attb;          /* GPIO connected to ATTB line */
++      struct pixcir_i2c_chip_data chip;
+ };
+ #endif
+--- /dev/null
++++ b/include/linux/mfd/tps65218.h
+@@ -0,0 +1,288 @@
++/*
++ * linux/mfd/tps65218.h
++ *
++ * Functions to access TPS65219 power management chip.
++ *
++ * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
++ *
++ * 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 "as is" WITHOUT ANY WARRANTY of any
++ * kind, whether expressed or implied; without even the implied warranty
++ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
++ * GNU General Public License version 2 for more details.
++ */
++
++#ifndef __LINUX_MFD_TPS65218_H
++#define __LINUX_MFD_TPS65218_H
++
++#include <linux/i2c.h>
++#include <linux/regulator/driver.h>
++#include <linux/regulator/machine.h>
++#include <linux/bitops.h>
++
++/* TPS chip id list */
++#define TPS65218                      0xF0
++
++/* I2C ID for TPS65218 part */
++#define TPS65218_I2C_ID                       0x24
++
++/* All register addresses */
++#define TPS65218_REG_CHIPID           0x00
++#define TPS65218_REG_INT1             0x01
++#define TPS65218_REG_INT2             0x02
++#define TPS65218_REG_INT_MASK1                0x03
++#define TPS65218_REG_INT_MASK2                0x04
++#define TPS65218_REG_STATUS           0x05
++#define TPS65218_REG_CONTROL          0x06
++#define TPS65218_REG_FLAG             0x07
++
++#define TPS65218_REG_PASSWORD         0x10
++#define TPS65218_REG_ENABLE1          0x11
++#define TPS65218_REG_ENABLE2          0x12
++#define TPS65218_REG_CONFIG1          0x13
++#define TPS65218_REG_CONFIG2          0x14
++#define TPS65218_REG_CONFIG3          0x15
++#define TPS65218_REG_CONTROL_DCDC1    0x16
++#define TPS65218_REG_CONTROL_DCDC2    0x17
++#define TPS65218_REG_CONTROL_DCDC3    0x18
++#define TPS65218_REG_CONTROL_DCDC4    0x19
++#define TPS65218_REG_CONTRL_SLEW_RATE 0x1A
++#define TPS65218_REG_CONTROL_LDO1     0x1B
++#define TPS65218_REG_SEQ1             0x20
++#define TPS65218_REG_SEQ2             0x21
++#define TPS65218_REG_SEQ3             0x22
++#define TPS65218_REG_SEQ4             0x23
++#define TPS65218_REG_SEQ5             0x24
++#define TPS65218_REG_SEQ6             0x25
++#define TPS65218_REG_SEQ7             0x26
++
++/* Register field definitions */
++#define TPS65218_CHIPID_CHIP_MASK     0xF8
++#define TPS65218_CHIPID_REV_MASK      0x07
++
++#define TPS65218_INT1_VPRG            BIT(5)
++#define TPS65218_INT1_AC              BIT(4)
++#define TPS65218_INT1_PB              BIT(3)
++#define TPS65218_INT1_HOT             BIT(2)
++#define TPS65218_INT1_CC_AQC          BIT(1)
++#define TPS65218_INT1_PRGC            BIT(0)
++
++#define TPS65218_INT2_LS3_F           BIT(5)
++#define TPS65218_INT2_LS2_F           BIT(4)
++#define TPS65218_INT2_LS1_F           BIT(3)
++#define TPS65218_INT2_LS3_I           BIT(2)
++#define TPS65218_INT2_LS2_I           BIT(1)
++#define TPS65218_INT2_LS1_I           BIT(0)
++
++#define TPS65218_INT_MASK1_VPRG               BIT(5)
++#define TPS65218_INT_MASK1_AC         BIT(4)
++#define TPS65218_INT_MASK1_PB         BIT(3)
++#define TPS65218_INT_MASK1_HOT                BIT(2)
++#define TPS65218_INT_MASK1_CC_AQC     BIT(1)
++#define TPS65218_INT_MASK1_PRGC               BIT(0)
++
++#define TPS65218_INT_MASK2_LS3_F      BIT(5)
++#define TPS65218_INT_MASK2_LS2_F      BIT(4)
++#define TPS65218_INT_MASK2_LS1_F      BIT(3)
++#define TPS65218_INT_MASK2_LS3_I      BIT(2)
++#define TPS65218_INT_MASK2_LS2_I      BIT(1)
++#define TPS65218_INT_MASK2_LS1_I      BIT(0)
++
++#define TPS65218_STATUS_FSEAL         BIT(7)
++#define TPS65218_STATUS_EE            BIT(6)
++#define TPS65218_STATUS_AC_STATE      BIT(5)
++#define TPS65218_STATUS_PB_STATE      BIT(4)
++#define TPS65218_STATUS_STATE_MASK    0xC
++#define TPS65218_STATUS_CC_STAT               0x3
++
++#define TPS65218_CONTROL_OFFNPFO      BIT(1)
++#define TPS65218_CONTROL_CC_AQ        BIT(0)
++
++#define TPS65218_FLAG_GPO3_FLG                BIT(7)
++#define TPS65218_FLAG_GPO2_FLG                BIT(6)
++#define TPS65218_FLAG_GPO1_FLG                BIT(5)
++#define TPS65218_FLAG_LDO1_FLG                BIT(4)
++#define TPS65218_FLAG_DC4_FLG         BIT(3)
++#define TPS65218_FLAG_DC3_FLG         BIT(2)
++#define TPS65218_FLAG_DC2_FLG         BIT(1)
++#define TPS65218_FLAG_DC1_FLG         BIT(0)
++
++#define TPS65218_ENABLE1_DC6_EN               BIT(5)
++#define TPS65218_ENABLE1_DC5_EN               BIT(4)
++#define TPS65218_ENABLE1_DC4_EN               BIT(3)
++#define TPS65218_ENABLE1_DC3_EN               BIT(2)
++#define TPS65218_ENABLE1_DC2_EN               BIT(1)
++#define TPS65218_ENABLE1_DC1_EN               BIT(0)
++
++#define TPS65218_ENABLE2_GPIO3                BIT(6)
++#define TPS65218_ENABLE2_GPIO2                BIT(5)
++#define TPS65218_ENABLE2_GPIO1                BIT(4)
++#define TPS65218_ENABLE2_LS3_EN               BIT(3)
++#define TPS65218_ENABLE2_LS2_EN               BIT(2)
++#define TPS65218_ENABLE2_LS1_EN               BIT(1)
++#define TPS65218_ENABLE2_LDO1_EN      BIT(0)
++
++
++#define TPS65218_CONFIG1_TRST         BIT(7)
++#define TPS65218_CONFIG1_GPO2_BUF     BIT(6)
++#define TPS65218_CONFIG1_IO1_SEL      BIT(5)
++#define TPS65218_CONFIG1_PGDLY_MASK   0x18
++#define TPS65218_CONFIG1_STRICT               BIT(2)
++#define TPS65218_CONFIG1_UVLO_MASK    0x3
++
++#define TPS65218_CONFIG2_DC12_RST     BIT(7)
++#define TPS65218_CONFIG2_UVLOHYS      BIT(6)
++#define TPS65218_CONFIG2_LS3ILIM_MASK 0xC
++#define TPS65218_CONFIG2_LS2ILIM_MASK 0x3
++
++#define TPS65218_CONFIG3_LS3NPFO      BIT(5)
++#define TPS65218_CONFIG3_LS2NPFO      BIT(4)
++#define TPS65218_CONFIG3_LS1NPFO      BIT(3)
++#define TPS65218_CONFIG3_LS3DCHRG     BIT(2)
++#define TPS65218_CONFIG3_LS2DCHRG     BIT(1)
++#define TPS65218_CONFIG3_LS1DCHRG     BIT(0)
++
++#define TPS65218_CONTROL_DCDC1_PFM    BIT(7)
++#define TPS65218_CONTROL_DCDC1_MASK   0x7F
++
++#define TPS65218_CONTROL_DCDC2_PFM    BIT(7)
++#define TPS65218_CONTROL_DCDC2_MASK   0x3F
++
++#define TPS65218_CONTROL_DCDC3_PFM    BIT(7)
++#define TPS65218_CONTROL_DCDC3_MASK   0x3F
++
++#define TPS65218_CONTROL_DCDC4_PFM    BIT(7)
++#define TPS65218_CONTROL_DCDC4_MASK   0x3F
++
++#define TPS65218_SLEW_RATE_GO         BIT(7)
++#define TPS65218_SLEW_RATE_GODSBL     BIT(6)
++#define TPS65218_SLEW_RATE_SLEW_MASK  0x7
++
++#define TPS65218_CONTROL_LDO1_MASK    0x3F
++
++#define TPS65218_SEQ1_DLY8            BIT(7)
++#define TPS65218_SEQ1_DLY7            BIT(6)
++#define TPS65218_SEQ1_DLY6            BIT(5)
++#define TPS65218_SEQ1_DLY5            BIT(4)
++#define TPS65218_SEQ1_DLY4            BIT(3)
++#define TPS65218_SEQ1_DLY3            BIT(2)
++#define TPS65218_SEQ1_DLY2            BIT(1)
++#define TPS65218_SEQ1_DLY1            BIT(0)
++
++#define TPS65218_SEQ2_DLYFCTR         BIT(7)
++#define TPS65218_SEQ2_DLY9            BIT(0)
++
++#define TPS65218_SEQ3_DC2_SEQ_MASK    0xF0
++#define TPS65218_SEQ3_DC1_SEQ_MASK    0xF
++
++#define TPS65218_SEQ4_DC4_SEQ_MASK    0xF0
++#define TPS65218_SEQ4_DC3_SEQ_MASK    0xF
++
++#define TPS65218_SEQ5_DC6_SEQ_MASK    0xF0
++#define TPS65218_SEQ5_DC5_SEQ_MASK    0xF
++
++#define TPS65218_SEQ6_LS1_SEQ_MASK    0xF0
++#define TPS65218_SEQ6_LDO1_SEQ_MASK   0xF
++
++#define TPS65218_SEQ7_GPO3_SEQ_MASK   0xF0
++#define TPS65218_SEQ7_GPO1_SEQ_MASK   0xF
++#define TPS65218_PROTECT_NONE         0
++#define TPS65218_PROTECT_L1           1
++
++enum tps65218_regulator_id {
++      /* DCDC's */
++      TPS65218_DCDC_1,
++      TPS65218_DCDC_2,
++      TPS65218_DCDC_3,
++      TPS65218_DCDC_4,
++      TPS65218_DCDC_5,
++      TPS65218_DCDC_6,
++      /* LDOs */
++      TPS65218_LDO_1,
++};
++
++#define TPS65218_MAX_REG_ID           TPS65218_LDO_1
++
++/* Number of step-down converters available */
++#define TPS65218_NUM_DCDC             6
++/* Number of LDO voltage regulators available */
++#define TPS65218_NUM_LDO              1
++/* Number of total regulators available */
++#define TPS65218_NUM_REGULATOR                (TPS65218_NUM_DCDC + TPS65218_NUM_LDO)
++
++/* Define the TPS65218 IRQ numbers */
++enum tps65218_irqs {
++      /* INT1 registers */
++      TPS65218_PRGC_IRQ,
++      TPS65218_CC_AQC_IRQ,
++      TPS65218_HOT_IRQ,
++      TPS65218_PB_IRQ,
++      TPS65218_AC_IRQ,
++      TPS65218_VPRG_IRQ,
++      TPS65218_INVALID1_IRQ,
++      TPS65218_INVALID2_IRQ,
++      /* INT2 registers */
++      TPS65218_LS1_I_IRQ,
++      TPS65218_LS2_I_IRQ,
++      TPS65218_LS3_I_IRQ,
++      TPS65218_LS1_F_IRQ,
++      TPS65218_LS2_F_IRQ,
++      TPS65218_LS3_F_IRQ,
++      TPS65218_INVALID3_IRQ,
++      TPS65218_INVALID4_IRQ,
++};
++
++/**
++ * struct tps_info - packages regulator constraints
++ * @id:                       Id of the regulator
++ * @name:             Voltage regulator name
++ * @min_uV:           minimum micro volts
++ * @max_uV:           minimum micro volts
++ * @vsel_to_uv:               Function pointer to get voltage from selector
++ * @uv_to_vsel:               Function pointer to get selector from voltage
++ *
++ * This data is used to check the regualtor voltage limits while setting.
++ */
++struct tps_info {
++      int id;
++      const char *name;
++      int min_uV;
++      int max_uV;
++      int (*vsel_to_uv)(unsigned int vsel);
++      int (*uv_to_vsel)(int uV, unsigned int *vsel);
++};
++
++/**
++ * struct tps65218 - tps65218 sub-driver chip access routines
++ *
++ * Device data may be used to access the TPS65218 chip
++ */
++
++struct tps65218 {
++      struct device *dev;
++      unsigned int id;
++
++      struct mutex tps_lock;          /* lock guarding the data structure */
++      /* IRQ Data */
++      int irq;
++      u32 irq_mask;
++      struct regmap_irq_chip_data *irq_data;
++      struct regulator_desc desc[TPS65218_NUM_REGULATOR];
++      struct regulator_dev *rdev[TPS65218_NUM_REGULATOR];
++      struct tps_info *info[TPS65218_NUM_REGULATOR];
++      struct regmap *regmap;
++};
++
++int tps65218_reg_read(struct tps65218 *tps, unsigned int reg,
++                                      unsigned int *val);
++int tps65218_reg_write(struct tps65218 *tps, unsigned int reg,
++                      unsigned int val, unsigned int level);
++int tps65218_set_bits(struct tps65218 *tps, unsigned int reg,
++              unsigned int mask, unsigned int val, unsigned int level);
++int tps65218_clear_bits(struct tps65218 *tps, unsigned int reg,
++              unsigned int mask, unsigned int level);
++
++#endif /*  __LINUX_MFD_TPS65218_H */
+--- a/include/linux/mfd/twl6040.h
++++ b/include/linux/mfd/twl6040.h
+@@ -28,6 +28,7 @@
+ #include <linux/interrupt.h>
+ #include <linux/mfd/core.h>
+ #include <linux/regulator/consumer.h>
++#include <linux/clk.h>
+ #define TWL6040_REG_ASICID            0x01
+ #define TWL6040_REG_ASICREV           0x02
+@@ -222,6 +223,7 @@ struct twl6040 {
+       struct regmap *regmap;
+       struct regmap_irq_chip_data *irq_data;
+       struct regulator_bulk_data supplies[2]; /* supplies for vio, v2v1 */
++      struct clk *clk32k;
+       struct mutex mutex;
+       struct mutex irq_mutex;
+       struct mfd_cell cells[TWL6040_CELLS];
+--- a/include/linux/omap-mailbox.h
++++ b/include/linux/omap-mailbox.h
+@@ -9,20 +9,27 @@
+ #ifndef OMAP_MAILBOX_H
+ #define OMAP_MAILBOX_H
++/* forward declaration for clients */
+ typedef u32 mbox_msg_t;
+ struct omap_mbox;
++/* interrupt direction identifiers */
+ typedef int __bitwise omap_mbox_irq_t;
+ #define IRQ_TX ((__force omap_mbox_irq_t) 1)
+ #define IRQ_RX ((__force omap_mbox_irq_t) 2)
++/* client api for message transmission */
+ int omap_mbox_msg_send(struct omap_mbox *, mbox_msg_t msg);
++/* client api for acquiring and releasing a mailbox */
+ struct omap_mbox *omap_mbox_get(const char *, struct notifier_block *nb);
+ void omap_mbox_put(struct omap_mbox *mbox, struct notifier_block *nb);
++/* client api for saving and restoring context */
+ void omap_mbox_save_ctx(struct omap_mbox *mbox);
+ void omap_mbox_restore_ctx(struct omap_mbox *mbox);
++
++/* client api for manipulating mailbox interrupts */
+ void omap_mbox_enable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq);
+ void omap_mbox_disable_irq(struct omap_mbox *mbox, omap_mbox_irq_t irq);
+--- /dev/null
++++ b/include/linux/phy/omap_control_phy.h
+@@ -0,0 +1,89 @@
++/*
++ * omap_control_phy.h - Header file for the PHY part of control module.
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#ifndef __OMAP_CONTROL_PHY_H__
++#define __OMAP_CONTROL_PHY_H__
++
++enum omap_control_phy_type {
++      OMAP_CTRL_TYPE_OTGHS = 1,       /* Mailbox OTGHS_CONTROL */
++      OMAP_CTRL_TYPE_USB2,    /* USB2_PHY, power down in CONTROL_DEV_CONF */
++      OMAP_CTRL_TYPE_PIPE3,   /* PIPE3 PHY, DPLL & seperate Rx/Tx power */
++      OMAP_CTRL_TYPE_DRA7USB2, /* USB2 PHY, power and power_aux e.g. DRA7 */
++      OMAP_CTRL_TYPE_AM437USB2, /* USB2 PHY, power e.g. AM437x */
++};
++
++struct omap_control_phy {
++      struct device *dev;
++
++      u32 __iomem *otghs_control;
++      u32 __iomem *power;
++      u32 __iomem *power_aux;
++
++      struct clk *sys_clk;
++
++      enum omap_control_phy_type type;
++};
++
++enum omap_control_usb_mode {
++      USB_MODE_UNDEFINED = 0,
++      USB_MODE_HOST,
++      USB_MODE_DEVICE,
++      USB_MODE_DISCONNECT,
++};
++
++#define       OMAP_CTRL_DEV_PHY_PD            BIT(0)
++
++#define       OMAP_CTRL_DEV_AVALID            BIT(0)
++#define       OMAP_CTRL_DEV_BVALID            BIT(1)
++#define       OMAP_CTRL_DEV_VBUSVALID         BIT(2)
++#define       OMAP_CTRL_DEV_SESSEND           BIT(3)
++#define       OMAP_CTRL_DEV_IDDIG             BIT(4)
++
++#define       OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_MASK         0x003FC000
++#define       OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_CMD_SHIFT        0xE
++
++#define       OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_MASK        0xFFC00000
++#define       OMAP_CTRL_PIPE3_PHY_PWRCTL_CLK_FREQ_SHIFT       0x16
++
++#define       OMAP_CTRL_PIPE3_PHY_TX_RX_POWERON       0x3
++#define       OMAP_CTRL_PIPE3_PHY_TX_RX_POWEROFF      0x0
++
++#define OMAP_CTRL_USB2_PHY_PD         BIT(28)
++
++#define AM437X_CTRL_USB2_PHY_PD               BIT(0)
++#define AM437X_CTRL_USB2_OTG_PD               BIT(1)
++#define AM437X_CTRL_USB2_OTGVDET_EN   BIT(19)
++#define AM437X_CTRL_USB2_OTGSESSEND_EN        BIT(20)
++
++#if IS_ENABLED(CONFIG_OMAP_CONTROL_PHY)
++extern void omap_control_phy_power(struct device *dev, int on);
++extern void omap_control_usb_set_mode(struct device *dev,
++      enum omap_control_usb_mode mode);
++#else
++
++static inline void omap_control_phy_power(struct device *dev, int on)
++{
++}
++
++static inline void omap_control_usb_set_mode(struct device *dev,
++      enum omap_control_usb_mode mode)
++{
++}
++#endif
++
++#endif        /* __OMAP_CONTROL_PHY_H__ */
+--- /dev/null
++++ b/include/linux/phy/omap_pipe3.h
+@@ -0,0 +1,59 @@
++/*
++ * omap_pipe3.h -- omap pipe3 phy header file
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#ifndef __DRIVERS_OMAP_PIPE3_H
++#define __DRIVERS_OMAP_PIPE3_H
++
++#include <linux/io.h>
++
++struct pipe3_dpll_params {
++      u16     m;
++      u8      n;
++      u8      freq:3;
++      u8      sd;
++      u32     mf;
++};
++
++struct pipe3_dpll_map {
++      unsigned long rate;
++      struct pipe3_dpll_params params;
++};
++
++struct omap_pipe3 {
++      void __iomem            *pll_ctrl_base;
++      struct device           *dev;
++      struct device           *control_dev;
++      struct clk              *wkupclk;
++      struct clk              *sys_clk;
++      struct clk              *optclk;
++      struct clk              *optclk2;
++      struct pipe3_dpll_map   *dpll_map;
++};
++
++static inline u32 omap_pipe3_readl(void __iomem *addr, unsigned offset)
++{
++      return __raw_readl(addr + offset);
++}
++
++static inline void omap_pipe3_writel(void __iomem *addr, unsigned offset,
++      u32 data)
++{
++      __raw_writel(data, addr + offset);
++}
++
++#endif /* __DRIVERS_OMAP_PIPE3_H */
+--- /dev/null
++++ b/include/linux/phy/omap_usb.h
+@@ -0,0 +1,74 @@
++/*
++ * omap_usb.h -- omap usb2 phy header file
++ *
++ * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
++ * 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.
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ *
++ */
++
++#ifndef __DRIVERS_OMAP_USB2_H
++#define __DRIVERS_OMAP_USB2_H
++
++#include <linux/io.h>
++#include <linux/usb/otg.h>
++
++struct usb_dpll_params {
++      u16     m;
++      u8      n;
++      u8      freq:3;
++      u8      sd;
++      u32     mf;
++};
++
++struct omap_usb {
++      struct usb_phy          phy;
++      struct phy_companion    *comparator;
++      struct device           *dev;
++      struct device           *control_dev;
++      struct clk              *wkupclk;
++      struct clk              *optclk;
++};
++
++struct usb_phy_data {
++      const char *label;
++      u32 flags;
++};
++
++enum usb_phy_data_flags {
++      OMAP_USB2_HAS_START_SRP = 1,
++      OMAP_USB2_HAS_SET_VBUS,
++};
++
++#define       phy_to_omapusb(x)       container_of((x), struct omap_usb, phy)
++
++#if defined(CONFIG_OMAP_USB2) || defined(CONFIG_OMAP_USB2_MODULE)
++extern int omap_usb2_set_comparator(struct phy_companion *comparator);
++#else
++static inline int omap_usb2_set_comparator(struct phy_companion *comparator)
++{
++      return -ENODEV;
++}
++#endif
++
++static inline u32 omap_usb_readl(void __iomem *addr, unsigned offset)
++{
++      return __raw_readl(addr + offset);
++}
++
++static inline void omap_usb_writel(void __iomem *addr, unsigned offset,
++      u32 data)
++{
++      __raw_writel(data, addr + offset);
++}
++
++#endif /* __DRIVERS_OMAP_USB_H */
+--- /dev/null
++++ b/include/linux/phy/phy.h
+@@ -0,0 +1,270 @@
++/*
++ * phy.h -- generic phy header file
++ *
++ * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
++ *
++ * Author: Kishon Vijay Abraham I <kishon@ti.com>
++ *
++ * 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.
++ */
++
++#ifndef __DRIVERS_PHY_H
++#define __DRIVERS_PHY_H
++
++#include <linux/err.h>
++#include <linux/of.h>
++#include <linux/device.h>
++#include <linux/pm_runtime.h>
++
++struct phy;
++
++/**
++ * struct phy_ops - set of function pointers for performing phy operations
++ * @init: operation to be performed for initializing phy
++ * @exit: operation to be performed while exiting
++ * @power_on: powering on the phy
++ * @power_off: powering off the phy
++ * @owner: the module owner containing the ops
++ */
++struct phy_ops {
++      int     (*init)(struct phy *phy);
++      int     (*exit)(struct phy *phy);
++      int     (*power_on)(struct phy *phy);
++      int     (*power_off)(struct phy *phy);
++      struct module *owner;
++};
++
++/**
++ * struct phy - represents the phy device
++ * @dev: phy device
++ * @id: id of the phy device
++ * @ops: function pointers for performing phy operations
++ * @init_data: list of PHY consumers (non-dt only)
++ * @mutex: mutex to protect phy_ops
++ * @init_count: used to protect when the PHY is used by multiple consumers
++ * @power_count: used to protect when the PHY is used by multiple consumers
++ */
++struct phy {
++      struct device           dev;
++      int                     id;
++      const struct phy_ops    *ops;
++      struct phy_init_data    *init_data;
++      struct mutex            mutex;
++      int                     init_count;
++      int                     power_count;
++};
++
++/**
++ * struct phy_provider - represents the phy provider
++ * @dev: phy provider device
++ * @owner: the module owner having of_xlate
++ * @of_xlate: function pointer to obtain phy instance from phy pointer
++ * @list: to maintain a linked list of PHY providers
++ */
++struct phy_provider {
++      struct device           *dev;
++      struct module           *owner;
++      struct list_head        list;
++      struct phy * (*of_xlate)(struct device *dev,
++              struct of_phandle_args *args);
++};
++
++/**
++ * struct phy_consumer - represents the phy consumer
++ * @dev_name: the device name of the controller that will use this PHY device
++ * @port: name given to the consumer port
++ */
++struct phy_consumer {
++      const char *dev_name;
++      const char *port;
++};
++
++/**
++ * struct phy_init_data - contains the list of PHY consumers
++ * @num_consumers: number of consumers for this PHY device
++ * @consumers: list of PHY consumers
++ */
++struct phy_init_data {
++      unsigned int num_consumers;
++      struct phy_consumer *consumers;
++};
++
++#define PHY_CONSUMER(_dev_name, _port)                                \
++{                                                             \
++      .dev_name       = _dev_name,                            \
++      .port           = _port,                                \
++}
++
++#define       to_phy(dev)     (container_of((dev), struct phy, dev))
++
++#define       of_phy_provider_register(dev, xlate)    \
++      __of_phy_provider_register((dev), THIS_MODULE, (xlate))
++
++#define       devm_of_phy_provider_register(dev, xlate)       \
++      __devm_of_phy_provider_register((dev), THIS_MODULE, (xlate))
++
++static inline void phy_set_drvdata(struct phy *phy, void *data)
++{
++      dev_set_drvdata(&phy->dev, data);
++}
++
++static inline void *phy_get_drvdata(struct phy *phy)
++{
++      return dev_get_drvdata(&phy->dev);
++}
++
++#if IS_ENABLED(CONFIG_GENERIC_PHY)
++extern int phy_pm_runtime_get(struct phy *phy);
++extern int phy_pm_runtime_get_sync(struct phy *phy);
++extern int phy_pm_runtime_put(struct phy *phy);
++extern int phy_pm_runtime_put_sync(struct phy *phy);
++extern void phy_pm_runtime_allow(struct phy *phy);
++extern void phy_pm_runtime_forbid(struct phy *phy);
++extern int phy_init(struct phy *phy);
++extern int phy_exit(struct phy *phy);
++extern int phy_power_on(struct phy *phy);
++extern int phy_power_off(struct phy *phy);
++extern struct phy *phy_get(struct device *dev, const char *string);
++extern struct phy *devm_phy_get(struct device *dev, const char *string);
++extern void phy_put(struct phy *phy);
++extern void devm_phy_put(struct device *dev, struct phy *phy);
++extern struct phy *of_phy_simple_xlate(struct device *dev,
++      struct of_phandle_args *args);
++extern struct phy *phy_create(struct device *dev, const struct phy_ops *ops,
++      struct phy_init_data *init_data);
++extern struct phy *devm_phy_create(struct device *dev,
++      const struct phy_ops *ops, struct phy_init_data *init_data);
++extern void phy_destroy(struct phy *phy);
++extern void devm_phy_destroy(struct device *dev, struct phy *phy);
++extern struct phy_provider *__of_phy_provider_register(struct device *dev,
++      struct module *owner, struct phy * (*of_xlate)(struct device *dev,
++      struct of_phandle_args *args));
++extern struct phy_provider *__devm_of_phy_provider_register(struct device *dev,
++      struct module *owner, struct phy * (*of_xlate)(struct device *dev,
++      struct of_phandle_args *args));
++extern void of_phy_provider_unregister(struct phy_provider *phy_provider);
++extern void devm_of_phy_provider_unregister(struct device *dev,
++      struct phy_provider *phy_provider);
++#else
++static inline int phy_pm_runtime_get(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_pm_runtime_get_sync(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_pm_runtime_put(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_pm_runtime_put_sync(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline void phy_pm_runtime_allow(struct phy *phy)
++{
++      return;
++}
++
++static inline void phy_pm_runtime_forbid(struct phy *phy)
++{
++      return;
++}
++
++static inline int phy_init(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_exit(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_power_on(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline int phy_power_off(struct phy *phy)
++{
++      return -ENOSYS;
++}
++
++static inline struct phy *phy_get(struct device *dev, const char *string)
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline struct phy *devm_phy_get(struct device *dev, const char *string)
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline void phy_put(struct phy *phy)
++{
++}
++
++static inline void devm_phy_put(struct device *dev, struct phy *phy)
++{
++}
++
++static inline struct phy *of_phy_simple_xlate(struct device *dev,
++      struct of_phandle_args *args)
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline struct phy *phy_create(struct device *dev,
++      const struct phy_ops *ops, struct phy_init_data *init_data)
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline struct phy *devm_phy_create(struct device *dev,
++      const struct phy_ops *ops, struct phy_init_data *init_data)
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline void phy_destroy(struct phy *phy)
++{
++}
++
++static inline void devm_phy_destroy(struct device *dev, struct phy *phy)
++{
++}
++
++static inline struct phy_provider *__of_phy_provider_register(
++      struct device *dev, struct module *owner, struct phy * (*of_xlate)(
++      struct device *dev, struct of_phandle_args *args))
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline struct phy_provider *__devm_of_phy_provider_register(struct device
++      *dev, struct module *owner, struct phy * (*of_xlate)(struct device *dev,
++      struct of_phandle_args *args))
++{
++      return ERR_PTR(-ENOSYS);
++}
++
++static inline void of_phy_provider_unregister(struct phy_provider *phy_provider)
++{
++}
++
++static inline void devm_of_phy_provider_unregister(struct device *dev,
++      struct phy_provider *phy_provider)
++{
++}
++#endif
++
++#endif /* __DRIVERS_PHY_H */
+--- a/include/linux/platform_data/davinci_asp.h
++++ b/include/linux/platform_data/davinci_asp.h
+@@ -84,6 +84,8 @@ struct snd_platform_data {
+       u8 version;
+       u8 txnumevt;
+       u8 rxnumevt;
++      int tx_dma_channel;
++      int rx_dma_channel;
+ };
+ enum {
+--- a/include/linux/platform_data/elm.h
++++ b/include/linux/platform_data/elm.h
+@@ -21,17 +21,12 @@
+ enum bch_ecc {
+       BCH4_ECC = 0,
+       BCH8_ECC,
++      BCH16_ECC
+ };
+ /* ELM support 8 error syndrome process */
+ #define ERROR_VECTOR_MAX              8
+-
+-#define BCH8_ECC_OOB_BYTES            13
+-#define BCH4_ECC_OOB_BYTES            7
+-/* RBL requires 14 byte even though BCH8 uses only 13 byte */
+-#define BCH8_SIZE                     (BCH8_ECC_OOB_BYTES + 1)
+-/* Uses 1 extra byte to handle erased pages */
+-#define BCH4_SIZE                     (BCH4_ECC_OOB_BYTES + 1)
++#define ELM_MAX_DETECTABLE_ERRORS     16
+ /**
+  * struct elm_errorvec - error vector for elm
+@@ -45,10 +40,11 @@ struct elm_errorvec {
+       bool error_reported;
+       bool error_uncorrectable;
+       int error_count;
+-      int error_loc[ERROR_VECTOR_MAX];
++      int error_loc[ELM_MAX_DETECTABLE_ERRORS];
+ };
+ void elm_decode_bch_error_page(struct device *dev, u8 *ecc_calc,
+               struct elm_errorvec *err_vec);
+-int elm_config(struct device *dev, enum bch_ecc bch_type);
++int elm_config(struct device *dev, struct mtd_info *mtd,
++              enum bch_ecc bch_type);
+ #endif /* __ELM_H */
+--- a/include/linux/platform_data/mtd-nand-omap2.h
++++ b/include/linux/platform_data/mtd-nand-omap2.h
+@@ -23,13 +23,18 @@ enum nand_io {
+ };
+ enum omap_ecc {
+-              /* 1-bit ecc: stored at end of spare area */
+-      OMAP_ECC_HAMMING_CODE_DEFAULT = 0, /* Default, s/w method */
+-      OMAP_ECC_HAMMING_CODE_HW, /* gpmc to detect the error */
+-              /* 1-bit ecc: stored at beginning of spare area as romcode */
+-      OMAP_ECC_HAMMING_CODE_HW_ROMCODE, /* gpmc method & romcode layout */
+-      OMAP_ECC_BCH4_CODE_HW, /* 4-bit BCH ecc code */
+-      OMAP_ECC_BCH8_CODE_HW, /* 8-bit BCH ecc code */
++      /* 1-bit  ECC calculation by GPMC, Error detection by Software */
++      OMAP_ECC_HAMMING_CODE_HW = 0,
++      /* 4-bit  ECC calculation by GPMC, Error detection by Software */
++      OMAP_ECC_BCH4_CODE_HW_DETECTION_SW,
++      /* 4-bit  ECC calculation by GPMC, Error detection by ELM */
++      OMAP_ECC_BCH4_CODE_HW,
++      /* 8-bit  ECC calculation by GPMC, Error detection by Software */
++      OMAP_ECC_BCH8_CODE_HW_DETECTION_SW,
++      /* 8-bit  ECC calculation by GPMC, Error detection by ELM */
++      OMAP_ECC_BCH8_CODE_HW,
++      /* 16-bit ECC calculation by GPMC, Error detection by ELM */
++      OMAP_ECC_BCH16_CODE_HW,
+ };
+ struct gpmc_nand_regs {
+@@ -49,6 +54,9 @@ struct gpmc_nand_regs {
+       void __iomem    *gpmc_bch_result1[GPMC_BCH_NUM_REMAINDER];
+       void __iomem    *gpmc_bch_result2[GPMC_BCH_NUM_REMAINDER];
+       void __iomem    *gpmc_bch_result3[GPMC_BCH_NUM_REMAINDER];
++      void __iomem    *gpmc_bch_result4[GPMC_BCH_NUM_REMAINDER];
++      void __iomem    *gpmc_bch_result5[GPMC_BCH_NUM_REMAINDER];
++      void __iomem    *gpmc_bch_result6[GPMC_BCH_NUM_REMAINDER];
+ };
+ struct omap_nand_platform_data {
+@@ -63,5 +71,6 @@ struct omap_nand_platform_data {
+       /* for passing the partitions */
+       struct device_node      *of_node;
++      struct device_node      *elm_of_node;
+ };
+ #endif
+--- a/include/linux/platform_data/omap-wd-timer.h
++++ b/include/linux/platform_data/omap-wd-timer.h
+@@ -16,6 +16,14 @@
+ #include <linux/types.h>
+ /*
++ * WATCHDOG IP Revisions
++ *    WDTIMER2_IP3 - Used in OMAP3
++ *    WDTIMER2_IP4 - Used in OMAP4+ Soc's
++ */
++#define WDTIMER2_IP3  1
++#define WDTIMER2_IP4  2
++
++/*
+  * Standardized OMAP reset source bits
+  *
+  * This is a subset of the ones listed in arch/arm/mach-omap2/prm.h
+@@ -33,6 +41,7 @@
+  */
+ struct omap_wd_timer_platform_data {
+       u32 (*read_reset_sources)(void);
++      u32 ip_rev;
+ };
+ #endif
+--- /dev/null
++++ b/include/linux/platform_data/usb-rcar-gen2-phy.h
+@@ -0,0 +1,22 @@
++/*
++ * Copyright (C) 2013 Renesas Solutions Corp.
++ * Copyright (C) 2013 Cogent Embedded, Inc.
++ *
++ * 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.
++ */
++
++#ifndef __USB_RCAR_GEN2_PHY_H
++#define __USB_RCAR_GEN2_PHY_H
++
++#include <linux/types.h>
++
++struct rcar_gen2_phy_platform_data {
++      /* USB channel 0 configuration */
++      bool chan0_pci:1;       /* true: PCI USB host 0, false: USBHS */
++      /* USB channel 2 configuration */
++      bool chan2_pci:1;       /* true: PCI USB host 2, false: USBSS */
++};
++
++#endif
+--- a/include/linux/regulator/driver.h
++++ b/include/linux/regulator/driver.h
+@@ -316,6 +316,8 @@ struct regulator_dev {
+       struct blocking_notifier_head notifier;
+       struct mutex mutex; /* consumer lock */
++      struct task_struct *lock_owner;
++      int lock_count;
+       struct module *owner;
+       struct device dev;
+       struct regulation_constraints *constraints;
+--- a/include/linux/reset-controller.h
++++ b/include/linux/reset-controller.h
+@@ -17,6 +17,8 @@ struct reset_control_ops {
+       int (*reset)(struct reset_controller_dev *rcdev, unsigned long id);
+       int (*assert)(struct reset_controller_dev *rcdev, unsigned long id);
+       int (*deassert)(struct reset_controller_dev *rcdev, unsigned long id);
++      int (*is_reset)(struct reset_controller_dev *rcdev, unsigned long id);
++      int (*clear_reset)(struct reset_controller_dev *rcdev, unsigned long i);
+ };
+ struct module;
+--- a/include/linux/reset.h
++++ b/include/linux/reset.h
+@@ -7,6 +7,8 @@ struct reset_control;
+ int reset_control_reset(struct reset_control *rstc);
+ int reset_control_assert(struct reset_control *rstc);
+ int reset_control_deassert(struct reset_control *rstc);
++int reset_control_is_reset(struct reset_control *rstc);
++int reset_control_clear_reset(struct reset_control *rstc);
+ struct reset_control *reset_control_get(struct device *dev, const char *id);
+ void reset_control_put(struct reset_control *rstc);
+--- a/include/linux/spi/spi.h
++++ b/include/linux/spi/spi.h
+@@ -91,6 +91,7 @@ struct spi_device {
+ #define       SPI_TX_QUAD     0x200                   /* transmit with 4 wires */
+ #define       SPI_RX_DUAL     0x400                   /* receive with 2 wires */
+ #define       SPI_RX_QUAD     0x800                   /* receive with 4 wires */
++#define SPI_RX_MMAP   0x1000                  /* Memory mapped Reas */
+       u8                      bits_per_word;
+       int                     irq;
+       void                    *controller_state;
+@@ -554,6 +555,7 @@ struct spi_transfer {
+       u8              bits_per_word;
+       u16             delay_usecs;
+       u32             speed_hz;
++      bool            memory_map;
+       struct list_head transfer_list;
+ };
+--- /dev/null
++++ b/include/linux/ti_emif.h
+@@ -0,0 +1,558 @@
++/*
++ * Register defines for the EMIF driver
++ *
++ * Copyright (C) 2012 Texas Instruments, Inc.
++ *
++ * Benoit Cousson (b-cousson@ti.com)
++ *
++ * 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.
++ */
++#ifndef __TI_EMIF_H
++#define __TI_EMIF_H
++
++/*
++ * Maximum number of different frequencies supported by EMIF driver
++ * Determines the number of entries in the pointer array for register
++ * cache
++ */
++#define EMIF_MAX_NUM_FREQUENCIES                      6
++
++/* State of the core voltage */
++#define DDR_VOLTAGE_STABLE                            0
++#define DDR_VOLTAGE_RAMPING                           1
++
++/* Defines for timing De-rating */
++#define EMIF_NORMAL_TIMINGS                           0
++#define EMIF_DERATED_TIMINGS                          1
++
++/* Length of the forced read idle period in terms of cycles */
++#define EMIF_READ_IDLE_LEN_VAL                                5
++
++/*
++ * forced read idle interval to be used when voltage
++ * is changed as part of DVFS/DPS - 1ms
++ */
++#define READ_IDLE_INTERVAL_DVFS                               (1*1000000)
++
++/*
++ * Forced read idle interval to be used when voltage is stable
++ * 50us - or maximum value will do
++ */
++#define READ_IDLE_INTERVAL_NORMAL                     (50*1000000)
++
++/* DLL calibration interval when voltage is NOT stable - 1us */
++#define DLL_CALIB_INTERVAL_DVFS                               (1*1000000)
++
++#define DLL_CALIB_ACK_WAIT_VAL                                5
++
++/* Interval between ZQCS commands - hw team recommended value */
++#define EMIF_ZQCS_INTERVAL_US                         (50*1000)
++/* Enable ZQ Calibration on exiting Self-refresh */
++#define ZQ_SFEXITEN_ENABLE                            1
++/*
++ * ZQ Calibration simultaneously on both chip-selects:
++ * Needs one calibration resistor per CS
++ */
++#define       ZQ_DUALCALEN_DISABLE                            0
++#define       ZQ_DUALCALEN_ENABLE                             1
++
++#define T_ZQCS_DEFAULT_NS                             90
++#define T_ZQCL_DEFAULT_NS                             360
++#define T_ZQINIT_DEFAULT_NS                           1000
++
++/* DPD_EN */
++#define DPD_DISABLE                                   0
++#define DPD_ENABLE                                    1
++
++/*
++ * Default values for the low-power entry to be used if not provided by user.
++ * OMAP4/5 has a hw bug(i735) due to which this value can not be less than 512
++ * Timeout values are in DDR clock 'cycles' and frequency threshold in Hz
++ */
++#define EMIF_LP_MODE_TIMEOUT_PERFORMANCE              2048
++#define EMIF_LP_MODE_TIMEOUT_POWER                    512
++#define EMIF_LP_MODE_FREQ_THRESHOLD                   400000000
++
++/* DDR_PHY_CTRL_1 values for EMIF4D - ATTILA PHY combination */
++#define EMIF_DDR_PHY_CTRL_1_BASE_VAL_ATTILAPHY                0x049FF000
++#define EMIF_DLL_SLAVE_DLY_CTRL_400_MHZ_ATTILAPHY     0x41
++#define EMIF_DLL_SLAVE_DLY_CTRL_200_MHZ_ATTILAPHY     0x80
++#define EMIF_DLL_SLAVE_DLY_CTRL_100_MHZ_AND_LESS_ATTILAPHY 0xFF
++
++/* DDR_PHY_CTRL_1 values for EMIF4D5 INTELLIPHY combination */
++#define EMIF_DDR_PHY_CTRL_1_BASE_VAL_INTELLIPHY               0x0E084200
++#define EMIF_PHY_TOTAL_READ_LATENCY_INTELLIPHY_PS     10000
++
++/* TEMP_ALERT_CONFIG - corresponding to temp gradient 5 C/s */
++#define TEMP_ALERT_POLL_INTERVAL_DEFAULT_MS           360
++
++#define EMIF_T_CSTA                                   3
++#define EMIF_T_PDLL_UL                                        128
++
++/* External PHY control registers magic values */
++#define EMIF_EXT_PHY_CTRL_1_VAL                               0x04020080
++#define EMIF_EXT_PHY_CTRL_5_VAL                               0x04010040
++#define EMIF_EXT_PHY_CTRL_6_VAL                               0x01004010
++#define EMIF_EXT_PHY_CTRL_7_VAL                               0x00001004
++#define EMIF_EXT_PHY_CTRL_8_VAL                               0x04010040
++#define EMIF_EXT_PHY_CTRL_9_VAL                               0x01004010
++#define EMIF_EXT_PHY_CTRL_10_VAL                      0x00001004
++#define EMIF_EXT_PHY_CTRL_11_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_12_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_13_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_14_VAL                      0x80080080
++#define EMIF_EXT_PHY_CTRL_15_VAL                      0x00800800
++#define EMIF_EXT_PHY_CTRL_16_VAL                      0x08102040
++#define EMIF_EXT_PHY_CTRL_17_VAL                      0x00000001
++#define EMIF_EXT_PHY_CTRL_18_VAL                      0x540A8150
++#define EMIF_EXT_PHY_CTRL_19_VAL                      0xA81502A0
++#define EMIF_EXT_PHY_CTRL_20_VAL                      0x002A0540
++#define EMIF_EXT_PHY_CTRL_21_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_22_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_23_VAL                      0x00000000
++#define EMIF_EXT_PHY_CTRL_24_VAL                      0x00000077
++
++#define EMIF_INTELLI_PHY_DQS_GATE_OPENING_DELAY_PS    1200
++
++/* Registers offset */
++#define EMIF_MODULE_ID_AND_REVISION                   0x0000
++#define EMIF_STATUS                                   0x0004
++#define EMIF_SDRAM_CONFIG                             0x0008
++#define EMIF_SDRAM_CONFIG_2                           0x000c
++#define EMIF_SDRAM_REFRESH_CONTROL                    0x0010
++#define EMIF_SDRAM_REFRESH_CTRL_SHDW                  0x0014
++#define EMIF_SDRAM_TIMING_1                           0x0018
++#define EMIF_SDRAM_TIMING_1_SHDW                      0x001c
++#define EMIF_SDRAM_TIMING_2                           0x0020
++#define EMIF_SDRAM_TIMING_2_SHDW                      0x0024
++#define EMIF_SDRAM_TIMING_3                           0x0028
++#define EMIF_SDRAM_TIMING_3_SHDW                      0x002c
++#define EMIF_LPDDR2_NVM_TIMING                                0x0030
++#define EMIF_LPDDR2_NVM_TIMING_SHDW                   0x0034
++#define EMIF_POWER_MANAGEMENT_CONTROL                 0x0038
++#define EMIF_POWER_MANAGEMENT_CTRL_SHDW                       0x003c
++#define EMIF_LPDDR2_MODE_REG_DATA                     0x0040
++#define EMIF_LPDDR2_MODE_REG_CONFIG                   0x0050
++#define EMIF_OCP_CONFIG                                       0x0054
++#define EMIF_OCP_CONFIG_VALUE_1                               0x0058
++#define EMIF_OCP_CONFIG_VALUE_2                               0x005c
++#define EMIF_IODFT_TEST_LOGIC_GLOBAL_CONTROL          0x0060
++#define EMIF_IODFT_TEST_LOGIC_CTRL_MISR_RESULT                0x0064
++#define EMIF_IODFT_TEST_LOGIC_ADDRESS_MISR_RESULT     0x0068
++#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_1      0x006c
++#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_2      0x0070
++#define EMIF_IODFT_TEST_LOGIC_DATA_MISR_RESULT_3      0x0074
++#define EMIF_PERFORMANCE_COUNTER_1                    0x0080
++#define EMIF_PERFORMANCE_COUNTER_2                    0x0084
++#define EMIF_PERFORMANCE_COUNTER_CONFIG                       0x0088
++#define EMIF_PERFORMANCE_COUNTER_MASTER_REGION_SELECT 0x008c
++#define EMIF_PERFORMANCE_COUNTER_TIME                 0x0090
++#define EMIF_MISC_REG                                 0x0094
++#define EMIF_DLL_CALIB_CTRL                           0x0098
++#define EMIF_DLL_CALIB_CTRL_SHDW                      0x009c
++#define EMIF_END_OF_INTERRUPT                         0x00a0
++#define EMIF_SYSTEM_OCP_INTERRUPT_RAW_STATUS          0x00a4
++#define EMIF_LL_OCP_INTERRUPT_RAW_STATUS              0x00a8
++#define EMIF_SYSTEM_OCP_INTERRUPT_STATUS              0x00ac
++#define EMIF_LL_OCP_INTERRUPT_STATUS                  0x00b0
++#define EMIF_SYSTEM_OCP_INTERRUPT_ENABLE_SET          0x00b4
++#define EMIF_LL_OCP_INTERRUPT_ENABLE_SET              0x00b8
++#define EMIF_SYSTEM_OCP_INTERRUPT_ENABLE_CLEAR                0x00bc
++#define EMIF_LL_OCP_INTERRUPT_ENABLE_CLEAR            0x00c0
++#define EMIF_SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG        0x00c8
++#define EMIF_TEMPERATURE_ALERT_CONFIG                 0x00cc
++#define EMIF_OCP_ERROR_LOG                            0x00d0
++#define EMIF_READ_WRITE_LEVELING_RAMP_WINDOW          0x00d4
++#define EMIF_READ_WRITE_LEVELING_RAMP_CONTROL         0x00d8
++#define EMIF_READ_WRITE_LEVELING_CONTROL              0x00dc
++#define EMIF_DDR_PHY_CTRL_1                           0x00e4
++#define EMIF_DDR_PHY_CTRL_1_SHDW                      0x00e8
++#define EMIF_DDR_PHY_CTRL_2                           0x00ec
++#define EMIF_PRIORITY_TO_CLASS_OF_SERVICE_MAPPING     0x0100
++#define EMIF_CONNECTION_ID_TO_CLASS_OF_SERVICE_1_MAPPING 0x0104
++#define EMIF_CONNECTION_ID_TO_CLASS_OF_SERVICE_2_MAPPING 0x0108
++#define EMIF_READ_WRITE_EXECUTION_THRESHOLD           0x0120
++#define EMIF_COS_CONFIG                                       0x0124
++#define EMIF_PHY_STATUS_1                             0x0140
++#define EMIF_PHY_STATUS_2                             0x0144
++#define EMIF_PHY_STATUS_3                             0x0148
++#define EMIF_PHY_STATUS_4                             0x014c
++#define EMIF_PHY_STATUS_5                             0x0150
++#define EMIF_PHY_STATUS_6                             0x0154
++#define EMIF_PHY_STATUS_7                             0x0158
++#define EMIF_PHY_STATUS_8                             0x015c
++#define EMIF_PHY_STATUS_9                             0x0160
++#define EMIF_PHY_STATUS_10                            0x0164
++#define EMIF_PHY_STATUS_11                            0x0168
++#define EMIF_PHY_STATUS_12                            0x016c
++#define EMIF_PHY_STATUS_13                            0x0170
++#define EMIF_PHY_STATUS_14                            0x0174
++#define EMIF_PHY_STATUS_15                            0x0178
++#define EMIF_PHY_STATUS_16                            0x017c
++#define EMIF_PHY_STATUS_17                            0x0180
++#define EMIF_PHY_STATUS_18                            0x0184
++#define EMIF_PHY_STATUS_19                            0x0188
++#define EMIF_PHY_STATUS_20                            0x018c
++#define EMIF_PHY_STATUS_21                            0x0190
++#define EMIF_EXT_PHY_CTRL_1                           0x0200
++#define EMIF_EXT_PHY_CTRL_1_SHDW                      0x0204
++#define EMIF_EXT_PHY_CTRL_2                           0x0208
++#define EMIF_EXT_PHY_CTRL_2_SHDW                      0x020c
++#define EMIF_EXT_PHY_CTRL_3                           0x0210
++#define EMIF_EXT_PHY_CTRL_3_SHDW                      0x0214
++#define EMIF_EXT_PHY_CTRL_4                           0x0218
++#define EMIF_EXT_PHY_CTRL_4_SHDW                      0x021c
++#define EMIF_EXT_PHY_CTRL_5                           0x0220
++#define EMIF_EXT_PHY_CTRL_5_SHDW                      0x0224
++#define EMIF_EXT_PHY_CTRL_6                           0x0228
++#define EMIF_EXT_PHY_CTRL_6_SHDW                      0x022c
++#define EMIF_EXT_PHY_CTRL_7                           0x0230
++#define EMIF_EXT_PHY_CTRL_7_SHDW                      0x0234
++#define EMIF_EXT_PHY_CTRL_8                           0x0238
++#define EMIF_EXT_PHY_CTRL_8_SHDW                      0x023c
++#define EMIF_EXT_PHY_CTRL_9                           0x0240
++#define EMIF_EXT_PHY_CTRL_9_SHDW                      0x0244
++#define EMIF_EXT_PHY_CTRL_10                          0x0248
++#define EMIF_EXT_PHY_CTRL_10_SHDW                     0x024c
++#define EMIF_EXT_PHY_CTRL_11                          0x0250
++#define EMIF_EXT_PHY_CTRL_11_SHDW                     0x0254
++#define EMIF_EXT_PHY_CTRL_12                          0x0258
++#define EMIF_EXT_PHY_CTRL_12_SHDW                     0x025c
++#define EMIF_EXT_PHY_CTRL_13                          0x0260
++#define EMIF_EXT_PHY_CTRL_13_SHDW                     0x0264
++#define EMIF_EXT_PHY_CTRL_14                          0x0268
++#define EMIF_EXT_PHY_CTRL_14_SHDW                     0x026c
++#define EMIF_EXT_PHY_CTRL_15                          0x0270
++#define EMIF_EXT_PHY_CTRL_15_SHDW                     0x0274
++#define EMIF_EXT_PHY_CTRL_16                          0x0278
++#define EMIF_EXT_PHY_CTRL_16_SHDW                     0x027c
++#define EMIF_EXT_PHY_CTRL_17                          0x0280
++#define EMIF_EXT_PHY_CTRL_17_SHDW                     0x0284
++#define EMIF_EXT_PHY_CTRL_18                          0x0288
++#define EMIF_EXT_PHY_CTRL_18_SHDW                     0x028c
++#define EMIF_EXT_PHY_CTRL_19                          0x0290
++#define EMIF_EXT_PHY_CTRL_19_SHDW                     0x0294
++#define EMIF_EXT_PHY_CTRL_20                          0x0298
++#define EMIF_EXT_PHY_CTRL_20_SHDW                     0x029c
++#define EMIF_EXT_PHY_CTRL_21                          0x02a0
++#define EMIF_EXT_PHY_CTRL_21_SHDW                     0x02a4
++#define EMIF_EXT_PHY_CTRL_22                          0x02a8
++#define EMIF_EXT_PHY_CTRL_22_SHDW                     0x02ac
++#define EMIF_EXT_PHY_CTRL_23                          0x02b0
++#define EMIF_EXT_PHY_CTRL_23_SHDW                     0x02b4
++#define EMIF_EXT_PHY_CTRL_24                          0x02b8
++#define EMIF_EXT_PHY_CTRL_24_SHDW                     0x02bc
++#define EMIF_EXT_PHY_CTRL_25                          0x02c0
++#define EMIF_EXT_PHY_CTRL_25_SHDW                     0x02c4
++#define EMIF_EXT_PHY_CTRL_26                          0x02c8
++#define EMIF_EXT_PHY_CTRL_26_SHDW                     0x02cc
++#define EMIF_EXT_PHY_CTRL_27                          0x02d0
++#define EMIF_EXT_PHY_CTRL_27_SHDW                     0x02d4
++#define EMIF_EXT_PHY_CTRL_28                          0x02d8
++#define EMIF_EXT_PHY_CTRL_28_SHDW                     0x02dc
++#define EMIF_EXT_PHY_CTRL_29                          0x02e0
++#define EMIF_EXT_PHY_CTRL_29_SHDW                     0x02e4
++#define EMIF_EXT_PHY_CTRL_30                          0x02e8
++#define EMIF_EXT_PHY_CTRL_30_SHDW                     0x02ec
++
++/* Registers shifts and masks */
++
++/* EMIF_MODULE_ID_AND_REVISION */
++#define SCHEME_SHIFT                                  30
++#define SCHEME_MASK                                   (0x3 << 30)
++#define MODULE_ID_SHIFT                                       16
++#define MODULE_ID_MASK                                        (0xfff << 16)
++#define RTL_VERSION_SHIFT                             11
++#define RTL_VERSION_MASK                              (0x1f << 11)
++#define MAJOR_REVISION_SHIFT                          8
++#define MAJOR_REVISION_MASK                           (0x7 << 8)
++#define MINOR_REVISION_SHIFT                          0
++#define MINOR_REVISION_MASK                           (0x3f << 0)
++
++/* STATUS */
++#define BE_SHIFT                                      31
++#define BE_MASK                                               (1 << 31)
++#define DUAL_CLK_MODE_SHIFT                           30
++#define DUAL_CLK_MODE_MASK                            (1 << 30)
++#define FAST_INIT_SHIFT                                       29
++#define FAST_INIT_MASK                                        (1 << 29)
++#define RDLVLGATETO_SHIFT                             6
++#define RDLVLGATETO_MASK                              (1 << 6)
++#define RDLVLTO_SHIFT                                 5
++#define RDLVLTO_MASK                                  (1 << 5)
++#define WRLVLTO_SHIFT                                 4
++#define WRLVLTO_MASK                                  (1 << 4)
++#define PHY_DLL_READY_SHIFT                           2
++#define PHY_DLL_READY_MASK                            (1 << 2)
++
++/* SDRAM_CONFIG */
++#define SDRAM_TYPE_SHIFT                              29
++#define SDRAM_TYPE_MASK                                       (0x7 << 29)
++#define IBANK_POS_SHIFT                                       27
++#define IBANK_POS_MASK                                        (0x3 << 27)
++#define DDR_TERM_SHIFT                                        24
++#define DDR_TERM_MASK                                 (0x7 << 24)
++#define DDR2_DDQS_SHIFT                                       23
++#define DDR2_DDQS_MASK                                        (1 << 23)
++#define DYN_ODT_SHIFT                                 21
++#define DYN_ODT_MASK                                  (0x3 << 21)
++#define DDR_DISABLE_DLL_SHIFT                         20
++#define DDR_DISABLE_DLL_MASK                          (1 << 20)
++#define SDRAM_DRIVE_SHIFT                             18
++#define SDRAM_DRIVE_MASK                              (0x3 << 18)
++#define CWL_SHIFT                                     16
++#define CWL_MASK                                      (0x3 << 16)
++#define NARROW_MODE_SHIFT                             14
++#define NARROW_MODE_MASK                              (0x3 << 14)
++#define CL_SHIFT                                      10
++#define CL_MASK                                               (0xf << 10)
++#define ROWSIZE_SHIFT                                 7
++#define ROWSIZE_MASK                                  (0x7 << 7)
++#define IBANK_SHIFT                                   4
++#define IBANK_MASK                                    (0x7 << 4)
++#define EBANK_SHIFT                                   3
++#define EBANK_MASK                                    (1 << 3)
++#define PAGESIZE_SHIFT                                        0
++#define PAGESIZE_MASK                                 (0x7 << 0)
++
++/* SDRAM_CONFIG_2 */
++#define CS1NVMEN_SHIFT                                        30
++#define CS1NVMEN_MASK                                 (1 << 30)
++#define EBANK_POS_SHIFT                                       27
++#define EBANK_POS_MASK                                        (1 << 27)
++#define RDBNUM_SHIFT                                  4
++#define RDBNUM_MASK                                   (0x3 << 4)
++#define RDBSIZE_SHIFT                                 0
++#define RDBSIZE_MASK                                  (0x7 << 0)
++
++/* SDRAM_REFRESH_CONTROL */
++#define INITREF_DIS_SHIFT                             31
++#define INITREF_DIS_MASK                              (1 << 31)
++#define SRT_SHIFT                                     29
++#define SRT_MASK                                      (1 << 29)
++#define ASR_SHIFT                                     28
++#define ASR_MASK                                      (1 << 28)
++#define PASR_SHIFT                                    24
++#define PASR_MASK                                     (0x7 << 24)
++#define REFRESH_RATE_SHIFT                            0
++#define REFRESH_RATE_MASK                             (0xffff << 0)
++
++/* SDRAM_TIMING_1 */
++#define T_RTW_SHIFT                                   29
++#define T_RTW_MASK                                    (0x7 << 29)
++#define T_RP_SHIFT                                    25
++#define T_RP_MASK                                     (0xf << 25)
++#define T_RCD_SHIFT                                   21
++#define T_RCD_MASK                                    (0xf << 21)
++#define T_WR_SHIFT                                    17
++#define T_WR_MASK                                     (0xf << 17)
++#define T_RAS_SHIFT                                   12
++#define T_RAS_MASK                                    (0x1f << 12)
++#define T_RC_SHIFT                                    6
++#define T_RC_MASK                                     (0x3f << 6)
++#define T_RRD_SHIFT                                   3
++#define T_RRD_MASK                                    (0x7 << 3)
++#define T_WTR_SHIFT                                   0
++#define T_WTR_MASK                                    (0x7 << 0)
++
++/* SDRAM_TIMING_2 */
++#define T_XP_SHIFT                                    28
++#define T_XP_MASK                                     (0x7 << 28)
++#define T_ODT_SHIFT                                   25
++#define T_ODT_MASK                                    (0x7 << 25)
++#define T_XSNR_SHIFT                                  16
++#define T_XSNR_MASK                                   (0x1ff << 16)
++#define T_XSRD_SHIFT                                  6
++#define T_XSRD_MASK                                   (0x3ff << 6)
++#define T_RTP_SHIFT                                   3
++#define T_RTP_MASK                                    (0x7 << 3)
++#define T_CKE_SHIFT                                   0
++#define T_CKE_MASK                                    (0x7 << 0)
++
++/* SDRAM_TIMING_3 */
++#define T_PDLL_UL_SHIFT                                       28
++#define T_PDLL_UL_MASK                                        (0xf << 28)
++#define T_CSTA_SHIFT                                  24
++#define T_CSTA_MASK                                   (0xf << 24)
++#define T_CKESR_SHIFT                                 21
++#define T_CKESR_MASK                                  (0x7 << 21)
++#define ZQ_ZQCS_SHIFT                                 15
++#define ZQ_ZQCS_MASK                                  (0x3f << 15)
++#define T_TDQSCKMAX_SHIFT                             13
++#define T_TDQSCKMAX_MASK                              (0x3 << 13)
++#define T_RFC_SHIFT                                   4
++#define T_RFC_MASK                                    (0x1ff << 4)
++#define T_RAS_MAX_SHIFT                                       0
++#define T_RAS_MAX_MASK                                        (0xf << 0)
++
++/* POWER_MANAGEMENT_CONTROL */
++#define PD_TIM_SHIFT                                  12
++#define PD_TIM_MASK                                   (0xf << 12)
++#define DPD_EN_SHIFT                                  11
++#define DPD_EN_MASK                                   (1 << 11)
++#define LP_MODE_SHIFT                                 8
++#define LP_MODE_MASK                                  (0x7 << 8)
++#define SR_TIM_SHIFT                                  4
++#define SR_TIM_MASK                                   (0xf << 4)
++#define CS_TIM_SHIFT                                  0
++#define CS_TIM_MASK                                   (0xf << 0)
++
++/* LPDDR2_MODE_REG_DATA */
++#define VALUE_0_SHIFT                                 0
++#define VALUE_0_MASK                                  (0x7f << 0)
++
++/* LPDDR2_MODE_REG_CONFIG */
++#define CS_SHIFT                                      31
++#define CS_MASK                                               (1 << 31)
++#define REFRESH_EN_SHIFT                              30
++#define REFRESH_EN_MASK                                       (1 << 30)
++#define ADDRESS_SHIFT                                 0
++#define ADDRESS_MASK                                  (0xff << 0)
++
++/* OCP_CONFIG */
++#define SYS_THRESH_MAX_SHIFT                          24
++#define SYS_THRESH_MAX_MASK                           (0xf << 24)
++#define MPU_THRESH_MAX_SHIFT                          20
++#define MPU_THRESH_MAX_MASK                           (0xf << 20)
++#define LL_THRESH_MAX_SHIFT                           16
++#define LL_THRESH_MAX_MASK                            (0xf << 16)
++
++/* PERFORMANCE_COUNTER_1 */
++#define COUNTER1_SHIFT                                        0
++#define COUNTER1_MASK                                 (0xffffffff << 0)
++
++/* PERFORMANCE_COUNTER_2 */
++#define COUNTER2_SHIFT                                        0
++#define COUNTER2_MASK                                 (0xffffffff << 0)
++
++/* PERFORMANCE_COUNTER_CONFIG */
++#define CNTR2_MCONNID_EN_SHIFT                                31
++#define CNTR2_MCONNID_EN_MASK                         (1 << 31)
++#define CNTR2_REGION_EN_SHIFT                         30
++#define CNTR2_REGION_EN_MASK                          (1 << 30)
++#define CNTR2_CFG_SHIFT                                       16
++#define CNTR2_CFG_MASK                                        (0xf << 16)
++#define CNTR1_MCONNID_EN_SHIFT                                15
++#define CNTR1_MCONNID_EN_MASK                         (1 << 15)
++#define CNTR1_REGION_EN_SHIFT                         14
++#define CNTR1_REGION_EN_MASK                          (1 << 14)
++#define CNTR1_CFG_SHIFT                                       0
++#define CNTR1_CFG_MASK                                        (0xf << 0)
++
++/* PERFORMANCE_COUNTER_MASTER_REGION_SELECT */
++#define MCONNID2_SHIFT                                        24
++#define MCONNID2_MASK                                 (0xff << 24)
++#define REGION_SEL2_SHIFT                             16
++#define REGION_SEL2_MASK                              (0x3 << 16)
++#define MCONNID1_SHIFT                                        8
++#define MCONNID1_MASK                                 (0xff << 8)
++#define REGION_SEL1_SHIFT                             0
++#define REGION_SEL1_MASK                              (0x3 << 0)
++
++/* PERFORMANCE_COUNTER_TIME */
++#define TOTAL_TIME_SHIFT                              0
++#define TOTAL_TIME_MASK                                       (0xffffffff << 0)
++
++/* DLL_CALIB_CTRL */
++#define ACK_WAIT_SHIFT                                        16
++#define ACK_WAIT_MASK                                 (0xf << 16)
++#define DLL_CALIB_INTERVAL_SHIFT                      0
++#define DLL_CALIB_INTERVAL_MASK                               (0x1ff << 0)
++
++/* END_OF_INTERRUPT */
++#define EOI_SHIFT                                     0
++#define EOI_MASK                                      (1 << 0)
++
++/* SYSTEM_OCP_INTERRUPT_RAW_STATUS */
++#define DNV_SYS_SHIFT                                 2
++#define DNV_SYS_MASK                                  (1 << 2)
++#define TA_SYS_SHIFT                                  1
++#define TA_SYS_MASK                                   (1 << 1)
++#define ERR_SYS_SHIFT                                 0
++#define ERR_SYS_MASK                                  (1 << 0)
++
++/* LOW_LATENCY_OCP_INTERRUPT_RAW_STATUS */
++#define DNV_LL_SHIFT                                  2
++#define DNV_LL_MASK                                   (1 << 2)
++#define TA_LL_SHIFT                                   1
++#define TA_LL_MASK                                    (1 << 1)
++#define ERR_LL_SHIFT                                  0
++#define ERR_LL_MASK                                   (1 << 0)
++
++/* SYSTEM_OCP_INTERRUPT_ENABLE_SET */
++#define EN_DNV_SYS_SHIFT                              2
++#define EN_DNV_SYS_MASK                                       (1 << 2)
++#define EN_TA_SYS_SHIFT                                       1
++#define EN_TA_SYS_MASK                                        (1 << 1)
++#define EN_ERR_SYS_SHIFT                                      0
++#define EN_ERR_SYS_MASK                                       (1 << 0)
++
++/* LOW_LATENCY_OCP_INTERRUPT_ENABLE_SET */
++#define EN_DNV_LL_SHIFT                                       2
++#define EN_DNV_LL_MASK                                        (1 << 2)
++#define EN_TA_LL_SHIFT                                        1
++#define EN_TA_LL_MASK                                 (1 << 1)
++#define EN_ERR_LL_SHIFT                                       0
++#define EN_ERR_LL_MASK                                        (1 << 0)
++
++/* SDRAM_OUTPUT_IMPEDANCE_CALIBRATION_CONFIG */
++#define ZQ_CS1EN_SHIFT                                        31
++#define ZQ_CS1EN_MASK                                 (1 << 31)
++#define ZQ_CS0EN_SHIFT                                        30
++#define ZQ_CS0EN_MASK                                 (1 << 30)
++#define ZQ_DUALCALEN_SHIFT                            29
++#define ZQ_DUALCALEN_MASK                             (1 << 29)
++#define ZQ_SFEXITEN_SHIFT                             28
++#define ZQ_SFEXITEN_MASK                              (1 << 28)
++#define ZQ_ZQINIT_MULT_SHIFT                          18
++#define ZQ_ZQINIT_MULT_MASK                           (0x3 << 18)
++#define ZQ_ZQCL_MULT_SHIFT                            16
++#define ZQ_ZQCL_MULT_MASK                             (0x3 << 16)
++#define ZQ_REFINTERVAL_SHIFT                          0
++#define ZQ_REFINTERVAL_MASK                           (0xffff << 0)
++
++/* TEMPERATURE_ALERT_CONFIG */
++#define TA_CS1EN_SHIFT                                        31
++#define TA_CS1EN_MASK                                 (1 << 31)
++#define TA_CS0EN_SHIFT                                        30
++#define TA_CS0EN_MASK                                 (1 << 30)
++#define TA_SFEXITEN_SHIFT                             28
++#define TA_SFEXITEN_MASK                              (1 << 28)
++#define TA_DEVWDT_SHIFT                                       26
++#define TA_DEVWDT_MASK                                        (0x3 << 26)
++#define TA_DEVCNT_SHIFT                                       24
++#define TA_DEVCNT_MASK                                        (0x3 << 24)
++#define TA_REFINTERVAL_SHIFT                          0
++#define TA_REFINTERVAL_MASK                           (0x3fffff << 0)
++
++/* OCP_ERROR_LOG */
++#define MADDRSPACE_SHIFT                              14
++#define MADDRSPACE_MASK                                       (0x3 << 14)
++#define MBURSTSEQ_SHIFT                                       11
++#define MBURSTSEQ_MASK                                        (0x7 << 11)
++#define MCMD_SHIFT                                    8
++#define MCMD_MASK                                     (0x7 << 8)
++#define MCONNID_SHIFT                                 0
++#define MCONNID_MASK                                  (0xff << 0)
++
++/* DDR_PHY_CTRL_1 - EMIF4D */
++#define DLL_SLAVE_DLY_CTRL_SHIFT_4D                   4
++#define DLL_SLAVE_DLY_CTRL_MASK_4D                    (0xFF << 4)
++#define READ_LATENCY_SHIFT_4D                         0
++#define READ_LATENCY_MASK_4D                          (0xf << 0)
++
++/* DDR_PHY_CTRL_1 - EMIF4D5 */
++#define DLL_HALF_DELAY_SHIFT_4D5                      21
++#define DLL_HALF_DELAY_MASK_4D5                               (1 << 21)
++#define READ_LATENCY_SHIFT_4D5                                0
++#define READ_LATENCY_MASK_4D5                         (0x1f << 0)
++
++/* DDR_PHY_CTRL_1_SHDW */
++#define DDR_PHY_CTRL_1_SHDW_SHIFT                     5
++#define DDR_PHY_CTRL_1_SHDW_MASK                      (0x7ffffff << 5)
++#define READ_LATENCY_SHDW_SHIFT                               0
++#define READ_LATENCY_SHDW_MASK                                (0x1f << 0)
++
++#endif /* __TI_EMIF_H */
+--- a/include/linux/usb/musb.h
++++ b/include/linux/usb/musb.h
+@@ -99,8 +99,6 @@ struct musb_hdrc_platform_data {
+       /* MUSB_HOST, MUSB_PERIPHERAL, or MUSB_OTG */
+       u8              mode;
+-      u8              has_mailbox:1;
+-
+       /* for clk_get() */
+       const char      *clock;
+--- a/include/linux/usb/omap_control_usb.h
++++ /dev/null
+@@ -1,92 +0,0 @@
+-/*
+- * omap_control_usb.h - Header file for the USB part of control module.
+- *
+- * Copyright (C) 2013 Texas Instruments Incorporated - http://www.ti.com
+- * 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.
+- *
+- * Author: Kishon Vijay Abraham I <kishon@ti.com>
+- *
+- * 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.
+- *
+- */
+-
+-#ifndef __OMAP_CONTROL_USB_H__
+-#define __OMAP_CONTROL_USB_H__
+-
+-struct omap_control_usb {
+-      struct device *dev;
+-
+-      u32 __iomem *dev_conf;
+-      u32 __iomem *otghs_control;
+-      u32 __iomem *phy_power;
+-
+-      struct clk *sys_clk;
+-
+-      u32 type;
+-};
+-
+-struct omap_control_usb_platform_data {
+-      u8 type;
+-};
+-
+-enum omap_control_usb_mode {
+-      USB_MODE_UNDEFINED = 0,
+-      USB_MODE_HOST,
+-      USB_MODE_DEVICE,
+-      USB_MODE_DISCONNECT,
+-};
+-
+-/* To differentiate ctrl module IP having either mailbox or USB3 PHY power */
+-#define       OMAP_CTRL_DEV_TYPE1             0x1
+-#define       OMAP_CTRL_DEV_TYPE2             0x2
+-
+-#define       OMAP_CTRL_DEV_PHY_PD            BIT(0)
+-
+-#define       OMAP_CTRL_DEV_AVALID            BIT(0)
+-#define       OMAP_CTRL_DEV_BVALID            BIT(1)
+-#define       OMAP_CTRL_DEV_VBUSVALID         BIT(2)
+-#define       OMAP_CTRL_DEV_SESSEND           BIT(3)
+-#define       OMAP_CTRL_DEV_IDDIG             BIT(4)
+-
+-#define       OMAP_CTRL_USB_PWRCTL_CLK_CMD_MASK       0x003FC000
+-#define       OMAP_CTRL_USB_PWRCTL_CLK_CMD_SHIFT      0xE
+-
+-#define       OMAP_CTRL_USB_PWRCTL_CLK_FREQ_MASK      0xFFC00000
+-#define       OMAP_CTRL_USB_PWRCTL_CLK_FREQ_SHIFT     0x16
+-
+-#define       OMAP_CTRL_USB3_PHY_TX_RX_POWERON        0x3
+-#define       OMAP_CTRL_USB3_PHY_TX_RX_POWEROFF       0x0
+-
+-#if IS_ENABLED(CONFIG_OMAP_CONTROL_USB)
+-extern struct device *omap_get_control_dev(void);
+-extern void omap_control_usb_phy_power(struct device *dev, int on);
+-extern void omap_control_usb3_phy_power(struct device *dev, bool on);
+-extern void omap_control_usb_set_mode(struct device *dev,
+-      enum omap_control_usb_mode mode);
+-#else
+-static inline struct device *omap_get_control_dev(void)
+-{
+-      return ERR_PTR(-ENODEV);
+-}
+-
+-static inline void omap_control_usb_phy_power(struct device *dev, int on)
+-{
+-}
+-
+-static inline void omap_control_usb3_phy_power(struct device *dev, int on)
+-{
+-}
+-
+-static inline void omap_control_usb_set_mode(struct device *dev,
+-      enum omap_control_usb_mode mode)
+-{
+-}
+-#endif
+-
+-#endif        /* __OMAP_CONTROL_USB_H__ */
+--- a/include/linux/usb/omap_usb.h
++++ /dev/null
+@@ -1,67 +0,0 @@
+-/*
+- * omap_usb.h -- omap usb2 phy header file
+- *
+- * Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
+- * 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.
+- *
+- * Author: Kishon Vijay Abraham I <kishon@ti.com>
+- *
+- * 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.
+- *
+- */
+-
+-#ifndef __DRIVERS_OMAP_USB2_H
+-#define __DRIVERS_OMAP_USB2_H
+-
+-#include <linux/io.h>
+-#include <linux/usb/otg.h>
+-
+-struct usb_dpll_params {
+-      u16     m;
+-      u8      n;
+-      u8      freq:3;
+-      u8      sd;
+-      u32     mf;
+-};
+-
+-struct omap_usb {
+-      struct usb_phy          phy;
+-      struct phy_companion    *comparator;
+-      void __iomem            *pll_ctrl_base;
+-      struct device           *dev;
+-      struct device           *control_dev;
+-      struct clk              *wkupclk;
+-      struct clk              *sys_clk;
+-      struct clk              *optclk;
+-      u8                      is_suspended:1;
+-};
+-
+-#define       phy_to_omapusb(x)       container_of((x), struct omap_usb, phy)
+-
+-#if defined(CONFIG_OMAP_USB2) || defined(CONFIG_OMAP_USB2_MODULE)
+-extern int omap_usb2_set_comparator(struct phy_companion *comparator);
+-#else
+-static inline int omap_usb2_set_comparator(struct phy_companion *comparator)
+-{
+-      return -ENODEV;
+-}
+-#endif
+-
+-static inline u32 omap_usb_readl(void __iomem *addr, unsigned offset)
+-{
+-      return __raw_readl(addr + offset);
+-}
+-
+-static inline void omap_usb_writel(void __iomem *addr, unsigned offset,
+-      u32 data)
+-{
+-      __raw_writel(data, addr + offset);
+-}
+-
+-#endif /* __DRIVERS_OMAP_USB_H */
+--- a/include/linux/usb/usb_phy_gen_xceiv.h
++++ b/include/linux/usb/usb_phy_gen_xceiv.h
+@@ -9,7 +9,8 @@ struct usb_phy_gen_xceiv_platform_data {
+       /* if set fails with -EPROBE_DEFER if can't get regulator */
+       unsigned int needs_vcc:1;
+-      unsigned int needs_reset:1;
++      unsigned int needs_reset:1;     /* deprecated */
++      int gpio_reset;
+ };
+ #if defined(CONFIG_NOP_USB_XCEIV) || (defined(CONFIG_NOP_USB_XCEIV_MODULE) && defined(MODULE))
+--- a/include/uapi/linux/v4l2-controls.h
++++ b/include/uapi/linux/v4l2-controls.h
+@@ -160,6 +160,10 @@ enum v4l2_colorfx {
+  * of controls. Total of 16 controls is reserved for this driver */
+ #define V4L2_CID_USER_SI476X_BASE             (V4L2_CID_USER_BASE + 0x1040)
++/* The base for the TI VPE driver controls. Total of 16 controls is reserved for
++ * this driver */
++#define V4L2_CID_USER_TI_VPE_BASE             (V4L2_CID_USER_BASE + 0x1050)
++
+ /* MPEG-class control IDs */
+ /* The MPEG controls are applicable to all codec controls
+  * and the 'MPEG' part of the define is historical */
+--- a/include/video/da8xx-fb.h
++++ b/include/video/da8xx-fb.h
+@@ -12,6 +12,8 @@
+ #ifndef DA8XX_FB_H
+ #define DA8XX_FB_H
++#include <linux/fb.h>
++
+ enum panel_shade {
+       MONOCHROME = 0,
+       COLOR_ACTIVE,
+@@ -91,5 +93,22 @@ struct lcd_sync_arg {
+ /* Proprietary FB_SYNC_ flags */
+ #define FB_SYNC_CLK_INVERT 0x40000000
++struct da8xx_encoder {
++      struct list_head list;  /* internal use only */
++      struct i2c_client *client;
++      void *priv;
++      void (*set_mode)(struct da8xx_encoder *encoder,
++                      struct fb_videomode *panel);
++      struct device_node *node;
++};
++
++void da8xx_register_encoder(struct da8xx_encoder *encoder);
++void da8xx_unregister_encoder(struct da8xx_encoder *encoder);
++
++
++typedef void (*vsync_callback_t)(void *arg);
++int register_vsync_cb(vsync_callback_t handler, void *arg, int idx);
++int unregister_vsync_cb(vsync_callback_t handler, void *arg, int idx);
++
+ #endif  /* ifndef DA8XX_FB_H */
+--- /dev/null
++++ b/include/video/da8xx-tda998x-hdmi.h
+@@ -0,0 +1,35 @@
++/*
++ * Header file for TI DA8XX/TDA998x Encoder Driver
++ *
++ * Copyright (C) 2013 Texas Instruments Inc
++ *
++ * This file is licensed under the terms of the GNU General Public License
++ * version 2. This program is licensed "as is" without any warranty of any
++ * kind, whether express or implied.
++ */
++
++#ifndef DA8XX_TDA998X_HDMI_H
++#define DA8XX_TDA998X_HDMI_H
++
++#include <linux/fb.h>
++
++enum tda998x_audio_format {
++      AFMT_I2S,
++      AFMT_SPDIF,
++};
++
++struct tda998x_encoder_params {
++      int audio_cfg;
++      int audio_clk_cfg;
++      enum tda998x_audio_format audio_format;
++      int audio_sample_rate;
++      char audio_frame[6];
++      int swap_a, mirr_a;
++      int swap_b, mirr_b;
++      int swap_c, mirr_c;
++      int swap_d, mirr_d;
++      int swap_e, mirr_e;
++      int swap_f, mirr_f;
++};
++
++#endif
+--- a/include/video/omapdss.h
++++ b/include/video/omapdss.h
+@@ -227,6 +227,8 @@ enum omap_dss_output_id {
+       OMAP_DSS_OUTPUT_DSI2    = 1 << 4,
+       OMAP_DSS_OUTPUT_VENC    = 1 << 5,
+       OMAP_DSS_OUTPUT_HDMI    = 1 << 6,
++      OMAP_DSS_OUTPUT_DPI1    = 1 << 7,
++      OMAP_DSS_OUTPUT_DPI2    = 1 << 8,
+ };
+ /* RFBI */
+@@ -319,6 +321,8 @@ enum omapdss_version {
+       OMAPDSS_VER_OMAP4430_ES2,       /* OMAP4430 ES2.0, 2.1, 2.2 */
+       OMAPDSS_VER_OMAP4,              /* All other OMAP4s */
+       OMAPDSS_VER_OMAP5,
++      OMAPDSS_VER_DRA7xx,
++      OMAPDSS_VER_AM43xx,
+ };
+ /* Board specific data */
+@@ -961,6 +965,10 @@ int dispc_ovl_enable(enum omap_plane pla
+ bool dispc_ovl_enabled(enum omap_plane plane);
+ void dispc_ovl_set_channel_out(enum omap_plane plane,
+               enum omap_channel channel);
++void dispc_ovl_compute_fifo_thresholds(enum omap_plane plane,
++              u32 *fifo_low, u32 *fifo_high, bool use_fifomerge,
++              bool manual_update);
++void dispc_ovl_set_fifo_threshold(enum omap_plane plane, u32 low, u32 high);
+ int dispc_ovl_setup(enum omap_plane plane, const struct omap_overlay_info *oi,
+               bool replication, const struct omap_video_timings *mgr_timings,
+               bool mem_to_mem);
+--- a/include/video/omap-panel-data.h
++++ b/include/video/omap-panel-data.h
+@@ -62,6 +62,20 @@ struct encoder_tpd12s015_platform_data {
+ };
+ /**
++ * encoder_sil9022 platform data
++ * @name: name for this display entity
++ * @res_gpio: Gpio to switch lcd and hdmi. Used as reset for Sil9022
++ * as a temproary solution.
++ */
++struct encoder_sil9022_platform_data {
++      const char *name;
++      const char *source;
++      int reset_gpio;
++      int data_lines;
++};
++
++
++/**
+  * connector_dvi platform data
+  * @name: name for this display entity
+  * @source: name of the display entity used as a video source
+--- a/MAINTAINERS
++++ b/MAINTAINERS
+@@ -3691,6 +3691,14 @@ S:      Maintained
+ F:    include/asm-generic/
+ F:    include/uapi/asm-generic/
++GENERIC PHY FRAMEWORK
++M:    Kishon Vijay Abraham I <kishon@ti.com>
++L:    linux-kernel@vger.kernel.org
++T:    git git://git.kernel.org/pub/scm/linux/kernel/git/kishon/linux-phy.git
++S:    Supported
++F:    drivers/phy/
++F:    include/linux/phy/
++
+ GENERIC UIO DRIVER FOR PCI DEVICES
+ M:    "Michael S. Tsirkin" <mst@redhat.com>
+ L:    kvm@vger.kernel.org
+--- a/sound/soc/davinci/davinci-evm.c
++++ b/sound/soc/davinci/davinci-evm.c
+@@ -16,6 +16,7 @@
+ #include <linux/platform_device.h>
+ #include <linux/platform_data/edma.h>
+ #include <linux/i2c.h>
++#include <linux/of_platform.h>
+ #include <sound/core.h>
+ #include <sound/pcm.h>
+ #include <sound/soc.h>
+@@ -23,10 +24,16 @@
+ #include <asm/dma.h>
+ #include <asm/mach-types.h>
++#include <linux/edma.h>
++
+ #include "davinci-pcm.h"
+ #include "davinci-i2s.h"
+ #include "davinci-mcasp.h"
++struct snd_soc_card_drvdata_davinci {
++      unsigned sysclk;
++};
++
+ #define AUDIO_FORMAT (SND_SOC_DAIFMT_DSP_B | \
+               SND_SOC_DAIFMT_CBM_CFM | SND_SOC_DAIFMT_IB_NF)
+ static int evm_hw_params(struct snd_pcm_substream *substream,
+@@ -35,27 +42,11 @@ static int evm_hw_params(struct snd_pcm_
+       struct snd_soc_pcm_runtime *rtd = substream->private_data;
+       struct snd_soc_dai *codec_dai = rtd->codec_dai;
+       struct snd_soc_dai *cpu_dai = rtd->cpu_dai;
++      struct snd_soc_codec *codec = rtd->codec;
++      struct snd_soc_card *soc_card = codec->card;
+       int ret = 0;
+-      unsigned sysclk;
+-
+-      /* ASP1 on DM355 EVM is clocked by an external oscillator */
+-      if (machine_is_davinci_dm355_evm() || machine_is_davinci_dm6467_evm() ||
+-          machine_is_davinci_dm365_evm())
+-              sysclk = 27000000;
+-
+-      /* ASP0 in DM6446 EVM is clocked by U55, as configured by
+-       * board-dm644x-evm.c using GPIOs from U18.  There are six
+-       * options; here we "know" we use a 48 KHz sample rate.
+-       */
+-      else if (machine_is_davinci_evm())
+-              sysclk = 12288000;
+-
+-      else if (machine_is_davinci_da830_evm() ||
+-                              machine_is_davinci_da850_evm())
+-              sysclk = 24576000;
+-
+-      else
+-              return -EINVAL;
++      unsigned sysclk = ((struct snd_soc_card_drvdata_davinci *)
++                         snd_soc_card_get_drvdata(soc_card))->sysclk;
+       /* set codec DAI configuration */
+       ret = snd_soc_dai_set_fmt(codec_dai, AUDIO_FORMAT);
+@@ -133,13 +124,22 @@ static int evm_aic3x_init(struct snd_soc
+ {
+       struct snd_soc_codec *codec = rtd->codec;
+       struct snd_soc_dapm_context *dapm = &codec->dapm;
++      struct device_node *np = codec->card->dev->of_node;
++      int ret;
+       /* Add davinci-evm specific widgets */
+       snd_soc_dapm_new_controls(dapm, aic3x_dapm_widgets,
+                                 ARRAY_SIZE(aic3x_dapm_widgets));
+-      /* Set up davinci-evm specific audio path audio_map */
+-      snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
++      if (np) {
++              ret = snd_soc_of_parse_audio_routing(codec->card,
++                                                      "ti,audio-routing");
++              if (ret)
++                      return ret;
++      } else {
++              /* Set up davinci-evm specific audio path audio_map */
++              snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map));
++      }
+       /* not connected */
+       snd_soc_dapm_disable_pin(dapm, "MONO_LOUT");
+@@ -243,35 +243,65 @@ static struct snd_soc_dai_link da850_evm
+ };
+ /* davinci dm6446 evm audio machine driver */
++/*
++ * ASP0 in DM6446 EVM is clocked by U55, as configured by
++ * board-dm644x-evm.c using GPIOs from U18.  There are six
++ * options; here we "know" we use a 48 KHz sample rate.
++ */
++static struct snd_soc_card_drvdata_davinci dm6446_snd_soc_card_drvdata = {
++      .sysclk = 12288000,
++};
++
+ static struct snd_soc_card dm6446_snd_soc_card_evm = {
+       .name = "DaVinci DM6446 EVM",
+       .owner = THIS_MODULE,
+       .dai_link = &dm6446_evm_dai,
+       .num_links = 1,
++      .drvdata = &dm6446_snd_soc_card_drvdata,
+ };
+ /* davinci dm355 evm audio machine driver */
++/* ASP1 on DM355 EVM is clocked by an external oscillator */
++static struct snd_soc_card_drvdata_davinci dm355_snd_soc_card_drvdata = {
++      .sysclk = 27000000,
++};
++
+ static struct snd_soc_card dm355_snd_soc_card_evm = {
+       .name = "DaVinci DM355 EVM",
+       .owner = THIS_MODULE,
+       .dai_link = &dm355_evm_dai,
+       .num_links = 1,
++      .drvdata = &dm355_snd_soc_card_drvdata,
+ };
+ /* davinci dm365 evm audio machine driver */
++static struct snd_soc_card_drvdata_davinci dm365_snd_soc_card_drvdata = {
++      .sysclk = 27000000,
++};
++
+ static struct snd_soc_card dm365_snd_soc_card_evm = {
+       .name = "DaVinci DM365 EVM",
+       .owner = THIS_MODULE,
+       .dai_link = &dm365_evm_dai,
+       .num_links = 1,
++      .drvdata = &dm365_snd_soc_card_drvdata,
+ };
+ /* davinci dm6467 evm audio machine driver */
++static struct snd_soc_card_drvdata_davinci dm6467_snd_soc_card_drvdata = {
++      .sysclk = 27000000,
++};
++
+ static struct snd_soc_card dm6467_snd_soc_card_evm = {
+       .name = "DaVinci DM6467 EVM",
+       .owner = THIS_MODULE,
+       .dai_link = dm6467_evm_dai,
+       .num_links = ARRAY_SIZE(dm6467_evm_dai),
++      .drvdata = &dm6467_snd_soc_card_drvdata,
++};
++
++static struct snd_soc_card_drvdata_davinci da830_snd_soc_card_drvdata = {
++      .sysclk = 24576000,
+ };
+ static struct snd_soc_card da830_snd_soc_card = {
+@@ -279,6 +309,11 @@ static struct snd_soc_card da830_snd_soc
+       .owner = THIS_MODULE,
+       .dai_link = &da830_evm_dai,
+       .num_links = 1,
++      .drvdata = &da830_snd_soc_card_drvdata,
++};
++
++static struct snd_soc_card_drvdata_davinci da850_snd_soc_card_drvdata = {
++      .sysclk = 24576000,
+ };
+ static struct snd_soc_card da850_snd_soc_card = {
+@@ -286,8 +321,101 @@ static struct snd_soc_card da850_snd_soc
+       .owner = THIS_MODULE,
+       .dai_link = &da850_evm_dai,
+       .num_links = 1,
++      .drvdata = &da850_snd_soc_card_drvdata,
++};
++
++#if defined(CONFIG_OF)
++
++/*
++ * The struct is used as place holder. It will be completely
++ * filled with data from dt node.
++ */
++static struct snd_soc_dai_link evm_dai_tlv320aic3x = {
++      .name           = "TLV320AIC3X",
++      .stream_name    = "AIC3X",
++      .codec_dai_name = "tlv320aic3x-hifi",
++      .ops            = &evm_ops,
++      .init           = evm_aic3x_init,
++};
++
++static const struct of_device_id davinci_evm_dt_ids[] = {
++      {
++              .compatible = "ti,da830-evm-audio",
++              .data = (void *) &evm_dai_tlv320aic3x,
++      },
++      { /* sentinel */ }
++};
++MODULE_DEVICE_TABLE(of, davinci_evm_dt_ids);
++
++/* davinci evm audio machine driver */
++static struct snd_soc_card evm_soc_card = {
++      .owner = THIS_MODULE,
++      .num_links = 1,
+ };
++static int davinci_evm_probe(struct platform_device *pdev)
++{
++      struct device_node *np = pdev->dev.of_node;
++      const struct of_device_id *match =
++              of_match_device(of_match_ptr(davinci_evm_dt_ids), &pdev->dev);
++      struct snd_soc_dai_link *dai = (struct snd_soc_dai_link *) match->data;
++      struct snd_soc_card_drvdata_davinci *drvdata = NULL;
++      int ret = 0;
++
++      evm_soc_card.dai_link = dai;
++
++      dai->codec_of_node = of_parse_phandle(np, "ti,audio-codec", 0);
++      if (!dai->codec_of_node)
++              return -EINVAL;
++
++      dai->cpu_of_node = of_parse_phandle(np, "ti,mcasp-controller", 0);
++      if (!dai->cpu_of_node)
++              return -EINVAL;
++
++      dai->platform_of_node = dai->cpu_of_node;
++
++      evm_soc_card.dev = &pdev->dev;
++      ret = snd_soc_of_parse_card_name(&evm_soc_card, "ti,model");
++      if (ret)
++              return ret;
++
++      drvdata = devm_kzalloc(&pdev->dev, sizeof(*drvdata), GFP_KERNEL);
++      if (!drvdata)
++              return -ENOMEM;
++
++      ret = of_property_read_u32(np, "ti,codec-clock-rate", &drvdata->sysclk);
++      if (ret < 0)
++              return -EINVAL;
++
++      snd_soc_card_set_drvdata(&evm_soc_card, drvdata);
++      ret = snd_soc_register_card(&evm_soc_card);
++
++      if (ret)
++              dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret);
++
++      return ret;
++}
++
++static int davinci_evm_remove(struct platform_device *pdev)
++{
++      struct snd_soc_card *card = platform_get_drvdata(pdev);
++
++      snd_soc_unregister_card(card);
++
++      return 0;
++}
++
++static struct platform_driver davinci_evm_driver = {
++      .probe          = davinci_evm_probe,
++      .remove         = davinci_evm_remove,
++      .driver         = {
++              .name   = "davinci_evm",
++              .owner  = THIS_MODULE,
++              .of_match_table = of_match_ptr(davinci_evm_dt_ids),
++      },
++};
++#endif
++
+ static struct platform_device *evm_snd_device;
+ static int __init evm_init(void)
+@@ -296,6 +424,13 @@ static int __init evm_init(void)
+       int index;
+       int ret;
++      /*
++       * If dtb is there, the devices will be created dynamically.
++       * Only register platfrom driver structure.
++       */
++      if (of_have_populated_dt())
++              return platform_driver_register(&davinci_evm_driver);
++
+       if (machine_is_davinci_evm()) {
+               evm_snd_dev_data = &dm6446_snd_soc_card_evm;
+               index = 0;
+@@ -331,6 +466,11 @@ static int __init evm_init(void)
+ static void __exit evm_exit(void)
+ {
++      if (of_have_populated_dt()) {
++              platform_driver_unregister(&davinci_evm_driver);
++              return;
++      }
++
+       platform_device_unregister(evm_snd_device);
+ }
+--- a/sound/soc/davinci/davinci-mcasp.c
++++ b/sound/soc/davinci/davinci-mcasp.c
+@@ -1001,18 +1001,40 @@ static const struct snd_soc_component_dr
+       .name           = "davinci-mcasp",
+ };
++/* Some HW specific values and defaults. The rest is filled in from DT. */
++static struct snd_platform_data dm646x_mcasp_pdata = {
++      .tx_dma_offset = 0x400,
++      .rx_dma_offset = 0x400,
++      .asp_chan_q = EVENTQ_0,
++      .version = MCASP_VERSION_1,
++};
++
++static struct snd_platform_data da830_mcasp_pdata = {
++      .tx_dma_offset = 0x2000,
++      .rx_dma_offset = 0x2000,
++      .asp_chan_q = EVENTQ_0,
++      .version = MCASP_VERSION_2,
++};
++
++static struct snd_platform_data omap2_mcasp_pdata = {
++      .tx_dma_offset = 0,
++      .rx_dma_offset = 0,
++      .asp_chan_q = EVENTQ_0,
++      .version = MCASP_VERSION_3,
++};
++
+ static const struct of_device_id mcasp_dt_ids[] = {
+       {
+               .compatible = "ti,dm646x-mcasp-audio",
+-              .data = (void *)MCASP_VERSION_1,
++              .data = &dm646x_mcasp_pdata,
+       },
+       {
+               .compatible = "ti,da830-mcasp-audio",
+-              .data = (void *)MCASP_VERSION_2,
++              .data = &da830_mcasp_pdata,
+       },
+       {
+               .compatible = "ti,omap2-mcasp-audio",
+-              .data = (void *)MCASP_VERSION_3,
++              .data = &omap2_mcasp_pdata,
+       },
+       { /* sentinel */ }
+ };
+@@ -1025,9 +1047,9 @@ static struct snd_platform_data *davinci
+       struct snd_platform_data *pdata = NULL;
+       const struct of_device_id *match =
+                       of_match_device(mcasp_dt_ids, &pdev->dev);
++      struct of_phandle_args dma_spec;
+       const u32 *of_serial_dir32;
+-      u8 *of_serial_dir;
+       u32 val;
+       int i, ret = 0;
+@@ -1035,20 +1057,13 @@ static struct snd_platform_data *davinci
+               pdata = pdev->dev.platform_data;
+               return pdata;
+       } else if (match) {
+-              pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
+-              if (!pdata) {
+-                      ret = -ENOMEM;
+-                      goto nodata;
+-              }
++              pdata = (struct snd_platform_data *) match->data;
+       } else {
+               /* control shouldn't reach here. something is wrong */
+               ret = -EINVAL;
+               goto nodata;
+       }
+-      if (match->data)
+-              pdata->version = (u8)((int)match->data);
+-
+       ret = of_property_read_u32(np, "op-mode", &val);
+       if (ret >= 0)
+               pdata->op_mode = val;
+@@ -1065,35 +1080,46 @@ static struct snd_platform_data *davinci
+               pdata->tdm_slots = val;
+       }
+-      ret = of_property_read_u32(np, "num-serializer", &val);
+-      if (ret >= 0)
+-              pdata->num_serializer = val;
+-
+       of_serial_dir32 = of_get_property(np, "serial-dir", &val);
+       val /= sizeof(u32);
+-      if (val != pdata->num_serializer) {
+-              dev_err(&pdev->dev,
+-                              "num-serializer(%d) != serial-dir size(%d)\n",
+-                              pdata->num_serializer, val);
+-              ret = -EINVAL;
+-              goto nodata;
+-      }
+-
+       if (of_serial_dir32) {
+-              of_serial_dir = devm_kzalloc(&pdev->dev,
+-                                              (sizeof(*of_serial_dir) * val),
+-                                              GFP_KERNEL);
++              u8 *of_serial_dir = devm_kzalloc(&pdev->dev,
++                                               (sizeof(*of_serial_dir) * val),
++                                               GFP_KERNEL);
+               if (!of_serial_dir) {
+                       ret = -ENOMEM;
+                       goto nodata;
+               }
+-              for (i = 0; i < pdata->num_serializer; i++)
++              for (i = 0; i < val; i++)
+                       of_serial_dir[i] = be32_to_cpup(&of_serial_dir32[i]);
++              pdata->num_serializer = val;
+               pdata->serial_dir = of_serial_dir;
+       }
++      ret = of_property_match_string(np, "dma-names", "tx");
++      if (ret < 0)
++              goto nodata;
++
++      ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
++                                       &dma_spec);
++      if (ret < 0)
++              goto nodata;
++
++      pdata->tx_dma_channel = dma_spec.args[0];
++
++      ret = of_property_match_string(np, "dma-names", "rx");
++      if (ret < 0)
++              goto nodata;
++
++      ret = of_parse_phandle_with_args(np, "dmas", "#dma-cells", ret,
++                                       &dma_spec);
++      if (ret < 0)
++              goto nodata;
++
++      pdata->rx_dma_channel = dma_spec.args[0];
++
+       ret = of_property_read_u32(np, "tx-num-evt", &val);
+       if (ret >= 0)
+               pdata->txnumevt = val;
+@@ -1124,7 +1150,7 @@ nodata:
+ static int davinci_mcasp_probe(struct platform_device *pdev)
+ {
+       struct davinci_pcm_dma_params *dma_data;
+-      struct resource *mem, *ioarea, *res;
++      struct resource *mem, *ioarea, *res, *dma;
+       struct snd_platform_data *pdata;
+       struct davinci_audio_dev *dev;
+       int ret;
+@@ -1145,10 +1171,15 @@ static int davinci_mcasp_probe(struct pl
+               return -EINVAL;
+       }
+-      mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++      mem = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mpu");
+       if (!mem) {
+-              dev_err(&pdev->dev, "no mem resource?\n");
+-              return -ENODEV;
++              dev_warn(dev->dev,
++                       "\"mpu\" mem resource not found, using index 0\n");
++              mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
++              if (!mem) {
++                      dev_err(&pdev->dev, "no mem resource?\n");
++                      return -ENODEV;
++              }
+       }
+       ioarea = devm_request_mem_region(&pdev->dev, mem->start,
+@@ -1182,40 +1213,36 @@ static int davinci_mcasp_probe(struct pl
+       dev->rxnumevt = pdata->rxnumevt;
+       dev->dev = &pdev->dev;
++      dma = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dma");
++      if (!dma)
++              dma = mem;
++
+       dma_data = &dev->dma_params[SNDRV_PCM_STREAM_PLAYBACK];
+       dma_data->asp_chan_q = pdata->asp_chan_q;
+       dma_data->ram_chan_q = pdata->ram_chan_q;
+       dma_data->sram_pool = pdata->sram_pool;
+       dma_data->sram_size = pdata->sram_size_playback;
+-      dma_data->dma_addr = (dma_addr_t) (pdata->tx_dma_offset +
+-                                                      mem->start);
++      dma_data->dma_addr = dma->start + pdata->tx_dma_offset;
+-      /* first TX, then RX */
+       res = platform_get_resource(pdev, IORESOURCE_DMA, 0);
+-      if (!res) {
+-              dev_err(&pdev->dev, "no DMA resource\n");
+-              ret = -ENODEV;
+-              goto err_release_clk;
+-      }
+-
+-      dma_data->channel = res->start;
++      if (res)
++              dma_data->channel = res->start;
++      else
++              dma_data->channel = pdata->tx_dma_channel;
+       dma_data = &dev->dma_params[SNDRV_PCM_STREAM_CAPTURE];
+       dma_data->asp_chan_q = pdata->asp_chan_q;
+       dma_data->ram_chan_q = pdata->ram_chan_q;
+       dma_data->sram_pool = pdata->sram_pool;
+       dma_data->sram_size = pdata->sram_size_capture;
+-      dma_data->dma_addr = (dma_addr_t)(pdata->rx_dma_offset +
+-                                                      mem->start);
++      dma_data->dma_addr = dma->start + pdata->rx_dma_offset;
+       res = platform_get_resource(pdev, IORESOURCE_DMA, 1);
+-      if (!res) {
+-              dev_err(&pdev->dev, "no DMA resource\n");
+-              ret = -ENODEV;
+-              goto err_release_clk;
+-      }
++      if (res)
++              dma_data->channel = res->start;
++      else
++              dma_data->channel = pdata->rx_dma_channel;
+-      dma_data->channel = res->start;
+       dev_set_drvdata(&pdev->dev, dev);
+       ret = snd_soc_register_component(&pdev->dev, &davinci_mcasp_component,
+                                        &davinci_mcasp_dai[pdata->op_mode], 1);
+@@ -1266,4 +1293,3 @@ module_platform_driver(davinci_mcasp_dri
+ MODULE_AUTHOR("Steve Chen");
+ MODULE_DESCRIPTION("TI DAVINCI McASP SoC Interface");
+ MODULE_LICENSE("GPL");
+-
+--- a/sound/soc/davinci/Kconfig
++++ b/sound/soc/davinci/Kconfig
+@@ -1,9 +1,10 @@
+ config SND_DAVINCI_SOC
+-      tristate "SoC Audio for the TI DAVINCI chip"
+-      depends on ARCH_DAVINCI
++      tristate "SoC Audio for the TI DAVINCI or AM33XX chip"
++      depends on ARCH_DAVINCI || SOC_AM33XX
+       help
++        Platform driver for daVinci or AM33xx
+         Say Y or M if you want to add support for codecs attached to
+-        the DAVINCI AC97 or I2S interface. You will also need
++        the DAVINCI AC97, I2S, or McASP interface. You will also need
+         to select the audio interfaces to support below.
+ config SND_DAVINCI_SOC_I2S
+@@ -15,6 +16,17 @@ config SND_DAVINCI_SOC_MCASP
+ config SND_DAVINCI_SOC_VCIF
+       tristate
++config SND_AM33XX_SOC_EVM
++      tristate "SoC Audio for the AM33XX chip based boards"
++      depends on SND_DAVINCI_SOC && SOC_AM33XX
++      select SND_SOC_TLV320AIC3X
++      select SND_DAVINCI_SOC_MCASP
++      help
++        Say Y or M if you want to add support for SoC audio on AM33XX
++        boards using McASP and TLV320AIC3X codec. For example AM335X-EVM,
++        AM335X-EVMSK, and BeagelBone with AudioCape boards have this
++        setup.
++
+ config SND_DAVINCI_SOC_EVM
+       tristate "SoC Audio support for DaVinci DM6446, DM355 or DM365 EVM"
+       depends on SND_DAVINCI_SOC
+--- a/sound/soc/davinci/Makefile
++++ b/sound/soc/davinci/Makefile
+@@ -13,6 +13,7 @@ obj-$(CONFIG_SND_DAVINCI_SOC_VCIF) += sn
+ snd-soc-evm-objs := davinci-evm.o
+ obj-$(CONFIG_SND_DAVINCI_SOC_EVM) += snd-soc-evm.o
++obj-$(CONFIG_SND_AM33XX_SOC_EVM) += snd-soc-evm.o
+ obj-$(CONFIG_SND_DM6467_SOC_EVM) += snd-soc-evm.o
+ obj-$(CONFIG_SND_DA830_SOC_EVM) += snd-soc-evm.o
+ obj-$(CONFIG_SND_DA850_SOC_EVM) += snd-soc-evm.o
+--- a/sound/soc/omap/Kconfig
++++ b/sound/soc/omap/Kconfig
+@@ -87,17 +87,19 @@ config SND_OMAP_SOC_OMAP_TWL4030
+ config SND_OMAP_SOC_OMAP_ABE_TWL6040
+       tristate "SoC Audio support for OMAP boards using ABE and twl6040 codec"
+-      depends on TWL6040_CORE && SND_OMAP_SOC && (ARCH_OMAP4 || COMPILE_TEST)
++      depends on TWL6040_CORE && SND_OMAP_SOC && (ARCH_OMAP4 || SOC_OMAP5 || COMPILE_TEST)
+       select SND_OMAP_SOC_DMIC
+       select SND_OMAP_SOC_MCPDM
+       select SND_SOC_TWL6040
+       select SND_SOC_DMIC
++      select COMMON_CLK_PALMAS if SOC_OMAP5
+       help
+         Say Y if you want to add support for SoC audio on OMAP boards using
+         ABE and twl6040 codec. This driver currently supports:
+         - SDP4430/Blaze boards
+         - PandaBoard (4430)
+         - PandaBoardES (4460)
++        - omap5-uevm (5432)
+ config SND_OMAP_SOC_OMAP_HDMI
+       tristate "SoC Audio support for Texas Instruments OMAP HDMI"