diff options
Diffstat (limited to 'recipes/linux/linux-2.6.24/hipox/hipox.patch')
| -rw-r--r-- | recipes/linux/linux-2.6.24/hipox/hipox.patch | 57804 |
1 files changed, 57804 insertions, 0 deletions
diff --git a/recipes/linux/linux-2.6.24/hipox/hipox.patch b/recipes/linux/linux-2.6.24/hipox/hipox.patch new file mode 100644 index 0000000000..686876fb1e --- /dev/null +++ b/recipes/linux/linux-2.6.24/hipox/hipox.patch @@ -0,0 +1,57804 @@ +diff -Nurd linux-2.6.24/.gitignore linux-2.6.24-oxe810/.gitignore +--- linux-2.6.24/.gitignore 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/.gitignore 1970-01-01 01:00:00.000000000 +0100 +@@ -1,54 +0,0 @@ +-# +-# NOTE! Don't add files that are generated in specific +-# subdirectories here. Add them in the ".gitignore" file +-# in that subdirectory instead. +-# +-# Normal rules +-# +-.* +-*.o +-*.o.* +-*.a +-*.s +-*.ko +-*.so +-*.so.dbg +-*.mod.c +-*.i +-*.lst +-*.symtypes +- +-# +-# Top-level generic files +-# +-tags +-TAGS +-vmlinux* +-!vmlinux.lds.S +-System.map +-Module.symvers +-!.gitignore +- +-# +-# Generated include files +-# +-include/asm +-include/asm-*/asm-offsets.h +-include/config +-include/linux/autoconf.h +-include/linux/compile.h +-include/linux/version.h +-include/linux/utsrelease.h +- +-# stgit generated dirs +-patches-* +- +-# quilt's files +-patches +-series +- +-# cscope files +-cscope.* +- +-*.orig +-*.rej +diff -Nurd linux-2.6.24/.mailmap linux-2.6.24-oxe810/.mailmap +--- linux-2.6.24/.mailmap 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/.mailmap 1970-01-01 01:00:00.000000000 +0100 +@@ -1,98 +0,0 @@ +-# +-# This list is used by git-shortlog to fix a few botched name translations +-# in the git archive, either because the author's full name was messed up +-# and/or not always written the same way, making contributions from the +-# same person appearing not to be so or badly displayed. +-# +-# repo-abbrev: /pub/scm/linux/kernel/git/ +-# +- +-Aaron Durbin <adurbin@google.com> +-Adam Oldham <oldhamca@gmail.com> +-Adam Radford <aradford@gmail.com> +-Adrian Bunk <bunk@stusta.de> +-Alan Cox <alan@lxorguk.ukuu.org.uk> +-Alan Cox <root@hraefn.swansea.linux.org.uk> +-Aleksey Gorelov <aleksey_gorelov@phoenix.com> +-Al Viro <viro@ftp.linux.org.uk> +-Al Viro <viro@zenIV.linux.org.uk> +-Andreas Herrmann <aherrman@de.ibm.com> +-Andrew Morton <akpm@osdl.org> +-Andrew Vasquez <andrew.vasquez@qlogic.com> +-Andy Adamson <andros@citi.umich.edu> +-Arnaud Patard <arnaud.patard@rtp-net.org> +-Arnd Bergmann <arnd@arndb.de> +-Axel Dyks <xl@xlsigned.net> +-Ben Gardner <bgardner@wabtec.com> +-Ben M Cahill <ben.m.cahill@intel.com> +-Björn Steinbrink <B.Steinbrink@gmx.de> +-Brian Avery <b.avery@hp.com> +-Brian King <brking@us.ibm.com> +-Christoph Hellwig <hch@lst.de> +-Corey Minyard <minyard@acm.org> +-David Brownell <david-b@pacbell.net> +-David Woodhouse <dwmw2@shinybook.infradead.org> +-Domen Puncer <domen@coderock.org> +-Douglas Gilbert <dougg@torque.net> +-Ed L. Cashin <ecashin@coraid.com> +-Evgeniy Polyakov <johnpol@2ka.mipt.ru> +-Felipe W Damasio <felipewd@terra.com.br> +-Felix Kuhling <fxkuehl@gmx.de> +-Felix Moeller <felix@derklecks.de> +-Filipe Lautert <filipe@icewall.org> +-Franck Bui-Huu <vagabon.xyz@gmail.com> +-Frank Zago <fzago@systemfabricworks.com> +-Greg Kroah-Hartman <greg@echidna.(none)> +-Greg Kroah-Hartman <gregkh@suse.de> +-Greg Kroah-Hartman <greg@kroah.com> +-Henk Vergonet <Henk.Vergonet@gmail.com> +-Henrik Kretzschmar <henne@nachtwindheim.de> +-Herbert Xu <herbert@gondor.apana.org.au> +-Jacob Shin <Jacob.Shin@amd.com> +-James Bottomley <jejb@mulgrave.(none)> +-James Bottomley <jejb@titanic.il.steeleye.com> +-James E Wilson <wilson@specifix.com> +-James Ketrenos <jketreno@io.(none)> +-Jean Tourrilhes <jt@hpl.hp.com> +-Jeff Garzik <jgarzik@pretzel.yyz.us> +-Jens Axboe <axboe@suse.de> +-Jens Osterkamp <Jens.Osterkamp@de.ibm.com> +-John Stultz <johnstul@us.ibm.com> +-Juha Yrjola <at solidboot.com> +-Juha Yrjola <juha.yrjola@nokia.com> +-Juha Yrjola <juha.yrjola@solidboot.com> +-Kay Sievers <kay.sievers@vrfy.org> +-Kenneth W Chen <kenneth.w.chen@intel.com> +-Koushik <raghavendra.koushik@neterion.com> +-Leonid I Ananiev <leonid.i.ananiev@intel.com> +-Linas Vepstas <linas@austin.ibm.com> +-Matthieu CASTET <castet.matthieu@free.fr> +-Michael Buesch <mb@bu3sch.de> +-Michael Buesch <mbuesch@freenet.de> +-Michel Dänzer <michel@tungstengraphics.com> +-Mitesh shah <mshah@teja.com> +-Morten Welinder <terra@gnome.org> +-Morten Welinder <welinder@anemone.rentec.com> +-Morten Welinder <welinder@darter.rentec.com> +-Morten Welinder <welinder@troll.com> +-Nguyen Anh Quynh <aquynh@gmail.com> +-Paolo 'Blaisorblade' Giarrusso <blaisorblade@yahoo.it> +-Patrick Mochel <mochel@digitalimplant.org> +-Peter A Jonsson <pj@ludd.ltu.se> +-Praveen BP <praveenbp@ti.com> +-Rajesh Shah <rajesh.shah@intel.com> +-Ralf Baechle <ralf@linux-mips.org> +-Ralf Wildenhues <Ralf.Wildenhues@gmx.de> +-Rémi Denis-Courmont <rdenis@simphalempin.com> +-Rudolf Marek <R.Marek@sh.cvut.cz> +-Rui Saraiva <rmps@joel.ist.utl.pt> +-Sachin P Sant <ssant@in.ibm.com> +-Sam Ravnborg <sam@mars.ravnborg.org> +-Simon Kelley <simon@thekelleys.org.uk> +-Stéphane Witzmann <stephane.witzmann@ubpmes.univ-bpclermont.fr> +-Stephen Hemminger <shemminger@osdl.org> +-Tejun Heo <htejun@gmail.com> +-Thomas Graf <tgraf@suug.ch> +-Tony Luck <tony.luck@intel.com> +-Tsuneo Yoshioka <Tsuneo.Yoshioka@f-secure.com> +-Valdis Kletnieks <Valdis.Kletnieks@vt.edu> +diff -Nurd linux-2.6.24/Documentation/video4linux/CARDLIST.cx23885 linux-2.6.24-oxe810/Documentation/video4linux/CARDLIST.cx23885 +--- linux-2.6.24/Documentation/video4linux/CARDLIST.cx23885 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/Documentation/video4linux/CARDLIST.cx23885 2008-06-11 17:47:23.000000000 +0200 +@@ -1,5 +1,5 @@ + 0 -> UNKNOWN/GENERIC [0070:3400] + 1 -> Hauppauge WinTV-HVR1800lp [0070:7600] +- 2 -> Hauppauge WinTV-HVR1800 [0070:7800,0070:7801] ++ 2 -> Hauppauge WinTV-HVR1800 [0070:7800,0070:7801,0070:7809] + 3 -> Hauppauge WinTV-HVR1250 [0070:7911] + 4 -> DViCO FusionHDTV5 Express [18ac:d500] +diff -Nurd linux-2.6.24/Makefile linux-2.6.24-oxe810/Makefile +--- linux-2.6.24/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/Makefile 2008-06-11 17:50:34.000000000 +0200 +@@ -1,8 +1,8 @@ + VERSION = 2 + PATCHLEVEL = 6 + SUBLEVEL = 24 +-EXTRAVERSION = +-NAME = Arr Matey! A Hairy Bilge Rat! ++EXTRAVERSION = .4 ++NAME = Err Metey! A Heury Beelge-a Ret! + + # *DOCUMENTATION* + # To see a list of typical targets execute "make help" +@@ -190,8 +190,8 @@ + # Default value for CROSS_COMPILE is not to prefix executables + # Note: Some architectures assign CROSS_COMPILE in their arch/*/Makefile + +-ARCH ?= $(SUBARCH) +-CROSS_COMPILE ?= ++ARCH ?= arm ++CROSS_COMPILE ?= arm-linux-uclibcgnueabi- + + # Architecture as present in compile.h + UTS_MACHINE := $(ARCH) +diff -Nurd linux-2.6.24/arch/arm/Kconfig linux-2.6.24-oxe810/arch/arm/Kconfig +--- linux-2.6.24/arch/arm/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/Kconfig 2008-06-11 17:47:58.000000000 +0200 +@@ -409,6 +409,10 @@ + help + Support for TI's OMAP platform (OMAP1 and OMAP2). + ++config ARCH_HIPOX ++ bool "Oxford Semiconductor NAS SoC" ++ help ++ This enables support for Oxsemi NAS SoC + endchoice + + source "arch/arm/mach-clps711x/Kconfig" +@@ -461,6 +465,8 @@ + + source "arch/arm/mach-versatile/Kconfig" + ++source "arch/arm/mach-hipox/Kconfig" ++ + source "arch/arm/mach-aaec2000/Kconfig" + + source "arch/arm/mach-realview/Kconfig" +@@ -537,7 +543,7 @@ + bool + + config PCI +- bool "PCI support" if ARCH_INTEGRATOR_AP || ARCH_VERSATILE_PB || ARCH_IXP4XX || ARCH_KS8695 || MACH_ARMCORE ++ bool "PCI support" if ARCH_INTEGRATOR_AP || ARCH_VERSATILE_PB || ARCH_IXP4XX || ARCH_KS8695 || MACH_ARMCORE || ARCH_HIPOX + help + Find out whether you have a PCI motherboard. PCI is the name of a + bus system, i.e. the way the CPU talks to the other stuff inside +@@ -653,11 +659,13 @@ + to have accurate timekeeping with dynamic tick. + + config HZ +- int ++ int "Kernel timer tick rate" + default 128 if ARCH_L7200 + default 200 if ARCH_EBSA110 || ARCH_S3C2410 + default OMAP_32K_TIMER_HZ if ARCH_OMAP && OMAP_32K_TIMER + default 100 ++ help ++ Sets the number of timer tick interrupts per second + + config AEABI + bool "Use the ARM EABI to compile the kernel" +@@ -1010,7 +1018,7 @@ + if PCMCIA || ARCH_CLPS7500 || ARCH_IOP32X || ARCH_IOP33X || ARCH_IXP4XX \ + || ARCH_L7200 || ARCH_LH7A40X || ARCH_PXA || ARCH_RPC \ + || ARCH_S3C2410 || ARCH_SA1100 || ARCH_SHARK || FOOTBRIDGE \ +- || ARCH_IXP23XX ++ || ARCH_IXP23XX || ARCH_HIPOX + source "drivers/ide/Kconfig" + endif + +diff -Nurd linux-2.6.24/arch/arm/Makefile linux-2.6.24-oxe810/arch/arm/Makefile +--- linux-2.6.24/arch/arm/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/Makefile 2008-06-11 17:47:58.000000000 +0200 +@@ -127,6 +127,7 @@ + machine-$(CONFIG_ARCH_VERSATILE) := versatile + machine-$(CONFIG_ARCH_IMX) := imx + machine-$(CONFIG_ARCH_H720X) := h720x ++ machine-$(CONFIG_ARCH_HIPOX) := hipox + machine-$(CONFIG_ARCH_AAEC2000) := aaec2000 + machine-$(CONFIG_ARCH_REALVIEW) := realview + machine-$(CONFIG_ARCH_AT91) := at91 +diff -Nurd linux-2.6.24/arch/arm/configs/hipox_810_eabi_dse_defconfig linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_dse_defconfig +--- linux-2.6.24/arch/arm/configs/hipox_810_eabi_dse_defconfig 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_dse_defconfig 2008-06-11 17:47:52.000000000 +0200 +@@ -0,0 +1,1233 @@ ++# ++# Automatically generated make config: don't edit ++# Linux kernel version: 2.6.24.4 ++# Mon Jun 2 12:34:33 2008 ++# ++CONFIG_ARM=y ++CONFIG_SYS_SUPPORTS_APM_EMULATION=y ++# CONFIG_GENERIC_GPIO is not set ++# CONFIG_GENERIC_TIME is not set ++# CONFIG_GENERIC_CLOCKEVENTS is not set ++CONFIG_MMU=y ++# CONFIG_NO_IOPORT is not set ++CONFIG_GENERIC_HARDIRQS=y ++CONFIG_STACKTRACE_SUPPORT=y ++CONFIG_LOCKDEP_SUPPORT=y ++CONFIG_TRACE_IRQFLAGS_SUPPORT=y ++CONFIG_HARDIRQS_SW_RESEND=y ++CONFIG_GENERIC_IRQ_PROBE=y ++CONFIG_RWSEM_GENERIC_SPINLOCK=y ++# CONFIG_ARCH_HAS_ILOG2_U32 is not set ++# CONFIG_ARCH_HAS_ILOG2_U64 is not set ++CONFIG_GENERIC_HWEIGHT=y ++CONFIG_GENERIC_CALIBRATE_DELAY=y ++CONFIG_ZONE_DMA=y ++CONFIG_VECTORS_BASE=0xffff0000 ++CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config" ++ ++# ++# General setup ++# ++CONFIG_EXPERIMENTAL=y ++CONFIG_BROKEN_ON_SMP=y ++CONFIG_INIT_ENV_ARG_LIMIT=32 ++CONFIG_LOCALVERSION="" ++CONFIG_LOCALVERSION_AUTO=y ++CONFIG_SWAP=y ++CONFIG_SYSVIPC=y ++CONFIG_SYSVIPC_SYSCTL=y ++# CONFIG_POSIX_MQUEUE is not set ++# CONFIG_BSD_PROCESS_ACCT is not set ++# CONFIG_TASKSTATS is not set ++# CONFIG_USER_NS is not set ++# CONFIG_PID_NS is not set ++# CONFIG_AUDIT is not set ++# CONFIG_IKCONFIG is not set ++CONFIG_LOG_BUF_SHIFT=14 ++# CONFIG_CGROUPS is not set ++# CONFIG_FAIR_GROUP_SCHED is not set ++# CONFIG_FAIR_USER_SCHED is not set ++# CONFIG_FAIR_CGROUP_SCHED is not set ++CONFIG_SYSFS_DEPRECATED=y ++# CONFIG_RELAY is not set ++CONFIG_BLK_DEV_INITRD=y ++CONFIG_INITRAMFS_SOURCE="" ++# CONFIG_CC_OPTIMIZE_FOR_SIZE is not set ++CONFIG_SYSCTL=y ++# CONFIG_EMBEDDED is not set ++CONFIG_UID16=y ++CONFIG_SYSCTL_SYSCALL=y ++CONFIG_KALLSYMS=y ++# CONFIG_KALLSYMS_EXTRA_PASS is not set ++CONFIG_HOTPLUG=y ++CONFIG_PRINTK=y ++CONFIG_BUG=y ++CONFIG_ELF_CORE=y ++CONFIG_BASE_FULL=y ++CONFIG_FUTEX=y ++CONFIG_ANON_INODES=y ++CONFIG_EPOLL=y ++CONFIG_SIGNALFD=y ++CONFIG_EVENTFD=y ++CONFIG_SHMEM=y ++CONFIG_VM_EVENT_COUNTERS=y ++CONFIG_SLAB=y ++# CONFIG_SLUB is not set ++# CONFIG_SLOB is not set ++CONFIG_SLABINFO=y ++CONFIG_RT_MUTEXES=y ++# CONFIG_TINY_SHMEM is not set ++CONFIG_BASE_SMALL=0 ++CONFIG_MODULES=y ++CONFIG_MODULE_UNLOAD=y ++# CONFIG_MODULE_FORCE_UNLOAD is not set ++# CONFIG_MODVERSIONS is not set ++# CONFIG_MODULE_SRCVERSION_ALL is not set ++# CONFIG_KMOD is not set ++CONFIG_BLOCK=y ++# CONFIG_LBD is not set ++# CONFIG_BLK_DEV_IO_TRACE is not set ++# CONFIG_LSF is not set ++# CONFIG_BLK_DEV_BSG is not set ++ ++# ++# IO Schedulers ++# ++CONFIG_IOSCHED_NOOP=y ++CONFIG_IOSCHED_AS=y ++CONFIG_IOSCHED_DEADLINE=y ++CONFIG_IOSCHED_CFQ=y ++CONFIG_DEFAULT_AS=y ++# CONFIG_DEFAULT_DEADLINE is not set ++# CONFIG_DEFAULT_CFQ is not set ++# CONFIG_DEFAULT_NOOP is not set ++CONFIG_DEFAULT_IOSCHED="anticipatory" ++ ++# ++# System Type ++# ++# CONFIG_ARCH_AAEC2000 is not set ++# CONFIG_ARCH_INTEGRATOR is not set ++# CONFIG_ARCH_REALVIEW is not set ++# CONFIG_ARCH_VERSATILE is not set ++# CONFIG_ARCH_AT91 is not set ++# CONFIG_ARCH_CLPS7500 is not set ++# CONFIG_ARCH_CLPS711X is not set ++# CONFIG_ARCH_CO285 is not set ++# CONFIG_ARCH_EBSA110 is not set ++# CONFIG_ARCH_EP93XX is not set ++# CONFIG_ARCH_FOOTBRIDGE is not set ++# CONFIG_ARCH_NETX is not set ++# CONFIG_ARCH_H720X is not set ++# CONFIG_ARCH_IMX is not set ++# CONFIG_ARCH_IOP13XX is not set ++# CONFIG_ARCH_IOP32X is not set ++# CONFIG_ARCH_IOP33X is not set ++# CONFIG_ARCH_IXP23XX is not set ++# CONFIG_ARCH_IXP2000 is not set ++# CONFIG_ARCH_IXP4XX is not set ++# CONFIG_ARCH_L7200 is not set ++# CONFIG_ARCH_KS8695 is not set ++# CONFIG_ARCH_NS9XXX is not set ++# CONFIG_ARCH_MXC is not set ++# CONFIG_ARCH_PNX4008 is not set ++# CONFIG_ARCH_PXA is not set ++# CONFIG_ARCH_RPC is not set ++# CONFIG_ARCH_SA1100 is not set ++# CONFIG_ARCH_S3C2410 is not set ++# CONFIG_ARCH_SHARK is not set ++# CONFIG_ARCH_LH7A40X is not set ++# CONFIG_ARCH_DAVINCI is not set ++# CONFIG_ARCH_OMAP is not set ++CONFIG_ARCH_HIPOX=y ++ ++# ++# Boot options ++# ++ ++# ++# Power management ++# ++ ++# ++# Oxford Semiconductor NAS Options ++# ++# CONFIG_ARCH_HIPOX_FPGA is not set ++CONFIG_NOMINAL_PLL400_FREQ=733333333 ++CONFIG_NOMINAL_RPSCLK_FREQ=25000000 ++# CONFIG_HIPOX_VERSION_0X800 is not set ++CONFIG_HIPOX_VERSION_0X810=y ++# CONFIG_HIPOX_VERSION_0X850 is not set ++# CONFIG_ARCH_HIPOX_UART1 is not set ++CONFIG_ARCH_HIPOX_UART2=y ++# CONFIG_ARCH_HIPOX_UART2_MODEM is not set ++# CONFIG_ARCH_HIPOX_UART3 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_0 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_1 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_2 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_3 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_0 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_1 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_2 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_3 is not set ++# CONFIG_HIPOX_PCI_RESET is not set ++CONFIG_FORCE_MAX_ZONEORDER=10 ++CONFIG_SRAM_NUM_PAGES=32 ++CONFIG_SUPPORT_LEON=y ++CONFIG_LEON_PAGES=2 ++CONFIG_LEON_COPRO=y ++CONFIG_LEON_OFFLOAD_TX=y ++# CONFIG_LEON_RESERVE_DMA_CHANNEL is not set ++CONFIG_LEON_OFFLOAD_TSO=y ++# CONFIG_LEON_START_EARLY is not set ++CONFIG_LEON_POWER_BUTTON_MONITOR=m ++CONFIG_HIPOX_POWER_BUTTON_GPIO=4 ++CONFIG_USER_RECOVERY_BUTTON_MONITOR=y ++CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO=32 ++# CONFIG_HIPOX_DDR_MON is not set ++# CONFIG_HIPOX_AHB_MON is not set ++# CONFIG_HIPOX_CACHE_LOCKDOWN is not set ++# CONFIG_DO_MEM_TEST is not set ++# CONFIG_CRYPTO_OXAESLRW is not set ++CONFIG_DESCRIPTORS_PAGES=6 ++CONFIG_ARCH_HIPOX_NUM_GMAC_DESCRIPTORS=192 ++CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES=256 ++CONFIG_TACHO_THERM_AND_FAN=m ++# CONFIG_GPIO_TEST is not set ++CONFIG_HIPOX_RTC=m ++# CONFIG_I2S is not set ++# CONFIG_DPE_TEST is not set ++# CONFIG_HIPOX_INSTRUMENT_COPIES is not set ++# CONFIG_HIPOX_DMA_COPIES is not set ++# CONFIG_HIPOX_AHB_MONITOR_MODULE is not set ++# CONFIG_HIPOX_USB_TEST_MODES is not set ++# CONFIG_HIPOX_FRONT_LAMP_CONTROL is not set ++# CONFIG_LEDS_TRIGGER_SATA_DISK is not set ++# CONFIG_HIPOX_LED_TEST is not set ++CONFIG_HIPOX_I2C_SDA=6 ++CONFIG_HIPOX_I2C_SCL=7 ++# CONFIG_HIPOX_USB_PORTA_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTB_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTC_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE is not set ++# CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE is not set ++# CONFIG_WDC_FAN_HIPOX800 is not set ++# CONFIG_HIPOX_MAP_SRAM is not set ++# CONFIG_HIPOX_SUID_INHERIT is not set ++# CONFIG_HIPOX_USB_HUB_SUPPORT is not set ++ ++# ++# Processor Type ++# ++CONFIG_CPU_32=y ++CONFIG_CPU_ARM926T=y ++CONFIG_CPU_32v5=y ++CONFIG_CPU_ABRT_EV5TJ=y ++CONFIG_CPU_CACHE_VIVT=y ++CONFIG_CPU_COPY_V4WB=y ++CONFIG_CPU_TLB_V4WBI=y ++CONFIG_CPU_CP15=y ++CONFIG_CPU_CP15_MMU=y ++ ++# ++# Processor Features ++# ++CONFIG_ARM_THUMB=y ++# CONFIG_CPU_ICACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_WRITETHROUGH is not set ++# CONFIG_CPU_CACHE_ROUND_ROBIN is not set ++# CONFIG_OUTER_CACHE is not set ++ ++# ++# Bus support ++# ++CONFIG_ARM_AMBA=y ++CONFIG_PCI=y ++CONFIG_PCI_SYSCALL=y ++# CONFIG_ARCH_SUPPORTS_MSI is not set ++CONFIG_PCI_LEGACY=y ++# CONFIG_PCCARD is not set ++ ++# ++# Kernel Features ++# ++# CONFIG_TICK_ONESHOT is not set ++# CONFIG_PREEMPT is not set ++# CONFIG_NO_IDLE_HZ is not set ++CONFIG_HZ=100 ++CONFIG_AEABI=y ++# CONFIG_OABI_COMPAT is not set ++# CONFIG_ARCH_DISCONTIGMEM_ENABLE is not set ++CONFIG_SELECT_MEMORY_MODEL=y ++CONFIG_FLATMEM_MANUAL=y ++# CONFIG_DISCONTIGMEM_MANUAL is not set ++# CONFIG_SPARSEMEM_MANUAL is not set ++CONFIG_FLATMEM=y ++CONFIG_FLAT_NODE_MEM_MAP=y ++# CONFIG_SPARSEMEM_STATIC is not set ++# CONFIG_SPARSEMEM_VMEMMAP_ENABLE is not set ++CONFIG_SPLIT_PTLOCK_CPUS=4096 ++# CONFIG_RESOURCES_64BIT is not set ++CONFIG_ZONE_DMA_FLAG=1 ++CONFIG_BOUNCE=y ++CONFIG_VIRT_TO_BUS=y ++CONFIG_ALIGNMENT_TRAP=y ++ ++# ++# Boot options ++# ++CONFIG_ZBOOT_ROM_TEXT=0x0 ++CONFIG_ZBOOT_ROM_BSS=0x0 ++CONFIG_CMDLINE="" ++# CONFIG_XIP_KERNEL is not set ++# CONFIG_KEXEC is not set ++ ++# ++# Floating point emulation ++# ++ ++# ++# At least one emulation must be selected ++# ++# CONFIG_VFP is not set ++ ++# ++# Userspace binary formats ++# ++CONFIG_BINFMT_ELF=y ++# CONFIG_BINFMT_AOUT is not set ++# CONFIG_BINFMT_MISC is not set ++ ++# ++# Power management options ++# ++# CONFIG_PM is not set ++CONFIG_SUSPEND_UP_POSSIBLE=y ++ ++# ++# Networking ++# ++CONFIG_NET=y ++ ++# ++# Networking options ++# ++CONFIG_PACKET=y ++CONFIG_PACKET_MMAP=y ++CONFIG_UNIX=y ++CONFIG_XFRM=y ++# CONFIG_XFRM_USER is not set ++# CONFIG_XFRM_SUB_POLICY is not set ++# CONFIG_XFRM_MIGRATE is not set ++# CONFIG_NET_KEY is not set ++CONFIG_INET=y ++CONFIG_IP_MULTICAST=y ++# CONFIG_IP_ADVANCED_ROUTER is not set ++CONFIG_IP_FIB_HASH=y ++# CONFIG_IP_PNP is not set ++# CONFIG_NET_IPIP is not set ++# CONFIG_NET_IPGRE is not set ++# CONFIG_IP_MROUTE is not set ++# CONFIG_ARPD is not set ++# CONFIG_SYN_COOKIES is not set ++# CONFIG_INET_AH is not set ++# CONFIG_INET_ESP is not set ++# CONFIG_INET_IPCOMP is not set ++# CONFIG_INET_XFRM_TUNNEL is not set ++# CONFIG_INET_TUNNEL is not set ++CONFIG_INET_XFRM_MODE_TRANSPORT=y ++CONFIG_INET_XFRM_MODE_TUNNEL=y ++CONFIG_INET_XFRM_MODE_BEET=y ++# CONFIG_INET_LRO is not set ++CONFIG_INET_DIAG=y ++CONFIG_INET_TCP_DIAG=y ++# CONFIG_TCP_CONG_ADVANCED is not set ++CONFIG_TCP_CONG_CUBIC=y ++CONFIG_DEFAULT_TCP_CONG="cubic" ++# CONFIG_TCP_MD5SIG is not set ++# CONFIG_IP_VS is not set ++# CONFIG_IPV6 is not set ++# CONFIG_INET6_XFRM_TUNNEL is not set ++# CONFIG_INET6_TUNNEL is not set ++# CONFIG_NETLABEL is not set ++# CONFIG_NETWORK_SECMARK is not set ++CONFIG_NETFILTER=y ++# CONFIG_NETFILTER_DEBUG is not set ++ ++# ++# Core Netfilter Configuration ++# ++# CONFIG_NETFILTER_NETLINK is not set ++# CONFIG_NF_CONNTRACK_ENABLED is not set ++# CONFIG_NF_CONNTRACK is not set ++# CONFIG_NETFILTER_XTABLES is not set ++ ++# ++# IP: Netfilter Configuration ++# ++# CONFIG_IP_NF_QUEUE is not set ++# CONFIG_IP_NF_IPTABLES is not set ++# CONFIG_IP_NF_ARPTABLES is not set ++# CONFIG_IP_DCCP is not set ++# CONFIG_IP_SCTP is not set ++# CONFIG_TIPC is not set ++# CONFIG_ATM is not set ++# CONFIG_BRIDGE is not set ++# CONFIG_VLAN_8021Q is not set ++# CONFIG_DECNET is not set ++# CONFIG_LLC2 is not set ++# CONFIG_IPX is not set ++# CONFIG_ATALK is not set ++# CONFIG_X25 is not set ++# CONFIG_LAPB is not set ++# CONFIG_ECONET is not set ++# CONFIG_WAN_ROUTER is not set ++# CONFIG_NET_SCHED is not set ++ ++# ++# Network testing ++# ++# CONFIG_NET_PKTGEN is not set ++# CONFIG_HAMRADIO is not set ++# CONFIG_IRDA is not set ++# CONFIG_BT is not set ++# CONFIG_AF_RXRPC is not set ++ ++# ++# Wireless ++# ++# CONFIG_CFG80211 is not set ++CONFIG_WIRELESS_EXT=y ++# CONFIG_MAC80211 is not set ++# CONFIG_IEEE80211 is not set ++# CONFIG_RFKILL is not set ++# CONFIG_NET_9P is not set ++ ++# ++# Device Drivers ++# ++ ++# ++# Generic Driver Options ++# ++CONFIG_UEVENT_HELPER_PATH="/sbin/hotplug" ++CONFIG_STANDALONE=y ++CONFIG_PREVENT_FIRMWARE_BUILD=y ++CONFIG_FW_LOADER=y ++# CONFIG_SYS_HYPERVISOR is not set ++# CONFIG_CONNECTOR is not set ++# CONFIG_MTD is not set ++# CONFIG_PARPORT is not set ++CONFIG_BLK_DEV=y ++# CONFIG_BLK_CPQ_DA is not set ++# CONFIG_BLK_CPQ_CISS_DA is not set ++# CONFIG_BLK_DEV_DAC960 is not set ++# CONFIG_BLK_DEV_UMEM is not set ++# CONFIG_BLK_DEV_COW_COMMON is not set ++CONFIG_BLK_DEV_LOOP=y ++# CONFIG_BLK_DEV_CRYPTOLOOP is not set ++# CONFIG_BLK_DEV_NBD is not set ++# CONFIG_BLK_DEV_SX8 is not set ++# CONFIG_BLK_DEV_UB is not set ++CONFIG_BLK_DEV_RAM=y ++CONFIG_BLK_DEV_RAM_COUNT=16 ++CONFIG_BLK_DEV_RAM_SIZE=10240 ++CONFIG_BLK_DEV_RAM_BLOCKSIZE=1024 ++# CONFIG_CDROM_PKTCDVD is not set ++# CONFIG_ATA_OVER_ETH is not set ++# CONFIG_MISC_DEVICES is not set ++# CONFIG_IDE is not set ++ ++# ++# SCSI device support ++# ++# CONFIG_RAID_ATTRS is not set ++CONFIG_SCSI=y ++CONFIG_SCSI_DMA=y ++# CONFIG_SCSI_TGT is not set ++# CONFIG_SCSI_NETLINK is not set ++CONFIG_SCSI_PROC_FS=y ++ ++# ++# SCSI support type (disk, tape, CD-ROM) ++# ++CONFIG_BLK_DEV_SD=y ++# CONFIG_CHR_DEV_ST is not set ++# CONFIG_CHR_DEV_OSST is not set ++# CONFIG_BLK_DEV_SR is not set ++# CONFIG_CHR_DEV_SG is not set ++# CONFIG_CHR_DEV_SCH is not set ++ ++# ++# Some SCSI devices (e.g. CD jukebox) support multiple LUNs ++# ++CONFIG_SCSI_MULTI_LUN=y ++# CONFIG_SCSI_CONSTANTS is not set ++# CONFIG_SCSI_LOGGING is not set ++# CONFIG_SCSI_SCAN_ASYNC is not set ++CONFIG_SCSI_WAIT_SCAN=m ++ ++# ++# SCSI Transports ++# ++# CONFIG_SCSI_SPI_ATTRS is not set ++# CONFIG_SCSI_FC_ATTRS is not set ++# CONFIG_SCSI_ISCSI_ATTRS is not set ++# CONFIG_SCSI_SAS_LIBSAS is not set ++# CONFIG_SCSI_SRP_ATTRS is not set ++CONFIG_SCSI_LOWLEVEL=y ++# CONFIG_ISCSI_TCP is not set ++# CONFIG_BLK_DEV_3W_XXXX_RAID is not set ++# CONFIG_SCSI_3W_9XXX is not set ++# CONFIG_SCSI_ACARD is not set ++# CONFIG_SCSI_AACRAID is not set ++# CONFIG_SCSI_AIC7XXX is not set ++# CONFIG_SCSI_AIC7XXX_OLD is not set ++# CONFIG_SCSI_AIC79XX is not set ++# CONFIG_SCSI_AIC94XX is not set ++# CONFIG_SCSI_DPT_I2O is not set ++# CONFIG_SCSI_ADVANSYS is not set ++# CONFIG_SCSI_ARCMSR is not set ++# CONFIG_MEGARAID_NEWGEN is not set ++# CONFIG_MEGARAID_LEGACY is not set ++# CONFIG_MEGARAID_SAS is not set ++# CONFIG_SCSI_HPTIOP is not set ++# CONFIG_SCSI_DMX3191D is not set ++# CONFIG_SCSI_FUTURE_DOMAIN is not set ++# CONFIG_SCSI_IPS is not set ++# CONFIG_SCSI_INITIO is not set ++# CONFIG_SCSI_INIA100 is not set ++# CONFIG_SCSI_STEX is not set ++# CONFIG_SCSI_SYM53C8XX_2 is not set ++# CONFIG_SCSI_IPR is not set ++# CONFIG_SCSI_QLOGIC_1280 is not set ++# CONFIG_SCSI_QLA_FC is not set ++# CONFIG_SCSI_QLA_ISCSI is not set ++# CONFIG_SCSI_LPFC is not set ++# CONFIG_SCSI_DC395x is not set ++# CONFIG_SCSI_DC390T is not set ++# CONFIG_SCSI_NSP32 is not set ++# CONFIG_SCSI_DEBUG is not set ++# CONFIG_SCSI_SRP is not set ++CONFIG_ATA=y ++# CONFIG_ATA_NONSTANDARD is not set ++# CONFIG_SATA_AHCI is not set ++# CONFIG_SATA_SVW is not set ++# CONFIG_ATA_PIIX is not set ++# CONFIG_SATA_MV is not set ++# CONFIG_SATA_NV is not set ++# CONFIG_PDC_ADMA is not set ++# CONFIG_SATA_QSTOR is not set ++# CONFIG_SATA_PROMISE is not set ++# CONFIG_SATA_SX4 is not set ++# CONFIG_SATA_SIL is not set ++# CONFIG_SATA_SIL24 is not set ++# CONFIG_SATA_SIS is not set ++# CONFIG_SATA_ULI is not set ++# CONFIG_SATA_VIA is not set ++# CONFIG_SATA_VITESSE is not set ++# CONFIG_SATA_INIC162X is not set ++CONFIG_SATA_OX810=y ++# CONFIG_SATA_HIPOX_SINGLE_SATA is not set ++# CONFIG_SATA_HIPOX_DISK_LIGHT is not set ++# CONFIG_PATA_ALI is not set ++# CONFIG_PATA_AMD is not set ++# CONFIG_PATA_ARTOP is not set ++# CONFIG_PATA_ATIIXP is not set ++# CONFIG_PATA_CMD640_PCI is not set ++# CONFIG_PATA_CMD64X is not set ++# CONFIG_PATA_CS5520 is not set ++# CONFIG_PATA_CS5530 is not set ++# CONFIG_PATA_CYPRESS is not set ++# CONFIG_PATA_EFAR is not set ++# CONFIG_ATA_GENERIC is not set ++# CONFIG_PATA_HPT366 is not set ++# CONFIG_PATA_HPT37X is not set ++# CONFIG_PATA_HPT3X2N is not set ++# CONFIG_PATA_HPT3X3 is not set ++# CONFIG_PATA_IT821X is not set ++# CONFIG_PATA_IT8213 is not set ++# CONFIG_PATA_JMICRON is not set ++# CONFIG_PATA_TRIFLEX is not set ++# CONFIG_PATA_MARVELL is not set ++# CONFIG_PATA_MPIIX is not set ++# CONFIG_PATA_OLDPIIX is not set ++# CONFIG_PATA_NETCELL is not set ++# CONFIG_PATA_NS87410 is not set ++# CONFIG_PATA_NS87415 is not set ++# CONFIG_PATA_OPTI is not set ++# CONFIG_PATA_OPTIDMA is not set ++# CONFIG_PATA_PDC_OLD is not set ++# CONFIG_PATA_RADISYS is not set ++# CONFIG_PATA_RZ1000 is not set ++# CONFIG_PATA_SC1200 is not set ++# CONFIG_PATA_SERVERWORKS is not set ++# CONFIG_PATA_PDC2027X is not set ++# CONFIG_PATA_SIL680 is not set ++# CONFIG_PATA_SIS is not set ++# CONFIG_PATA_VIA is not set ++# CONFIG_PATA_WINBOND is not set ++CONFIG_MD=y ++CONFIG_BLK_DEV_MD=y ++CONFIG_MD_LINEAR=y ++# CONFIG_MD_RAID0 is not set ++CONFIG_MD_RAID1=y ++# CONFIG_MD_RAID10 is not set ++# CONFIG_MD_RAID456 is not set ++# CONFIG_MD_MULTIPATH is not set ++# CONFIG_MD_FAULTY is not set ++CONFIG_BLK_DEV_DM=y ++# CONFIG_DM_DEBUG is not set ++CONFIG_DM_CRYPT=y ++# CONFIG_DM_SNAPSHOT is not set ++# CONFIG_DM_MIRROR is not set ++# CONFIG_DM_ZERO is not set ++# CONFIG_DM_MULTIPATH is not set ++# CONFIG_DM_DELAY is not set ++# CONFIG_DM_UEVENT is not set ++# CONFIG_FUSION is not set ++ ++# ++# IEEE 1394 (FireWire) support ++# ++# CONFIG_FIREWIRE is not set ++# CONFIG_IEEE1394 is not set ++# CONFIG_I2O is not set ++CONFIG_NETDEVICES=y ++# CONFIG_NETDEVICES_MULTIQUEUE is not set ++# CONFIG_DUMMY is not set ++# CONFIG_BONDING is not set ++# CONFIG_MACVLAN is not set ++# CONFIG_EQUALIZER is not set ++# CONFIG_TUN is not set ++# CONFIG_VETH is not set ++# CONFIG_ARCNET is not set ++# CONFIG_NET_ETHERNET is not set ++CONFIG_MII=y ++CONFIG_NETDEV_1000=y ++# CONFIG_ACENIC is not set ++# CONFIG_DL2K is not set ++# CONFIG_E1000 is not set ++# CONFIG_E1000E is not set ++# CONFIG_IP1000 is not set ++# CONFIG_NS83820 is not set ++# CONFIG_HAMACHI is not set ++# CONFIG_YELLOWFIN is not set ++# CONFIG_R8169 is not set ++# CONFIG_SIS190 is not set ++# CONFIG_SKGE is not set ++# CONFIG_SKY2 is not set ++# CONFIG_SK98LIN is not set ++# CONFIG_VIA_VELOCITY is not set ++# CONFIG_TIGON3 is not set ++# CONFIG_BNX2 is not set ++# CONFIG_QLA3XXX is not set ++# CONFIG_ATL1 is not set ++CONFIG_SYNOPSYS_GMAC=y ++# CONFIG_NETDEV_10000 is not set ++# CONFIG_TR is not set ++ ++# ++# Wireless LAN ++# ++# CONFIG_WLAN_PRE80211 is not set ++# CONFIG_WLAN_80211 is not set ++ ++# ++# USB Network Adapters ++# ++# CONFIG_USB_CATC is not set ++# CONFIG_USB_KAWETH is not set ++# CONFIG_USB_PEGASUS is not set ++# CONFIG_USB_RTL8150 is not set ++# CONFIG_USB_USBNET is not set ++# CONFIG_WAN is not set ++# CONFIG_FDDI is not set ++# CONFIG_HIPPI is not set ++# CONFIG_PPP is not set ++# CONFIG_SLIP is not set ++# CONFIG_NET_FC is not set ++# CONFIG_SHAPER is not set ++# CONFIG_NETCONSOLE is not set ++# CONFIG_NETPOLL is not set ++# CONFIG_NET_POLL_CONTROLLER is not set ++# CONFIG_ISDN is not set ++ ++# ++# Input device support ++# ++CONFIG_INPUT=y ++# CONFIG_INPUT_FF_MEMLESS is not set ++# CONFIG_INPUT_POLLDEV is not set ++ ++# ++# Userland interfaces ++# ++CONFIG_INPUT_MOUSEDEV=y ++# CONFIG_INPUT_MOUSEDEV_PSAUX is not set ++CONFIG_INPUT_MOUSEDEV_SCREEN_X=1024 ++CONFIG_INPUT_MOUSEDEV_SCREEN_Y=768 ++# CONFIG_INPUT_JOYDEV is not set ++# CONFIG_INPUT_EVDEV is not set ++# CONFIG_INPUT_EVBUG is not set ++ ++# ++# Input Device Drivers ++# ++# CONFIG_INPUT_KEYBOARD is not set ++# CONFIG_INPUT_MOUSE is not set ++# CONFIG_INPUT_JOYSTICK is not set ++# CONFIG_INPUT_TABLET is not set ++# CONFIG_INPUT_TOUCHSCREEN is not set ++# CONFIG_INPUT_MISC is not set ++ ++# ++# Hardware I/O ports ++# ++# CONFIG_SERIO is not set ++# CONFIG_GAMEPORT is not set ++ ++# ++# Character devices ++# ++CONFIG_VT=y ++CONFIG_VT_CONSOLE=y ++CONFIG_HW_CONSOLE=y ++# CONFIG_VT_HW_CONSOLE_BINDING is not set ++# CONFIG_SERIAL_NONSTANDARD is not set ++ ++# ++# Serial drivers ++# ++CONFIG_SERIAL_8250=y ++CONFIG_SERIAL_8250_CONSOLE=y ++CONFIG_SERIAL_8250_PCI=y ++CONFIG_SERIAL_8250_NR_UARTS=4 ++CONFIG_SERIAL_8250_RUNTIME_UARTS=4 ++# CONFIG_SERIAL_8250_EXTENDED is not set ++ ++# ++# Non-8250 serial port support ++# ++# CONFIG_SERIAL_AMBA_PL010 is not set ++# CONFIG_SERIAL_AMBA_PL011 is not set ++CONFIG_SERIAL_CORE=y ++CONFIG_SERIAL_CORE_CONSOLE=y ++# CONFIG_SERIAL_JSM is not set ++CONFIG_UNIX98_PTYS=y ++# CONFIG_LEGACY_PTYS is not set ++# CONFIG_IPMI_HANDLER is not set ++CONFIG_HW_RANDOM=m ++# CONFIG_NVRAM is not set ++# CONFIG_R3964 is not set ++# CONFIG_APPLICOM is not set ++# CONFIG_RAW_DRIVER is not set ++# CONFIG_TCG_TPM is not set ++CONFIG_DEVPORT=y ++CONFIG_I2C=m ++CONFIG_I2C_BOARDINFO=y ++# CONFIG_I2C_CHARDEV is not set ++ ++# ++# I2C Algorithms ++# ++CONFIG_I2C_ALGOBIT=m ++# CONFIG_I2C_ALGOPCF is not set ++# CONFIG_I2C_ALGOPCA is not set ++# CONFIG_I2C_ALGOOXSEMI is not set ++ ++# ++# I2C Hardware Bus support ++# ++# CONFIG_I2C_ALI1535 is not set ++# CONFIG_I2C_ALI1563 is not set ++# CONFIG_I2C_ALI15X3 is not set ++# CONFIG_I2C_AMD756 is not set ++# CONFIG_I2C_AMD8111 is not set ++# CONFIG_I2C_I801 is not set ++# CONFIG_I2C_I810 is not set ++# CONFIG_I2C_PIIX4 is not set ++# CONFIG_I2C_NFORCE2 is not set ++CONFIG_I2C_HIPOX_BITBASH=m ++# CONFIG_I2C_OCORES is not set ++# CONFIG_I2C_PARPORT_LIGHT is not set ++# CONFIG_I2C_PROSAVAGE is not set ++# CONFIG_I2C_SAVAGE4 is not set ++# CONFIG_I2C_SIMTEC is not set ++# CONFIG_I2C_SIS5595 is not set ++# CONFIG_I2C_SIS630 is not set ++# CONFIG_I2C_SIS96X is not set ++# CONFIG_I2C_TAOS_EVM is not set ++# CONFIG_I2C_STUB is not set ++# CONFIG_I2C_TINY_USB is not set ++# CONFIG_I2C_VIA is not set ++# CONFIG_I2C_VIAPRO is not set ++# CONFIG_I2C_VOODOO3 is not set ++ ++# ++# Miscellaneous I2C Chip support ++# ++# CONFIG_SENSORS_DS1337 is not set ++# CONFIG_SENSORS_DS1374 is not set ++# CONFIG_DS1682 is not set ++# CONFIG_SENSORS_EEPROM is not set ++# CONFIG_SENSORS_PCF8574 is not set ++# CONFIG_SENSORS_PCA9539 is not set ++# CONFIG_SENSORS_PCF8591 is not set ++# CONFIG_SENSORS_MAX6875 is not set ++# CONFIG_SENSORS_TSL2550 is not set ++# CONFIG_I2C_DEBUG_CORE is not set ++# CONFIG_I2C_DEBUG_ALGO is not set ++# CONFIG_I2C_DEBUG_BUS is not set ++# CONFIG_I2C_DEBUG_CHIP is not set ++ ++# ++# SPI support ++# ++# CONFIG_SPI is not set ++# CONFIG_SPI_MASTER is not set ++# CONFIG_W1 is not set ++# CONFIG_POWER_SUPPLY is not set ++# CONFIG_HWMON is not set ++# CONFIG_WATCHDOG is not set ++ ++# ++# Sonics Silicon Backplane ++# ++CONFIG_SSB_POSSIBLE=y ++# CONFIG_SSB is not set ++ ++# ++# Multifunction device drivers ++# ++# CONFIG_MFD_SM501 is not set ++ ++# ++# Multimedia devices ++# ++# CONFIG_VIDEO_DEV is not set ++# CONFIG_DVB_CORE is not set ++CONFIG_DAB=y ++# CONFIG_USB_DABUSB is not set ++ ++# ++# Graphics support ++# ++# CONFIG_DRM is not set ++# CONFIG_VGASTATE is not set ++CONFIG_VIDEO_OUTPUT_CONTROL=m ++# CONFIG_FB is not set ++# CONFIG_BACKLIGHT_LCD_SUPPORT is not set ++ ++# ++# Display device support ++# ++# CONFIG_DISPLAY_SUPPORT is not set ++ ++# ++# Console display driver support ++# ++# CONFIG_VGA_CONSOLE is not set ++CONFIG_DUMMY_CONSOLE=y ++ ++# ++# Sound ++# ++# CONFIG_SOUND is not set ++# CONFIG_HID_SUPPORT is not set ++CONFIG_USB_SUPPORT=y ++CONFIG_USB_ARCH_HAS_HCD=y ++CONFIG_USB_ARCH_HAS_OHCI=y ++CONFIG_USB_ARCH_HAS_EHCI=y ++CONFIG_USB=m ++# CONFIG_USB_DEBUG is not set ++ ++# ++# Miscellaneous USB options ++# ++CONFIG_USB_DEVICEFS=y ++CONFIG_USB_DEVICE_CLASS=y ++# CONFIG_USB_DYNAMIC_MINORS is not set ++# CONFIG_USB_OTG is not set ++ ++# ++# USB Host Controller Drivers ++# ++CONFIG_USB_EHCI_HCD=m ++# CONFIG_USB_EHCI_SPLIT_ISO is not set ++CONFIG_USB_EHCI_ROOT_HUB_TT=y ++# CONFIG_USB_EHCI_TT_NEWSCHED is not set ++# CONFIG_USB_ISP116X_HCD is not set ++# CONFIG_USB_OHCI_HCD is not set ++# CONFIG_USB_UHCI_HCD is not set ++# CONFIG_USB_SL811_HCD is not set ++# CONFIG_USB_R8A66597_HCD is not set ++ ++# ++# USB Device Class drivers ++# ++# CONFIG_USB_ACM is not set ++# CONFIG_USB_PRINTER is not set ++ ++# ++# NOTE: USB_STORAGE enables SCSI, and 'SCSI disk support' ++# ++ ++# ++# may also be needed; see USB_STORAGE Help for more information ++# ++CONFIG_USB_STORAGE=m ++# CONFIG_USB_STORAGE_DEBUG is not set ++# CONFIG_USB_STORAGE_DATAFAB is not set ++# CONFIG_USB_STORAGE_FREECOM is not set ++# CONFIG_USB_STORAGE_ISD200 is not set ++# CONFIG_USB_STORAGE_DPCM is not set ++# CONFIG_USB_STORAGE_USBAT is not set ++# CONFIG_USB_STORAGE_SDDR09 is not set ++# CONFIG_USB_STORAGE_SDDR55 is not set ++# CONFIG_USB_STORAGE_JUMPSHOT is not set ++# CONFIG_USB_STORAGE_ALAUDA is not set ++# CONFIG_USB_STORAGE_KARMA is not set ++# CONFIG_USB_LIBUSUAL is not set ++ ++# ++# USB Imaging devices ++# ++# CONFIG_USB_MDC800 is not set ++# CONFIG_USB_MICROTEK is not set ++# CONFIG_USB_MON is not set ++ ++# ++# USB port drivers ++# ++ ++# ++# USB Serial Converter support ++# ++# CONFIG_USB_SERIAL is not set ++ ++# ++# USB Miscellaneous drivers ++# ++# CONFIG_USB_EMI62 is not set ++# CONFIG_USB_EMI26 is not set ++# CONFIG_USB_ADUTUX is not set ++# CONFIG_USB_AUERSWALD is not set ++# CONFIG_USB_RIO500 is not set ++# CONFIG_USB_LEGOTOWER is not set ++# CONFIG_USB_LCD is not set ++# CONFIG_USB_BERRY_CHARGE is not set ++# CONFIG_USB_LED is not set ++# CONFIG_USB_CYPRESS_CY7C63 is not set ++# CONFIG_USB_CYTHERM is not set ++# CONFIG_USB_PHIDGET is not set ++# CONFIG_USB_IDMOUSE is not set ++# CONFIG_USB_FTDI_ELAN is not set ++# CONFIG_USB_APPLEDISPLAY is not set ++# CONFIG_USB_SISUSBVGA is not set ++# CONFIG_USB_LD is not set ++# CONFIG_USB_TRANCEVIBRATOR is not set ++# CONFIG_USB_IOWARRIOR is not set ++CONFIG_USB_TEST=m ++ ++# ++# USB DSL modem support ++# ++ ++# ++# USB Gadget Support ++# ++# CONFIG_USB_GADGET is not set ++# CONFIG_MMC is not set ++# CONFIG_NEW_LEDS is not set ++CONFIG_RTC_LIB=y ++CONFIG_RTC_CLASS=m ++ ++# ++# RTC interfaces ++# ++CONFIG_RTC_INTF_SYSFS=y ++CONFIG_RTC_INTF_PROC=y ++CONFIG_RTC_INTF_DEV=y ++# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set ++# CONFIG_RTC_DRV_TEST is not set ++ ++# ++# I2C RTC drivers ++# ++CONFIG_RTC_DRV_DS1307=m ++# CONFIG_RTC_DRV_DS1374 is not set ++# CONFIG_RTC_DRV_DS1672 is not set ++# CONFIG_RTC_DRV_MAX6900 is not set ++# CONFIG_RTC_DRV_RS5C372 is not set ++# CONFIG_RTC_DRV_ISL1208 is not set ++# CONFIG_RTC_DRV_X1205 is not set ++# CONFIG_RTC_DRV_PCF8563 is not set ++# CONFIG_RTC_DRV_PCF8583 is not set ++# CONFIG_RTC_DRV_M41T80 is not set ++ ++# ++# SPI RTC drivers ++# ++ ++# ++# Platform RTC drivers ++# ++# CONFIG_RTC_DRV_CMOS is not set ++# CONFIG_RTC_DRV_DS1553 is not set ++# CONFIG_RTC_DRV_STK17TA8 is not set ++# CONFIG_RTC_DRV_DS1742 is not set ++# CONFIG_RTC_DRV_M48T86 is not set ++# CONFIG_RTC_DRV_M48T59 is not set ++# CONFIG_RTC_DRV_V3020 is not set ++ ++# ++# on-CPU RTC drivers ++# ++# CONFIG_RTC_DRV_PL031 is not set ++# CONFIG_DMADEVICES is not set ++ ++# ++# File systems ++# ++CONFIG_EXT2_FS=y ++# CONFIG_EXT2_FS_XATTR is not set ++# CONFIG_EXT2_FS_XIP is not set ++CONFIG_EXT3_FS=y ++# CONFIG_EXT3_FS_XATTR is not set ++# CONFIG_EXT4DEV_FS is not set ++CONFIG_JBD=y ++# CONFIG_REISERFS_FS is not set ++# CONFIG_JFS_FS is not set ++CONFIG_FS_POSIX_ACL=y ++CONFIG_XFS_FS=y ++# CONFIG_XFS_QUOTA is not set ++# CONFIG_XFS_SECURITY is not set ++# CONFIG_XFS_POSIX_ACL is not set ++# CONFIG_XFS_RT is not set ++# CONFIG_GFS2_FS is not set ++# CONFIG_OCFS2_FS is not set ++# CONFIG_MINIX_FS is not set ++# CONFIG_ROMFS_FS is not set ++CONFIG_INOTIFY=y ++CONFIG_INOTIFY_USER=y ++# CONFIG_QUOTA is not set ++CONFIG_DNOTIFY=y ++# CONFIG_AUTOFS_FS is not set ++# CONFIG_AUTOFS4_FS is not set ++CONFIG_FUSE_FS=y ++ ++# ++# CD-ROM/DVD Filesystems ++# ++# CONFIG_ISO9660_FS is not set ++# CONFIG_UDF_FS is not set ++ ++# ++# DOS/FAT/NT Filesystems ++# ++CONFIG_FAT_FS=y ++CONFIG_MSDOS_FS=y ++CONFIG_VFAT_FS=m ++CONFIG_FAT_DEFAULT_CODEPAGE=437 ++CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1" ++CONFIG_NTFS_FS=m ++# CONFIG_NTFS_DEBUG is not set ++# CONFIG_NTFS_RW is not set ++ ++# ++# Pseudo filesystems ++# ++CONFIG_PROC_FS=y ++CONFIG_PROC_SYSCTL=y ++CONFIG_SYSFS=y ++# CONFIG_TMPFS is not set ++# CONFIG_HUGETLB_PAGE is not set ++# CONFIG_CONFIGFS_FS is not set ++ ++# ++# Miscellaneous filesystems ++# ++# CONFIG_ADFS_FS is not set ++# CONFIG_AFFS_FS is not set ++# CONFIG_HFS_FS is not set ++CONFIG_HFSPLUS_FS=m ++# CONFIG_BEFS_FS is not set ++# CONFIG_BFS_FS is not set ++# CONFIG_EFS_FS is not set ++# CONFIG_CRAMFS is not set ++# CONFIG_VXFS_FS is not set ++# CONFIG_HPFS_FS is not set ++# CONFIG_QNX4FS_FS is not set ++# CONFIG_SYSV_FS is not set ++# CONFIG_UFS_FS is not set ++CONFIG_NETWORK_FILESYSTEMS=y ++# CONFIG_NFS_FS is not set ++CONFIG_NFSD=m ++CONFIG_NFSD_V2_ACL=y ++CONFIG_NFSD_V3=y ++CONFIG_NFSD_V3_ACL=y ++# CONFIG_NFSD_V4 is not set ++CONFIG_NFSD_TCP=y ++CONFIG_LOCKD=m ++CONFIG_LOCKD_V4=y ++CONFIG_EXPORTFS=m ++CONFIG_NFS_ACL_SUPPORT=m ++CONFIG_NFS_COMMON=y ++CONFIG_SUNRPC=m ++# CONFIG_SUNRPC_BIND34 is not set ++# CONFIG_RPCSEC_GSS_KRB5 is not set ++# CONFIG_RPCSEC_GSS_SPKM3 is not set ++# CONFIG_SMB_FS is not set ++# CONFIG_CIFS is not set ++# CONFIG_NCP_FS is not set ++# CONFIG_CODA_FS is not set ++# CONFIG_AFS_FS is not set ++ ++# ++# Partition Types ++# ++CONFIG_PARTITION_ADVANCED=y ++# CONFIG_ACORN_PARTITION is not set ++# CONFIG_OSF_PARTITION is not set ++# CONFIG_AMIGA_PARTITION is not set ++# CONFIG_ATARI_PARTITION is not set ++CONFIG_MAC_PARTITION=y ++CONFIG_MSDOS_PARTITION=y ++# CONFIG_BSD_DISKLABEL is not set ++# CONFIG_MINIX_SUBPARTITION is not set ++# CONFIG_SOLARIS_X86_PARTITION is not set ++# CONFIG_UNIXWARE_DISKLABEL is not set ++CONFIG_LDM_PARTITION=y ++# CONFIG_LDM_DEBUG is not set ++# CONFIG_SGI_PARTITION is not set ++# CONFIG_ULTRIX_PARTITION is not set ++# CONFIG_SUN_PARTITION is not set ++# CONFIG_KARMA_PARTITION is not set ++CONFIG_EFI_PARTITION=y ++# CONFIG_SYSV68_PARTITION is not set ++CONFIG_NLS=y ++CONFIG_NLS_DEFAULT="iso8859-1" ++CONFIG_NLS_CODEPAGE_437=m ++# CONFIG_NLS_CODEPAGE_737 is not set ++# CONFIG_NLS_CODEPAGE_775 is not set ++# CONFIG_NLS_CODEPAGE_850 is not set ++# CONFIG_NLS_CODEPAGE_852 is not set ++# CONFIG_NLS_CODEPAGE_855 is not set ++# CONFIG_NLS_CODEPAGE_857 is not set ++# CONFIG_NLS_CODEPAGE_860 is not set ++# CONFIG_NLS_CODEPAGE_861 is not set ++# CONFIG_NLS_CODEPAGE_862 is not set ++# CONFIG_NLS_CODEPAGE_863 is not set ++# CONFIG_NLS_CODEPAGE_864 is not set ++# CONFIG_NLS_CODEPAGE_865 is not set ++# CONFIG_NLS_CODEPAGE_866 is not set ++# CONFIG_NLS_CODEPAGE_869 is not set ++# CONFIG_NLS_CODEPAGE_936 is not set ++# CONFIG_NLS_CODEPAGE_950 is not set ++# CONFIG_NLS_CODEPAGE_932 is not set ++# CONFIG_NLS_CODEPAGE_949 is not set ++# CONFIG_NLS_CODEPAGE_874 is not set ++# CONFIG_NLS_ISO8859_8 is not set ++# CONFIG_NLS_CODEPAGE_1250 is not set ++# CONFIG_NLS_CODEPAGE_1251 is not set ++# CONFIG_NLS_ASCII is not set ++CONFIG_NLS_ISO8859_1=m ++# CONFIG_NLS_ISO8859_2 is not set ++# CONFIG_NLS_ISO8859_3 is not set ++# CONFIG_NLS_ISO8859_4 is not set ++# CONFIG_NLS_ISO8859_5 is not set ++# CONFIG_NLS_ISO8859_6 is not set ++# CONFIG_NLS_ISO8859_7 is not set ++# CONFIG_NLS_ISO8859_9 is not set ++# CONFIG_NLS_ISO8859_13 is not set ++# CONFIG_NLS_ISO8859_14 is not set ++# CONFIG_NLS_ISO8859_15 is not set ++# CONFIG_NLS_KOI8_R is not set ++# CONFIG_NLS_KOI8_U is not set ++CONFIG_NLS_UTF8=y ++# CONFIG_DLM is not set ++# CONFIG_INSTRUMENTATION is not set ++ ++# ++# Kernel hacking ++# ++# CONFIG_PRINTK_TIME is not set ++CONFIG_ENABLE_WARN_DEPRECATED=y ++CONFIG_ENABLE_MUST_CHECK=y ++# CONFIG_MAGIC_SYSRQ is not set ++# CONFIG_UNUSED_SYMBOLS is not set ++# CONFIG_DEBUG_FS is not set ++# CONFIG_HEADERS_CHECK is not set ++# CONFIG_DEBUG_KERNEL is not set ++CONFIG_DEBUG_BUGVERBOSE=y ++CONFIG_FRAME_POINTER=y ++# CONFIG_SAMPLES is not set ++# CONFIG_DEBUG_USER is not set ++ ++# ++# Security options ++# ++# CONFIG_KEYS is not set ++CONFIG_SECURITY=y ++# CONFIG_SECURITY_NETWORK is not set ++# CONFIG_SECURITY_CAPABILITIES is not set ++CONFIG_SECURITY_TRUSTEES=y ++# CONFIG_SECURITY_TRUSTEES_DEBUG is not set ++CONFIG_CRYPTO=y ++CONFIG_CRYPTO_ALGAPI=y ++CONFIG_CRYPTO_BLKCIPHER=y ++CONFIG_CRYPTO_MANAGER=y ++# CONFIG_CRYPTO_HMAC is not set ++# CONFIG_CRYPTO_XCBC is not set ++# CONFIG_CRYPTO_NULL is not set ++# CONFIG_CRYPTO_MD4 is not set ++# CONFIG_CRYPTO_MD5 is not set ++# CONFIG_CRYPTO_SHA1 is not set ++# CONFIG_CRYPTO_SHA256 is not set ++# CONFIG_CRYPTO_SHA512 is not set ++# CONFIG_CRYPTO_WP512 is not set ++# CONFIG_CRYPTO_TGR192 is not set ++# CONFIG_CRYPTO_GF128MUL is not set ++CONFIG_CRYPTO_ECB=m ++CONFIG_CRYPTO_CBC=y ++CONFIG_CRYPTO_PCBC=m ++# CONFIG_CRYPTO_LRW is not set ++# CONFIG_CRYPTO_XTS is not set ++# CONFIG_CRYPTO_CRYPTD is not set ++# CONFIG_CRYPTO_DES is not set ++# CONFIG_CRYPTO_FCRYPT is not set ++# CONFIG_CRYPTO_BLOWFISH is not set ++# CONFIG_CRYPTO_TWOFISH is not set ++# CONFIG_CRYPTO_SERPENT is not set ++CONFIG_CRYPTO_AES=m ++# CONFIG_CRYPTO_CAST5 is not set ++# CONFIG_CRYPTO_CAST6 is not set ++# CONFIG_CRYPTO_TEA is not set ++CONFIG_CRYPTO_ARC4=m ++# CONFIG_CRYPTO_KHAZAD is not set ++# CONFIG_CRYPTO_ANUBIS is not set ++# CONFIG_CRYPTO_SEED is not set ++# CONFIG_CRYPTO_DEFLATE is not set ++CONFIG_CRYPTO_MICHAEL_MIC=m ++# CONFIG_CRYPTO_CRC32C is not set ++# CONFIG_CRYPTO_CAMELLIA is not set ++# CONFIG_CRYPTO_TEST is not set ++# CONFIG_CRYPTO_AUTHENC is not set ++CONFIG_CRYPTO_HW=y ++ ++# ++# Library routines ++# ++CONFIG_BITREVERSE=y ++CONFIG_CRC_CCITT=y ++# CONFIG_CRC16 is not set ++# CONFIG_CRC_ITU_T is not set ++CONFIG_CRC32=y ++# CONFIG_CRC7 is not set ++# CONFIG_LIBCRC32C is not set ++CONFIG_PLIST=y ++CONFIG_HAS_IOMEM=y ++CONFIG_HAS_IOPORT=y ++CONFIG_HAS_DMA=y +diff -Nurd linux-2.6.24/arch/arm/configs/hipox_810_eabi_upgrade_defconfig linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_upgrade_defconfig +--- linux-2.6.24/arch/arm/configs/hipox_810_eabi_upgrade_defconfig 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_upgrade_defconfig 2008-06-11 17:47:52.000000000 +0200 +@@ -0,0 +1,901 @@ ++# ++# Automatically generated make config: don't edit ++# Linux kernel version: 2.6.24.4 ++# Thu May 15 10:43:48 2008 ++# ++CONFIG_ARM=y ++CONFIG_SYS_SUPPORTS_APM_EMULATION=y ++# CONFIG_GENERIC_GPIO is not set ++# CONFIG_GENERIC_TIME is not set ++# CONFIG_GENERIC_CLOCKEVENTS is not set ++CONFIG_MMU=y ++# CONFIG_NO_IOPORT is not set ++CONFIG_GENERIC_HARDIRQS=y ++CONFIG_STACKTRACE_SUPPORT=y ++CONFIG_LOCKDEP_SUPPORT=y ++CONFIG_TRACE_IRQFLAGS_SUPPORT=y ++CONFIG_HARDIRQS_SW_RESEND=y ++CONFIG_GENERIC_IRQ_PROBE=y ++CONFIG_RWSEM_GENERIC_SPINLOCK=y ++# CONFIG_ARCH_HAS_ILOG2_U32 is not set ++# CONFIG_ARCH_HAS_ILOG2_U64 is not set ++CONFIG_GENERIC_HWEIGHT=y ++CONFIG_GENERIC_CALIBRATE_DELAY=y ++CONFIG_ZONE_DMA=y ++CONFIG_VECTORS_BASE=0xffff0000 ++CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config" ++ ++# ++# General setup ++# ++CONFIG_EXPERIMENTAL=y ++CONFIG_BROKEN_ON_SMP=y ++CONFIG_INIT_ENV_ARG_LIMIT=32 ++CONFIG_LOCALVERSION="" ++CONFIG_LOCALVERSION_AUTO=y ++CONFIG_SWAP=y ++CONFIG_SYSVIPC=y ++CONFIG_SYSVIPC_SYSCTL=y ++# CONFIG_BSD_PROCESS_ACCT is not set ++# CONFIG_USER_NS is not set ++# CONFIG_PID_NS is not set ++# CONFIG_IKCONFIG is not set ++CONFIG_LOG_BUF_SHIFT=14 ++# CONFIG_CGROUPS is not set ++CONFIG_FAIR_GROUP_SCHED=y ++CONFIG_FAIR_USER_SCHED=y ++# CONFIG_FAIR_CGROUP_SCHED is not set ++CONFIG_SYSFS_DEPRECATED=y ++# CONFIG_RELAY is not set ++CONFIG_BLK_DEV_INITRD=y ++CONFIG_INITRAMFS_SOURCE="" ++# CONFIG_CC_OPTIMIZE_FOR_SIZE is not set ++CONFIG_SYSCTL=y ++# CONFIG_EMBEDDED is not set ++CONFIG_UID16=y ++CONFIG_SYSCTL_SYSCALL=y ++CONFIG_KALLSYMS=y ++# CONFIG_KALLSYMS_EXTRA_PASS is not set ++CONFIG_HOTPLUG=y ++CONFIG_PRINTK=y ++CONFIG_BUG=y ++CONFIG_ELF_CORE=y ++CONFIG_BASE_FULL=y ++CONFIG_FUTEX=y ++CONFIG_ANON_INODES=y ++CONFIG_EPOLL=y ++CONFIG_SIGNALFD=y ++CONFIG_EVENTFD=y ++CONFIG_SHMEM=y ++CONFIG_VM_EVENT_COUNTERS=y ++CONFIG_SLAB=y ++# CONFIG_SLUB is not set ++# CONFIG_SLOB is not set ++CONFIG_SLABINFO=y ++CONFIG_RT_MUTEXES=y ++# CONFIG_TINY_SHMEM is not set ++CONFIG_BASE_SMALL=0 ++# CONFIG_MODULES is not set ++CONFIG_BLOCK=y ++# CONFIG_LBD is not set ++# CONFIG_BLK_DEV_IO_TRACE is not set ++# CONFIG_LSF is not set ++# CONFIG_BLK_DEV_BSG is not set ++ ++# ++# IO Schedulers ++# ++CONFIG_IOSCHED_NOOP=y ++CONFIG_IOSCHED_AS=y ++CONFIG_IOSCHED_DEADLINE=y ++CONFIG_IOSCHED_CFQ=y ++CONFIG_DEFAULT_AS=y ++# CONFIG_DEFAULT_DEADLINE is not set ++# CONFIG_DEFAULT_CFQ is not set ++# CONFIG_DEFAULT_NOOP is not set ++CONFIG_DEFAULT_IOSCHED="anticipatory" ++ ++# ++# System Type ++# ++# CONFIG_ARCH_AAEC2000 is not set ++# CONFIG_ARCH_INTEGRATOR is not set ++# CONFIG_ARCH_REALVIEW is not set ++# CONFIG_ARCH_VERSATILE is not set ++# CONFIG_ARCH_AT91 is not set ++# CONFIG_ARCH_CLPS7500 is not set ++# CONFIG_ARCH_CLPS711X is not set ++# CONFIG_ARCH_CO285 is not set ++# CONFIG_ARCH_EBSA110 is not set ++# CONFIG_ARCH_EP93XX is not set ++# CONFIG_ARCH_FOOTBRIDGE is not set ++# CONFIG_ARCH_NETX is not set ++# CONFIG_ARCH_H720X is not set ++# CONFIG_ARCH_IMX is not set ++# CONFIG_ARCH_IOP13XX is not set ++# CONFIG_ARCH_IOP32X is not set ++# CONFIG_ARCH_IOP33X is not set ++# CONFIG_ARCH_IXP23XX is not set ++# CONFIG_ARCH_IXP2000 is not set ++# CONFIG_ARCH_IXP4XX is not set ++# CONFIG_ARCH_L7200 is not set ++# CONFIG_ARCH_KS8695 is not set ++# CONFIG_ARCH_NS9XXX is not set ++# CONFIG_ARCH_MXC is not set ++# CONFIG_ARCH_PNX4008 is not set ++# CONFIG_ARCH_PXA is not set ++# CONFIG_ARCH_RPC is not set ++# CONFIG_ARCH_SA1100 is not set ++# CONFIG_ARCH_S3C2410 is not set ++# CONFIG_ARCH_SHARK is not set ++# CONFIG_ARCH_LH7A40X is not set ++# CONFIG_ARCH_DAVINCI is not set ++# CONFIG_ARCH_OMAP is not set ++CONFIG_ARCH_HIPOX=y ++ ++# ++# Boot options ++# ++ ++# ++# Power management ++# ++ ++# ++# Oxford Semiconductor NAS Options ++# ++# CONFIG_ARCH_HIPOX_FPGA is not set ++CONFIG_NOMINAL_PLL400_FREQ=733333333 ++CONFIG_NOMINAL_RPSCLK_FREQ=25000000 ++# CONFIG_HIPOX_VERSION_0X800 is not set ++CONFIG_HIPOX_VERSION_0X810=y ++# CONFIG_HIPOX_VERSION_0X850 is not set ++# CONFIG_ARCH_HIPOX_UART1 is not set ++CONFIG_ARCH_HIPOX_UART2=y ++# CONFIG_ARCH_HIPOX_UART2_MODEM is not set ++# CONFIG_ARCH_HIPOX_UART3 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_0 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_1 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_2 is not set ++# CONFIG_ARCH_HIPOX_PCI_REQGNT_3 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_0 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_1 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_2 is not set ++# CONFIG_ARCH_HIPOX_PCI_CLKOUT_3 is not set ++# CONFIG_HIPOX_PCI_RESET is not set ++CONFIG_FORCE_MAX_ZONEORDER=10 ++CONFIG_SRAM_NUM_PAGES=32 ++CONFIG_SUPPORT_LEON=y ++CONFIG_LEON_PAGES=2 ++# CONFIG_LEON_COPRO is not set ++# CONFIG_LEON_START_EARLY is not set ++CONFIG_LEON_POWER_BUTTON_MONITOR=y ++CONFIG_HIPOX_POWER_BUTTON_GPIO=4 ++CONFIG_USER_RECOVERY_BUTTON_MONITOR=y ++CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO=32 ++# CONFIG_HIPOX_DDR_MON is not set ++# CONFIG_HIPOX_AHB_MON is not set ++# CONFIG_HIPOX_CACHE_LOCKDOWN is not set ++# CONFIG_DO_MEM_TEST is not set ++# CONFIG_CRYPTO_OXAESLRW is not set ++CONFIG_DESCRIPTORS_PAGES=6 ++CONFIG_ARCH_HIPOX_NUM_GMAC_DESCRIPTORS=192 ++CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES=256 ++# CONFIG_TACHO_THERM_AND_FAN is not set ++# CONFIG_GPIO_TEST is not set ++# CONFIG_HIPOX_RTC is not set ++# CONFIG_I2S is not set ++# CONFIG_DPE_TEST is not set ++# CONFIG_HIPOX_INSTRUMENT_COPIES is not set ++# CONFIG_HIPOX_DMA_COPIES is not set ++# CONFIG_HIPOX_AHB_MONITOR_MODULE is not set ++# CONFIG_HIPOX_USB_TEST_MODES is not set ++# CONFIG_LEDS_TRIGGER_SATA_DISK is not set ++# CONFIG_HIPOX_LED_TEST is not set ++CONFIG_HIPOX_I2C_SDA=6 ++CONFIG_HIPOX_I2C_SCL=7 ++# CONFIG_HIPOX_USB_PORTA_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTB_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTC_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE is not set ++# CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE is not set ++# CONFIG_WDC_FAN_HIPOX800 is not set ++# CONFIG_HIPOX_MAP_SRAM is not set ++# CONFIG_HIPOX_SUID_INHERIT is not set ++ ++# ++# Processor Type ++# ++CONFIG_CPU_32=y ++CONFIG_CPU_ARM926T=y ++CONFIG_CPU_32v5=y ++CONFIG_CPU_ABRT_EV5TJ=y ++CONFIG_CPU_CACHE_VIVT=y ++CONFIG_CPU_COPY_V4WB=y ++CONFIG_CPU_TLB_V4WBI=y ++CONFIG_CPU_CP15=y ++CONFIG_CPU_CP15_MMU=y ++ ++# ++# Processor Features ++# ++CONFIG_ARM_THUMB=y ++# CONFIG_CPU_ICACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_WRITETHROUGH is not set ++# CONFIG_CPU_CACHE_ROUND_ROBIN is not set ++# CONFIG_OUTER_CACHE is not set ++ ++# ++# Bus support ++# ++CONFIG_ARM_AMBA=y ++CONFIG_PCI=y ++CONFIG_PCI_SYSCALL=y ++# CONFIG_ARCH_SUPPORTS_MSI is not set ++CONFIG_PCI_LEGACY=y ++# CONFIG_PCCARD is not set ++ ++# ++# Kernel Features ++# ++# CONFIG_TICK_ONESHOT is not set ++# CONFIG_PREEMPT is not set ++# CONFIG_NO_IDLE_HZ is not set ++CONFIG_HZ=100 ++CONFIG_AEABI=y ++# CONFIG_OABI_COMPAT is not set ++# CONFIG_ARCH_DISCONTIGMEM_ENABLE is not set ++CONFIG_SELECT_MEMORY_MODEL=y ++CONFIG_FLATMEM_MANUAL=y ++# CONFIG_DISCONTIGMEM_MANUAL is not set ++# CONFIG_SPARSEMEM_MANUAL is not set ++CONFIG_FLATMEM=y ++CONFIG_FLAT_NODE_MEM_MAP=y ++# CONFIG_SPARSEMEM_STATIC is not set ++# CONFIG_SPARSEMEM_VMEMMAP_ENABLE is not set ++CONFIG_SPLIT_PTLOCK_CPUS=4096 ++# CONFIG_RESOURCES_64BIT is not set ++CONFIG_ZONE_DMA_FLAG=1 ++CONFIG_BOUNCE=y ++CONFIG_VIRT_TO_BUS=y ++CONFIG_ALIGNMENT_TRAP=y ++ ++# ++# Boot options ++# ++CONFIG_ZBOOT_ROM_TEXT=0x0 ++CONFIG_ZBOOT_ROM_BSS=0x0 ++CONFIG_CMDLINE="" ++# CONFIG_XIP_KERNEL is not set ++# CONFIG_KEXEC is not set ++ ++# ++# Floating point emulation ++# ++ ++# ++# At least one emulation must be selected ++# ++CONFIG_VFP=y ++ ++# ++# Userspace binary formats ++# ++CONFIG_BINFMT_ELF=y ++# CONFIG_BINFMT_AOUT is not set ++# CONFIG_BINFMT_MISC is not set ++ ++# ++# Power management options ++# ++# CONFIG_PM is not set ++CONFIG_SUSPEND_UP_POSSIBLE=y ++ ++# ++# Networking ++# ++# CONFIG_NET is not set ++ ++# ++# Device Drivers ++# ++ ++# ++# Generic Driver Options ++# ++CONFIG_UEVENT_HELPER_PATH="/sbin/hotplug" ++CONFIG_STANDALONE=y ++CONFIG_PREVENT_FIRMWARE_BUILD=y ++# CONFIG_FW_LOADER is not set ++# CONFIG_SYS_HYPERVISOR is not set ++# CONFIG_MTD is not set ++# CONFIG_PARPORT is not set ++CONFIG_BLK_DEV=y ++# CONFIG_BLK_CPQ_DA is not set ++# CONFIG_BLK_CPQ_CISS_DA is not set ++# CONFIG_BLK_DEV_DAC960 is not set ++# CONFIG_BLK_DEV_UMEM is not set ++# CONFIG_BLK_DEV_COW_COMMON is not set ++CONFIG_BLK_DEV_LOOP=y ++# CONFIG_BLK_DEV_CRYPTOLOOP is not set ++# CONFIG_BLK_DEV_SX8 is not set ++CONFIG_BLK_DEV_RAM=y ++CONFIG_BLK_DEV_RAM_COUNT=1 ++CONFIG_BLK_DEV_RAM_SIZE=10240 ++CONFIG_BLK_DEV_RAM_BLOCKSIZE=1024 ++# CONFIG_CDROM_PKTCDVD is not set ++# CONFIG_MISC_DEVICES is not set ++# CONFIG_IDE is not set ++ ++# ++# SCSI device support ++# ++# CONFIG_RAID_ATTRS is not set ++CONFIG_SCSI=y ++CONFIG_SCSI_DMA=y ++# CONFIG_SCSI_TGT is not set ++# CONFIG_SCSI_NETLINK is not set ++CONFIG_SCSI_PROC_FS=y ++ ++# ++# SCSI support type (disk, tape, CD-ROM) ++# ++CONFIG_BLK_DEV_SD=y ++# CONFIG_CHR_DEV_ST is not set ++# CONFIG_CHR_DEV_OSST is not set ++# CONFIG_BLK_DEV_SR is not set ++# CONFIG_CHR_DEV_SG is not set ++# CONFIG_CHR_DEV_SCH is not set ++ ++# ++# Some SCSI devices (e.g. CD jukebox) support multiple LUNs ++# ++CONFIG_SCSI_MULTI_LUN=y ++# CONFIG_SCSI_CONSTANTS is not set ++# CONFIG_SCSI_LOGGING is not set ++# CONFIG_SCSI_SCAN_ASYNC is not set ++ ++# ++# SCSI Transports ++# ++# CONFIG_SCSI_SPI_ATTRS is not set ++# CONFIG_SCSI_FC_ATTRS is not set ++# CONFIG_SCSI_SAS_LIBSAS is not set ++# CONFIG_SCSI_SRP_ATTRS is not set ++CONFIG_SCSI_LOWLEVEL=y ++# CONFIG_BLK_DEV_3W_XXXX_RAID is not set ++# CONFIG_SCSI_3W_9XXX is not set ++# CONFIG_SCSI_ACARD is not set ++# CONFIG_SCSI_AACRAID is not set ++# CONFIG_SCSI_AIC7XXX is not set ++# CONFIG_SCSI_AIC7XXX_OLD is not set ++# CONFIG_SCSI_AIC79XX is not set ++# CONFIG_SCSI_AIC94XX is not set ++# CONFIG_SCSI_DPT_I2O is not set ++# CONFIG_SCSI_ADVANSYS is not set ++# CONFIG_SCSI_ARCMSR is not set ++# CONFIG_MEGARAID_NEWGEN is not set ++# CONFIG_MEGARAID_LEGACY is not set ++# CONFIG_MEGARAID_SAS is not set ++# CONFIG_SCSI_HPTIOP is not set ++# CONFIG_SCSI_DMX3191D is not set ++# CONFIG_SCSI_FUTURE_DOMAIN is not set ++# CONFIG_SCSI_IPS is not set ++# CONFIG_SCSI_INITIO is not set ++# CONFIG_SCSI_INIA100 is not set ++# CONFIG_SCSI_STEX is not set ++# CONFIG_SCSI_SYM53C8XX_2 is not set ++# CONFIG_SCSI_IPR is not set ++# CONFIG_SCSI_QLOGIC_1280 is not set ++# CONFIG_SCSI_QLA_FC is not set ++# CONFIG_SCSI_LPFC is not set ++# CONFIG_SCSI_DC395x is not set ++# CONFIG_SCSI_DC390T is not set ++# CONFIG_SCSI_NSP32 is not set ++# CONFIG_SCSI_DEBUG is not set ++# CONFIG_SCSI_SRP is not set ++CONFIG_ATA=y ++# CONFIG_ATA_NONSTANDARD is not set ++# CONFIG_SATA_AHCI is not set ++# CONFIG_SATA_SVW is not set ++# CONFIG_ATA_PIIX is not set ++# CONFIG_SATA_MV is not set ++# CONFIG_SATA_NV is not set ++# CONFIG_PDC_ADMA is not set ++# CONFIG_SATA_QSTOR is not set ++# CONFIG_SATA_PROMISE is not set ++# CONFIG_SATA_SX4 is not set ++# CONFIG_SATA_SIL is not set ++# CONFIG_SATA_SIL24 is not set ++# CONFIG_SATA_SIS is not set ++# CONFIG_SATA_ULI is not set ++# CONFIG_SATA_VIA is not set ++# CONFIG_SATA_VITESSE is not set ++# CONFIG_SATA_INIC162X is not set ++CONFIG_SATA_OX810=y ++# CONFIG_SATA_HIPOX_SINGLE_SATA is not set ++# CONFIG_SATA_HIPOX_DISK_LIGHT is not set ++# CONFIG_PATA_ALI is not set ++# CONFIG_PATA_AMD is not set ++# CONFIG_PATA_ARTOP is not set ++# CONFIG_PATA_ATIIXP is not set ++# CONFIG_PATA_CMD640_PCI is not set ++# CONFIG_PATA_CMD64X is not set ++# CONFIG_PATA_CS5520 is not set ++# CONFIG_PATA_CS5530 is not set ++# CONFIG_PATA_CYPRESS is not set ++# CONFIG_PATA_EFAR is not set ++# CONFIG_ATA_GENERIC is not set ++# CONFIG_PATA_HPT366 is not set ++# CONFIG_PATA_HPT37X is not set ++# CONFIG_PATA_HPT3X2N is not set ++# CONFIG_PATA_HPT3X3 is not set ++# CONFIG_PATA_IT821X is not set ++# CONFIG_PATA_IT8213 is not set ++# CONFIG_PATA_JMICRON is not set ++# CONFIG_PATA_TRIFLEX is not set ++# CONFIG_PATA_MARVELL is not set ++# CONFIG_PATA_MPIIX is not set ++# CONFIG_PATA_OLDPIIX is not set ++# CONFIG_PATA_NETCELL is not set ++# CONFIG_PATA_NS87410 is not set ++# CONFIG_PATA_NS87415 is not set ++# CONFIG_PATA_OPTI is not set ++# CONFIG_PATA_OPTIDMA is not set ++# CONFIG_PATA_PDC_OLD is not set ++# CONFIG_PATA_RADISYS is not set ++# CONFIG_PATA_RZ1000 is not set ++# CONFIG_PATA_SC1200 is not set ++# CONFIG_PATA_SERVERWORKS is not set ++# CONFIG_PATA_PDC2027X is not set ++# CONFIG_PATA_SIL680 is not set ++# CONFIG_PATA_SIS is not set ++# CONFIG_PATA_VIA is not set ++# CONFIG_PATA_WINBOND is not set ++CONFIG_MD=y ++CONFIG_BLK_DEV_MD=y ++CONFIG_MD_LINEAR=y ++# CONFIG_MD_RAID0 is not set ++CONFIG_MD_RAID1=y ++# CONFIG_MD_RAID10 is not set ++# CONFIG_MD_RAID456 is not set ++# CONFIG_MD_MULTIPATH is not set ++# CONFIG_MD_FAULTY is not set ++CONFIG_BLK_DEV_DM=y ++# CONFIG_DM_DEBUG is not set ++# CONFIG_DM_CRYPT is not set ++# CONFIG_DM_SNAPSHOT is not set ++# CONFIG_DM_MIRROR is not set ++# CONFIG_DM_ZERO is not set ++# CONFIG_DM_MULTIPATH is not set ++# CONFIG_DM_DELAY is not set ++# CONFIG_DM_UEVENT is not set ++# CONFIG_FUSION is not set ++ ++# ++# IEEE 1394 (FireWire) support ++# ++# CONFIG_FIREWIRE is not set ++# CONFIG_IEEE1394 is not set ++# CONFIG_I2O is not set ++ ++# ++# Input device support ++# ++CONFIG_INPUT=y ++# CONFIG_INPUT_FF_MEMLESS is not set ++# CONFIG_INPUT_POLLDEV is not set ++ ++# ++# Userland interfaces ++# ++CONFIG_INPUT_MOUSEDEV=y ++# CONFIG_INPUT_MOUSEDEV_PSAUX is not set ++CONFIG_INPUT_MOUSEDEV_SCREEN_X=1024 ++CONFIG_INPUT_MOUSEDEV_SCREEN_Y=768 ++# CONFIG_INPUT_JOYDEV is not set ++# CONFIG_INPUT_EVDEV is not set ++# CONFIG_INPUT_EVBUG is not set ++ ++# ++# Input Device Drivers ++# ++# CONFIG_INPUT_KEYBOARD is not set ++# CONFIG_INPUT_MOUSE is not set ++# CONFIG_INPUT_JOYSTICK is not set ++# CONFIG_INPUT_TABLET is not set ++# CONFIG_INPUT_TOUCHSCREEN is not set ++# CONFIG_INPUT_MISC is not set ++ ++# ++# Hardware I/O ports ++# ++# CONFIG_SERIO is not set ++# CONFIG_GAMEPORT is not set ++ ++# ++# Character devices ++# ++CONFIG_VT=y ++CONFIG_VT_CONSOLE=y ++CONFIG_HW_CONSOLE=y ++# CONFIG_VT_HW_CONSOLE_BINDING is not set ++# CONFIG_SERIAL_NONSTANDARD is not set ++ ++# ++# Serial drivers ++# ++CONFIG_SERIAL_8250=y ++CONFIG_SERIAL_8250_CONSOLE=y ++CONFIG_SERIAL_8250_PCI=y ++CONFIG_SERIAL_8250_NR_UARTS=4 ++CONFIG_SERIAL_8250_RUNTIME_UARTS=4 ++# CONFIG_SERIAL_8250_EXTENDED is not set ++ ++# ++# Non-8250 serial port support ++# ++# CONFIG_SERIAL_AMBA_PL010 is not set ++# CONFIG_SERIAL_AMBA_PL011 is not set ++CONFIG_SERIAL_CORE=y ++CONFIG_SERIAL_CORE_CONSOLE=y ++# CONFIG_SERIAL_JSM is not set ++CONFIG_UNIX98_PTYS=y ++# CONFIG_LEGACY_PTYS is not set ++# CONFIG_IPMI_HANDLER is not set ++CONFIG_HW_RANDOM=y ++# CONFIG_NVRAM is not set ++# CONFIG_R3964 is not set ++# CONFIG_APPLICOM is not set ++# CONFIG_RAW_DRIVER is not set ++# CONFIG_TCG_TPM is not set ++CONFIG_DEVPORT=y ++CONFIG_I2C=y ++CONFIG_I2C_BOARDINFO=y ++# CONFIG_I2C_CHARDEV is not set ++ ++# ++# I2C Algorithms ++# ++CONFIG_I2C_ALGOBIT=y ++# CONFIG_I2C_ALGOPCF is not set ++# CONFIG_I2C_ALGOPCA is not set ++# CONFIG_I2C_ALGOOXSEMI is not set ++ ++# ++# I2C Hardware Bus support ++# ++# CONFIG_I2C_ALI1535 is not set ++# CONFIG_I2C_ALI1563 is not set ++# CONFIG_I2C_ALI15X3 is not set ++# CONFIG_I2C_AMD756 is not set ++# CONFIG_I2C_AMD8111 is not set ++# CONFIG_I2C_I801 is not set ++# CONFIG_I2C_I810 is not set ++# CONFIG_I2C_PIIX4 is not set ++# CONFIG_I2C_NFORCE2 is not set ++CONFIG_I2C_HIPOX_BITBASH=y ++# CONFIG_I2C_OCORES is not set ++# CONFIG_I2C_PARPORT_LIGHT is not set ++# CONFIG_I2C_PROSAVAGE is not set ++# CONFIG_I2C_SAVAGE4 is not set ++# CONFIG_I2C_SIMTEC is not set ++# CONFIG_I2C_SIS5595 is not set ++# CONFIG_I2C_SIS630 is not set ++# CONFIG_I2C_SIS96X is not set ++# CONFIG_I2C_TAOS_EVM is not set ++# CONFIG_I2C_VIA is not set ++# CONFIG_I2C_VIAPRO is not set ++# CONFIG_I2C_VOODOO3 is not set ++ ++# ++# Miscellaneous I2C Chip support ++# ++# CONFIG_SENSORS_DS1337 is not set ++# CONFIG_SENSORS_DS1374 is not set ++# CONFIG_DS1682 is not set ++# CONFIG_SENSORS_EEPROM is not set ++# CONFIG_SENSORS_PCF8574 is not set ++# CONFIG_SENSORS_PCA9539 is not set ++# CONFIG_SENSORS_PCF8591 is not set ++# CONFIG_SENSORS_MAX6875 is not set ++# CONFIG_SENSORS_TSL2550 is not set ++# CONFIG_I2C_DEBUG_CORE is not set ++# CONFIG_I2C_DEBUG_ALGO is not set ++# CONFIG_I2C_DEBUG_BUS is not set ++# CONFIG_I2C_DEBUG_CHIP is not set ++ ++# ++# SPI support ++# ++# CONFIG_SPI is not set ++# CONFIG_SPI_MASTER is not set ++# CONFIG_W1 is not set ++# CONFIG_POWER_SUPPLY is not set ++# CONFIG_HWMON is not set ++# CONFIG_WATCHDOG is not set ++ ++# ++# Sonics Silicon Backplane ++# ++CONFIG_SSB_POSSIBLE=y ++# CONFIG_SSB is not set ++ ++# ++# Multifunction device drivers ++# ++# CONFIG_MFD_SM501 is not set ++ ++# ++# Multimedia devices ++# ++# CONFIG_VIDEO_DEV is not set ++CONFIG_DAB=y ++ ++# ++# Graphics support ++# ++# CONFIG_DRM is not set ++# CONFIG_VGASTATE is not set ++CONFIG_VIDEO_OUTPUT_CONTROL=y ++# CONFIG_FB is not set ++# CONFIG_BACKLIGHT_LCD_SUPPORT is not set ++ ++# ++# Display device support ++# ++# CONFIG_DISPLAY_SUPPORT is not set ++ ++# ++# Console display driver support ++# ++# CONFIG_VGA_CONSOLE is not set ++CONFIG_DUMMY_CONSOLE=y ++ ++# ++# Sound ++# ++# CONFIG_SOUND is not set ++# CONFIG_HID_SUPPORT is not set ++# CONFIG_USB_SUPPORT is not set ++# CONFIG_MMC is not set ++# CONFIG_NEW_LEDS is not set ++CONFIG_RTC_LIB=y ++CONFIG_RTC_CLASS=y ++CONFIG_RTC_HCTOSYS=y ++CONFIG_RTC_HCTOSYS_DEVICE="rtc0" ++# CONFIG_RTC_DEBUG is not set ++ ++# ++# RTC interfaces ++# ++CONFIG_RTC_INTF_SYSFS=y ++CONFIG_RTC_INTF_PROC=y ++CONFIG_RTC_INTF_DEV=y ++# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set ++# CONFIG_RTC_DRV_TEST is not set ++ ++# ++# I2C RTC drivers ++# ++CONFIG_RTC_DRV_DS1307=y ++# CONFIG_RTC_DRV_DS1374 is not set ++# CONFIG_RTC_DRV_DS1672 is not set ++# CONFIG_RTC_DRV_MAX6900 is not set ++# CONFIG_RTC_DRV_RS5C372 is not set ++# CONFIG_RTC_DRV_ISL1208 is not set ++# CONFIG_RTC_DRV_X1205 is not set ++# CONFIG_RTC_DRV_PCF8563 is not set ++# CONFIG_RTC_DRV_PCF8583 is not set ++# CONFIG_RTC_DRV_M41T80 is not set ++ ++# ++# SPI RTC drivers ++# ++ ++# ++# Platform RTC drivers ++# ++# CONFIG_RTC_DRV_CMOS is not set ++# CONFIG_RTC_DRV_DS1553 is not set ++# CONFIG_RTC_DRV_STK17TA8 is not set ++# CONFIG_RTC_DRV_DS1742 is not set ++# CONFIG_RTC_DRV_M48T86 is not set ++# CONFIG_RTC_DRV_M48T59 is not set ++# CONFIG_RTC_DRV_V3020 is not set ++ ++# ++# on-CPU RTC drivers ++# ++# CONFIG_RTC_DRV_PL031 is not set ++# CONFIG_DMADEVICES is not set ++ ++# ++# File systems ++# ++CONFIG_EXT2_FS=y ++# CONFIG_EXT2_FS_XATTR is not set ++# CONFIG_EXT2_FS_XIP is not set ++CONFIG_EXT3_FS=y ++# CONFIG_EXT3_FS_XATTR is not set ++# CONFIG_EXT4DEV_FS is not set ++CONFIG_JBD=y ++# CONFIG_REISERFS_FS is not set ++# CONFIG_JFS_FS is not set ++# CONFIG_FS_POSIX_ACL is not set ++# CONFIG_XFS_FS is not set ++# CONFIG_GFS2_FS is not set ++# CONFIG_MINIX_FS is not set ++# CONFIG_ROMFS_FS is not set ++# CONFIG_INOTIFY is not set ++# CONFIG_QUOTA is not set ++# CONFIG_DNOTIFY is not set ++# CONFIG_AUTOFS_FS is not set ++# CONFIG_AUTOFS4_FS is not set ++# CONFIG_FUSE_FS is not set ++ ++# ++# CD-ROM/DVD Filesystems ++# ++# CONFIG_ISO9660_FS is not set ++# CONFIG_UDF_FS is not set ++ ++# ++# DOS/FAT/NT Filesystems ++# ++# CONFIG_MSDOS_FS is not set ++# CONFIG_VFAT_FS is not set ++# CONFIG_NTFS_FS is not set ++ ++# ++# Pseudo filesystems ++# ++CONFIG_PROC_FS=y ++CONFIG_PROC_SYSCTL=y ++CONFIG_SYSFS=y ++# CONFIG_TMPFS is not set ++# CONFIG_HUGETLB_PAGE is not set ++# CONFIG_CONFIGFS_FS is not set ++ ++# ++# Miscellaneous filesystems ++# ++# CONFIG_ADFS_FS is not set ++# CONFIG_AFFS_FS is not set ++# CONFIG_HFS_FS is not set ++# CONFIG_HFSPLUS_FS is not set ++# CONFIG_BEFS_FS is not set ++# CONFIG_BFS_FS is not set ++# CONFIG_EFS_FS is not set ++# CONFIG_CRAMFS is not set ++# CONFIG_VXFS_FS is not set ++# CONFIG_HPFS_FS is not set ++# CONFIG_QNX4FS_FS is not set ++# CONFIG_SYSV_FS is not set ++# CONFIG_UFS_FS is not set ++ ++# ++# Partition Types ++# ++# CONFIG_PARTITION_ADVANCED is not set ++CONFIG_MSDOS_PARTITION=y ++CONFIG_NLS=y ++CONFIG_NLS_DEFAULT="iso8859-1" ++CONFIG_NLS_CODEPAGE_437=y ++# CONFIG_NLS_CODEPAGE_737 is not set ++# CONFIG_NLS_CODEPAGE_775 is not set ++# CONFIG_NLS_CODEPAGE_850 is not set ++# CONFIG_NLS_CODEPAGE_852 is not set ++# CONFIG_NLS_CODEPAGE_855 is not set ++# CONFIG_NLS_CODEPAGE_857 is not set ++# CONFIG_NLS_CODEPAGE_860 is not set ++# CONFIG_NLS_CODEPAGE_861 is not set ++# CONFIG_NLS_CODEPAGE_862 is not set ++# CONFIG_NLS_CODEPAGE_863 is not set ++# CONFIG_NLS_CODEPAGE_864 is not set ++# CONFIG_NLS_CODEPAGE_865 is not set ++# CONFIG_NLS_CODEPAGE_866 is not set ++# CONFIG_NLS_CODEPAGE_869 is not set ++# CONFIG_NLS_CODEPAGE_936 is not set ++# CONFIG_NLS_CODEPAGE_950 is not set ++# CONFIG_NLS_CODEPAGE_932 is not set ++# CONFIG_NLS_CODEPAGE_949 is not set ++# CONFIG_NLS_CODEPAGE_874 is not set ++# CONFIG_NLS_ISO8859_8 is not set ++# CONFIG_NLS_CODEPAGE_1250 is not set ++# CONFIG_NLS_CODEPAGE_1251 is not set ++# CONFIG_NLS_ASCII is not set ++CONFIG_NLS_ISO8859_1=y ++# CONFIG_NLS_ISO8859_2 is not set ++# CONFIG_NLS_ISO8859_3 is not set ++# CONFIG_NLS_ISO8859_4 is not set ++# CONFIG_NLS_ISO8859_5 is not set ++# CONFIG_NLS_ISO8859_6 is not set ++# CONFIG_NLS_ISO8859_7 is not set ++# CONFIG_NLS_ISO8859_9 is not set ++# CONFIG_NLS_ISO8859_13 is not set ++# CONFIG_NLS_ISO8859_14 is not set ++# CONFIG_NLS_ISO8859_15 is not set ++# CONFIG_NLS_KOI8_R is not set ++# CONFIG_NLS_KOI8_U is not set ++CONFIG_NLS_UTF8=y ++# CONFIG_INSTRUMENTATION is not set ++ ++# ++# Kernel hacking ++# ++# CONFIG_PRINTK_TIME is not set ++# CONFIG_ENABLE_WARN_DEPRECATED is not set ++# CONFIG_ENABLE_MUST_CHECK is not set ++# CONFIG_MAGIC_SYSRQ is not set ++# CONFIG_UNUSED_SYMBOLS is not set ++# CONFIG_DEBUG_FS is not set ++# CONFIG_HEADERS_CHECK is not set ++# CONFIG_DEBUG_KERNEL is not set ++CONFIG_DEBUG_BUGVERBOSE=y ++CONFIG_FRAME_POINTER=y ++# CONFIG_SAMPLES is not set ++# CONFIG_DEBUG_USER is not set ++ ++# ++# Security options ++# ++# CONFIG_KEYS is not set ++# CONFIG_SECURITY is not set ++# CONFIG_SECURITY_FILE_CAPABILITIES is not set ++CONFIG_CRYPTO=y ++CONFIG_CRYPTO_ALGAPI=y ++CONFIG_CRYPTO_BLKCIPHER=y ++CONFIG_CRYPTO_MANAGER=y ++# CONFIG_CRYPTO_HMAC is not set ++# CONFIG_CRYPTO_XCBC is not set ++# CONFIG_CRYPTO_NULL is not set ++# CONFIG_CRYPTO_MD4 is not set ++# CONFIG_CRYPTO_MD5 is not set ++# CONFIG_CRYPTO_SHA1 is not set ++# CONFIG_CRYPTO_SHA256 is not set ++# CONFIG_CRYPTO_SHA512 is not set ++# CONFIG_CRYPTO_WP512 is not set ++# CONFIG_CRYPTO_TGR192 is not set ++# CONFIG_CRYPTO_GF128MUL is not set ++# CONFIG_CRYPTO_ECB is not set ++CONFIG_CRYPTO_CBC=y ++# CONFIG_CRYPTO_PCBC is not set ++# CONFIG_CRYPTO_LRW is not set ++# CONFIG_CRYPTO_XTS is not set ++# CONFIG_CRYPTO_CRYPTD is not set ++# CONFIG_CRYPTO_DES is not set ++# CONFIG_CRYPTO_FCRYPT is not set ++# CONFIG_CRYPTO_BLOWFISH is not set ++# CONFIG_CRYPTO_TWOFISH is not set ++# CONFIG_CRYPTO_SERPENT is not set ++# CONFIG_CRYPTO_AES is not set ++# CONFIG_CRYPTO_CAST5 is not set ++# CONFIG_CRYPTO_CAST6 is not set ++# CONFIG_CRYPTO_TEA is not set ++# CONFIG_CRYPTO_ARC4 is not set ++# CONFIG_CRYPTO_KHAZAD is not set ++# CONFIG_CRYPTO_ANUBIS is not set ++# CONFIG_CRYPTO_SEED is not set ++# CONFIG_CRYPTO_DEFLATE is not set ++# CONFIG_CRYPTO_MICHAEL_MIC is not set ++# CONFIG_CRYPTO_CRC32C is not set ++# CONFIG_CRYPTO_CAMELLIA is not set ++# CONFIG_CRYPTO_AUTHENC is not set ++# CONFIG_CRYPTO_HW is not set ++ ++# ++# Library routines ++# ++CONFIG_BITREVERSE=y ++CONFIG_CRC_CCITT=y ++# CONFIG_CRC16 is not set ++# CONFIG_CRC_ITU_T is not set ++CONFIG_CRC32=y ++# CONFIG_CRC7 is not set ++# CONFIG_LIBCRC32C is not set ++CONFIG_PLIST=y ++CONFIG_HAS_IOMEM=y ++CONFIG_HAS_IOPORT=y ++CONFIG_HAS_DMA=y +diff -Nurd linux-2.6.24/arch/arm/configs/hipox_810_eabi_wd_eval_defconfig linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_wd_eval_defconfig +--- linux-2.6.24/arch/arm/configs/hipox_810_eabi_wd_eval_defconfig 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_wd_eval_defconfig 2008-06-11 17:47:52.000000000 +0200 +@@ -0,0 +1,1096 @@ ++# ++# Automatically generated make config: don't edit ++# Linux kernel version: 2.6.24.4 ++# Mon Jun 2 12:33:10 2008 ++# ++CONFIG_ARM=y ++CONFIG_SYS_SUPPORTS_APM_EMULATION=y ++# CONFIG_GENERIC_GPIO is not set ++# CONFIG_GENERIC_TIME is not set ++# CONFIG_GENERIC_CLOCKEVENTS is not set ++CONFIG_MMU=y ++# CONFIG_NO_IOPORT is not set ++CONFIG_GENERIC_HARDIRQS=y ++CONFIG_STACKTRACE_SUPPORT=y ++CONFIG_LOCKDEP_SUPPORT=y ++CONFIG_TRACE_IRQFLAGS_SUPPORT=y ++CONFIG_HARDIRQS_SW_RESEND=y ++CONFIG_GENERIC_IRQ_PROBE=y ++CONFIG_RWSEM_GENERIC_SPINLOCK=y ++# CONFIG_ARCH_HAS_ILOG2_U32 is not set ++# CONFIG_ARCH_HAS_ILOG2_U64 is not set ++CONFIG_GENERIC_HWEIGHT=y ++CONFIG_GENERIC_CALIBRATE_DELAY=y ++CONFIG_ZONE_DMA=y ++CONFIG_VECTORS_BASE=0xffff0000 ++CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config" ++ ++# ++# General setup ++# ++CONFIG_EXPERIMENTAL=y ++CONFIG_BROKEN_ON_SMP=y ++CONFIG_INIT_ENV_ARG_LIMIT=32 ++CONFIG_LOCALVERSION="" ++CONFIG_LOCALVERSION_AUTO=y ++CONFIG_SWAP=y ++CONFIG_SYSVIPC=y ++CONFIG_SYSVIPC_SYSCTL=y ++# CONFIG_POSIX_MQUEUE is not set ++# CONFIG_BSD_PROCESS_ACCT is not set ++# CONFIG_TASKSTATS is not set ++# CONFIG_USER_NS is not set ++# CONFIG_PID_NS is not set ++# CONFIG_AUDIT is not set ++# CONFIG_IKCONFIG is not set ++CONFIG_LOG_BUF_SHIFT=14 ++# CONFIG_CGROUPS is not set ++# CONFIG_FAIR_GROUP_SCHED is not set ++# CONFIG_FAIR_USER_SCHED is not set ++# CONFIG_FAIR_CGROUP_SCHED is not set ++CONFIG_SYSFS_DEPRECATED=y ++# CONFIG_RELAY is not set ++CONFIG_BLK_DEV_INITRD=y ++CONFIG_INITRAMFS_SOURCE="" ++# CONFIG_CC_OPTIMIZE_FOR_SIZE is not set ++CONFIG_SYSCTL=y ++# CONFIG_EMBEDDED is not set ++CONFIG_UID16=y ++CONFIG_SYSCTL_SYSCALL=y ++CONFIG_KALLSYMS=y ++# CONFIG_KALLSYMS_EXTRA_PASS is not set ++CONFIG_HOTPLUG=y ++CONFIG_PRINTK=y ++CONFIG_BUG=y ++CONFIG_ELF_CORE=y ++CONFIG_BASE_FULL=y ++CONFIG_FUTEX=y ++CONFIG_ANON_INODES=y ++CONFIG_EPOLL=y ++CONFIG_SIGNALFD=y ++CONFIG_EVENTFD=y ++CONFIG_SHMEM=y ++CONFIG_VM_EVENT_COUNTERS=y ++CONFIG_SLAB=y ++# CONFIG_SLUB is not set ++# CONFIG_SLOB is not set ++CONFIG_SLABINFO=y ++CONFIG_RT_MUTEXES=y ++# CONFIG_TINY_SHMEM is not set ++CONFIG_BASE_SMALL=0 ++CONFIG_MODULES=y ++CONFIG_MODULE_UNLOAD=y ++# CONFIG_MODULE_FORCE_UNLOAD is not set ++# CONFIG_MODVERSIONS is not set ++# CONFIG_MODULE_SRCVERSION_ALL is not set ++# CONFIG_KMOD is not set ++CONFIG_BLOCK=y ++# CONFIG_LBD is not set ++# CONFIG_BLK_DEV_IO_TRACE is not set ++# CONFIG_LSF is not set ++# CONFIG_BLK_DEV_BSG is not set ++ ++# ++# IO Schedulers ++# ++CONFIG_IOSCHED_NOOP=y ++CONFIG_IOSCHED_AS=y ++CONFIG_IOSCHED_DEADLINE=y ++CONFIG_IOSCHED_CFQ=y ++CONFIG_DEFAULT_AS=y ++# CONFIG_DEFAULT_DEADLINE is not set ++# CONFIG_DEFAULT_CFQ is not set ++# CONFIG_DEFAULT_NOOP is not set ++CONFIG_DEFAULT_IOSCHED="anticipatory" ++ ++# ++# System Type ++# ++# CONFIG_ARCH_AAEC2000 is not set ++# CONFIG_ARCH_INTEGRATOR is not set ++# CONFIG_ARCH_REALVIEW is not set ++# CONFIG_ARCH_VERSATILE is not set ++# CONFIG_ARCH_AT91 is not set ++# CONFIG_ARCH_CLPS7500 is not set ++# CONFIG_ARCH_CLPS711X is not set ++# CONFIG_ARCH_CO285 is not set ++# CONFIG_ARCH_EBSA110 is not set ++# CONFIG_ARCH_EP93XX is not set ++# CONFIG_ARCH_FOOTBRIDGE is not set ++# CONFIG_ARCH_NETX is not set ++# CONFIG_ARCH_H720X is not set ++# CONFIG_ARCH_IMX is not set ++# CONFIG_ARCH_IOP13XX is not set ++# CONFIG_ARCH_IOP32X is not set ++# CONFIG_ARCH_IOP33X is not set ++# CONFIG_ARCH_IXP23XX is not set ++# CONFIG_ARCH_IXP2000 is not set ++# CONFIG_ARCH_IXP4XX is not set ++# CONFIG_ARCH_L7200 is not set ++# CONFIG_ARCH_KS8695 is not set ++# CONFIG_ARCH_NS9XXX is not set ++# CONFIG_ARCH_MXC is not set ++# CONFIG_ARCH_PNX4008 is not set ++# CONFIG_ARCH_PXA is not set ++# CONFIG_ARCH_RPC is not set ++# CONFIG_ARCH_SA1100 is not set ++# CONFIG_ARCH_S3C2410 is not set ++# CONFIG_ARCH_SHARK is not set ++# CONFIG_ARCH_LH7A40X is not set ++# CONFIG_ARCH_DAVINCI is not set ++# CONFIG_ARCH_OMAP is not set ++CONFIG_ARCH_HIPOX=y ++ ++# ++# Boot options ++# ++ ++# ++# Power management ++# ++ ++# ++# Oxford Semiconductor NAS Options ++# ++# CONFIG_ARCH_HIPOX_FPGA is not set ++CONFIG_NOMINAL_PLL400_FREQ=733333333 ++CONFIG_NOMINAL_RPSCLK_FREQ=25000000 ++# CONFIG_HIPOX_VERSION_0X800 is not set ++CONFIG_HIPOX_VERSION_0X810=y ++# CONFIG_HIPOX_VERSION_0X850 is not set ++# CONFIG_ARCH_HIPOX_UART1 is not set ++CONFIG_ARCH_HIPOX_UART2=y ++# CONFIG_ARCH_HIPOX_UART2_MODEM is not set ++# CONFIG_ARCH_HIPOX_UART3 is not set ++# CONFIG_ARCH_HIPOX_UART4 is not set ++CONFIG_FORCE_MAX_ZONEORDER=10 ++CONFIG_SRAM_NUM_PAGES=32 ++CONFIG_SUPPORT_LEON=y ++CONFIG_LEON_PAGES=2 ++CONFIG_LEON_COPRO=y ++CONFIG_LEON_OFFLOAD_TX=y ++# CONFIG_LEON_RESERVE_DMA_CHANNEL is not set ++CONFIG_LEON_OFFLOAD_TSO=y ++# CONFIG_LEON_START_EARLY is not set ++CONFIG_LEON_POWER_BUTTON_MONITOR=m ++CONFIG_HIPOX_POWER_BUTTON_GPIO=4 ++CONFIG_USER_RECOVERY_BUTTON_MONITOR=y ++CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO=28 ++# CONFIG_HIPOX_DDR_MON is not set ++# CONFIG_HIPOX_AHB_MON is not set ++# CONFIG_HIPOX_CACHE_LOCKDOWN is not set ++# CONFIG_DO_MEM_TEST is not set ++# CONFIG_CRYPTO_OXAESLRW is not set ++CONFIG_DESCRIPTORS_PAGES=6 ++CONFIG_ARCH_HIPOX_NUM_GMAC_DESCRIPTORS=192 ++CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES=256 ++CONFIG_TACHO_THERM_AND_FAN=m ++# CONFIG_GPIO_TEST is not set ++CONFIG_HIPOX_RTC=m ++# CONFIG_I2S is not set ++# CONFIG_DPE_TEST is not set ++# CONFIG_HIPOX_INSTRUMENT_COPIES is not set ++# CONFIG_HIPOX_DMA_COPIES is not set ++# CONFIG_HIPOX_AHB_MONITOR_MODULE is not set ++# CONFIG_HIPOX_USB_TEST_MODES is not set ++# CONFIG_HIPOX_FRONT_LAMP_CONTROL is not set ++# CONFIG_LEDS_TRIGGER_SATA_DISK is not set ++# CONFIG_HIPOX_LED_TEST is not set ++CONFIG_HIPOX_I2C_SDA=3 ++CONFIG_HIPOX_I2C_SCL=2 ++CONFIG_HIPOX_USB_PORTA_POWER_CONTROL=y ++# CONFIG_HIPOX_USB_PORTB_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTC_POWER_CONTROL is not set ++CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE=y ++CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE=y ++# CONFIG_WDC_FAN_HIPOX800 is not set ++# CONFIG_HIPOX_MAP_SRAM is not set ++# CONFIG_HIPOX_SUID_INHERIT is not set ++# CONFIG_HIPOX_USB_HUB_SUPPORT is not set ++ ++# ++# Processor Type ++# ++CONFIG_CPU_32=y ++CONFIG_CPU_ARM926T=y ++CONFIG_CPU_32v5=y ++CONFIG_CPU_ABRT_EV5TJ=y ++CONFIG_CPU_CACHE_VIVT=y ++CONFIG_CPU_COPY_V4WB=y ++CONFIG_CPU_TLB_V4WBI=y ++CONFIG_CPU_CP15=y ++CONFIG_CPU_CP15_MMU=y ++ ++# ++# Processor Features ++# ++CONFIG_ARM_THUMB=y ++# CONFIG_CPU_ICACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_WRITETHROUGH is not set ++# CONFIG_CPU_CACHE_ROUND_ROBIN is not set ++# CONFIG_OUTER_CACHE is not set ++ ++# ++# Bus support ++# ++CONFIG_ARM_AMBA=y ++# CONFIG_PCI is not set ++# CONFIG_PCI_SYSCALL is not set ++# CONFIG_ARCH_SUPPORTS_MSI is not set ++# CONFIG_PCCARD is not set ++ ++# ++# Kernel Features ++# ++# CONFIG_TICK_ONESHOT is not set ++# CONFIG_PREEMPT is not set ++# CONFIG_NO_IDLE_HZ is not set ++CONFIG_HZ=100 ++CONFIG_AEABI=y ++# CONFIG_OABI_COMPAT is not set ++# CONFIG_ARCH_DISCONTIGMEM_ENABLE is not set ++CONFIG_SELECT_MEMORY_MODEL=y ++CONFIG_FLATMEM_MANUAL=y ++# CONFIG_DISCONTIGMEM_MANUAL is not set ++# CONFIG_SPARSEMEM_MANUAL is not set ++CONFIG_FLATMEM=y ++CONFIG_FLAT_NODE_MEM_MAP=y ++# CONFIG_SPARSEMEM_STATIC is not set ++# CONFIG_SPARSEMEM_VMEMMAP_ENABLE is not set ++CONFIG_SPLIT_PTLOCK_CPUS=4096 ++# CONFIG_RESOURCES_64BIT is not set ++CONFIG_ZONE_DMA_FLAG=1 ++CONFIG_BOUNCE=y ++CONFIG_VIRT_TO_BUS=y ++CONFIG_ALIGNMENT_TRAP=y ++ ++# ++# Boot options ++# ++CONFIG_ZBOOT_ROM_TEXT=0x0 ++CONFIG_ZBOOT_ROM_BSS=0x0 ++CONFIG_CMDLINE="" ++# CONFIG_XIP_KERNEL is not set ++# CONFIG_KEXEC is not set ++ ++# ++# Floating point emulation ++# ++ ++# ++# At least one emulation must be selected ++# ++# CONFIG_VFP is not set ++ ++# ++# Userspace binary formats ++# ++CONFIG_BINFMT_ELF=y ++# CONFIG_BINFMT_AOUT is not set ++# CONFIG_BINFMT_MISC is not set ++ ++# ++# Power management options ++# ++# CONFIG_PM is not set ++CONFIG_SUSPEND_UP_POSSIBLE=y ++ ++# ++# Networking ++# ++CONFIG_NET=y ++ ++# ++# Networking options ++# ++CONFIG_PACKET=y ++CONFIG_PACKET_MMAP=y ++CONFIG_UNIX=y ++CONFIG_XFRM=y ++# CONFIG_XFRM_USER is not set ++# CONFIG_XFRM_SUB_POLICY is not set ++# CONFIG_XFRM_MIGRATE is not set ++# CONFIG_NET_KEY is not set ++CONFIG_INET=y ++CONFIG_IP_MULTICAST=y ++# CONFIG_IP_ADVANCED_ROUTER is not set ++CONFIG_IP_FIB_HASH=y ++# CONFIG_IP_PNP is not set ++# CONFIG_NET_IPIP is not set ++# CONFIG_NET_IPGRE is not set ++# CONFIG_IP_MROUTE is not set ++# CONFIG_ARPD is not set ++# CONFIG_SYN_COOKIES is not set ++# CONFIG_INET_AH is not set ++# CONFIG_INET_ESP is not set ++# CONFIG_INET_IPCOMP is not set ++# CONFIG_INET_XFRM_TUNNEL is not set ++# CONFIG_INET_TUNNEL is not set ++CONFIG_INET_XFRM_MODE_TRANSPORT=y ++CONFIG_INET_XFRM_MODE_TUNNEL=y ++CONFIG_INET_XFRM_MODE_BEET=y ++# CONFIG_INET_LRO is not set ++CONFIG_INET_DIAG=y ++CONFIG_INET_TCP_DIAG=y ++# CONFIG_TCP_CONG_ADVANCED is not set ++CONFIG_TCP_CONG_CUBIC=y ++CONFIG_DEFAULT_TCP_CONG="cubic" ++# CONFIG_TCP_MD5SIG is not set ++# CONFIG_IP_VS is not set ++# CONFIG_IPV6 is not set ++# CONFIG_INET6_XFRM_TUNNEL is not set ++# CONFIG_INET6_TUNNEL is not set ++# CONFIG_NETLABEL is not set ++# CONFIG_NETWORK_SECMARK is not set ++CONFIG_NETFILTER=y ++# CONFIG_NETFILTER_DEBUG is not set ++ ++# ++# Core Netfilter Configuration ++# ++# CONFIG_NETFILTER_NETLINK is not set ++# CONFIG_NF_CONNTRACK_ENABLED is not set ++# CONFIG_NF_CONNTRACK is not set ++# CONFIG_NETFILTER_XTABLES is not set ++ ++# ++# IP: Netfilter Configuration ++# ++# CONFIG_IP_NF_QUEUE is not set ++# CONFIG_IP_NF_IPTABLES is not set ++# CONFIG_IP_NF_ARPTABLES is not set ++# CONFIG_IP_DCCP is not set ++# CONFIG_IP_SCTP is not set ++# CONFIG_TIPC is not set ++# CONFIG_ATM is not set ++# CONFIG_BRIDGE is not set ++# CONFIG_VLAN_8021Q is not set ++# CONFIG_DECNET is not set ++# CONFIG_LLC2 is not set ++# CONFIG_IPX is not set ++# CONFIG_ATALK is not set ++# CONFIG_X25 is not set ++# CONFIG_LAPB is not set ++# CONFIG_ECONET is not set ++# CONFIG_WAN_ROUTER is not set ++# CONFIG_NET_SCHED is not set ++ ++# ++# Network testing ++# ++# CONFIG_NET_PKTGEN is not set ++# CONFIG_HAMRADIO is not set ++# CONFIG_IRDA is not set ++# CONFIG_BT is not set ++# CONFIG_AF_RXRPC is not set ++ ++# ++# Wireless ++# ++# CONFIG_CFG80211 is not set ++CONFIG_WIRELESS_EXT=y ++# CONFIG_MAC80211 is not set ++# CONFIG_IEEE80211 is not set ++# CONFIG_RFKILL is not set ++# CONFIG_NET_9P is not set ++ ++# ++# Device Drivers ++# ++ ++# ++# Generic Driver Options ++# ++CONFIG_UEVENT_HELPER_PATH="/sbin/hotplug" ++CONFIG_STANDALONE=y ++CONFIG_PREVENT_FIRMWARE_BUILD=y ++CONFIG_FW_LOADER=y ++# CONFIG_SYS_HYPERVISOR is not set ++# CONFIG_CONNECTOR is not set ++# CONFIG_MTD is not set ++# CONFIG_PARPORT is not set ++CONFIG_BLK_DEV=y ++# CONFIG_BLK_DEV_COW_COMMON is not set ++CONFIG_BLK_DEV_LOOP=y ++# CONFIG_BLK_DEV_CRYPTOLOOP is not set ++# CONFIG_BLK_DEV_NBD is not set ++# CONFIG_BLK_DEV_UB is not set ++CONFIG_BLK_DEV_RAM=y ++CONFIG_BLK_DEV_RAM_COUNT=16 ++CONFIG_BLK_DEV_RAM_SIZE=10240 ++CONFIG_BLK_DEV_RAM_BLOCKSIZE=1024 ++# CONFIG_CDROM_PKTCDVD is not set ++# CONFIG_ATA_OVER_ETH is not set ++# CONFIG_MISC_DEVICES is not set ++# CONFIG_IDE is not set ++ ++# ++# SCSI device support ++# ++# CONFIG_RAID_ATTRS is not set ++CONFIG_SCSI=y ++CONFIG_SCSI_DMA=y ++# CONFIG_SCSI_TGT is not set ++# CONFIG_SCSI_NETLINK is not set ++CONFIG_SCSI_PROC_FS=y ++ ++# ++# SCSI support type (disk, tape, CD-ROM) ++# ++CONFIG_BLK_DEV_SD=y ++# CONFIG_CHR_DEV_ST is not set ++# CONFIG_CHR_DEV_OSST is not set ++# CONFIG_BLK_DEV_SR is not set ++# CONFIG_CHR_DEV_SG is not set ++# CONFIG_CHR_DEV_SCH is not set ++ ++# ++# Some SCSI devices (e.g. CD jukebox) support multiple LUNs ++# ++CONFIG_SCSI_MULTI_LUN=y ++# CONFIG_SCSI_CONSTANTS is not set ++# CONFIG_SCSI_LOGGING is not set ++# CONFIG_SCSI_SCAN_ASYNC is not set ++CONFIG_SCSI_WAIT_SCAN=m ++ ++# ++# SCSI Transports ++# ++# CONFIG_SCSI_SPI_ATTRS is not set ++# CONFIG_SCSI_FC_ATTRS is not set ++# CONFIG_SCSI_ISCSI_ATTRS is not set ++# CONFIG_SCSI_SAS_LIBSAS is not set ++# CONFIG_SCSI_SRP_ATTRS is not set ++CONFIG_SCSI_LOWLEVEL=y ++# CONFIG_ISCSI_TCP is not set ++# CONFIG_SCSI_DEBUG is not set ++CONFIG_ATA=y ++# CONFIG_ATA_NONSTANDARD is not set ++CONFIG_SATA_OX810=y ++# CONFIG_SATA_HIPOX_SINGLE_SATA is not set ++# CONFIG_SATA_HIPOX_DISK_LIGHT is not set ++CONFIG_MD=y ++CONFIG_BLK_DEV_MD=y ++CONFIG_MD_LINEAR=y ++# CONFIG_MD_RAID0 is not set ++CONFIG_MD_RAID1=y ++# CONFIG_MD_RAID10 is not set ++# CONFIG_MD_RAID456 is not set ++# CONFIG_MD_MULTIPATH is not set ++# CONFIG_MD_FAULTY is not set ++CONFIG_BLK_DEV_DM=y ++# CONFIG_DM_DEBUG is not set ++CONFIG_DM_CRYPT=y ++# CONFIG_DM_SNAPSHOT is not set ++# CONFIG_DM_MIRROR is not set ++# CONFIG_DM_ZERO is not set ++# CONFIG_DM_MULTIPATH is not set ++# CONFIG_DM_DELAY is not set ++# CONFIG_DM_UEVENT is not set ++CONFIG_NETDEVICES=y ++# CONFIG_NETDEVICES_MULTIQUEUE is not set ++# CONFIG_DUMMY is not set ++# CONFIG_BONDING is not set ++# CONFIG_MACVLAN is not set ++# CONFIG_EQUALIZER is not set ++# CONFIG_TUN is not set ++# CONFIG_VETH is not set ++# CONFIG_NET_ETHERNET is not set ++CONFIG_MII=y ++CONFIG_NETDEV_1000=y ++CONFIG_SYNOPSYS_GMAC=y ++# CONFIG_NETDEV_10000 is not set ++ ++# ++# Wireless LAN ++# ++# CONFIG_WLAN_PRE80211 is not set ++# CONFIG_WLAN_80211 is not set ++ ++# ++# USB Network Adapters ++# ++# CONFIG_USB_CATC is not set ++# CONFIG_USB_KAWETH is not set ++# CONFIG_USB_PEGASUS is not set ++# CONFIG_USB_RTL8150 is not set ++# CONFIG_USB_USBNET is not set ++# CONFIG_WAN is not set ++# CONFIG_PPP is not set ++# CONFIG_SLIP is not set ++# CONFIG_SHAPER is not set ++# CONFIG_NETCONSOLE is not set ++# CONFIG_NETPOLL is not set ++# CONFIG_NET_POLL_CONTROLLER is not set ++# CONFIG_ISDN is not set ++ ++# ++# Input device support ++# ++CONFIG_INPUT=y ++# CONFIG_INPUT_FF_MEMLESS is not set ++# CONFIG_INPUT_POLLDEV is not set ++ ++# ++# Userland interfaces ++# ++CONFIG_INPUT_MOUSEDEV=y ++# CONFIG_INPUT_MOUSEDEV_PSAUX is not set ++CONFIG_INPUT_MOUSEDEV_SCREEN_X=1024 ++CONFIG_INPUT_MOUSEDEV_SCREEN_Y=768 ++# CONFIG_INPUT_JOYDEV is not set ++# CONFIG_INPUT_EVDEV is not set ++# CONFIG_INPUT_EVBUG is not set ++ ++# ++# Input Device Drivers ++# ++# CONFIG_INPUT_KEYBOARD is not set ++# CONFIG_INPUT_MOUSE is not set ++# CONFIG_INPUT_JOYSTICK is not set ++# CONFIG_INPUT_TABLET is not set ++# CONFIG_INPUT_TOUCHSCREEN is not set ++# CONFIG_INPUT_MISC is not set ++ ++# ++# Hardware I/O ports ++# ++# CONFIG_SERIO is not set ++# CONFIG_GAMEPORT is not set ++ ++# ++# Character devices ++# ++CONFIG_VT=y ++CONFIG_VT_CONSOLE=y ++CONFIG_HW_CONSOLE=y ++# CONFIG_VT_HW_CONSOLE_BINDING is not set ++# CONFIG_SERIAL_NONSTANDARD is not set ++ ++# ++# Serial drivers ++# ++CONFIG_SERIAL_8250=y ++CONFIG_SERIAL_8250_CONSOLE=y ++CONFIG_SERIAL_8250_NR_UARTS=4 ++CONFIG_SERIAL_8250_RUNTIME_UARTS=4 ++# CONFIG_SERIAL_8250_EXTENDED is not set ++ ++# ++# Non-8250 serial port support ++# ++# CONFIG_SERIAL_AMBA_PL010 is not set ++# CONFIG_SERIAL_AMBA_PL011 is not set ++CONFIG_SERIAL_CORE=y ++CONFIG_SERIAL_CORE_CONSOLE=y ++CONFIG_UNIX98_PTYS=y ++# CONFIG_LEGACY_PTYS is not set ++# CONFIG_IPMI_HANDLER is not set ++CONFIG_HW_RANDOM=m ++# CONFIG_NVRAM is not set ++# CONFIG_R3964 is not set ++# CONFIG_RAW_DRIVER is not set ++# CONFIG_TCG_TPM is not set ++CONFIG_I2C=m ++CONFIG_I2C_BOARDINFO=y ++# CONFIG_I2C_CHARDEV is not set ++ ++# ++# I2C Algorithms ++# ++CONFIG_I2C_ALGOBIT=m ++# CONFIG_I2C_ALGOPCF is not set ++# CONFIG_I2C_ALGOPCA is not set ++# CONFIG_I2C_ALGOOXSEMI is not set ++ ++# ++# I2C Hardware Bus support ++# ++CONFIG_I2C_HIPOX_BITBASH=m ++# CONFIG_I2C_OCORES is not set ++# CONFIG_I2C_PARPORT_LIGHT is not set ++# CONFIG_I2C_SIMTEC is not set ++# CONFIG_I2C_TAOS_EVM is not set ++# CONFIG_I2C_STUB is not set ++# CONFIG_I2C_TINY_USB is not set ++ ++# ++# Miscellaneous I2C Chip support ++# ++# CONFIG_SENSORS_DS1337 is not set ++# CONFIG_SENSORS_DS1374 is not set ++# CONFIG_DS1682 is not set ++# CONFIG_SENSORS_EEPROM is not set ++# CONFIG_SENSORS_PCF8574 is not set ++# CONFIG_SENSORS_PCA9539 is not set ++# CONFIG_SENSORS_PCF8591 is not set ++# CONFIG_SENSORS_MAX6875 is not set ++# CONFIG_SENSORS_TSL2550 is not set ++# CONFIG_I2C_DEBUG_CORE is not set ++# CONFIG_I2C_DEBUG_ALGO is not set ++# CONFIG_I2C_DEBUG_BUS is not set ++# CONFIG_I2C_DEBUG_CHIP is not set ++ ++# ++# SPI support ++# ++# CONFIG_SPI is not set ++# CONFIG_SPI_MASTER is not set ++# CONFIG_W1 is not set ++# CONFIG_POWER_SUPPLY is not set ++# CONFIG_HWMON is not set ++# CONFIG_WATCHDOG is not set ++ ++# ++# Sonics Silicon Backplane ++# ++CONFIG_SSB_POSSIBLE=y ++# CONFIG_SSB is not set ++ ++# ++# Multifunction device drivers ++# ++# CONFIG_MFD_SM501 is not set ++ ++# ++# Multimedia devices ++# ++# CONFIG_VIDEO_DEV is not set ++# CONFIG_DVB_CORE is not set ++CONFIG_DAB=y ++# CONFIG_USB_DABUSB is not set ++ ++# ++# Graphics support ++# ++# CONFIG_VGASTATE is not set ++CONFIG_VIDEO_OUTPUT_CONTROL=m ++# CONFIG_FB is not set ++# CONFIG_BACKLIGHT_LCD_SUPPORT is not set ++ ++# ++# Display device support ++# ++# CONFIG_DISPLAY_SUPPORT is not set ++ ++# ++# Console display driver support ++# ++# CONFIG_VGA_CONSOLE is not set ++CONFIG_DUMMY_CONSOLE=y ++ ++# ++# Sound ++# ++# CONFIG_SOUND is not set ++# CONFIG_HID_SUPPORT is not set ++CONFIG_USB_SUPPORT=y ++CONFIG_USB_ARCH_HAS_HCD=y ++CONFIG_USB_ARCH_HAS_OHCI=y ++CONFIG_USB_ARCH_HAS_EHCI=y ++CONFIG_USB=m ++# CONFIG_USB_DEBUG is not set ++ ++# ++# Miscellaneous USB options ++# ++CONFIG_USB_DEVICEFS=y ++CONFIG_USB_DEVICE_CLASS=y ++# CONFIG_USB_DYNAMIC_MINORS is not set ++# CONFIG_USB_OTG is not set ++ ++# ++# USB Host Controller Drivers ++# ++CONFIG_USB_EHCI_HCD=m ++# CONFIG_USB_EHCI_SPLIT_ISO is not set ++CONFIG_USB_EHCI_ROOT_HUB_TT=y ++# CONFIG_USB_EHCI_TT_NEWSCHED is not set ++# CONFIG_USB_ISP116X_HCD is not set ++# CONFIG_USB_OHCI_HCD is not set ++# CONFIG_USB_SL811_HCD is not set ++# CONFIG_USB_R8A66597_HCD is not set ++ ++# ++# USB Device Class drivers ++# ++# CONFIG_USB_ACM is not set ++# CONFIG_USB_PRINTER is not set ++ ++# ++# NOTE: USB_STORAGE enables SCSI, and 'SCSI disk support' ++# ++ ++# ++# may also be needed; see USB_STORAGE Help for more information ++# ++CONFIG_USB_STORAGE=m ++# CONFIG_USB_STORAGE_DEBUG is not set ++# CONFIG_USB_STORAGE_DATAFAB is not set ++# CONFIG_USB_STORAGE_FREECOM is not set ++# CONFIG_USB_STORAGE_ISD200 is not set ++# CONFIG_USB_STORAGE_DPCM is not set ++# CONFIG_USB_STORAGE_USBAT is not set ++# CONFIG_USB_STORAGE_SDDR09 is not set ++# CONFIG_USB_STORAGE_SDDR55 is not set ++# CONFIG_USB_STORAGE_JUMPSHOT is not set ++# CONFIG_USB_STORAGE_ALAUDA is not set ++# CONFIG_USB_STORAGE_KARMA is not set ++# CONFIG_USB_LIBUSUAL is not set ++ ++# ++# USB Imaging devices ++# ++# CONFIG_USB_MDC800 is not set ++# CONFIG_USB_MICROTEK is not set ++# CONFIG_USB_MON is not set ++ ++# ++# USB port drivers ++# ++ ++# ++# USB Serial Converter support ++# ++# CONFIG_USB_SERIAL is not set ++ ++# ++# USB Miscellaneous drivers ++# ++# CONFIG_USB_EMI62 is not set ++# CONFIG_USB_EMI26 is not set ++# CONFIG_USB_ADUTUX is not set ++# CONFIG_USB_AUERSWALD is not set ++# CONFIG_USB_RIO500 is not set ++# CONFIG_USB_LEGOTOWER is not set ++# CONFIG_USB_LCD is not set ++# CONFIG_USB_BERRY_CHARGE is not set ++# CONFIG_USB_LED is not set ++# CONFIG_USB_CYPRESS_CY7C63 is not set ++# CONFIG_USB_CYTHERM is not set ++# CONFIG_USB_PHIDGET is not set ++# CONFIG_USB_IDMOUSE is not set ++# CONFIG_USB_FTDI_ELAN is not set ++# CONFIG_USB_APPLEDISPLAY is not set ++# CONFIG_USB_SISUSBVGA is not set ++# CONFIG_USB_LD is not set ++# CONFIG_USB_TRANCEVIBRATOR is not set ++# CONFIG_USB_IOWARRIOR is not set ++CONFIG_USB_TEST=m ++ ++# ++# USB DSL modem support ++# ++ ++# ++# USB Gadget Support ++# ++# CONFIG_USB_GADGET is not set ++# CONFIG_MMC is not set ++CONFIG_NEW_LEDS=y ++CONFIG_LEDS_CLASS=y ++ ++# ++# LED drivers ++# ++CONFIG_WDC_LEDS_HIPOX800=m ++# CONFIG_HIPOX_WD810_LEDS is not set ++ ++# ++# LED Triggers ++# ++CONFIG_LEDS_TRIGGERS=y ++# CONFIG_LEDS_TRIGGER_TIMER is not set ++CONFIG_WDC_LEDS_TRIGGER_SATA_DISK=y ++# CONFIG_LEDS_TRIGGER_HEARTBEAT is not set ++CONFIG_RTC_LIB=y ++CONFIG_RTC_CLASS=m ++ ++# ++# RTC interfaces ++# ++CONFIG_RTC_INTF_SYSFS=y ++CONFIG_RTC_INTF_PROC=y ++CONFIG_RTC_INTF_DEV=y ++# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set ++# CONFIG_RTC_DRV_TEST is not set ++ ++# ++# I2C RTC drivers ++# ++CONFIG_RTC_DRV_DS1307=m ++# CONFIG_RTC_DRV_DS1374 is not set ++# CONFIG_RTC_DRV_DS1672 is not set ++# CONFIG_RTC_DRV_MAX6900 is not set ++# CONFIG_RTC_DRV_RS5C372 is not set ++# CONFIG_RTC_DRV_ISL1208 is not set ++# CONFIG_RTC_DRV_X1205 is not set ++# CONFIG_RTC_DRV_PCF8563 is not set ++# CONFIG_RTC_DRV_PCF8583 is not set ++# CONFIG_RTC_DRV_M41T80 is not set ++ ++# ++# SPI RTC drivers ++# ++ ++# ++# Platform RTC drivers ++# ++# CONFIG_RTC_DRV_CMOS is not set ++# CONFIG_RTC_DRV_DS1553 is not set ++# CONFIG_RTC_DRV_STK17TA8 is not set ++# CONFIG_RTC_DRV_DS1742 is not set ++# CONFIG_RTC_DRV_M48T86 is not set ++# CONFIG_RTC_DRV_M48T59 is not set ++# CONFIG_RTC_DRV_V3020 is not set ++ ++# ++# on-CPU RTC drivers ++# ++# CONFIG_RTC_DRV_PL031 is not set ++# CONFIG_DMADEVICES is not set ++ ++# ++# File systems ++# ++CONFIG_EXT2_FS=y ++# CONFIG_EXT2_FS_XATTR is not set ++# CONFIG_EXT2_FS_XIP is not set ++CONFIG_EXT3_FS=y ++# CONFIG_EXT3_FS_XATTR is not set ++# CONFIG_EXT4DEV_FS is not set ++CONFIG_JBD=y ++# CONFIG_REISERFS_FS is not set ++# CONFIG_JFS_FS is not set ++CONFIG_FS_POSIX_ACL=y ++CONFIG_XFS_FS=y ++# CONFIG_XFS_QUOTA is not set ++# CONFIG_XFS_SECURITY is not set ++# CONFIG_XFS_POSIX_ACL is not set ++# CONFIG_XFS_RT is not set ++# CONFIG_GFS2_FS is not set ++# CONFIG_OCFS2_FS is not set ++# CONFIG_MINIX_FS is not set ++# CONFIG_ROMFS_FS is not set ++CONFIG_INOTIFY=y ++CONFIG_INOTIFY_USER=y ++# CONFIG_QUOTA is not set ++CONFIG_DNOTIFY=y ++# CONFIG_AUTOFS_FS is not set ++# CONFIG_AUTOFS4_FS is not set ++CONFIG_FUSE_FS=y ++ ++# ++# CD-ROM/DVD Filesystems ++# ++# CONFIG_ISO9660_FS is not set ++# CONFIG_UDF_FS is not set ++ ++# ++# DOS/FAT/NT Filesystems ++# ++CONFIG_FAT_FS=y ++CONFIG_MSDOS_FS=y ++CONFIG_VFAT_FS=m ++CONFIG_FAT_DEFAULT_CODEPAGE=437 ++CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1" ++CONFIG_NTFS_FS=m ++# CONFIG_NTFS_DEBUG is not set ++# CONFIG_NTFS_RW is not set ++ ++# ++# Pseudo filesystems ++# ++CONFIG_PROC_FS=y ++CONFIG_PROC_SYSCTL=y ++CONFIG_SYSFS=y ++# CONFIG_TMPFS is not set ++# CONFIG_HUGETLB_PAGE is not set ++# CONFIG_CONFIGFS_FS is not set ++ ++# ++# Miscellaneous filesystems ++# ++# CONFIG_ADFS_FS is not set ++# CONFIG_AFFS_FS is not set ++# CONFIG_HFS_FS is not set ++CONFIG_HFSPLUS_FS=m ++# CONFIG_BEFS_FS is not set ++# CONFIG_BFS_FS is not set ++# CONFIG_EFS_FS is not set ++# CONFIG_CRAMFS is not set ++# CONFIG_VXFS_FS is not set ++# CONFIG_HPFS_FS is not set ++# CONFIG_QNX4FS_FS is not set ++# CONFIG_SYSV_FS is not set ++# CONFIG_UFS_FS is not set ++CONFIG_NETWORK_FILESYSTEMS=y ++# CONFIG_NFS_FS is not set ++CONFIG_NFSD=m ++CONFIG_NFSD_V2_ACL=y ++CONFIG_NFSD_V3=y ++CONFIG_NFSD_V3_ACL=y ++# CONFIG_NFSD_V4 is not set ++CONFIG_NFSD_TCP=y ++CONFIG_LOCKD=m ++CONFIG_LOCKD_V4=y ++CONFIG_EXPORTFS=m ++CONFIG_NFS_ACL_SUPPORT=m ++CONFIG_NFS_COMMON=y ++CONFIG_SUNRPC=m ++# CONFIG_SUNRPC_BIND34 is not set ++# CONFIG_RPCSEC_GSS_KRB5 is not set ++# CONFIG_RPCSEC_GSS_SPKM3 is not set ++# CONFIG_SMB_FS is not set ++# CONFIG_CIFS is not set ++# CONFIG_NCP_FS is not set ++# CONFIG_CODA_FS is not set ++# CONFIG_AFS_FS is not set ++ ++# ++# Partition Types ++# ++CONFIG_PARTITION_ADVANCED=y ++# CONFIG_ACORN_PARTITION is not set ++# CONFIG_OSF_PARTITION is not set ++# CONFIG_AMIGA_PARTITION is not set ++# CONFIG_ATARI_PARTITION is not set ++CONFIG_MAC_PARTITION=y ++CONFIG_MSDOS_PARTITION=y ++# CONFIG_BSD_DISKLABEL is not set ++# CONFIG_MINIX_SUBPARTITION is not set ++# CONFIG_SOLARIS_X86_PARTITION is not set ++# CONFIG_UNIXWARE_DISKLABEL is not set ++CONFIG_LDM_PARTITION=y ++# CONFIG_LDM_DEBUG is not set ++# CONFIG_SGI_PARTITION is not set ++# CONFIG_ULTRIX_PARTITION is not set ++# CONFIG_SUN_PARTITION is not set ++# CONFIG_KARMA_PARTITION is not set ++CONFIG_EFI_PARTITION=y ++# CONFIG_SYSV68_PARTITION is not set ++CONFIG_NLS=y ++CONFIG_NLS_DEFAULT="iso8859-1" ++CONFIG_NLS_CODEPAGE_437=m ++# CONFIG_NLS_CODEPAGE_737 is not set ++# CONFIG_NLS_CODEPAGE_775 is not set ++# CONFIG_NLS_CODEPAGE_850 is not set ++# CONFIG_NLS_CODEPAGE_852 is not set ++# CONFIG_NLS_CODEPAGE_855 is not set ++# CONFIG_NLS_CODEPAGE_857 is not set ++# CONFIG_NLS_CODEPAGE_860 is not set ++# CONFIG_NLS_CODEPAGE_861 is not set ++# CONFIG_NLS_CODEPAGE_862 is not set ++# CONFIG_NLS_CODEPAGE_863 is not set ++# CONFIG_NLS_CODEPAGE_864 is not set ++# CONFIG_NLS_CODEPAGE_865 is not set ++# CONFIG_NLS_CODEPAGE_866 is not set ++# CONFIG_NLS_CODEPAGE_869 is not set ++# CONFIG_NLS_CODEPAGE_936 is not set ++# CONFIG_NLS_CODEPAGE_950 is not set ++# CONFIG_NLS_CODEPAGE_932 is not set ++# CONFIG_NLS_CODEPAGE_949 is not set ++# CONFIG_NLS_CODEPAGE_874 is not set ++# CONFIG_NLS_ISO8859_8 is not set ++# CONFIG_NLS_CODEPAGE_1250 is not set ++# CONFIG_NLS_CODEPAGE_1251 is not set ++# CONFIG_NLS_ASCII is not set ++CONFIG_NLS_ISO8859_1=m ++# CONFIG_NLS_ISO8859_2 is not set ++# CONFIG_NLS_ISO8859_3 is not set ++# CONFIG_NLS_ISO8859_4 is not set ++# CONFIG_NLS_ISO8859_5 is not set ++# CONFIG_NLS_ISO8859_6 is not set ++# CONFIG_NLS_ISO8859_7 is not set ++# CONFIG_NLS_ISO8859_9 is not set ++# CONFIG_NLS_ISO8859_13 is not set ++# CONFIG_NLS_ISO8859_14 is not set ++# CONFIG_NLS_ISO8859_15 is not set ++# CONFIG_NLS_KOI8_R is not set ++# CONFIG_NLS_KOI8_U is not set ++CONFIG_NLS_UTF8=y ++# CONFIG_DLM is not set ++# CONFIG_INSTRUMENTATION is not set ++ ++# ++# Kernel hacking ++# ++# CONFIG_PRINTK_TIME is not set ++CONFIG_ENABLE_WARN_DEPRECATED=y ++CONFIG_ENABLE_MUST_CHECK=y ++# CONFIG_MAGIC_SYSRQ is not set ++# CONFIG_UNUSED_SYMBOLS is not set ++# CONFIG_DEBUG_FS is not set ++# CONFIG_HEADERS_CHECK is not set ++# CONFIG_DEBUG_KERNEL is not set ++CONFIG_DEBUG_BUGVERBOSE=y ++CONFIG_FRAME_POINTER=y ++# CONFIG_SAMPLES is not set ++# CONFIG_DEBUG_USER is not set ++ ++# ++# Security options ++# ++# CONFIG_KEYS is not set ++CONFIG_SECURITY=y ++# CONFIG_SECURITY_NETWORK is not set ++# CONFIG_SECURITY_CAPABILITIES is not set ++CONFIG_SECURITY_TRUSTEES=y ++# CONFIG_SECURITY_TRUSTEES_DEBUG is not set ++CONFIG_CRYPTO=y ++CONFIG_CRYPTO_ALGAPI=y ++CONFIG_CRYPTO_BLKCIPHER=y ++CONFIG_CRYPTO_MANAGER=y ++# CONFIG_CRYPTO_HMAC is not set ++# CONFIG_CRYPTO_XCBC is not set ++# CONFIG_CRYPTO_NULL is not set ++# CONFIG_CRYPTO_MD4 is not set ++# CONFIG_CRYPTO_MD5 is not set ++# CONFIG_CRYPTO_SHA1 is not set ++# CONFIG_CRYPTO_SHA256 is not set ++# CONFIG_CRYPTO_SHA512 is not set ++# CONFIG_CRYPTO_WP512 is not set ++# CONFIG_CRYPTO_TGR192 is not set ++# CONFIG_CRYPTO_GF128MUL is not set ++CONFIG_CRYPTO_ECB=m ++CONFIG_CRYPTO_CBC=y ++CONFIG_CRYPTO_PCBC=m ++# CONFIG_CRYPTO_LRW is not set ++# CONFIG_CRYPTO_XTS is not set ++# CONFIG_CRYPTO_CRYPTD is not set ++# CONFIG_CRYPTO_DES is not set ++# CONFIG_CRYPTO_FCRYPT is not set ++# CONFIG_CRYPTO_BLOWFISH is not set ++# CONFIG_CRYPTO_TWOFISH is not set ++# CONFIG_CRYPTO_SERPENT is not set ++CONFIG_CRYPTO_AES=m ++# CONFIG_CRYPTO_CAST5 is not set ++# CONFIG_CRYPTO_CAST6 is not set ++# CONFIG_CRYPTO_TEA is not set ++CONFIG_CRYPTO_ARC4=m ++# CONFIG_CRYPTO_KHAZAD is not set ++# CONFIG_CRYPTO_ANUBIS is not set ++# CONFIG_CRYPTO_SEED is not set ++# CONFIG_CRYPTO_DEFLATE is not set ++CONFIG_CRYPTO_MICHAEL_MIC=m ++# CONFIG_CRYPTO_CRC32C is not set ++# CONFIG_CRYPTO_CAMELLIA is not set ++# CONFIG_CRYPTO_TEST is not set ++# CONFIG_CRYPTO_AUTHENC is not set ++CONFIG_CRYPTO_HW=y ++ ++# ++# Library routines ++# ++CONFIG_BITREVERSE=y ++CONFIG_CRC_CCITT=y ++# CONFIG_CRC16 is not set ++# CONFIG_CRC_ITU_T is not set ++CONFIG_CRC32=y ++# CONFIG_CRC7 is not set ++# CONFIG_LIBCRC32C is not set ++CONFIG_PLIST=y ++CONFIG_HAS_IOMEM=y ++CONFIG_HAS_IOPORT=y ++CONFIG_HAS_DMA=y +diff -Nurd linux-2.6.24/arch/arm/configs/hipox_810_eabi_wd_prod_defconfig linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_wd_prod_defconfig +--- linux-2.6.24/arch/arm/configs/hipox_810_eabi_wd_prod_defconfig 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/configs/hipox_810_eabi_wd_prod_defconfig 2008-06-11 17:47:52.000000000 +0200 +@@ -0,0 +1,1108 @@ ++# ++# Automatically generated make config: don't edit ++# Linux kernel version: 2.6.24.4 ++# Thu Jun 5 16:08:07 2008 ++# ++CONFIG_ARM=y ++CONFIG_SYS_SUPPORTS_APM_EMULATION=y ++# CONFIG_GENERIC_GPIO is not set ++# CONFIG_GENERIC_TIME is not set ++# CONFIG_GENERIC_CLOCKEVENTS is not set ++CONFIG_MMU=y ++# CONFIG_NO_IOPORT is not set ++CONFIG_GENERIC_HARDIRQS=y ++CONFIG_STACKTRACE_SUPPORT=y ++CONFIG_LOCKDEP_SUPPORT=y ++CONFIG_TRACE_IRQFLAGS_SUPPORT=y ++CONFIG_HARDIRQS_SW_RESEND=y ++CONFIG_GENERIC_IRQ_PROBE=y ++CONFIG_RWSEM_GENERIC_SPINLOCK=y ++# CONFIG_ARCH_HAS_ILOG2_U32 is not set ++# CONFIG_ARCH_HAS_ILOG2_U64 is not set ++CONFIG_GENERIC_HWEIGHT=y ++CONFIG_GENERIC_CALIBRATE_DELAY=y ++CONFIG_ZONE_DMA=y ++CONFIG_VECTORS_BASE=0xffff0000 ++CONFIG_DEFCONFIG_LIST="/lib/modules/$UNAME_RELEASE/.config" ++ ++# ++# General setup ++# ++CONFIG_EXPERIMENTAL=y ++CONFIG_BROKEN_ON_SMP=y ++CONFIG_INIT_ENV_ARG_LIMIT=32 ++CONFIG_LOCALVERSION="" ++CONFIG_LOCALVERSION_AUTO=y ++CONFIG_SWAP=y ++CONFIG_SYSVIPC=y ++CONFIG_SYSVIPC_SYSCTL=y ++# CONFIG_POSIX_MQUEUE is not set ++# CONFIG_BSD_PROCESS_ACCT is not set ++# CONFIG_TASKSTATS is not set ++# CONFIG_USER_NS is not set ++# CONFIG_PID_NS is not set ++# CONFIG_AUDIT is not set ++# CONFIG_IKCONFIG is not set ++CONFIG_LOG_BUF_SHIFT=14 ++# CONFIG_CGROUPS is not set ++# CONFIG_FAIR_GROUP_SCHED is not set ++CONFIG_SYSFS_DEPRECATED=y ++# CONFIG_RELAY is not set ++CONFIG_BLK_DEV_INITRD=y ++CONFIG_INITRAMFS_SOURCE="" ++# CONFIG_CC_OPTIMIZE_FOR_SIZE is not set ++CONFIG_SYSCTL=y ++# CONFIG_EMBEDDED is not set ++CONFIG_UID16=y ++CONFIG_SYSCTL_SYSCALL=y ++CONFIG_KALLSYMS=y ++# CONFIG_KALLSYMS_EXTRA_PASS is not set ++CONFIG_HOTPLUG=y ++CONFIG_PRINTK=y ++CONFIG_BUG=y ++CONFIG_ELF_CORE=y ++CONFIG_BASE_FULL=y ++CONFIG_FUTEX=y ++CONFIG_ANON_INODES=y ++CONFIG_EPOLL=y ++CONFIG_SIGNALFD=y ++CONFIG_EVENTFD=y ++CONFIG_SHMEM=y ++CONFIG_VM_EVENT_COUNTERS=y ++CONFIG_SLAB=y ++# CONFIG_SLUB is not set ++# CONFIG_SLOB is not set ++CONFIG_SLABINFO=y ++CONFIG_RT_MUTEXES=y ++# CONFIG_TINY_SHMEM is not set ++CONFIG_BASE_SMALL=0 ++CONFIG_MODULES=y ++CONFIG_MODULE_UNLOAD=y ++# CONFIG_MODULE_FORCE_UNLOAD is not set ++# CONFIG_MODVERSIONS is not set ++# CONFIG_MODULE_SRCVERSION_ALL is not set ++# CONFIG_KMOD is not set ++CONFIG_BLOCK=y ++# CONFIG_LBD is not set ++# CONFIG_BLK_DEV_IO_TRACE is not set ++# CONFIG_LSF is not set ++# CONFIG_BLK_DEV_BSG is not set ++ ++# ++# IO Schedulers ++# ++CONFIG_IOSCHED_NOOP=y ++CONFIG_IOSCHED_AS=y ++CONFIG_IOSCHED_DEADLINE=y ++CONFIG_IOSCHED_CFQ=y ++CONFIG_DEFAULT_AS=y ++# CONFIG_DEFAULT_DEADLINE is not set ++# CONFIG_DEFAULT_CFQ is not set ++# CONFIG_DEFAULT_NOOP is not set ++CONFIG_DEFAULT_IOSCHED="anticipatory" ++ ++# ++# System Type ++# ++# CONFIG_ARCH_AAEC2000 is not set ++# CONFIG_ARCH_INTEGRATOR is not set ++# CONFIG_ARCH_REALVIEW is not set ++# CONFIG_ARCH_VERSATILE is not set ++# CONFIG_ARCH_AT91 is not set ++# CONFIG_ARCH_CLPS7500 is not set ++# CONFIG_ARCH_CLPS711X is not set ++# CONFIG_ARCH_CO285 is not set ++# CONFIG_ARCH_EBSA110 is not set ++# CONFIG_ARCH_EP93XX is not set ++# CONFIG_ARCH_FOOTBRIDGE is not set ++# CONFIG_ARCH_NETX is not set ++# CONFIG_ARCH_H720X is not set ++# CONFIG_ARCH_IMX is not set ++# CONFIG_ARCH_IOP13XX is not set ++# CONFIG_ARCH_IOP32X is not set ++# CONFIG_ARCH_IOP33X is not set ++# CONFIG_ARCH_IXP23XX is not set ++# CONFIG_ARCH_IXP2000 is not set ++# CONFIG_ARCH_IXP4XX is not set ++# CONFIG_ARCH_L7200 is not set ++# CONFIG_ARCH_KS8695 is not set ++# CONFIG_ARCH_NS9XXX is not set ++# CONFIG_ARCH_MXC is not set ++# CONFIG_ARCH_PNX4008 is not set ++# CONFIG_ARCH_PXA is not set ++# CONFIG_ARCH_RPC is not set ++# CONFIG_ARCH_SA1100 is not set ++# CONFIG_ARCH_S3C2410 is not set ++# CONFIG_ARCH_SHARK is not set ++# CONFIG_ARCH_LH7A40X is not set ++# CONFIG_ARCH_DAVINCI is not set ++# CONFIG_ARCH_OMAP is not set ++CONFIG_ARCH_HIPOX=y ++ ++# ++# Boot options ++# ++ ++# ++# Power management ++# ++ ++# ++# Oxford Semiconductor NAS Options ++# ++# CONFIG_ARCH_HIPOX_FPGA is not set ++CONFIG_NOMINAL_PLL400_FREQ=733333333 ++CONFIG_NOMINAL_RPSCLK_FREQ=25000000 ++# CONFIG_HIPOX_VERSION_0X800 is not set ++CONFIG_HIPOX_VERSION_0X810=y ++# CONFIG_HIPOX_VERSION_0X850 is not set ++# CONFIG_ARCH_HIPOX_UART1 is not set ++CONFIG_ARCH_HIPOX_UART2=y ++# CONFIG_ARCH_HIPOX_UART2_MODEM is not set ++# CONFIG_ARCH_HIPOX_UART3 is not set ++# CONFIG_ARCH_HIPOX_UART4 is not set ++CONFIG_HIPOX_SATA_POWER_1=y ++CONFIG_HIPOX_SATA_POWER_GPIO_1=31 ++CONFIG_HIPOX_SATA_POWER_2=y ++CONFIG_HIPOX_SATA_POWER_GPIO_2=32 ++CONFIG_FORCE_MAX_ZONEORDER=10 ++CONFIG_SRAM_NUM_PAGES=32 ++CONFIG_SUPPORT_LEON=y ++CONFIG_LEON_PAGES=2 ++CONFIG_LEON_COPRO=y ++CONFIG_LEON_OFFLOAD_TX=y ++# CONFIG_LEON_RESERVE_DMA_CHANNEL is not set ++CONFIG_LEON_OFFLOAD_TSO=y ++# CONFIG_LEON_START_EARLY is not set ++CONFIG_LEON_POWER_BUTTON_MONITOR=m ++CONFIG_HIPOX_POWER_BUTTON_GPIO=0 ++CONFIG_USER_RECOVERY_BUTTON_MONITOR=y ++CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO=4 ++# CONFIG_HIPOX_DDR_MON is not set ++# CONFIG_HIPOX_AHB_MON is not set ++# CONFIG_HIPOX_CACHE_LOCKDOWN is not set ++# CONFIG_DO_MEM_TEST is not set ++# CONFIG_CRYPTO_OXAESLRW is not set ++CONFIG_DESCRIPTORS_PAGES=6 ++CONFIG_ARCH_HIPOX_NUM_GMAC_DESCRIPTORS=192 ++CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES=256 ++CONFIG_TACHO_THERM_AND_FAN=m ++# CONFIG_GPIO_TEST is not set ++CONFIG_HIPOX_RTC=m ++# CONFIG_I2S is not set ++# CONFIG_DPE_TEST is not set ++# CONFIG_HIPOX_INSTRUMENT_COPIES is not set ++# CONFIG_HIPOX_DMA_COPIES is not set ++# CONFIG_HIPOX_AHB_MONITOR_MODULE is not set ++# CONFIG_HIPOX_USB_TEST_MODES is not set ++# CONFIG_HIPOX_FRONT_LAMP_CONTROL is not set ++# CONFIG_LEDS_TRIGGER_SATA_DISK is not set ++# CONFIG_HIPOX_LED_TEST is not set ++CONFIG_HIPOX_I2C_SDA=3 ++CONFIG_HIPOX_I2C_SCL=2 ++CONFIG_HIPOX_USB_PORTA_POWER_CONTROL=y ++# CONFIG_HIPOX_USB_PORTB_POWER_CONTROL is not set ++# CONFIG_HIPOX_USB_PORTC_POWER_CONTROL is not set ++CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE=y ++CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE=y ++# CONFIG_WDC_FAN_HIPOX800 is not set ++# CONFIG_HIPOX_MAP_SRAM is not set ++# CONFIG_HIPOX_SUID_INHERIT is not set ++CONFIG_HIPOX_USB_HUB_SUPPORT=y ++CONFIG_HIPOX_USB_CKOUT=y ++CONFIG_HIPOX_USB_HUB_RESET_CONTROL=y ++CONFIG_HIPOX_USB_HUB_RESET_GPIO=27 ++CONFIG_HIPOX_USB_HUB_RESET_ACTIVE_HIGH=0 ++CONFIG_HIPOX_USB_HUB_RESET_TOGGLE=y ++CONFIG_HIPOX_USB_HUB_RESET_PERIOD_MS=100 ++ ++# ++# Processor Type ++# ++CONFIG_CPU_32=y ++CONFIG_CPU_ARM926T=y ++CONFIG_CPU_32v5=y ++CONFIG_CPU_ABRT_EV5TJ=y ++CONFIG_CPU_CACHE_VIVT=y ++CONFIG_CPU_COPY_V4WB=y ++CONFIG_CPU_TLB_V4WBI=y ++CONFIG_CPU_CP15=y ++CONFIG_CPU_CP15_MMU=y ++ ++# ++# Processor Features ++# ++CONFIG_ARM_THUMB=y ++# CONFIG_CPU_ICACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_DISABLE is not set ++# CONFIG_CPU_DCACHE_WRITETHROUGH is not set ++# CONFIG_CPU_CACHE_ROUND_ROBIN is not set ++# CONFIG_OUTER_CACHE is not set ++ ++# ++# Bus support ++# ++CONFIG_ARM_AMBA=y ++# CONFIG_PCI is not set ++# CONFIG_PCI_SYSCALL is not set ++# CONFIG_ARCH_SUPPORTS_MSI is not set ++# CONFIG_PCCARD is not set ++ ++# ++# Kernel Features ++# ++# CONFIG_TICK_ONESHOT is not set ++# CONFIG_PREEMPT is not set ++# CONFIG_NO_IDLE_HZ is not set ++CONFIG_HZ=100 ++CONFIG_AEABI=y ++CONFIG_OABI_COMPAT=y ++# CONFIG_ARCH_DISCONTIGMEM_ENABLE is not set ++CONFIG_SELECT_MEMORY_MODEL=y ++CONFIG_FLATMEM_MANUAL=y ++# CONFIG_DISCONTIGMEM_MANUAL is not set ++# CONFIG_SPARSEMEM_MANUAL is not set ++CONFIG_FLATMEM=y ++CONFIG_FLAT_NODE_MEM_MAP=y ++# CONFIG_SPARSEMEM_STATIC is not set ++# CONFIG_SPARSEMEM_VMEMMAP_ENABLE is not set ++CONFIG_SPLIT_PTLOCK_CPUS=4096 ++# CONFIG_RESOURCES_64BIT is not set ++CONFIG_ZONE_DMA_FLAG=1 ++CONFIG_BOUNCE=y ++CONFIG_VIRT_TO_BUS=y ++CONFIG_ALIGNMENT_TRAP=y ++ ++# ++# Boot options ++# ++CONFIG_ZBOOT_ROM_TEXT=0x0 ++CONFIG_ZBOOT_ROM_BSS=0x0 ++CONFIG_CMDLINE="" ++# CONFIG_XIP_KERNEL is not set ++# CONFIG_KEXEC is not set ++ ++# ++# Floating point emulation ++# ++ ++# ++# At least one emulation must be selected ++# ++# CONFIG_FPE_NWFPE is not set ++# CONFIG_FPE_FASTFPE is not set ++# CONFIG_VFP is not set ++ ++# ++# Userspace binary formats ++# ++CONFIG_BINFMT_ELF=y ++# CONFIG_BINFMT_AOUT is not set ++# CONFIG_BINFMT_MISC is not set ++ ++# ++# Power management options ++# ++# CONFIG_PM is not set ++CONFIG_SUSPEND_UP_POSSIBLE=y ++ ++# ++# Networking ++# ++CONFIG_NET=y ++ ++# ++# Networking options ++# ++CONFIG_PACKET=y ++CONFIG_PACKET_MMAP=y ++CONFIG_UNIX=y ++CONFIG_XFRM=y ++# CONFIG_XFRM_USER is not set ++# CONFIG_XFRM_SUB_POLICY is not set ++# CONFIG_XFRM_MIGRATE is not set ++# CONFIG_NET_KEY is not set ++CONFIG_INET=y ++CONFIG_IP_MULTICAST=y ++# CONFIG_IP_ADVANCED_ROUTER is not set ++CONFIG_IP_FIB_HASH=y ++# CONFIG_IP_PNP is not set ++# CONFIG_NET_IPIP is not set ++# CONFIG_NET_IPGRE is not set ++# CONFIG_IP_MROUTE is not set ++# CONFIG_ARPD is not set ++# CONFIG_SYN_COOKIES is not set ++# CONFIG_INET_AH is not set ++# CONFIG_INET_ESP is not set ++# CONFIG_INET_IPCOMP is not set ++# CONFIG_INET_XFRM_TUNNEL is not set ++# CONFIG_INET_TUNNEL is not set ++CONFIG_INET_XFRM_MODE_TRANSPORT=y ++CONFIG_INET_XFRM_MODE_TUNNEL=y ++CONFIG_INET_XFRM_MODE_BEET=y ++# CONFIG_INET_LRO is not set ++CONFIG_INET_DIAG=y ++CONFIG_INET_TCP_DIAG=y ++# CONFIG_TCP_CONG_ADVANCED is not set ++CONFIG_TCP_CONG_CUBIC=y ++CONFIG_DEFAULT_TCP_CONG="cubic" ++# CONFIG_TCP_MD5SIG is not set ++# CONFIG_IP_VS is not set ++# CONFIG_IPV6 is not set ++# CONFIG_INET6_XFRM_TUNNEL is not set ++# CONFIG_INET6_TUNNEL is not set ++# CONFIG_NETLABEL is not set ++# CONFIG_NETWORK_SECMARK is not set ++CONFIG_NETFILTER=y ++# CONFIG_NETFILTER_DEBUG is not set ++ ++# ++# Core Netfilter Configuration ++# ++# CONFIG_NETFILTER_NETLINK is not set ++# CONFIG_NF_CONNTRACK_ENABLED is not set ++# CONFIG_NF_CONNTRACK is not set ++# CONFIG_NETFILTER_XTABLES is not set ++ ++# ++# IP: Netfilter Configuration ++# ++# CONFIG_IP_NF_QUEUE is not set ++# CONFIG_IP_NF_IPTABLES is not set ++# CONFIG_IP_NF_ARPTABLES is not set ++# CONFIG_IP_DCCP is not set ++# CONFIG_IP_SCTP is not set ++# CONFIG_TIPC is not set ++# CONFIG_ATM is not set ++# CONFIG_BRIDGE is not set ++# CONFIG_VLAN_8021Q is not set ++# CONFIG_DECNET is not set ++# CONFIG_LLC2 is not set ++# CONFIG_IPX is not set ++# CONFIG_ATALK is not set ++# CONFIG_X25 is not set ++# CONFIG_LAPB is not set ++# CONFIG_ECONET is not set ++# CONFIG_WAN_ROUTER is not set ++# CONFIG_NET_SCHED is not set ++ ++# ++# Network testing ++# ++# CONFIG_NET_PKTGEN is not set ++# CONFIG_HAMRADIO is not set ++# CONFIG_IRDA is not set ++# CONFIG_BT is not set ++# CONFIG_AF_RXRPC is not set ++ ++# ++# Wireless ++# ++# CONFIG_CFG80211 is not set ++CONFIG_WIRELESS_EXT=y ++# CONFIG_MAC80211 is not set ++# CONFIG_IEEE80211 is not set ++# CONFIG_RFKILL is not set ++# CONFIG_NET_9P is not set ++ ++# ++# Device Drivers ++# ++ ++# ++# Generic Driver Options ++# ++CONFIG_UEVENT_HELPER_PATH="/sbin/hotplug" ++CONFIG_STANDALONE=y ++CONFIG_PREVENT_FIRMWARE_BUILD=y ++CONFIG_FW_LOADER=y ++# CONFIG_SYS_HYPERVISOR is not set ++# CONFIG_CONNECTOR is not set ++# CONFIG_MTD is not set ++# CONFIG_PARPORT is not set ++CONFIG_BLK_DEV=y ++# CONFIG_BLK_DEV_COW_COMMON is not set ++CONFIG_BLK_DEV_LOOP=y ++# CONFIG_BLK_DEV_CRYPTOLOOP is not set ++# CONFIG_BLK_DEV_NBD is not set ++# CONFIG_BLK_DEV_UB is not set ++CONFIG_BLK_DEV_RAM=y ++CONFIG_BLK_DEV_RAM_COUNT=16 ++CONFIG_BLK_DEV_RAM_SIZE=10240 ++CONFIG_BLK_DEV_RAM_BLOCKSIZE=1024 ++# CONFIG_CDROM_PKTCDVD is not set ++# CONFIG_ATA_OVER_ETH is not set ++# CONFIG_MISC_DEVICES is not set ++# CONFIG_IDE is not set ++ ++# ++# SCSI device support ++# ++# CONFIG_RAID_ATTRS is not set ++CONFIG_SCSI=y ++CONFIG_SCSI_DMA=y ++# CONFIG_SCSI_TGT is not set ++# CONFIG_SCSI_NETLINK is not set ++CONFIG_SCSI_PROC_FS=y ++ ++# ++# SCSI support type (disk, tape, CD-ROM) ++# ++CONFIG_BLK_DEV_SD=y ++# CONFIG_CHR_DEV_ST is not set ++# CONFIG_CHR_DEV_OSST is not set ++# CONFIG_BLK_DEV_SR is not set ++# CONFIG_CHR_DEV_SG is not set ++# CONFIG_CHR_DEV_SCH is not set ++ ++# ++# Some SCSI devices (e.g. CD jukebox) support multiple LUNs ++# ++CONFIG_SCSI_MULTI_LUN=y ++# CONFIG_SCSI_CONSTANTS is not set ++# CONFIG_SCSI_LOGGING is not set ++# CONFIG_SCSI_SCAN_ASYNC is not set ++CONFIG_SCSI_WAIT_SCAN=m ++ ++# ++# SCSI Transports ++# ++# CONFIG_SCSI_SPI_ATTRS is not set ++# CONFIG_SCSI_FC_ATTRS is not set ++# CONFIG_SCSI_ISCSI_ATTRS is not set ++# CONFIG_SCSI_SAS_LIBSAS is not set ++# CONFIG_SCSI_SRP_ATTRS is not set ++CONFIG_SCSI_LOWLEVEL=y ++# CONFIG_ISCSI_TCP is not set ++# CONFIG_SCSI_DEBUG is not set ++CONFIG_ATA=y ++# CONFIG_ATA_NONSTANDARD is not set ++CONFIG_SATA_OX810=y ++# CONFIG_SATA_HIPOX_SINGLE_SATA is not set ++# CONFIG_SATA_HIPOX_DISK_LIGHT is not set ++CONFIG_MD=y ++CONFIG_BLK_DEV_MD=y ++CONFIG_MD_LINEAR=y ++CONFIG_MD_RAID0=y ++CONFIG_MD_RAID1=y ++# CONFIG_MD_RAID10 is not set ++# CONFIG_MD_RAID456 is not set ++# CONFIG_MD_MULTIPATH is not set ++# CONFIG_MD_FAULTY is not set ++CONFIG_BLK_DEV_DM=y ++# CONFIG_DM_DEBUG is not set ++CONFIG_DM_CRYPT=y ++# CONFIG_DM_SNAPSHOT is not set ++# CONFIG_DM_MIRROR is not set ++# CONFIG_DM_ZERO is not set ++# CONFIG_DM_MULTIPATH is not set ++# CONFIG_DM_DELAY is not set ++# CONFIG_DM_UEVENT is not set ++CONFIG_NETDEVICES=y ++# CONFIG_NETDEVICES_MULTIQUEUE is not set ++# CONFIG_DUMMY is not set ++# CONFIG_BONDING is not set ++# CONFIG_MACVLAN is not set ++# CONFIG_EQUALIZER is not set ++# CONFIG_TUN is not set ++# CONFIG_VETH is not set ++# CONFIG_NET_ETHERNET is not set ++CONFIG_MII=y ++CONFIG_NETDEV_1000=y ++CONFIG_SYNOPSYS_GMAC=y ++# CONFIG_NETDEV_10000 is not set ++ ++# ++# Wireless LAN ++# ++# CONFIG_WLAN_PRE80211 is not set ++# CONFIG_WLAN_80211 is not set ++ ++# ++# USB Network Adapters ++# ++# CONFIG_USB_CATC is not set ++# CONFIG_USB_KAWETH is not set ++# CONFIG_USB_PEGASUS is not set ++# CONFIG_USB_RTL8150 is not set ++# CONFIG_USB_USBNET is not set ++# CONFIG_WAN is not set ++# CONFIG_PPP is not set ++# CONFIG_SLIP is not set ++# CONFIG_SHAPER is not set ++# CONFIG_NETCONSOLE is not set ++# CONFIG_NETPOLL is not set ++# CONFIG_NET_POLL_CONTROLLER is not set ++# CONFIG_ISDN is not set ++ ++# ++# Input device support ++# ++CONFIG_INPUT=y ++# CONFIG_INPUT_FF_MEMLESS is not set ++# CONFIG_INPUT_POLLDEV is not set ++ ++# ++# Userland interfaces ++# ++CONFIG_INPUT_MOUSEDEV=y ++# CONFIG_INPUT_MOUSEDEV_PSAUX is not set ++CONFIG_INPUT_MOUSEDEV_SCREEN_X=1024 ++CONFIG_INPUT_MOUSEDEV_SCREEN_Y=768 ++# CONFIG_INPUT_JOYDEV is not set ++# CONFIG_INPUT_EVDEV is not set ++# CONFIG_INPUT_EVBUG is not set ++ ++# ++# Input Device Drivers ++# ++# CONFIG_INPUT_KEYBOARD is not set ++# CONFIG_INPUT_MOUSE is not set ++# CONFIG_INPUT_JOYSTICK is not set ++# CONFIG_INPUT_TABLET is not set ++# CONFIG_INPUT_TOUCHSCREEN is not set ++# CONFIG_INPUT_MISC is not set ++ ++# ++# Hardware I/O ports ++# ++# CONFIG_SERIO is not set ++# CONFIG_GAMEPORT is not set ++ ++# ++# Character devices ++# ++CONFIG_VT=y ++CONFIG_VT_CONSOLE=y ++CONFIG_HW_CONSOLE=y ++# CONFIG_VT_HW_CONSOLE_BINDING is not set ++# CONFIG_SERIAL_NONSTANDARD is not set ++ ++# ++# Serial drivers ++# ++CONFIG_SERIAL_8250=y ++CONFIG_SERIAL_8250_CONSOLE=y ++CONFIG_SERIAL_8250_NR_UARTS=4 ++CONFIG_SERIAL_8250_RUNTIME_UARTS=4 ++# CONFIG_SERIAL_8250_EXTENDED is not set ++ ++# ++# Non-8250 serial port support ++# ++# CONFIG_SERIAL_AMBA_PL010 is not set ++# CONFIG_SERIAL_AMBA_PL011 is not set ++CONFIG_SERIAL_CORE=y ++CONFIG_SERIAL_CORE_CONSOLE=y ++CONFIG_UNIX98_PTYS=y ++CONFIG_LEGACY_PTYS=y ++CONFIG_LEGACY_PTY_COUNT=256 ++# CONFIG_IPMI_HANDLER is not set ++CONFIG_HW_RANDOM=m ++# CONFIG_NVRAM is not set ++# CONFIG_R3964 is not set ++# CONFIG_RAW_DRIVER is not set ++# CONFIG_TCG_TPM is not set ++CONFIG_I2C=m ++CONFIG_I2C_BOARDINFO=y ++# CONFIG_I2C_CHARDEV is not set ++ ++# ++# I2C Algorithms ++# ++CONFIG_I2C_ALGOBIT=m ++# CONFIG_I2C_ALGOPCF is not set ++# CONFIG_I2C_ALGOPCA is not set ++# CONFIG_I2C_ALGOOXSEMI is not set ++ ++# ++# I2C Hardware Bus support ++# ++CONFIG_I2C_HIPOX_BITBASH=m ++# CONFIG_I2C_OCORES is not set ++# CONFIG_I2C_PARPORT_LIGHT is not set ++# CONFIG_I2C_SIMTEC is not set ++# CONFIG_I2C_TAOS_EVM is not set ++# CONFIG_I2C_STUB is not set ++# CONFIG_I2C_TINY_USB is not set ++ ++# ++# Miscellaneous I2C Chip support ++# ++# CONFIG_SENSORS_DS1337 is not set ++# CONFIG_SENSORS_DS1374 is not set ++# CONFIG_DS1682 is not set ++# CONFIG_SENSORS_EEPROM is not set ++# CONFIG_SENSORS_PCF8574 is not set ++# CONFIG_SENSORS_PCA9539 is not set ++# CONFIG_SENSORS_PCF8591 is not set ++# CONFIG_SENSORS_MAX6875 is not set ++# CONFIG_SENSORS_TSL2550 is not set ++# CONFIG_I2C_DEBUG_CORE is not set ++# CONFIG_I2C_DEBUG_ALGO is not set ++# CONFIG_I2C_DEBUG_BUS is not set ++# CONFIG_I2C_DEBUG_CHIP is not set ++ ++# ++# SPI support ++# ++# CONFIG_SPI is not set ++# CONFIG_SPI_MASTER is not set ++# CONFIG_W1 is not set ++# CONFIG_POWER_SUPPLY is not set ++# CONFIG_HWMON is not set ++# CONFIG_WATCHDOG is not set ++ ++# ++# Sonics Silicon Backplane ++# ++CONFIG_SSB_POSSIBLE=y ++# CONFIG_SSB is not set ++ ++# ++# Multifunction device drivers ++# ++# CONFIG_MFD_SM501 is not set ++ ++# ++# Multimedia devices ++# ++# CONFIG_VIDEO_DEV is not set ++# CONFIG_DVB_CORE is not set ++CONFIG_DAB=y ++# CONFIG_USB_DABUSB is not set ++ ++# ++# Graphics support ++# ++# CONFIG_VGASTATE is not set ++CONFIG_VIDEO_OUTPUT_CONTROL=m ++# CONFIG_FB is not set ++# CONFIG_BACKLIGHT_LCD_SUPPORT is not set ++ ++# ++# Display device support ++# ++# CONFIG_DISPLAY_SUPPORT is not set ++ ++# ++# Console display driver support ++# ++# CONFIG_VGA_CONSOLE is not set ++CONFIG_DUMMY_CONSOLE=y ++ ++# ++# Sound ++# ++# CONFIG_SOUND is not set ++# CONFIG_HID_SUPPORT is not set ++CONFIG_USB_SUPPORT=y ++CONFIG_USB_ARCH_HAS_HCD=y ++CONFIG_USB_ARCH_HAS_OHCI=y ++CONFIG_USB_ARCH_HAS_EHCI=y ++CONFIG_USB=m ++# CONFIG_USB_DEBUG is not set ++ ++# ++# Miscellaneous USB options ++# ++CONFIG_USB_DEVICEFS=y ++CONFIG_USB_DEVICE_CLASS=y ++# CONFIG_USB_DYNAMIC_MINORS is not set ++# CONFIG_USB_OTG is not set ++ ++# ++# USB Host Controller Drivers ++# ++CONFIG_USB_EHCI_HCD=m ++# CONFIG_USB_EHCI_SPLIT_ISO is not set ++CONFIG_USB_EHCI_ROOT_HUB_TT=y ++# CONFIG_USB_EHCI_TT_NEWSCHED is not set ++# CONFIG_USB_ISP116X_HCD is not set ++# CONFIG_USB_OHCI_HCD is not set ++# CONFIG_USB_SL811_HCD is not set ++# CONFIG_USB_R8A66597_HCD is not set ++ ++# ++# USB Device Class drivers ++# ++# CONFIG_USB_ACM is not set ++# CONFIG_USB_PRINTER is not set ++ ++# ++# NOTE: USB_STORAGE enables SCSI, and 'SCSI disk support' ++# ++ ++# ++# may also be needed; see USB_STORAGE Help for more information ++# ++CONFIG_USB_STORAGE=m ++# CONFIG_USB_STORAGE_DEBUG is not set ++# CONFIG_USB_STORAGE_DATAFAB is not set ++# CONFIG_USB_STORAGE_FREECOM is not set ++# CONFIG_USB_STORAGE_ISD200 is not set ++# CONFIG_USB_STORAGE_DPCM is not set ++# CONFIG_USB_STORAGE_USBAT is not set ++# CONFIG_USB_STORAGE_SDDR09 is not set ++# CONFIG_USB_STORAGE_SDDR55 is not set ++# CONFIG_USB_STORAGE_JUMPSHOT is not set ++# CONFIG_USB_STORAGE_ALAUDA is not set ++# CONFIG_USB_STORAGE_KARMA is not set ++# CONFIG_USB_LIBUSUAL is not set ++ ++# ++# USB Imaging devices ++# ++# CONFIG_USB_MDC800 is not set ++# CONFIG_USB_MICROTEK is not set ++# CONFIG_USB_MON is not set ++ ++# ++# USB port drivers ++# ++ ++# ++# USB Serial Converter support ++# ++# CONFIG_USB_SERIAL is not set ++ ++# ++# USB Miscellaneous drivers ++# ++# CONFIG_USB_EMI62 is not set ++# CONFIG_USB_EMI26 is not set ++# CONFIG_USB_ADUTUX is not set ++# CONFIG_USB_AUERSWALD is not set ++# CONFIG_USB_RIO500 is not set ++# CONFIG_USB_LEGOTOWER is not set ++# CONFIG_USB_LCD is not set ++# CONFIG_USB_BERRY_CHARGE is not set ++# CONFIG_USB_LED is not set ++# CONFIG_USB_CYPRESS_CY7C63 is not set ++# CONFIG_USB_CYTHERM is not set ++# CONFIG_USB_PHIDGET is not set ++# CONFIG_USB_IDMOUSE is not set ++# CONFIG_USB_FTDI_ELAN is not set ++# CONFIG_USB_APPLEDISPLAY is not set ++# CONFIG_USB_SISUSBVGA is not set ++# CONFIG_USB_LD is not set ++# CONFIG_USB_TRANCEVIBRATOR is not set ++# CONFIG_USB_IOWARRIOR is not set ++CONFIG_USB_TEST=m ++ ++# ++# USB DSL modem support ++# ++ ++# ++# USB Gadget Support ++# ++# CONFIG_USB_GADGET is not set ++# CONFIG_MMC is not set ++CONFIG_NEW_LEDS=y ++CONFIG_LEDS_CLASS=y ++ ++# ++# LED drivers ++# ++# CONFIG_WDC_LEDS_HIPOX800 is not set ++CONFIG_HIPOX_WD810_LEDS=m ++ ++# ++# LED Triggers ++# ++CONFIG_LEDS_TRIGGERS=y ++# CONFIG_LEDS_TRIGGER_TIMER is not set ++CONFIG_WDC_LEDS_TRIGGER_SATA_DISK=y ++# CONFIG_LEDS_TRIGGER_HEARTBEAT is not set ++CONFIG_RTC_LIB=y ++CONFIG_RTC_CLASS=m ++ ++# ++# RTC interfaces ++# ++CONFIG_RTC_INTF_SYSFS=y ++CONFIG_RTC_INTF_PROC=y ++CONFIG_RTC_INTF_DEV=y ++# CONFIG_RTC_INTF_DEV_UIE_EMUL is not set ++# CONFIG_RTC_DRV_TEST is not set ++ ++# ++# I2C RTC drivers ++# ++CONFIG_RTC_DRV_DS1307=m ++# CONFIG_RTC_DRV_DS1374 is not set ++# CONFIG_RTC_DRV_DS1672 is not set ++# CONFIG_RTC_DRV_MAX6900 is not set ++# CONFIG_RTC_DRV_RS5C372 is not set ++# CONFIG_RTC_DRV_ISL1208 is not set ++# CONFIG_RTC_DRV_X1205 is not set ++# CONFIG_RTC_DRV_PCF8563 is not set ++# CONFIG_RTC_DRV_PCF8583 is not set ++# CONFIG_RTC_DRV_M41T80 is not set ++ ++# ++# SPI RTC drivers ++# ++ ++# ++# Platform RTC drivers ++# ++# CONFIG_RTC_DRV_CMOS is not set ++# CONFIG_RTC_DRV_DS1553 is not set ++# CONFIG_RTC_DRV_STK17TA8 is not set ++# CONFIG_RTC_DRV_DS1742 is not set ++# CONFIG_RTC_DRV_M48T86 is not set ++# CONFIG_RTC_DRV_M48T59 is not set ++# CONFIG_RTC_DRV_V3020 is not set ++ ++# ++# on-CPU RTC drivers ++# ++# CONFIG_RTC_DRV_PL031 is not set ++# CONFIG_DMADEVICES is not set ++ ++# ++# File systems ++# ++CONFIG_EXT2_FS=y ++# CONFIG_EXT2_FS_XATTR is not set ++# CONFIG_EXT2_FS_XIP is not set ++CONFIG_EXT3_FS=y ++# CONFIG_EXT3_FS_XATTR is not set ++# CONFIG_EXT4DEV_FS is not set ++CONFIG_JBD=y ++# CONFIG_REISERFS_FS is not set ++# CONFIG_JFS_FS is not set ++CONFIG_FS_POSIX_ACL=y ++CONFIG_XFS_FS=y ++CONFIG_XFS_QUOTA=y ++# CONFIG_XFS_SECURITY is not set ++# CONFIG_XFS_POSIX_ACL is not set ++# CONFIG_XFS_RT is not set ++# CONFIG_GFS2_FS is not set ++# CONFIG_OCFS2_FS is not set ++# CONFIG_MINIX_FS is not set ++# CONFIG_ROMFS_FS is not set ++CONFIG_INOTIFY=y ++CONFIG_INOTIFY_USER=y ++# CONFIG_QUOTA is not set ++CONFIG_QUOTACTL=y ++CONFIG_DNOTIFY=y ++# CONFIG_AUTOFS_FS is not set ++# CONFIG_AUTOFS4_FS is not set ++CONFIG_FUSE_FS=y ++ ++# ++# CD-ROM/DVD Filesystems ++# ++# CONFIG_ISO9660_FS is not set ++# CONFIG_UDF_FS is not set ++ ++# ++# DOS/FAT/NT Filesystems ++# ++CONFIG_FAT_FS=y ++CONFIG_MSDOS_FS=y ++CONFIG_VFAT_FS=m ++CONFIG_FAT_DEFAULT_CODEPAGE=437 ++CONFIG_FAT_DEFAULT_IOCHARSET="iso8859-1" ++CONFIG_NTFS_FS=m ++# CONFIG_NTFS_DEBUG is not set ++# CONFIG_NTFS_RW is not set ++ ++# ++# Pseudo filesystems ++# ++CONFIG_PROC_FS=y ++CONFIG_PROC_SYSCTL=y ++CONFIG_SYSFS=y ++# CONFIG_TMPFS is not set ++# CONFIG_HUGETLB_PAGE is not set ++# CONFIG_CONFIGFS_FS is not set ++ ++# ++# Miscellaneous filesystems ++# ++# CONFIG_ADFS_FS is not set ++# CONFIG_AFFS_FS is not set ++# CONFIG_HFS_FS is not set ++CONFIG_HFSPLUS_FS=m ++# CONFIG_BEFS_FS is not set ++# CONFIG_BFS_FS is not set ++# CONFIG_EFS_FS is not set ++# CONFIG_CRAMFS is not set ++# CONFIG_VXFS_FS is not set ++# CONFIG_HPFS_FS is not set ++# CONFIG_QNX4FS_FS is not set ++# CONFIG_SYSV_FS is not set ++# CONFIG_UFS_FS is not set ++CONFIG_NETWORK_FILESYSTEMS=y ++# CONFIG_NFS_FS is not set ++CONFIG_NFSD=m ++CONFIG_NFSD_V2_ACL=y ++CONFIG_NFSD_V3=y ++CONFIG_NFSD_V3_ACL=y ++# CONFIG_NFSD_V4 is not set ++CONFIG_NFSD_TCP=y ++CONFIG_LOCKD=m ++CONFIG_LOCKD_V4=y ++CONFIG_EXPORTFS=m ++CONFIG_NFS_ACL_SUPPORT=m ++CONFIG_NFS_COMMON=y ++CONFIG_SUNRPC=m ++# CONFIG_SUNRPC_BIND34 is not set ++# CONFIG_RPCSEC_GSS_KRB5 is not set ++# CONFIG_RPCSEC_GSS_SPKM3 is not set ++# CONFIG_SMB_FS is not set ++# CONFIG_CIFS is not set ++# CONFIG_NCP_FS is not set ++# CONFIG_CODA_FS is not set ++# CONFIG_AFS_FS is not set ++ ++# ++# Partition Types ++# ++CONFIG_PARTITION_ADVANCED=y ++# CONFIG_ACORN_PARTITION is not set ++# CONFIG_OSF_PARTITION is not set ++# CONFIG_AMIGA_PARTITION is not set ++# CONFIG_ATARI_PARTITION is not set ++CONFIG_MAC_PARTITION=y ++CONFIG_MSDOS_PARTITION=y ++# CONFIG_BSD_DISKLABEL is not set ++# CONFIG_MINIX_SUBPARTITION is not set ++# CONFIG_SOLARIS_X86_PARTITION is not set ++# CONFIG_UNIXWARE_DISKLABEL is not set ++CONFIG_LDM_PARTITION=y ++# CONFIG_LDM_DEBUG is not set ++# CONFIG_SGI_PARTITION is not set ++# CONFIG_ULTRIX_PARTITION is not set ++# CONFIG_SUN_PARTITION is not set ++# CONFIG_KARMA_PARTITION is not set ++CONFIG_EFI_PARTITION=y ++# CONFIG_SYSV68_PARTITION is not set ++CONFIG_NLS=y ++CONFIG_NLS_DEFAULT="iso8859-1" ++CONFIG_NLS_CODEPAGE_437=m ++# CONFIG_NLS_CODEPAGE_737 is not set ++# CONFIG_NLS_CODEPAGE_775 is not set ++# CONFIG_NLS_CODEPAGE_850 is not set ++# CONFIG_NLS_CODEPAGE_852 is not set ++# CONFIG_NLS_CODEPAGE_855 is not set ++# CONFIG_NLS_CODEPAGE_857 is not set ++# CONFIG_NLS_CODEPAGE_860 is not set ++# CONFIG_NLS_CODEPAGE_861 is not set ++# CONFIG_NLS_CODEPAGE_862 is not set ++# CONFIG_NLS_CODEPAGE_863 is not set ++# CONFIG_NLS_CODEPAGE_864 is not set ++# CONFIG_NLS_CODEPAGE_865 is not set ++# CONFIG_NLS_CODEPAGE_866 is not set ++# CONFIG_NLS_CODEPAGE_869 is not set ++# CONFIG_NLS_CODEPAGE_936 is not set ++# CONFIG_NLS_CODEPAGE_950 is not set ++# CONFIG_NLS_CODEPAGE_932 is not set ++# CONFIG_NLS_CODEPAGE_949 is not set ++# CONFIG_NLS_CODEPAGE_874 is not set ++# CONFIG_NLS_ISO8859_8 is not set ++# CONFIG_NLS_CODEPAGE_1250 is not set ++# CONFIG_NLS_CODEPAGE_1251 is not set ++# CONFIG_NLS_ASCII is not set ++CONFIG_NLS_ISO8859_1=m ++# CONFIG_NLS_ISO8859_2 is not set ++# CONFIG_NLS_ISO8859_3 is not set ++# CONFIG_NLS_ISO8859_4 is not set ++# CONFIG_NLS_ISO8859_5 is not set ++# CONFIG_NLS_ISO8859_6 is not set ++# CONFIG_NLS_ISO8859_7 is not set ++# CONFIG_NLS_ISO8859_9 is not set ++# CONFIG_NLS_ISO8859_13 is not set ++# CONFIG_NLS_ISO8859_14 is not set ++# CONFIG_NLS_ISO8859_15 is not set ++# CONFIG_NLS_KOI8_R is not set ++# CONFIG_NLS_KOI8_U is not set ++CONFIG_NLS_UTF8=y ++# CONFIG_DLM is not set ++# CONFIG_INSTRUMENTATION is not set ++ ++# ++# Kernel hacking ++# ++# CONFIG_PRINTK_TIME is not set ++CONFIG_ENABLE_WARN_DEPRECATED=y ++CONFIG_ENABLE_MUST_CHECK=y ++# CONFIG_MAGIC_SYSRQ is not set ++# CONFIG_UNUSED_SYMBOLS is not set ++# CONFIG_DEBUG_FS is not set ++# CONFIG_HEADERS_CHECK is not set ++# CONFIG_DEBUG_KERNEL is not set ++CONFIG_DEBUG_BUGVERBOSE=y ++CONFIG_FRAME_POINTER=y ++# CONFIG_SAMPLES is not set ++# CONFIG_DEBUG_USER is not set ++ ++# ++# Security options ++# ++# CONFIG_KEYS is not set ++CONFIG_SECURITY=y ++# CONFIG_SECURITY_NETWORK is not set ++# CONFIG_SECURITY_CAPABILITIES is not set ++CONFIG_SECURITY_TRUSTEES=y ++# CONFIG_SECURITY_TRUSTEES_DEBUG is not set ++CONFIG_CRYPTO=y ++CONFIG_CRYPTO_ALGAPI=y ++CONFIG_CRYPTO_BLKCIPHER=y ++CONFIG_CRYPTO_MANAGER=y ++# CONFIG_CRYPTO_HMAC is not set ++# CONFIG_CRYPTO_XCBC is not set ++# CONFIG_CRYPTO_NULL is not set ++# CONFIG_CRYPTO_MD4 is not set ++# CONFIG_CRYPTO_MD5 is not set ++# CONFIG_CRYPTO_SHA1 is not set ++# CONFIG_CRYPTO_SHA256 is not set ++# CONFIG_CRYPTO_SHA512 is not set ++# CONFIG_CRYPTO_WP512 is not set ++# CONFIG_CRYPTO_TGR192 is not set ++# CONFIG_CRYPTO_GF128MUL is not set ++CONFIG_CRYPTO_ECB=m ++CONFIG_CRYPTO_CBC=y ++CONFIG_CRYPTO_PCBC=m ++# CONFIG_CRYPTO_LRW is not set ++# CONFIG_CRYPTO_XTS is not set ++# CONFIG_CRYPTO_CRYPTD is not set ++# CONFIG_CRYPTO_DES is not set ++# CONFIG_CRYPTO_FCRYPT is not set ++# CONFIG_CRYPTO_BLOWFISH is not set ++# CONFIG_CRYPTO_TWOFISH is not set ++# CONFIG_CRYPTO_SERPENT is not set ++CONFIG_CRYPTO_AES=m ++# CONFIG_CRYPTO_CAST5 is not set ++# CONFIG_CRYPTO_CAST6 is not set ++# CONFIG_CRYPTO_TEA is not set ++CONFIG_CRYPTO_ARC4=m ++# CONFIG_CRYPTO_KHAZAD is not set ++# CONFIG_CRYPTO_ANUBIS is not set ++# CONFIG_CRYPTO_SEED is not set ++# CONFIG_CRYPTO_DEFLATE is not set ++CONFIG_CRYPTO_MICHAEL_MIC=m ++# CONFIG_CRYPTO_CRC32C is not set ++# CONFIG_CRYPTO_CAMELLIA is not set ++# CONFIG_CRYPTO_TEST is not set ++# CONFIG_CRYPTO_AUTHENC is not set ++CONFIG_CRYPTO_HW=y ++ ++# ++# Library routines ++# ++CONFIG_BITREVERSE=y ++CONFIG_CRC_CCITT=y ++# CONFIG_CRC16 is not set ++# CONFIG_CRC_ITU_T is not set ++CONFIG_CRC32=y ++# CONFIG_CRC7 is not set ++# CONFIG_LIBCRC32C is not set ++CONFIG_PLIST=y ++CONFIG_HAS_IOMEM=y ++CONFIG_HAS_IOPORT=y ++CONFIG_HAS_DMA=y +diff -Nurd linux-2.6.24/arch/arm/kernel/armksyms.c linux-2.6.24-oxe810/arch/arm/kernel/armksyms.c +--- linux-2.6.24/arch/arm/kernel/armksyms.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/armksyms.c 2008-06-11 17:47:43.000000000 +0200 +@@ -114,9 +114,15 @@ + EXPORT_SYMBOL(__strncpy_from_user); + + #ifdef CONFIG_MMU ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++EXPORT_SYMBOL(__copy_from_user_alt); ++EXPORT_SYMBOL(__copy_to_user_alt); ++EXPORT_SYMBOL(__clear_user_alt); ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + EXPORT_SYMBOL(__copy_from_user); + EXPORT_SYMBOL(__copy_to_user); + EXPORT_SYMBOL(__clear_user); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + + EXPORT_SYMBOL(__get_user_1); + EXPORT_SYMBOL(__get_user_2); +diff -Nurd linux-2.6.24/arch/arm/kernel/bios32.c linux-2.6.24-oxe810/arch/arm/kernel/bios32.c +--- linux-2.6.24/arch/arm/kernel/bios32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/bios32.c 2008-06-11 17:47:43.000000000 +0200 +@@ -616,7 +616,7 @@ + } + } + +-char * __init pcibios_setup(char *str) ++char * __devinit pcibios_setup(char *str) + { + if (!strcmp(str, "debug")) { + debug_pci = 1; +diff -Nurd linux-2.6.24/arch/arm/kernel/calls.S linux-2.6.24-oxe810/arch/arm/kernel/calls.S +--- linux-2.6.24/arch/arm/kernel/calls.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/calls.S 2008-06-11 17:47:43.000000000 +0200 +@@ -362,6 +362,7 @@ + /* 350 */ CALL(sys_timerfd) + CALL(sys_eventfd) + CALL(sys_fallocate) ++ CALL(sys_samba_reserve) + #ifndef syscalls_counted + .equ syscalls_padding, ((NR_syscalls + 3) & ~3) - NR_syscalls + #define syscalls_counted +diff -Nurd linux-2.6.24/arch/arm/kernel/head.S linux-2.6.24-oxe810/arch/arm/kernel/head.S +--- linux-2.6.24/arch/arm/kernel/head.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/head.S 2008-06-11 17:47:43.000000000 +0200 +@@ -59,6 +59,34 @@ + #define KERNEL_END _end + #endif + ++#ifdef CONFIG_HIPOX_MAP_SRAM ++ .macro course_pgtbl, rd ++ ldr \rd, =(__virt_to_phys(KERNEL_RAM_ADDR - 0x4400)) ++ .endm ++ ++ .globl SMALL_AP ++ .equ SMALL_AP, 0xAA ++ ++ .globl COURSE_DOMAIN ++ .equ COURSE_DOMAIN, 0x04 ++ ++ .globl SRAM_CODE_START ++ .globl CODE_COPY_LEN ++ ++#ifdef CONFIG_SUPPORT_LEON ++ /* ++ * Allow 2 pages after GMAC/DMA descriptors for ARM/Leon TSO workspace ++ * May have to change if Leon code is built to use more Tx descriptors, but ++ * current 2 pages is easily enough for 54 descriptors ++ */ ++ .equ SRAM_CODE_START, SRAM_PA+((CONFIG_DESCRIPTORS_PAGES+2)*4096) ++ .equ CODE_COPY_LEN, ((CONFIG_SRAM_NUM_PAGES-CONFIG_LEON_PAGES-(CONFIG_DESCRIPTORS_PAGES+2))*4096) ++#else // CONFIG_SUPPORT_LEON ++ .equ SRAM_CODE_START, SRAM_PA+(CONFIG_DESCRIPTORS_PAGES*4096) ++ .equ CODE_COPY_LEN, ((CONFIG_SRAM_NUM_PAGES-CONFIG_DESCRIPTORS_PAGES)*4096) ++#endif // CONFIG_SUPPORT_LEON ++#endif // CONFIG_HIPOX_MAP_SRAM ++ + /* + * Kernel startup entry point. + * --------------------------- +@@ -82,6 +110,27 @@ + ENTRY(stext) + msr cpsr_c, #PSR_F_BIT | PSR_I_BIT | SVC_MODE @ ensure svc mode + @ and irqs disabled ++ ++#ifdef CONFIG_HIPOX_CACHE_LOCKDOWN ++ /* ++ * Lock down ICache - do not care what ends up in locked down ways - ++ * eventually context switch etc will flush out anything that gets loaded ++ * next ++ */ ++ mrc p15,0,r2,c9,c0,1 ++ orr r2,r2,#CONFIG_HIPOX_CACHE_I_MASK ++ mcr p15,0,r2,c9,c0,1 ++ ++ /* ++ * Lock down DCache - do not care what ends up in locked down ways - ++ * eventually context switch etc will flush out anything that gets loaded ++ * next ++ */ ++ mrc p15,0,r2,c9,c0,0 ++ orr r2,r2,#CONFIG_HIPOX_CACHE_D_MASK ++ mcr p15,0,r2,c9,c0,0 ++#endif // CONFIG_HIPOX_CACHE_LOCKDOWN ++ + mrc p15, 0, r9, c0, c0 @ get processor id + bl __lookup_processor_type @ r5=procinfo r9=cpuid + movs r10, r5 @ invalid processor (r5=0)? +@@ -231,7 +280,33 @@ + teq r0, r6 + bne 1b + +- ldr r7, [r10, #PROCINFO_MM_MMUFLAGS] @ mm_mmuflags ++ ldr r7, [r10, #PROCINFO_MM_MMUFLAGS] @ mmuflags ++ ++#ifdef CONFIG_HIPOX_MAP_SRAM ++ /* ++ * Create the contents of the first descriptor in the course table which ++ * is to describe the first MB of the kernel with 256 4K small descriptors. ++ * The descriptors' are composed of the top 20 bits of the physical ++ * address plus the appropriate AP, cacheable and bufferable flags ++ */ ++ mov r3, #PHYS_OFFSET ++ mov r3, r3, lsr #12 ++ mov r3, r3, lsl #12 ++ mov r6, #SMALL_AP @ TBC: AP values ++ orr r3, r3, r6, lsl #4 ++ orr r3, r3, #0xe @ Cachable, bufferable and small desc ++ ++ /* ++ * Fill all 256 entries in the course page table with descriptors for ++ * contiguous pages ++ */ ++ course_pgtbl r0 ++ add r6, r0, #0x0400 ++1: str r3, [r0], #4 ++ add r3, r3, #1 << 12 ++ teq r0, r6 ++ bne 1b ++#endif // CONFIG_HIPOX_MAP_SRAM + + /* + * Create identity mapping for first MB of kernel to +@@ -243,12 +318,26 @@ + orr r3, r7, r6, lsl #20 @ flags + kernel base + str r3, [r4, r6, lsl #2] @ identity mapping + ++#ifdef CONFIG_HIPOX_MAP_SRAM ++ /* ++ * Write a course descriptor pointing to the small page mapping table ++ * setup to map the first MB of kernel with 4K small pages ++ */ ++ course_pgtbl r6 ++ mov r0, #COURSE_DOMAIN @ TBC SBZ, Domain etc ++ orr r6, r6, r0, lsl #2 ++ orr r6, r6, #1 @ Course descriptor identifier ++ ++ add r0, r4, #(KERNEL_START & 0xff000000) >> 18 ++ str r6, [r0, #(KERNEL_START & 0x00f00000) >> 18]! ++#else // CONFIG_HIPOX_MAP_SRAM + /* + * Now setup the pagetables for our kernel direct + * mapped region. + */ + add r0, r4, #(KERNEL_START & 0xff000000) >> 18 + str r3, [r0, #(KERNEL_START & 0x00f00000) >> 18]! ++#endif // CONFIG_HIPOX_MAP_SRAM + ldr r6, =(KERNEL_END - 1) + add r0, r0, #4 + add r6, r4, r6, lsr #18 +@@ -276,6 +365,64 @@ + bls 1b + #endif + ++#ifdef CONFIG_HIPOX_COPY_CODE_TO_SRAM ++ /* ++ * Copy smallest/most-used kernel code into SRAM ++ */ ++ ++ /* Get start of kernel code to copy */ ++ ldr r0, =(_text) ++ mvn r3, #0xff000000 ++ and r0, r0, r3 ++ mov r6, #PHYS_OFFSET ++ mov r3, #0xff000000 ++ and r6, r6, r3 ++ orr r0, r0, r6 ++ ++ /* Get start of SRAM region to copy into */ ++ ldr r3, =(SRAM_CODE_START) ++ ++ /* Get amount of code to copy */ ++ ldr r6, =(CODE_COPY_LEN) ++ ++ /* NB r7 is corrupted here, but opt. debug code below needs it */ ++ add r6, r0, r6 ++1: ldr r7, [r0], #4 ++ str r7, [r3], #4 ++ teq r0, r6 ++ bne 1b ++ ++ /* ++ * Map SRAM resident code into kernel virtual address space by altering ++ * course page table entries covering the smallest/most-used code ++ */ ++ ++ /* Get the address of the first page table entry to modify */ ++ course_pgtbl r3 ++ ldr r0, =(_text) ++ sub r0, r0, #PAGE_OFFSET ++ add r3, r3, r0, lsr #10 ++ ++ /* Get the address after the last entry in the page table to be altered */ ++ ldr r6, =(CODE_COPY_LEN) ++ add r6, r3, r6, lsr #10 ++ ++ /* Form the first small descriptor contents */ ++ ldr r0, =(SRAM_CODE_START) ++ mov r0, r0, lsr #12 ++ mov r0, r0, lsl #12 ++ mov r7, #SMALL_AP ++ orr r0, r0, r7, lsl #4 ++ orr r0, r0, #0xe ++ ++ /* Modify the page table entries for all SRAM pages filled with code */ ++1: str r0, [r3], #4 ++ add r0, r0, #1 << 12 ++ teq r3, r6 ++ bne 1b ++ ++#else // CONFIG_HIPOX_COPY_CODE_TO_SRAM ++#ifndef CONFIG_ARCH_HIPOX + /* + * Then map first 1MB of ram in case it contains our boot params. + */ +@@ -285,6 +432,8 @@ + orr r6, r6, #(PHYS_OFFSET & 0x00f00000) + .endif + str r6, [r0] ++#endif // !CONFIG_ARCH_HIPOX ++#endif // CONFIG_HIPOX_COPY_CODE_TO_SRAM + + #ifdef CONFIG_DEBUG_LL + ldr r7, [r10, #PROCINFO_IO_MMUFLAGS] @ io_mmuflags +diff -Nurd linux-2.6.24/arch/arm/kernel/process.c linux-2.6.24-oxe810/arch/arm/kernel/process.c +--- linux-2.6.24/arch/arm/kernel/process.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/process.c 2008-06-11 17:47:43.000000000 +0200 +@@ -117,7 +117,7 @@ + void (*pm_idle)(void); + EXPORT_SYMBOL(pm_idle); + +-void (*pm_power_off)(void); ++void (*pm_power_off)(void) = arch_poweroff; + EXPORT_SYMBOL(pm_power_off); + + void (*arm_pm_restart)(char str) = arm_machine_restart; +diff -Nurd linux-2.6.24/arch/arm/kernel/vmlinux.lds.S linux-2.6.24-oxe810/arch/arm/kernel/vmlinux.lds.S +--- linux-2.6.24/arch/arm/kernel/vmlinux.lds.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/kernel/vmlinux.lds.S 2008-06-11 17:47:43.000000000 +0200 +@@ -86,8 +86,659 @@ + #endif + } + +- .text : { /* Real text segment */ +- _text = .; /* Text and read-only data */ ++ .text : { /* Real text segment */ ++ _text = .; /* Text and read-only data */ ++ *(.text.arm926_dma_clean_range) ++ *(.text.arm926_dma_inv_range) ++ *(.text.arm926_dma_flush_range) ++ *(.text.__irq_svc) ++ *(.text.__arch_copy_to_user) ++ *(.text.__arch_copy_from_user) ++ *(.text.__kmalloc) ++ *(.text.HIPOX_unmask_irq) ++ *(.text.local_bh_enable) ++ *(.text.do_level_IRQ) ++ *(.text.__memzero) ++ *(.text.irq_exit) ++ *(.text.__do_irq) ++ *(.text.pfifo_fast_dequeue) ++ *(.text.preempt_return) ++ *(.text.cpu_arm926_switch_mm) ++ *(.text.check_irq_lock) ++ *(.text.tcp_init_tso_segs) ++ *(.text.kfree_skbmem) ++ *(.text.consistent_sync) ++ *(.text.__alloc_skb) ++ *(.text.skb_release_data) ++ *(.text.HIPOX_mask_irq) ++ *(.text.Ldiv0) ++ *(.text.__do_softirq) ++ *(.text.kmem_cache_free) ++ *(.text.__kfree_skb) ++ *(.text.kmem_cache_alloc) ++ *(.text.radix_tree_lookup) ++ *(.text.kfree) ++ *(.text.asm_do_IRQ) ++ *(.text.skb_clone) ++ *(.text.qdisc_restart) ++ *(.text.sock_wfree) ++ *(.text.unlock_page) ++ *(.text.tcp_cwnd_validate) ++ *(.text.free_hot_cold_page) ++ *(.text.memcpy) ++ *(.text.velocity_free_tx_buf) ++ *(.text.wake_up_bit) ++ *(.text.cond_resched) ++ *(.text.pfifo_fast_enqueue) ++ *(.text.raise_softirq_irqoff) ++ *(.text.tcp_push_one) ++ *(.text.__modsi3) ++ *(.text.update_send_head) ++ *(.text.tcp_set_skb_tso_segs) ++ *(.text.tcp_snd_test) ++ *(.text.svc_preempt) ++ *(.text.__tcp_select_window) ++ *(.text.dev_queue_xmit) ++ *(.text.hipox_gettimeoffset) ++ *(.text.__wake_up_bit) ++ *(.text.mod_timer) ++ *(.text.do_simple_IRQ) ++ *(.text.velocity_xmit) ++ *(.text.ip_output) ++ *(.text.net_tx_action) ++ *(.text.ip_queue_xmit) ++ *(.text.tcp_cong_avoid) ++ *(.text.sk_reset_timer) ++ *(.text.velocity_intr) ++ *(.text.pci_dma_sync_single_for_device) ++ *(.text.process_backlog) ++ *(.text.tcp_v4_send_check) ++ *(.text.tcp_transmit_skb) ++ *(.text.file_send_actor) ++ *(.text.tcp_current_mss) ++ *(.text.__netif_rx_schedule) ++ *(.text.__muldi3) ++ *(.text.release_sock) ++ *(.text.do_softirq) ++ *(.text.pfifo_fast_reset) ++ *(.text.netif_rx) ++ *(.text.kernel_sendmsg) ++ *(.text.rt_hash_code) ++ *(.text.mod_page_state_offset) ++ *(.text.preempt_schedule) ++ *(.text.inet_sendmsg) ++ *(.text.page_waitqueue) ++ *(.text.bictcp_acked) ++ *(.text.__sk_dst_check) ++ *(.text.blk_rq_map_sg) ++ *(.text.tcp_mtu_to_mss) ++ *(.text.__delay) ++ *(.text.sock_sendmsg) ++ *(.text.sock_sendpage) ++ *(.text.ip_local_deliver) ++ *(.text.bio_add_page) ++ *(.text.tcp_sendmsg) ++ *(.text.sock_no_sendpage) ++ *(.text.__remove_from_page_cache) ++ *(.text.net_rx_action) ++ *(.text.eth_type_trans) ++ *(.text.find_get_page) ++ *(.text.netif_receive_skb) ++ *(.text.verify_chain) ++ *(.text.radix_tree_delete) ++ *(.text.mpage_readpages) ++ *(.text.velocity_rx_refill) ++ *(.text.mpage_end_io_read) ++ *(.text.radix_tree_insert) ++ *(.text.ip_rcv) ++ *(.text.register_gifconf) ++ *(.text.dma_mmap) ++ *(.text.tcp_rtt_estimator) ++ *(.text.ox800sata_get_bbp_base) ++ *(.text.mark_page_accessed) ++ *(.text.update_process_times) ++ *(.text.__pagevec_free) ++ *(.text.read_page_state_offset) ++ *(.text.__bio_add_page) ++ *(.text.__pagevec_lru_add) ++ *(.text.ox800sata_scr_read) ++ *(.text.bio_add_pc_page) ++ *(.text.__rcu_pending) ++ *(.text.free_sg_entry) ++ *(.text.put_page) ++ *(.text.lock_timer_base) ++ *(.text.radix_tree_tagged) ++ *(.text.__lshrdi3) ++ *(.text.lock_sock) ++ *(.text.__udivsi3) ++ *(.text.zone_watermark_ok) ++ *(.text.klist_children_put) ++ *(.text.sock_aio_dtor) ++ *(.text.ata_qc_prep) ++ *(.text.hipox_dma_free) ++ *(.text.rcu_pending) ++ *(.text.free_cold_page) ++ *(.text.get_page_from_freelist) ++ *(.text.alloc_sg_entry) ++ *(.text.ret_fast_syscall) ++ *(.text.add_to_page_cache) ++ *(.text.__mod_timer) ++ *(.text.velocity_free_td_ring) ++ *(.text.__do_div64) ++ *(.text.remove_mapping) ++ *(.text.fast_work_pending) ++ *(.text.cond_resched_softirq) ++ *(.text.tcp_v4_rcv) ++ *(.text.kernel_recvmsg) ++ *(.text.isolate_lru_pages) ++ *(.text.klist_children_get) ++ *(.text.sys_getpid) ++ *(.text.mempool_free_slab) ++ *(.text.kobject_get) ++ *(.text.__tcp_push_pending_frames) ++ *(.text.sk_stop_timer) ++ *(.text.bictcp_state) ++ *(.text.tcp_check_space) ++ *(.text.kmem_cache_zalloc) ++ *(.text.get_device) ++ *(.text.work_pending) ++ *(.text.tcp_ack) ++ *(.text.do_edge_IRQ) ++ *(.text.page_referenced) ++ *(.text.profile_tick) ++ *(.text.ox800sata_get_link_base) ++ *(.text.__pagevec_release_nonlru) ++ *(.text.blk_recount_segments) ++ *(.text.__mod_page_state_offset) ++ *(.text.linear_mergeable_bvec) ++ *(.text.recalc_task_prio) ++ *(.text.mempool_kmalloc) ++ *(.text.do_mpage_readpage) ++ *(.text.ksoftirqd) ++ *(.text.__generic_unplug_device) ++ *(.text.rt_cpu_seq_start) ++ *(.text.bio_alloc) ++ *(.text.tasklet_action) ++ *(.text.effective_prio) ++ *(.text.HIPOX_timer_interrupt) ++ *(.text.__wake_up_common) ++ *(.text.free_poll_entry) ++ *(.text.vector_swi) ++ *(.text.do_sock_read) ++ *(.text.alloc_sg_controller) ++ *(.text.tcp_rcv_established) ++ *(.text.hipox_dma_set_callback) ++ *(.text.run_local_timers) ++ *(.text.sock_rmalloc) ++ *(.text.__rmqueue) ++ *(.text.ox800sata_bmdma_start) ++ *(.text.fget_light) ++ *(.text.queue_work) ++ *(.text.mempool_alloc_slab) ++ *(.text.__wake_up) ++ *(.text.default_idle) ++ *(.text.fput) ++ *(.text.add_wait_queue) ++ *(.text.memcpy_toiovec) ++ *(.text.rw_verify_area) ++ *(.text.internal_add_timer) ++ *(.text.hrtimer_run_queues) ++ *(.text.tcp_v4_do_rcv) ++ *(.text.raise_softirq) ++ *(.text.del_timer) ++ *(.text.try_to_wake_up) ++ *(.text.__do_page_cache_readahead) ++ *(.text.__alloc_pages) ++ *(.text.sock_aio_read) ++ *(.text.timer_tick) ++ *(.text.ox800sata_check_status) ++ *(.text.do_generic_mapping_read) ++ *(.text.__ox800sata_scr_read) ++ *(.text.elv_queue_empty) ++ *(.text.do_select) ++ *(.text.free_pages_bulk) ++ *(.text.remove_wait_queue) ++ *(.text.dma_bh) ++ *(.text.__irq_usr) ++ *(.text.vfs_read) ++ *(.text.run_timer_softirq) ++ *(.text.radix_tree_preload) ++ *(.text.ptrace_getrn) ++ *(.text.tcp_dsack_set) ++ *(.text.__switch_to) ++ *(.text.bio_hw_segments) ++ *(.text.__const_udelay) ++ *(.text.nr_running) ++ *(.text.hipox_dma_device_set_prd) ++ *(.text.kref_put) ++ *(.text.enqueue_task) ++ *(.text.dequeue_task) ++ *(.text.elv_next_request) ++ *(.text.profile_hit) ++ *(.text.slab_destroy) ++ *(.text.schedule) ++ *(.text.end_that_request_first) ++ *(.text.cfq_find_next_crq) ++ *(.text.__freed_request) ++ *(.text.adjtime_adjustment) ++ *(.text.bictcp_cong_avoid) ++ *(.text.kthread_should_stop) ++ *(.text.__activate_task) ++ *(.text.account_system_time) ++ *(.text.bio_fs_destructor) ++ *(.text.mempool_alloc) ++ *(.text.elv_set_request) ++ *(.text.schedule_work) ++ *(.text.wake_up_state) ++ *(.text.encode_control_status) ++ *(.text.alloc_skb_from_cache) ++ *(.text.qdisc_lock_tree) ++ *(.text.kref_get) ++ *(.text.init_timer) ++ *(.text.hipox_dma_is_active) ++ *(.text.shrink_slab) ++ *(.text.poll_freewait) ++ *(.text.sys_fstat64) ++ *(.text.__pollwait) ++ *(.text.cfq_queue_empty) ++ *(.text.linear_issue_flush) ++ *(.text.__tasklet_schedule) ++ *(.text.ox800sata_get_io_base) ++ *(.text.deactivate_task) ++ *(.text.cleanup_rbuf) ++ *(.text.nr_free_zone_pages) ++ *(.text.ip_route_input) ++ *(.text.__lock_page) ++ *(.text.sock_poll) ++ *(.text.__pskb_trim_head) ++ *(.text.sys_read) ++ *(.text.__arch_copy_to_user) ++ *(.text.generic_make_request) ++ *(.text.scsi_end_request) ++ *(.text.bio_init) ++ *(.text.pipefs_delete_dentry) ++ *(.text.ox800sata_post_set_mode) ++ *(.text.sock_common_recvmsg) ++ *(.text.put_device) ++ *(.text.tcp_syn_build_options) ++ *(.text.scheduler_tick) ++ *(.text.__sys_trace) ++ *(.text.ox800sata_qc_new) ++ *(.text.elv_latter_request) ++ *(.text.do_sync_read) ++ *(.text.ox800sata_spot_the_end) ++ *(.text.get_dirty_limits) ++ *(.text.bio_phys_segments) ++ *(.text.vfs_fstat) ++ *(.text.scsi_finish_command) ++ *(.text.wake_up_process) ++ *(.text.wdc_ledtrig_sata_activity) ++ *(.text.__elv_add_request) ++ *(.text.sock_common_setsockopt) ++ *(.text.elv_may_queue) ++ *(.text.rb_first) ++ *(.text.dnotify_parent) ++ *(.text.get_writeback_state) ++ *(.text.__blk_put_request) ++ *(.text.sock_mmap) ++ *(.text.throttle_vm_writeout) ++ *(.text.drive_stat_acct) ++ *(.text.dlci_ioctl_set) ++ *(.text.sys_send) ++ *(.text.default_wake_function) ++ *(.text.cfq_resort_rr_list) ++ *(.text.bio_put) ++ *(.text.scsi_done) ++ *(.text.kobject_put) ++ *(.text.release_pages) ++ *(.text.ata_qc_issue) ++ *(.text.cfq_dispatch_insert) ++ *(.text.run_workqueue) ++ *(.text.delayed_work_timer_fn) ++ *(.text.scsi_init_cmd_errh) ++ *(.text.alloc_sock_iocb) ++ *(.text.blk_done_softirq) ++ *(.text.do_timer) ++ *(.text.scsi_10_lba_len) ++ *(.text.scsi_device_unbusy) ++ *(.text.bio_get_nr_vecs) ++ *(.text.cfq_find_cfq_hash) ++ *(.text.ata_dev_select) ++ *(.text.blk_remove_plug) ++ *(.text.end_that_request_last) ++ *(.text.shrink_dcache_memory) ++ *(.text.elv_put_request) ++ *(.text.sys_sendto) ++ *(.text.scsi_put_command) ++ *(.text._clear_bit_le) ++ *(.text.ata_rwcmd_protocol) ++ *(.text.kobject_cleanup) ++ *(.text.do_sendfile) ++ *(.text.worker_thread) ++ *(.text.elv_dispatch_sort) ++ *(.text.tcp_fast_parse_options) ++ *(.text.ox800sata_irq_on) ++ *(.text.scsi_request_fn) ++ *(.text.ox800sata_irq_handler) ++ *(.text.nr_context_switches) ++ *(.text.hipox_dma_request) ++ *(.text.sys_sendfile64) ++ *(.text.cfq_add_crq_rb) ++ *(.text.ata_scsi_queuecmd) ++ *(.text.sock_def_readable) ++ *(.text.inet_sendpage) ++ *(.text.cfq_set_request) ++ *(.text.init_request_from_bio) ++ *(.text.tcp_v4_conn_request) ++ *(.text.requeue_task) ++ *(.text.cache_alloc_refill) ++ *(.text.scsi_get_command) ++ *(.text.blk_complete_request) ++ *(.text.scsi_add_timer) ++ *(.text.sk_stream_rfree) ++ *(.text.__umodsi3) ++ *(.text.ox800sata_tf_load) ++ *(.text.tcp_recvmsg) ++ *(.text.cfq_insert_request) ++ *(.text.tcp_sendpage) ++ *(.text.bio_alloc_bioset) ++ *(.text.__tcp_ack_snd_check) ++ *(.text.kthread_bind) ++ *(.text.scsi_delete_timer) ++ *(.text.ox800sata_dev_config) ++ *(.text.add_wait_queue_exclusive) ++ *(.text.ox800sata_bmdma_setup) ++ *(.text.ox800sata_exec_command) ++ *(.text.clear_queue_congested) ++ *(.text.generic_file_sendfile) ++ *(.text.get_io_context) ++ *(.text.swap_buf_le16) ++ *(.text._set_bit_be) ++ *(.text.led_trigger_event) ++ *(.text.current_io_context) ++ *(.text.bio_free) ++ *(.text.pipe_poll) ++ *(.text.freed_request) ++ *(.text.cfq_choose_req) ++ *(.text.ox800sata_RAID_faults) ++ *(.text.rb_prev) ++ *(.text.blk_run_queue) ++ *(.text.mpage_alloc) ++ *(.text.__get_zone_counts) ++ *(.text.mpage_bio_submit) ++ *(.text.generic_fillattr) ++ *(.text.kswapd) ++ *(.text.preempt_schedule_irq) ++ *(.text.mempool_free) ++ *(.text.elv_dequeue_request) ++ *(.text.add_interrupt_randomness) ++ *(.text.poll_initwait) ++ *(.text.__put_user_bad) ++ *(.text.vfs_getattr) ++ *(.text.scsi_free_sgtable) ++ *(.text.laptop_sync_completion) ++ *(.text.submit_bio) ++ *(.text.sock_from_file) ++ *(.text.add_disk_randomness) ++ *(.text.scsi_kill_request) ++ *(.text.free_hot_page) ++ *(.text.bio_endio) ++ *(.text.scsi_dispatch_cmd) ++ *(.text.hipox_dma_start) ++ *(.text.cfq_remove_request) ++ *(.text.do_gettimeofday) ++ *(.text.skb_copy_datagram_iovec) ++ *(.text.ext3_get_blocks_handle) ++ *(.text.__down_read_trylock) ++ *(.text.cfq_activate_request) ++ *(.text.recalc_sigpending) ++ *(.text.ext3_readpage) ++ *(.text.ox800sata_dev_select) ++ *(.text.ret_to_user) ++ *(.text.elv_completed_request) ++ *(.text.read_cache_page) ++ *(.text.touch_atime) ++ *(.text.cfq_update_next_crq) ++ *(.text.no_work_pending) ++ *(.text.recalc_sigpending_tsk) ++ *(.text.end_that_request_chunk) ++ *(.text.cp_new_stat64) ++ *(.text.rb_next) ++ *(.text.__wake_up_sync) ++ *(.text.subsys_create_file) ++ *(.text.rcu_needs_cpu) ++ *(.text.sys_select) ++ *(.text.hipox_dma_device_set) ++ *(.text.ata_sg_init) ++ *(.text.__put_user_8) ++ *(.text.ox800sata_port_disable) ++ *(.text.scsi_next_command) ++ *(.text.__scsi_done) ++ *(.text.ata_scsi_qc_complete) ++ *(.text.__wake_up_locked) ++ *(.text.lru_add_drain) ++ *(.text.bio_check_pages_dirty) ++ *(.text.cascade) ++ *(.text.tcp_poll) ++ *(.text.hipox_dma_set_common) ++ *(.text.__pagevec_release) ++ *(.text.ata_scsi_translate) ++ *(.text.hipox_dma_interrupt) ++ *(.text.sys_newfstat) ++ *(.text.tcp_send_delayed_ack) ++ *(.text.scsi_decide_disposition) ++ *(.text.ox800sata_qc_free) ++ *(.text.scsi_softirq_done) ++ *(.text.netlink_group_mask) ++ *(.text.__brelse) ++ *(.text.do_sock_write) ++ *(.text.mempool_create_node) ++ *(.text.ox800sata_qc_issue) ++ *(.text.__scsi_release_request) ++ *(.text.blockable_page_cache_readahead) ++ *(.text.get_index) ++ *(.text.walk_page_buffers) ++ *(.text.__queue_work) ++ *(.text.ret_from_fork) ++ *(.text.mb_cache_shrink_fn) ++ *(.text.sys_socketcall) ++ *(.text.blk_congestion_wait) ++ *(.text.put_io_context) ++ *(.text.elevator_find) ++ *(.text._set_bit_le) ++ *(.text.generic_write_checks) ++ *(.text.datagram_poll) ++ *(.text.ext3_block_to_path) ++ *(.text.scsi_prep_fn) ++ *(.text.fget) ++ *(.text.blk_plug_device) ++ *(.text.disk_round_stats) ++ *(.text.get_request) ++ *(.text.page_cache_readahead) ++ *(.text.__bread) ++ *(.text.tcp_rcv_space_adjust) ++ *(.text.ox800sata_tf_read) ++ *(.text.add_timer_randomness) ++ *(.text.sockfd_lookup_light) ++ *(.text.__find_get_block) ++ *(.text.split_page) ++ *(.text.cfq_dispatch_requests) ++ *(.text.cfq_kick_queue) ++ *(.text.cfq_may_queue) ++ *(.text.cfq_put_request) ++ *(.text.get_request_wait) ++ *(.text.default_callback) ++ *(.text.cpu_arm926_set_pte) ++ *(.text.tcp_event_data_recv) ++ *(.text.ata_scsi_qc_new) ++ *(.text.SetRoundingMode) ++ *(.text.make_ahead_window) ++ *(.text.inotify_inode_queue_event) ++ *(.text.__make_request) ++ *(.text.finish_wait) ++ *(.text.cfq_completed_request) ++ *(.text.__cfq_slice_expired) ++ *(.text.sd_init_command) ++ *(.text.find_lock_page) ++ *(.text.pipefs_get_sb) ++ *(.text.ata_qc_new_init) ++ *(.text.task_timeslice) ++ *(.text.sk_dst_check) ++ *(.text.set_queue_congested) ++ *(.text.prepare_to_wait) ++ *(.text.sys_write) ++ *(.text.swap_io_context) ++ *(.text.sys_alarm) ++ *(.text.mempool_resize) ++ *(.text.__cond_resched) ++ *(.text.scsi_16_lba_len) ++ *(.text.autoremove_wake_function) ++ *(.text.inotify_dentry_parent_queue_event) ++ *(.text.cfq_init_prio_data) ++ *(.text.group_send_sig_info) ++ *(.text.ata_qc_issue_prot) ++ *(.text.cfq_put_queue) ++ *(.text.__set_irq_handler) ++ *(.text.__generic_file_aio_read) ++ *(.text.ox800sata_eng_timeout) ++ *(.text.rb_erase) ++ *(.text.generic_file_aio_read) ++ *(.text.default_llseek) ++ *(.text.blk_unplug_work) ++ *(.text.linear_make_request) ++ *(.text.elv_insert) ++ *(.text.velocity_init_registers) ++ *(.text.vfs_permission) ++ *(.text.alloc_inode) ++ *(.text.mii_ethtool_sset) ++ *(.text.blk_rq_map_kern) ++ *(.text.tcp_urg) ++ *(.text.__ata_qc_complete) ++ *(.text.io_schedule_timeout) ++ *(.text.run_posix_cpu_timers) ++ *(.text.ox800sata_irq_clear) ++ *(.text.put_tty_driver) ++ *(.text.free_sg_controller) ++ *(.text.__sk_stream_mem_reclaim) ++ *(.text.elv_merge) ++ *(.text.scsi_run_queue) ++ *(.text.elv_former_request) ++ *(.text.blk_requeue_request) ++ *(.text.__end_that_request_first) ++ *(.text.ext3_get_block) ++ *(.text.ox800sata_phy_reset) ++ *(.text.schedule_timeout) ++ *(.text.grab_cache_page_nowait) ++ *(.text.bio_map_kern_endio) ++ *(.text.__up_read) ++ *(.text.tcp_data_queue) ++ *(.text.set_bdev_super) ++ *(.text.ext3_readpages) ++ *(.text.scsi_exit_queue) ++ *(.text.ext3_get_branch) ++ *(.text.cfq_forced_dispatch_cfqqs) ++ *(.text.bioset_free) ++ *(.text.blk_execute_rq_nowait) ++ *(.text.scsi_eh_wakeup) ++ *(.text.tcp_delack_timer) ++ *(.text.shrink_icache_memory) ++ *(.text.mpage_end_io_write) ++ *(.text.scsi_io_completion) ++ *(.text.verify_iovec) ++ *(.text.credit_entropy_store) ++ *(.text.blk_unplug_timeout) ++ *(.text.work_resched) ++ *(.text.sys_sendfile) ++ *(.text.do_bad_IRQ) ++ *(.text.sd_rw_intr) ++ *(.text.set_task_comm) ++ *(.text.blk_do_ordered) ++ *(.text.rb_last) ++ *(.text.drop_buffers) ++ *(.text.ata_scsi_rw_xlat) ++ *(.text.hipox_dma_shutdown) ++ *(.text.__group_send_sig_info) ++ *(.text.led_trigger_set_default) ++ *(.text.blk_queue_bounce) ++ *(.text.cfq_var_store) ++ *(.text.rb_insert_color) ++ *(.text.__remove_hrtimer) ++ *(.text.sys_sysinfo) ++ *(.text.tcp_simple_retransmit) ++ *(.text.it_real_fn) ++ *(.text.sk_send_sigurg) ++ *(.text.sys_statfs64_wrapper) ++ *(.text.alloc_page_buffers) ++ *(.text.bio_pair_release) ++ *(.text.__dequeue_signal) ++ *(.text.kblockd_schedule_work) ++ *(.text.wakeup_kswapd) ++ *(.text.process_timeout) ++ *(.text.__getblk) ++ *(.text.blk_get_request) ++ *(.text.sync_buffer) ++ *(.text.sk_stream_mem_schedule) ++ *(.text.vfs_stat) ++ *(.text.rb_replace_node) ++ *(.text.signal_wake_up) ++ *(.text.ata_std_ports) ++ *(.text.tcp_send_ack) ++ *(.text.send_signal) ++ *(.text._atomic_dec_and_lock) ++ *(.text.set_bh_page) ++ *(.text.mutex_trylock) ++ *(.text.sys_sigaltstack_wrapper) ++ *(.text.sig_ignored) ++ *(.text.net_family_write_lock) ++ *(.text.radix_tree_node_alloc) ++ *(.text.may_open) ++ *(.text.account_user_time) ++ *(.text.udp_seq_start) ++ *(.text.ll_front_merge_fn) ++ *(.text.laptop_flush) ++ *(.text.__tasklet_hi_schedule) ++ *(.text.__und_usr) ++ *(.text.do_signal) ++ *(.text.wake_bit_function) ++ *(.text.mutex_lock_interruptible) ++ *(.text.cfq_merged_request) ++ *(.text.scsi_init_cmd_from_req) ++ *(.text.elv_requeue_request) ++ *(.text.force_sigsegv) ++ *(.text.elv_merge_requests) ++ *(.text.cp_new_stat) ++ *(.text.prepare_to_wait_exclusive) ++ *(.text.ioc_set_batching) ++ *(.text.check_kill_permission) ++ *(.text.scsi_queue_insert) ++ *(.text.__csum_ipv6_magic) ++ *(.text.wb_kupdate) ++ *(.text.__down_write_trylock) ++ *(.text.elv_register_queue) ++ *(.text.sys_getitimer) ++ *(.text.ox800sata_pio_task) ++ *(.text.hrtimer_try_to_cancel) ++ *(.text.find_pid) ++ *(.text.hipox_dma_raw_isactive) ++ *(.text.cmp_ex) ++ *(.text.__mpage_writepage) ++ *(.text.sk_stream_wait_memory) ++ *(.text.sys_sched_yield) ++ *(.text.background_writeout) ++ *(.text.rotate_reclaimable_page) ++ *(.text.do_sigaction) ++ *(.text.sock_def_write_space) ++ *(.text.sched_exit) ++ *(.text.inode_change_ok) ++ *(.text.wait_for_completion_interruptible) ++ *(.text.device_initialize) ++ *(.text.journal_set_revoke) ++ *(.text.try_to_free_pages) ++ *(.text.tcp_write_timer) ++ *(.text.dev_ioctl) ++ *(.text.skb_copy_expand) ++ *(.text.invalidate_complete_page) ++ *(.text.*) + __exception_text_start = .; + *(.exception.text) + __exception_text_end = .; +diff -Nurd linux-2.6.24/arch/arm/lib/Makefile linux-2.6.24-oxe810/arch/arm/lib/Makefile +--- linux-2.6.24/arch/arm/lib/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/Makefile 2008-06-11 17:47:47.000000000 +0200 +@@ -29,6 +29,10 @@ + endif + endif + ++ifeq ($(CONFIG_HIPOX_DMA_COPIES),y) ++ lib-y += hipox_copies.o ++endif ++ + lib-$(CONFIG_MMU) += $(mmu-y) + + ifeq ($(CONFIG_CPU_32v3),y) +diff -Nurd linux-2.6.24/arch/arm/lib/clear_user.S linux-2.6.24-oxe810/arch/arm/lib/clear_user.S +--- linux-2.6.24/arch/arm/lib/clear_user.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/clear_user.S 2008-06-11 17:47:47.000000000 +0200 +@@ -18,7 +18,11 @@ + * : sz - number of bytes to clear + * Returns : number of bytes NOT cleared + */ ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ENTRY(__clear_user_alt) ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + ENTRY(__clear_user) ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + stmfd sp!, {r1, lr} + mov r2, #0 + cmp r1, #4 +diff -Nurd linux-2.6.24/arch/arm/lib/copy_from_user.S linux-2.6.24-oxe810/arch/arm/lib/copy_from_user.S +--- linux-2.6.24/arch/arm/lib/copy_from_user.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/copy_from_user.S 2008-06-11 17:47:47.000000000 +0200 +@@ -83,7 +83,12 @@ + + .text + ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ENTRY(__copy_from_user_alt) ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES ++.section ".text.__copy_from_user" + ENTRY(__copy_from_user) ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + + #include "copy_template.S" + +diff -Nurd linux-2.6.24/arch/arm/lib/copy_to_user.S linux-2.6.24-oxe810/arch/arm/lib/copy_to_user.S +--- linux-2.6.24/arch/arm/lib/copy_to_user.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/copy_to_user.S 2008-06-11 17:47:47.000000000 +0200 +@@ -86,7 +86,12 @@ + + .text + ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ENTRY(__copy_to_user_alt) ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES ++.section ".text.__copy_to_user" + ENTRY(__copy_to_user) ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + + #include "copy_template.S" + +diff -Nurd linux-2.6.24/arch/arm/lib/memcpy.S linux-2.6.24-oxe810/arch/arm/lib/memcpy.S +--- linux-2.6.24/arch/arm/lib/memcpy.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/memcpy.S 2008-06-11 17:47:47.000000000 +0200 +@@ -53,6 +53,7 @@ + + /* Prototype: void *memcpy(void *dest, const void *src, size_t n); */ + ++.section ".text.memcpy" + ENTRY(memcpy) + + #include "copy_template.S" +diff -Nurd linux-2.6.24/arch/arm/lib/memzero.S linux-2.6.24-oxe810/arch/arm/lib/memzero.S +--- linux-2.6.24/arch/arm/lib/memzero.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/memzero.S 2008-06-11 17:47:47.000000000 +0200 +@@ -30,6 +30,7 @@ + * memzero again. + */ + ++.section ".text.__memzero" + ENTRY(__memzero) + mov r2, #0 @ 1 + ands r3, r0, #3 @ 1 unaligned? +diff -Nurd linux-2.6.24/arch/arm/lib/hipox_copies.c linux-2.6.24-oxe810/arch/arm/lib/hipox_copies.c +--- linux-2.6.24/arch/arm/lib/hipox_copies.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/lib/hipox_copies.c 2008-06-11 17:47:47.000000000 +0200 +@@ -0,0 +1,261 @@ ++/* ++ * linux/arch/arm/lib/nas_copies.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/compiler.h> ++#include <linux/dma-mapping.h> ++#include <linux/mm.h> ++#include <linux/pagemap.h> ++#include <asm/scatterlist.h> ++#include <asm/semaphore.h> ++#include <asm/arch/dma.h> ++ ++static DECLARE_MUTEX(copy_mutex); ++static __DECLARE_SEMAPHORE_GENERIC(callback_semaphore, 0); ++ ++static void dma_callback( ++ hipox_dma_channel_t *channel, ++ hipox_callback_arg_t arg, ++ hipox_dma_callback_status_t error_code, ++ u16 checksum, ++ int interrupt_count) ++{ ++ up(&callback_semaphore); ++} ++ ++unsigned long hipox_copy_from_user(void *to, const void __user *from, unsigned long count) ++{ ++ int pages_mapped, i; ++ unsigned long transfered = 0; ++ struct page *pages[2]; ++ hipox_dma_channel_t *channel; ++ unsigned long uaddr = (unsigned long)from; ++ unsigned long end_page = (uaddr + count + PAGE_SIZE - 1) >> PAGE_SHIFT; ++ unsigned long start_page = uaddr >> PAGE_SHIFT; ++ int nr_pages = end_page - start_page; ++//printk("F 0x%08lx 0x%08lx %lu -> %lu, %lu, %d\n", (unsigned long)to, (unsigned long)from, count, start_page, end_page, nr_pages); ++ ++ might_sleep(); ++ ++ BUG_ON(nr_pages > 2); ++ ++ // Only support a single concurrent copy operation, as only using a single ++ // DMA channel for now ++ while (down_interruptible(©_mutex)); ++ ++ // Get kernel mappings for the user pages ++ down_read(¤t->mm->mmap_sem); ++ pages_mapped = get_user_pages(current, current->mm, uaddr, nr_pages, 0, 0, pages, NULL); ++ up_read(¤t->mm->mmap_sem); ++ ++ if (pages_mapped != nr_pages) { ++ // Didn't get mappings for all pages requested, so release any we did get ++ for (i=0; i < pages_mapped; ++i) { ++ page_cache_release(pages[i]); ++ } ++ pages_mapped = 0; ++ } ++ ++ if (pages_mapped) { ++ int i; ++ struct scatterlist sl; ++ struct scatterlist gl[2]; ++ ++ // Fill gathering DMA descriptors ++ gl[0].page = pages[0]; ++ gl[0].offset = uaddr & ~PAGE_MASK; ++ if (pages_mapped > 1) { ++ gl[0].length = PAGE_SIZE - gl[0].offset; ++ gl[1].offset = 0; ++ gl[1].page = pages[1]; ++ gl[1].length = count - gl[0].length; ++ } else { ++ gl[0].length = count; ++ } ++ ++ // Create DMA mappings for all the user pages ++ for (i=0; i < pages_mapped; ++i) { ++ gl[i].dma_address = dma_map_single(0, page_address(gl[i].page) + gl[i].offset, gl[i].length, DMA_TO_DEVICE); ++ } ++ ++ // Create a DMA mapping for the kernel memory range ++ sl.dma_address = dma_map_single(0, to, count, DMA_FROM_DEVICE); ++ sl.length = count; ++ ++ // Allocate a DMA channel ++ channel = hipox_dma_request(1); ++ BUG_ON(channel == HIPOX_DMA_CHANNEL_NUL); ++ ++ // Do DMA from user to kernel memory ++ hipox_dma_set_sg( ++ channel, ++ gl, ++ pages_mapped, ++ &sl, ++ 1, ++ HIPOX_DMA_MODE_INC, ++ HIPOX_DMA_MODE_INC, ++ 0); ++ ++ // Using notification callback ++ hipox_dma_set_callback(channel, dma_callback, HIPOX_DMA_CALLBACK_ARG_NUL); ++ hipox_dma_start(channel); ++ ++ // Sleep until transfer complete ++ while (down_interruptible(&callback_semaphore)); ++ hipox_dma_set_callback(channel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ transfered += count; ++ ++ // Release the DMA channel ++ hipox_dma_free(channel); ++ ++ // Release kernel DMA mapping ++ dma_unmap_single(0, sl.length, count, DMA_FROM_DEVICE); ++ // Release user DMA mappings ++ for (i=0; i < pages_mapped; ++i) { ++ dma_unmap_single(0, gl[i].dma_address, gl[i].length, DMA_TO_DEVICE); ++ } ++ ++ // Release user pages ++ for (i=0; i < pages_mapped; ++i) { ++ page_cache_release(pages[i]); ++ } ++ } ++ ++ up(©_mutex); ++ ++ return count - transfered; ++} ++ ++//unsigned long hipox_copy_to_user(void __user *to, const void *from, unsigned long count) ++//{ ++// int pages_mapped, i; ++// unsigned long transfered = 0; ++// struct page *pages[2]; ++// hipox_dma_channel_t *channel; ++// unsigned long uaddr = (unsigned long)to; ++// unsigned long end_page = (uaddr + count + PAGE_SIZE - 1) >> PAGE_SHIFT; ++// unsigned long start_page = uaddr >> PAGE_SHIFT; ++// int nr_pages = end_page - start_page; ++////printk("T 0x%08lx 0x%08lx %lu -> %lu, %lu, %d\n", (unsigned long)to, (unsigned long)from, count, start_page, end_page, nr_pages); ++// ++// might_sleep(); ++// ++// BUG_ON(nr_pages > 2); ++// ++// // Only support a single concurrent copy operation, as only using a single ++// // DMA channel for now ++// while (down_interruptible(©_mutex)); ++// ++// // Get kernel mappings for the user pages ++// down_read(¤t->mm->mmap_sem); ++// pages_mapped = get_user_pages(current, current->mm, uaddr, nr_pages, 1, 0, pages, NULL); ++// up_read(¤t->mm->mmap_sem); ++// ++// if (pages_mapped != nr_pages) { ++// // Didn't get mapping for all the pages we requested, so release any ++// // user page mappings we did get ++// for (i=0; i < pages_mapped; ++i) { ++// page_cache_release(pages[i]); ++// } ++// pages_mapped = 0; ++// } ++// ++// if (pages_mapped) { ++// int i; ++// struct scatterlist gl; ++// struct scatterlist sl[2]; ++// ++// // Fill scattering DMA descriptors for writing to user space ++// sl[0].page = pages[0]; ++// sl[0].offset = uaddr & ~PAGE_MASK; ++// if (pages_mapped > 1) { ++// sl[0].length = PAGE_SIZE - sl[0].offset; ++// sl[1].offset = 0; ++// sl[1].page = pages[1]; ++// sl[1].length = count - sl[0].length; ++// } else { ++// sl[0].length = count; ++// } ++// ++// // Create DMA mappings for all the user pages ++// for (i=0; i < pages_mapped; ++i) { ++// sl[i].__address = page_address(sl[i].page) + sl[i].offset; ++// sl[i].dma_address = dma_map_single(0, sl[i].__address, sl[i].length, DMA_FROM_DEVICE); ++// } ++// ++// // Create a DMA mapping for the kernel memory range ++// gl.dma_address = dma_map_single(0, (void*)from, count, DMA_TO_DEVICE); ++// gl.length = count; ++// ++//// { ++//////flush_cache_all(); ++//// // Do copy with CPU to test ++//// const char* src = from; ++//////printk("T Copying...\n"); ++//// for (i=0; i < pages_mapped; ++i) { ++//// void* kadr = kmap(sl[i].page) + sl[i].offset; ++//// memcpy(kadr, src, sl[i].length); ++//// kunmap(sl[i].page); ++//// src += sl[i].length; ++//// transfered += sl[i].length; ++//// } ++//// } ++// ++//flush_cache_all(); ++// // Allocate a DMA channel ++// channel = hipox_dma_request(1); ++// BUG_ON(channel == HIPOX_DMA_CHANNEL_NUL); ++// ++// // Do DMA from kernel to user memory ++// hipox_dma_set_sg( ++// channel, ++// &gl, ++// 1, ++// sl, ++// pages_mapped, ++// HIPOX_DMA_MODE_INC, ++// HIPOX_DMA_MODE_INC, ++// 0); ++// hipox_dma_start(channel); ++// while (hipox_dma_is_active(channel)); ++// transfered += count; ++// ++// // Release the DMA channel ++// hipox_dma_free(channel); ++////flush_cache_all(); ++// ++// // Release kernel DMA mapping ++// dma_unmap_single(0, gl.dma_address, count, DMA_TO_DEVICE); ++// // Release user DMA mappings ++// for (i=0; i < pages_mapped; ++i) { ++// dma_unmap_single(0, sl[i].dma_address, sl[i].length, DMA_FROM_DEVICE); ++// } ++// ++// // Release user pages ++// for (i=0; i < pages_mapped; ++i) { ++// SetPageDirty(pages[i]); ++// page_cache_release(pages[i]); ++// } ++// } ++// ++// up(©_mutex); ++// ++// return count - transfered; ++//} ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/Kconfig linux-2.6.24-oxe810/arch/arm/mach-hipox/Kconfig +--- linux-2.6.24/arch/arm/mach-hipox/Kconfig 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/Kconfig 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,574 @@ ++if ARCH_HIPOX ++ ++menu "Oxford Semiconductor NAS Options" ++ ++config ARCH_HIPOX_FPGA ++ bool "FPGA platform" ++ default n ++ help ++ This enables support for Oxsemi NAS SoC FPGA development platform ++ ++config HIPOX_CORE_CLK ++ int "Integrator core module processor clock frequency in MHz" ++ depends on ARCH_HIPOX_FPGA ++ default 175 ++ help ++ Maximum reliable frequency 175MHz ++ ++config HIPOX_CORE_BUS_CLK_DIV ++ int "Integrator core module bus clock divider" ++ depends on ARCH_HIPOX_FPGA ++ default 4 ++ help ++ Must be greater than 0 ++ ++config NOMINAL_PLL400_FREQ ++ int "The master clock frequency of the Soc" ++ default 400000000 ++ help ++ The PLL400 clock is divided by 2 to drive the ARM clock and by ++ 4 to drive the AHB clock ++ ++config NOMINAL_RPSCLK_FREQ ++ int "The input clock frequency to the RPS" ++ default 25000000 ++ help ++ The RPS clock feeds into a prescaler and from there feeds the ++ RPS timers ++ ++choice ++ prompt "HIPOX system type" ++ default HIPOX_VERSION_0X800 ++ ++config HIPOX_VERSION_0X800 ++ bool "0X800" ++ select ARM_AMBA ++ help ++ Support for the 0X800 SoC ++ ++config HIPOX_VERSION_0X810 ++ bool "0X810" ++ select ARM_AMBA ++ help ++ Support for the 0X810 SoC ++ ++config HIPOX_VERSION_0X850 ++ bool "0X850" ++ help ++ Support for the 0X850 SoC ++endchoice ++ ++config ARCH_HIPOX_UART1 ++ bool "Support UART1" ++ default n ++ help ++ This enables UART1 to be accessible to Linux. ++ UARTs will be mapped to ttySn numbers from UART1 to UART4, only ++ including those UARTs selected to be present ++ ++config ARCH_HIPOX_UART1_MODEM ++ bool "Support UART1 modem control lines" ++ depends on ARCH_HIPOX_UART1 ++ default n ++ help ++ Multiplex the modem control lines from UART1 onto external pins ++ ++config ARCH_HIPOX_UART2 ++ bool "Support UART2" ++ default n ++ help ++ This enables UART2 to be accessible to Linux ++ UARTs will be mapped to ttySn numbers from UART1 to UART4, only ++ including those UARTs selected to be present ++ ++config ARCH_HIPOX_UART2_MODEM ++ bool "Support UART2 modem control lines" ++ depends on ARCH_HIPOX_UART2 ++ default n ++ help ++ Multiplex the modem control lines from UART2 onto external pins ++ ++config ARCH_HIPOX_UART3 ++ bool "Support UART3" ++ default n ++ help ++ This enables UAR3 to be accessible to Linux ++ UARTs will be mapped to ttySn numbers from UART1 to UART4, only ++ including those UARTs selected to be present ++ ++config ARCH_HIPOX_UART3_MODEM ++ bool "Support UART3 modem control lines" ++ depends on ARCH_HIPOX_UART3 ++ default n ++ help ++ Multiplex the modem control lines from UART3 onto external pins ++ ++config ARCH_HIPOX_UART4 ++ bool "Support UART4" ++ depends on !PCI ++ default n ++ help ++ This enables UART4 to be accessible to Linux ++ UARTs will be mapped to ttySn numbers from UART1 to UART4, only ++ including those UARTs selected to be present ++ UART4 always has its modem control lines available on external pins ++ when selected (overlaying PCI functions) ++ ++config ARCH_HIPOX_PCI_REQGNT_0 ++ bool "Enable req/gnt for PCI device 0" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_REQGNT_1 ++ bool "Enable req/gnt for PCI device 1" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_REQGNT_2 ++ bool "Enable req/gnt for PCI device 2" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_REQGNT_3 ++ bool "Enable req/gnt for PCI device 3" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_CLKOUT_0 ++ bool "Enable PCI clock output 0" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_CLKOUT_1 ++ bool "Enable PCI clock output 1" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_CLKOUT_2 ++ bool "Enable PCI clock output 2" ++ depends on PCI ++ default n ++ help ++ ++config ARCH_HIPOX_PCI_CLKOUT_3 ++ bool "Enable PCI clock output 3" ++ depends on PCI ++ default n ++ help ++ ++config HIPOX_PCI_RESET ++ bool "Allow PCI reset to be toggled after power up" ++ depends on PCI ++ default n ++ help ++ The SoC requires that the PCI bus reset be toggled after the ++ rest of the SoC has emerged from reset ++ ++config HIPOX_PCI_RESET_GPIO ++ int "GPIO line connected to PCI reset" ++ depends on HIPOX_PCI_RESET ++ default 12 ++ help ++ The PCI bus requires a separate reset to be asserted after the ++ reset of the SoC has emerged from reset. This defines the GPIO ++ line which is connected to the PCI reset ++ ++config HIPOX_SATA_POWER_1 ++ bool "Allow control of SATA 1 disk power via GPIO" ++ default n ++ help ++ Allow SATA disk 1 power to be turned off via GPIO lines ++ ++config HIPOX_SATA_POWER_GPIO_1 ++ int "GPIO line connected to SATA power control for disk 1" ++ depends on HIPOX_SATA_POWER_1 ++ default 15 ++ help ++ The GPIO line that controls SATA disk 1 power ++ ++config HIPOX_SATA_POWER_2 ++ bool "Allow control of SATA disk 2 power via GPIO" ++ default n ++ help ++ Allow SATA disk 2 power to be turned off via GPIO lines ++ ++config HIPOX_SATA_POWER_GPIO_2 ++ int "GPIO line connected to SATA power control for disk 2" ++ depends on HIPOX_SATA_POWER_2 ++ default 18 ++ help ++ The GPIO line that controls SATA disk 2 power ++ ++config FORCE_MAX_ZONEORDER ++ int "Max order of zoned buddy allocator" ++ default 11 ++ help ++ The value to be assigned to MAX_ORDER ++ ++config SRAM_NUM_PAGES ++ int "The number of SRAM memory pages present in the system" ++ default 8 ++ help ++ Determines the number of pages of SRAM that are assumed to exist in the ++ system memory map ++ ++config SUPPORT_LEON ++ bool "Include support for Leon" ++ default n ++ ++config LEON_PAGES ++ int "The number of 4K pages of SRAM to reserve for the LEON program" ++ depends on SUPPORT_LEON ++ default 2 ++ help ++ Determines the number of 4K pages of SRAM that are reserved for the ++ LEON program ++ ++config LEON_COPRO ++ bool "Load LEON networking acceleration program" ++ depends on SUPPORT_LEON && HIPOX_VERSION_0X810 ++ default n ++ ++config LEON_OFFLOAD_TX ++ bool "Whether network Tx operations should be offloaded to the LEON" ++ depends on LEON_COPRO ++ default n ++ ++config LEON_RESERVE_DMA_CHANNEL ++ bool "Whether to reserve the last DMA channel for the CoPro's use" ++ depends on LEON_OFFLOAD_TX ++ default n ++ ++config LEON_OFFLOAD_TSO ++ bool "Whether network TSO operations should be offloaded to the LEON" ++ depends on LEON_OFFLOAD_TX ++ default n ++ ++config LEON_START_EARLY ++ bool "Load LEON early startup program" ++ depends on SUPPORT_LEON ++ default n ++ help ++ For situations where the LEON is to run some code unrelated to ++ its normal network acceleration functions, this options causes ++ the LEON code to be loaded and the LEON started early in the ++ boot process ++ ++config LEON_POWER_BUTTON_MONITOR ++ tristate "Load LEON power button monitoring program" ++ depends on SUPPORT_LEON ++ default n ++ help ++ Support powering down the system via a GPIO button and when the ++ system is powered down load a LEON program that will monitor the ++ button for attempts to power the system back on ++ ++config HIPOX_POWER_BUTTON_GPIO ++ int "GPIO line connected to power button" ++ depends on LEON_POWER_BUTTON_MONITOR ++ default 33 ++ help ++ Specifies the GPIO line to which the power button is connected ++ ++config USER_RECOVERY_BUTTON_MONITOR ++ tristate "Load user recovery button monitoring program" ++ default n ++ help ++ Support User recovery of the system via a GPIO button. When the ++ system is power cycled after the use of this button, the admin ++ password and network settings are set to factory values. ++ ++config HIPOX_USER_RECOVERY_BUTTON_GPIO ++ int "GPIO line connected to user recovery button" ++ depends on USER_RECOVERY_BUTTON_MONITOR ++ default 32 ++ help ++ Specifies the GPIO line to which the user recovery button is ++ connected. ++ ++config HIPOX_DDR_MON ++ bool "Poll the DDR core bus monitors from timer tick interrupt" ++ default n ++ ++config HIPOX_AHB_MON ++ bool "Include support for AHB monitors" ++ default n ++ ++config HIPOX_MONITOR_SUBSAMPLE ++ int "Jiffy subsample factor for AHB monitor sampling" ++ depends on HIPOX_AHB_MON || HIPOX_DDR_MON ++ default 10 ++ help ++ The factor by which to subsample the jiffy count to produce AHB monitor ++ sampling events ++ ++config HIPOX_CACHE_LOCKDOWN ++ bool "Allow locking down part of the caches" ++ default n ++ ++config HIPOX_CACHE_I_MASK ++ int "Bit mask for I cache lockdown" ++ depends on HIPOX_CACHE_LOCKDOWN ++ default 0 ++ help ++ Allowable values are: ++ 0 - No ways locked down ++ 1 - One way locked down ++ 3 - Two ways locked down ++ 7 - Three ways locked down ++ ++config HIPOX_CACHE_D_MASK ++ int "Bit mask for D cache lockdown" ++ depends on HIPOX_CACHE_LOCKDOWN ++ default 0 ++ help ++ Allowable values are: ++ 0 - No ways locked down ++ 1 - One way locked down ++ 3 - Two ways locked down ++ 7 - Three ways locked down ++ ++config DO_MEM_TEST ++ bool "Perform memory copy throughput test during boot" ++ default 0 ++ ++config CRYPTO_OXAESLRW ++ tristate "LRW-AES hardware support" ++ help ++ Driver for controlling the Ox-Semi OX800 cipher core for LRW-AES ++ encryption ++ ++config DESCRIPTORS_PAGES ++ int "The number of SRAM memory pages to reserve for DMA descriptors" ++ default 1 ++ help ++ Determines the number of pages of SRAM that are reserved for DMA ++ descriptors ++ ++config ARCH_HIPOX_NUM_GMAC_DESCRIPTORS ++ int "The number of GMAC descriptors to allocate" ++ default 112 ++ ++config ARCH_HIPOX_MAX_SATA_SG_ENTRIES ++ int "The max. number of SG DMA descriptors to use in the single transfer" ++ default 64 ++ ++config TACHO_THERM_AND_FAN ++ tristate "Include support for the temperature sensing, and automatic fan control" ++ default n ++ ++config GPIO_TEST ++ tristate "Device driver for exercising GPIO block." ++ default n ++ help ++ Connect the I2C serial lines (SCLK, SCS, and SDT) together to run test ++ ++config HIPOX_RTC ++ tristate "Probe for m41t00 RTC" ++ select I2C ++ select I2C_ALGOBIT ++ select I2C_HIPOX_BITBASH ++ select RTC_CLASS ++ select RTC_DRV_DS1307 ++ default n ++ help ++ The M41T00 RTC provides basic time save and restore. ++ The device is probed for on the HIPOX bit-bash I2C bus. ++ ++config I2S ++ tristate "I2S test interface" ++ default n ++ help ++ Say Y here to use i2s ++ This support is also available as a module. If so, the module will be ++ called i2s. ++ ++config PCI_HIPOX_CARDBUS ++ bool "Switches from a PCI/Mini-PCI bus to a Cardbus bus." ++ depends on PCI && ARCH_HIPOX_FPGA ++ ---help--- ++ This option limits scanning of the bus to omit the Via SATA interface. ++ This makes the bus compatible with cardbus cards that expect to be the ++ only PCI device on the bus. ++ ++config DPE_TEST ++ tristate "Test the DPE core" ++ default n ++ ++config HIPOX_EARLY_PRINTK ++ bool "Whether to output to printascii from printk" ++ depends on DEBUG_LL ++ help ++ If both CONFIG_DEBUG_LL and this option are selected, then each printk ++ call will duplicate the message in a call to printascii to get very ++ early console output ++ ++config HIPOX_INSTRUMENT_COPIES ++ bool "Instrument copy_to_user and copy_from_user" ++ default n ++ ++config HIPOX_INSTRUMENT_COPIES_THRESHOLD ++ int "The threshold above which copies will be instrumented" ++ depends on HIPOX_INSTRUMENT_COPIES ++ default 0 ++ ++config HIPOX_INSTRUMENT_COPIES_TIME ++ bool "Whether to print copy timing to console" ++ depends on HIPOX_INSTRUMENT_COPIES ++ default n ++ ++config HIPOX_INSTRUMENT_COPIES_GPIO ++ bool "Whether to toggle a GPIO around copies" ++ depends on HIPOX_INSTRUMENT_COPIES ++ default n ++ ++config HIPOX_DMA_COPIES ++ bool "Whether to use DMA for larger user-kernel copies" ++ default n ++ ++config HIPOX_DMA_COPY_THRESHOLD ++ int "The threshold above which DMA will be used for copies" ++ depends on HIPOX_DMA_COPIES ++ default 1024 ++ ++config HIPOX_AHB_MONITOR_MODULE ++ tristate "Creates a loadable module to control the AHB monitors" ++ default n ++ help ++ This module publishes the current values of the AHB ++ monitors in the /proc filing system. ++ The monitors can be controlled by writing into this ++ filing system ++ ++config HIPOX_USB_TEST_MODES ++ tristate "Create a loadable module to control the USB port test modes" ++ default n ++ help ++ This module reports the port status and allows setting ++ of the test mode in the port register via the /proc ++ filing system. ++ ++config HIPOX_FRONT_LAMP_CONTROL ++ tristate "Front Panel LED control system" ++ depends on LEDS_CLASS ++ default n ++ help ++ This module reports drives a number of GPIOs as PWM signals to drive ++ front panel LEDs. The pattern displayed is dependent on system state. ++ ++config LEDS_TRIGGER_SATA_DISK ++ tristate "Front Panel SATA disk activity lamp control system" ++ default n ++ help ++ This module reports drives the SATA disk activity lamp. ++ ++config HIPOX_LED_TEST ++ bool "Exercise the WD LEDs" ++ default n ++ ++config HIPOX_I2C_SDA ++ int "I2C bit-bash data line" ++ default 2 ++ ++config HIPOX_I2C_SCL ++ int "I2C bit-bash clock line" ++ default 3 ++ ++config HIPOX_USB_PORTA_POWER_CONTROL ++ bool "Support USB port A power control lines" ++ default n ++ help ++ Whether to support power switch out and monitor in via GPIOs ++ for USB port A ++ ++config HIPOX_USB_PORTB_POWER_CONTROL ++ bool "Support USB port B power control lines" ++ default n ++ help ++ Whether to support power switch out and monitor in via GPIOs ++ for USB port B ++ ++config HIPOX_USB_PORTC_POWER_CONTROL ++ bool "Support USB port C power control lines" ++ default n ++ help ++ Whether to support power switch out and monitor in via GPIOs ++ for USB port C ++ ++config HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE ++ bool "Set USB power monitor input polarity to negative" ++ default n ++ help ++ n - Positive polarity ++ y - Negative polarity ++ ++config HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE ++ bool "Set USB power switch output polarity to negative" ++ default n ++ help ++ n - Positive polarity ++ y - Negative polarity ++ ++config WDC_FAN_HIPOX800 ++ tristate "WD NetCenter/2NC Fan control driver" ++ default n ++ help ++ This driver allows user-mode applications to control the cooling ++ fan on Western Digital's NetCenter/2NC platform. ++ ++config HIPOX_MAP_SRAM ++ bool "Allow part of kernel to be mapped into SRAM" ++ default n ++ ++config HIPOX_COPY_CODE_TO_SRAM ++ bool "Copy part of kernel to SRAM" ++ depends on HIPOX_MAP_SRAM ++ default n ++ ++config HIPOX_SUID_INHERIT ++ bool "Make SUID be inherited by subdirectories" ++ default n ++ ++config HIPOX_USB_HUB_SUPPORT ++ bool "Enable support for on-board USB hub" ++ default n ++ ++config HIPOX_USB_CKOUT ++ bool "Enable output of 12MHz USB clock on GPIO 10" ++ depends on HIPOX_USB_HUB_SUPPORT ++ default n ++ ++config HIPOX_USB_HUB_RESET_CONTROL ++ bool "Control the USB hub reset line" ++ depends on HIPOX_USB_HUB_SUPPORT ++ default n ++ ++config HIPOX_USB_HUB_RESET_GPIO ++ int "The GPIO connected to the USB hub reset" ++ depends on HIPOX_USB_HUB_RESET_CONTROL ++ default 27 ++ ++config HIPOX_USB_HUB_RESET_ACTIVE_HIGH ++ int "Set to 1 for active high, 0 for active low reset" ++ depends on HIPOX_USB_HUB_RESET_CONTROL ++ default 1 ++ ++config HIPOX_USB_HUB_RESET_TOGGLE ++ bool "Select to toggle reset, do not select to just deassert reset" ++ depends on HIPOX_USB_HUB_RESET_CONTROL ++ default y ++ ++config HIPOX_USB_HUB_RESET_PERIOD_MS ++ int "The period for which the USB hub reset should be asserted in milliseconds" ++ depends on HIPOX_USB_HUB_RESET_TOGGLE ++ default 100 ++ ++endmenu ++ ++endif +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/Makefile linux-2.6.24-oxe810/arch/arm/mach-hipox/Makefile +--- linux-2.6.24/arch/arm/mach-hipox/Makefile 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/Makefile 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,43 @@ ++# ++# Makefile for the linux kernel. ++# ++ ++# Object file lists. ++ ++obj-y := hipox.o irq.o time.o dma.o pci.o ahb_mon.o leon.o samba_reserve.o ++ ++obj-$(CONFIG_SYNOPSYS_GMAC) += gmac.o ++ ++gmac-objs := gmac-napi.o gmac_ethtool.o gmac_phy.o gmac_desc.o gmac_offload.o ++ ++obj-$(CONFIG_HIPOX_IBW) += ibw.o ++ ++obj-$(CONFIG_TACHO_THERM_AND_FAN) += thermAndFan.o ++ ++obj-$(CONFIG_I2S) += i2s.o ++ ++obj-$(CONFIG_CRYPTO_OXAESLRW) += cipher.o ++ ++obj-$(CONFIG_GPIO_TEST) += gpioTest.o ++ ++obj-$(CONFIG_I2S) += i2s.o ++ ++obj-$(CONFIG_DPE_TEST) += dpe_test.o ++ ++obj-$(CONFIG_HIPOX_AHB_MONITOR_MODULE) += hipox-ahb-monitor.o ++ ++obj-$(CONFIG_HIPOX_USB_TEST_MODES) += usb-test-mode.o ++ ++obj-$(CONFIG_LEON_POWER_BUTTON_MONITOR) += power_button.o ++ ++obj-$(CONFIG_USER_RECOVERY_BUTTON_MONITOR) += user_recovery_button.o ++ ++obj-$(CONFIG_HIPOX_FRONT_LAMP_CONTROL) += leds.o ++ ++obj-$(CONFIG_WDC_FAN_HIPOX800) += wdc-fan.o ++ ++obj-$(CONFIG_WDC_LEDS_HIPOX800) += wdc-leds.o ++ ++obj-$(CONFIG_HIPOX_WD810_LEDS) += hipox-wd810-leds.o ++ ++obj-$(CONFIG_WDC_LEDS_TRIGGER_SATA_DISK) += wdc-ledtrig-sata.o +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/Makefile.boot linux-2.6.24-oxe810/arch/arm/mach-hipox/Makefile.boot +--- linux-2.6.24/arch/arm/mach-hipox/Makefile.boot 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/Makefile.boot 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,3 @@ ++initrd_phys-$(CONFIG_ARCH_HIPOX) := 0x48200000 ++params_phys-$(CONFIG_ARCH_HIPOX) := 0x48000100 ++zreladdr-$(CONFIG_ARCH_HIPOX) := 0x48008000 +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/README linux-2.6.24-oxe810/arch/arm/mach-hipox/README +--- linux-2.6.24/arch/arm/mach-hipox/README 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/README 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,85 @@ ++ ++usb-test-modes ++ ++This is best built as a module which may be inserted into a running ++Linux system only when needed. ++The module can be built as part of the standard kernel module build ++if the correct options are chosen in the config. ++ ++ ++How to use: ++ ++copy the usb-test-mode.ko file somewhere convenient on the NAS and ++insert the module into the system using ++'modprobe usb-test-mode.ko' ++ ++It should report successfull loading or an error message. Assuming it is ++successful /proc will have an 'usb_test_mode' entry (verify with ls). ++ ++Actions: ++read the current port status: ++cat /proc/usb_test_mode/read ++ ++set port 1 into test mode 4: ++echo 4 > /proc/usb_test_mode/write1 ++ ++ ++When testing is completed the module can be removed from the linux ++system using: ++rmmod usb_test_mode ++ ++ahb_mon ++ ++This should be built as a module. ++ ++How to use: ++ ++insert the module into a working system by typing ++'modprobe hipox-ahb-monitor' ++ ++When successfully installed a directory entry will appear in /proc for ++hipox-ahb-monitor. In the directory will be a writeable file for each ++AHB monitor and a control file. There will also be a readable file for ++obtaining the counts stored in all the ahb monitors. ++ ++ ++Actions: ++set a monitor to a limited range, burst mode etc using ++low addres, high address, mode, burst mode, burst mask, hprot, hprot mask ++ ++Use the echo command to set data into the /proc/hipox-ahb-monitor an example is ++the following script to observe the activities of the ARM processor on the GMAC ++core when pinging a remote machine: ++--------------------------- ++#!/bin/sh -x ++# ++ ++# start montoring of ARM data bus to MAC ++# format is "low high mode burst mask hprot mask" ++# mode - 1 write 2 read 3 read write. ++ ++echo 2 > /proc/hipox-test/control ++ ++echo 0 > /proc/hipox-test/control ++ ++ ++echo "0x40400000,0x405fffff,3,0,0,0,0" > /proc/hipox-test/ARM_Data ++echo "0x40400000,0x405fffff,3,0,0,0,0" > /proc/hipox-test/Arm_Inst ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/CoPro ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/DMA_A ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/DMA_B ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/GMAC ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/PCI ++echo "0,4,3,0,0,0,0" > /proc/hipox-test/USBHS ++ ++echo 1 > /proc/hipox-test/control ++ ++ping -c 1 172.31.0.102 ++ ++echo 0 > /proc/hipox-test/control ++-------------------------------------- ++ ++When testing is commplete the module can be removed using ++rmmod hipox-ahb-monitor ++ ++ +Files linux-2.6.24/arch/arm/mach-hipox/ThermCalc.xls and linux-2.6.24-oxe810/arch/arm/mach-hipox/ThermCalc.xls differ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/ahb_mon.c linux-2.6.24-oxe810/arch/arm/mach-hipox/ahb_mon.c +--- linux-2.6.24/arch/arm/mach-hipox/ahb_mon.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/ahb_mon.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,177 @@ ++/* ++ * linux/arch/arm/mach-hipox/ahb_mon.c ++ * ++ * 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/kernel.h> ++#include <asm/io.h> ++#include <asm/arch/hardware.h> ++ ++#ifdef CONFIG_HIPOX_AHB_MON ++static void start_ahb_monitors(void) ++{ ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_D + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_I + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_A + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_B + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_LEON + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_USB + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_MAC + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_ACTIVE << AHB_MON_MODE_MODE_BIT, AHB_MON_PCI + AHB_MON_MODE_REG_OFFSET); ++} ++ ++void init_ahb_monitors( ++ AHB_MON_HWRITE_T ahb_mon_hwrite, ++ unsigned hburst_mask, ++ unsigned hburst_match, ++ unsigned hprot_mask, ++ unsigned hprot_match) ++{ ++ u32 hburst_mask_value = (hburst_mask & ((1 << AHB_MON_HBURST_MASK_NUM_BITS) - 1)); ++ u32 hburst_match_value = (hburst_match & ((1 << AHB_MON_HBURST_MATCH_NUM_BITS) - 1)); ++ u32 hprot_mask_value = (hprot_mask & ((1 << AHB_MON_HPROT_MASK_NUM_BITS) - 1)); ++ u32 hprot_match_value = (hprot_match & ((1 << AHB_MON_HPROT_MATCH_NUM_BITS) - 1)); ++ ++ u32 hburst_reg_value = (hburst_mask_value << AHB_MON_HBURST_MASK_BIT) | (hburst_match_value << AHB_MON_HBURST_MATCH_BIT); ++ u32 hprot_reg_value = (hprot_mask_value << AHB_MON_HPROT_MASK_BIT) | (hprot_match_value << AHB_MON_HPROT_MATCH_BIT); ++ ++printk("$Ghburst reg value = 0x%08x\n", hburst_reg_value); ++printk("$Ghprot reg value = 0x%08x\n", hprot_reg_value); ++ ++ // Reset all the counters and set their operating mode ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_D + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_ARM_D + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_ARM_D + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_ARM_D + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_ARM_D + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_ARM_D + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_I + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_ARM_I + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_ARM_I + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_ARM_I + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_ARM_I + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_ARM_I + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_A + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_DMA_A + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_DMA_A + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_DMA_A + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_DMA_A + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_DMA_A + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_B + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_DMA_B + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_DMA_B + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_DMA_B + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_DMA_B + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_DMA_B + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_LEON + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_LEON + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_LEON + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_LEON + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_LEON + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_LEON + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_USB + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_USB + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_USB + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_USB + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_USB + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_USB + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_MAC + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_MAC + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_MAC + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_MAC + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_MAC + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_MAC + AHB_MON_HPROT_REG_OFFSET); ++ ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_PCI + AHB_MON_MODE_REG_OFFSET); ++ writel(ahb_mon_hwrite << AHB_MON_HWRITE_COUNT_BIT, AHB_MON_PCI + AHB_MON_HWRITE_REG_OFFSET); ++ writel(0UL, AHB_MON_PCI + AHB_MON_HADDR_LOW_REG_OFFSET); ++ writel(~0UL, AHB_MON_PCI + AHB_MON_HADDR_HIGH_REG_OFFSET); ++ writel(hburst_reg_value, AHB_MON_PCI + AHB_MON_HBURST_REG_OFFSET); ++ writel(hprot_reg_value, AHB_MON_PCI + AHB_MON_HPROT_REG_OFFSET); ++ ++ // Start all the counters ++ start_ahb_monitors(); ++} ++ ++void restart_ahb_monitors(void) ++{ ++ // Reset the counters ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_D + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_I + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_A + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_B + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_LEON + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_USB + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_MAC + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_RESET << AHB_MON_MODE_MODE_BIT, AHB_MON_PCI + AHB_MON_MODE_REG_OFFSET); ++ ++ // Start the counters ++ start_ahb_monitors(); ++} ++ ++void read_ahb_monitors(void) ++{ ++ // Prepare the counters for reading ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_D + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_ARM_I + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_A + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_DMA_B + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_LEON + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_USB + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_MAC + AHB_MON_MODE_REG_OFFSET); ++ writel(AHB_MON_MODE_IDLE << AHB_MON_MODE_MODE_BIT, AHB_MON_PCI + AHB_MON_MODE_REG_OFFSET); ++ ++ // Read the counters ++ printk("ARM-D: B=%u, T=%u, W=%u\n", readl(AHB_MON_ARM_D + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_ARM_D + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_ARM_D + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("ARM-I: B=%u, T=%u, W=%u\n", readl(AHB_MON_ARM_I + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_ARM_I + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_ARM_I + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("DMA-A: B=%u, T=%u, W=%u\n", readl(AHB_MON_DMA_A + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_DMA_A + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_DMA_A + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("DMA-B: B=%u, T=%u, W=%u\n", readl(AHB_MON_DMA_B + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_DMA_B + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_DMA_B + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("LEON: B=%u, T=%u, W=%u\n", readl(AHB_MON_LEON + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_LEON + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_LEON + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("USB: B=%u, T=%u, W=%u\n", readl(AHB_MON_USB + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_USB + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_USB + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("MAC: B=%u, T=%u, W=%u\n", readl(AHB_MON_MAC + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_MAC + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_MAC + AHB_MON_WAITS_REG_OFFSET)); ++ ++ printk("PCI: B=%u, T=%u, W=%u\n", readl(AHB_MON_PCI + AHB_MON_CYCLES_REG_OFFSET), ++ readl(AHB_MON_PCI + AHB_MON_TRANSFERS_REG_OFFSET), ++ readl(AHB_MON_PCI + AHB_MON_WAITS_REG_OFFSET)); ++} ++#endif // CONFIG_HIPOX_AHB_MON ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/cipher.c linux-2.6.24-oxe810/arch/arm/mach-hipox/cipher.c +--- linux-2.6.24/arch/arm/mach-hipox/cipher.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/cipher.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,362 @@ ++/* linux/arch/arm/mach-hipox/cipher.c ++ * ++ * 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/types.h> ++#include <linux/sched.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/list.h> ++#include <linux/device.h> ++#include <linux/string.h> ++#include <linux/sysdev.h> ++#include <linux/highmem.h> ++#include <asm/semaphore.h> ++#include <asm/arch/cipher.h> ++#include <asm/io.h> ++#include <asm/arch/hardware.h> ++#include <linux/dma-mapping.h> ++#include <asm/arch/dma.h> ++#include <asm-arm/page.h> ++ ++ ++#if 0 ++#define DPRINTK(fmt, args...) printk(KERN_ERR "%s: " fmt, __FUNCTION__, ## args) ++#define VPRINTK(fmt, args...) printk(KERN_ERR "%s: " fmt, __FUNCTION__, ## args) ++#else ++#define DPRINTK(fmt, args...) ++#define VPRINTK(fmt, args...) ++#endif ++ ++//#define CIPHER_USE_SG_DMA ++ ++/*****************************************************************************/ ++ ++typedef struct ox800_aeslrw_driver ox800_aeslrw_driver_t; ++ ++struct ox800_aeslrw_driver { ++ struct device dev; ++ struct semaphore core; ++ int result; ++ u8 cipher_key[OX800DPE_KEYSIZE]; ++ u8 tweak_key[OX800DPE_KEYSIZE]; ++}; ++ ++static ox800_aeslrw_driver_t ox800_aeslrw_driver; ++ ++ ++/*****************************************************************************/ ++ ++/** ++ * Sets the keys only if they have changed. ++ * @param cipher_key 16 byte array that is the cipher key ++ * @param tweak_key 16 byte array that is the I-Value tweak key ++ */ ++static void ox800_aeslrw_setkeys(u8* cipher_key, u8* tweak_key) ++{ ++ VPRINTK(KERN_INFO"\n"); ++ ++ /* ++ * changing the keys can take a long time as the core will ++ * compute internal values based on the keys ++ */ ++ if (memcmp(&(ox800_aeslrw_driver.cipher_key[0]), cipher_key, OX800DPE_KEYSIZE) || ++ memcmp(&(ox800_aeslrw_driver.tweak_key[0]), tweak_key, OX800DPE_KEYSIZE) ) ++ { ++ u32* key; ++ unsigned int i; ++ ++ DPRINTK(KERN_INFO"cipher key ="); ++ for (i = 0; i < OX800DPE_KEYSIZE; ++i) ++ DPRINTK("%02x", cipher_key[i]); ++ DPRINTK("\n"); ++ DPRINTK(KERN_INFO"tweak key ="); ++ for (i = 0; i < OX800DPE_KEYSIZE; ++i) ++ DPRINTK("%02x", tweak_key[i]); ++ DPRINTK("\n"); ++ ++ /* update stored values */ ++ memcpy(&(ox800_aeslrw_driver.cipher_key[0]), cipher_key, OX800DPE_KEYSIZE); ++ memcpy(&(ox800_aeslrw_driver.tweak_key[0]), tweak_key, OX800DPE_KEYSIZE); ++ ++ /* update hardware values */ ++ key = (u32* )cipher_key; ++ writel(key[0], OX800DPE_KEY00 ); ++ writel(key[1], OX800DPE_KEY01 ); ++ writel(key[2], OX800DPE_KEY02 ); ++ writel(key[3], OX800DPE_KEY03 ); ++ ++ key = (u32* )tweak_key; ++ writel(key[0], OX800DPE_KEY10 ); ++ writel(key[1], OX800DPE_KEY11 ); ++ writel(key[2], OX800DPE_KEY12 ); ++ writel(key[3], OX800DPE_KEY13 ); ++ } ++} ++ ++/** ++ * Generic LRW-AES en/decryption ++ * @param encrypt non-zero to encrypt, zero to decrypt ++ * @param in Source of data ++ * @param out Location to place en/decrypted data ++ * @param nents Number of entries in scatter list, in and out must have the same ++ * number of entries ++ * @param iv 8 byte array containing the I-Value ++ * @return error code or 0 for success ++ */ ++static int ox800_aeslrw_gencrypt( u8 encrypt, ++ struct scatterlist* in, ++ struct scatterlist* out, ++ unsigned int nents, ++ u8 iv[]) ++{ ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ struct scatterlist* out_; ++ char same_buffer; ++ int status = 0; ++ ++ /* get dma resources (non blocking) */ ++ dma_in = hipox_dma_request(0); ++ dma_out = hipox_dma_request(0); ++ ++ VPRINTK("dma in %d out %d \n", ++ dma_in->channel_number_, ++ dma_out->channel_number_); ++ ++ if ((dma_in) && (dma_out)) { ++ u32 reg; ++ ++ // shouldn't be busy or full ++ reg = readl( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ printk("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ printk("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ printk("rx not empty after abort toggle"); ++ ++ /* check to see if the destination buffer is the same as the source */ ++ same_buffer = (in->page == out->page); ++ ++ /* map transfers */ ++ if (same_buffer) { ++ dma_map_sg(NULL, in, nents, DMA_BIDIRECTIONAL); ++ out_ = in; ++ } else { ++ /* map transfers */ ++ dma_map_sg(NULL, in, nents, DMA_TO_DEVICE); ++ dma_map_sg(NULL, out, nents, DMA_FROM_DEVICE); ++ out_ = out; ++ } ++#ifdef CIPHER_USE_SG_DMA ++ /* setup DMA transfers */ ++ hipox_dma_device_set_sg( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ in, ++ nents, ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC); ++ ++ hipox_dma_device_set_sg( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ out_, ++ nents, ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC); ++ ++#else ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (unsigned char* )sg_dma_address(in), ++ sg_dma_len(in), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ 1 /*paused */ ); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (unsigned char* )sg_dma_address(out_), ++ sg_dma_len(out_), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ 1 /*paused */ ); ++#endif ++ ++ /* set dma callbacks */ ++ hipox_dma_set_callback( ++ dma_in, ++ HIPOX_DMA_CALLBACK_ARG_NUL, ++ HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ hipox_dma_set_callback( ++ dma_out, ++ HIPOX_DMA_CALLBACK_ARG_NUL, ++ HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ ++ /* set for AES LRW encryption or decryption */ ++ writel( (encrypt ? OX800DPE_CTL_DIRECTION_ENC : 0 ) | ++ OX800DPE_CTL_MODE_LRW_AES, ++ OX800DPE_CONTROL); ++ wmb(); ++ ++ /* write in I-value */ ++ writel(*((u32* )&(iv[0])), OX800DPE_DATA_LRW0 ); ++ writel(*((u32* )&(iv[4])), OX800DPE_DATA_LRW1 ); ++ ++ wmb(); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & readl( OX800DPE_STATUS )) ); ++ ++ /* start dma */ ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait (once for each channel) */ ++ while ( hipox_dma_is_active( dma_out ) || ++ hipox_dma_is_active( dma_in ) ) ++ { ++ schedule(); ++ } ++ ++ /* free any allocated dma channels */ ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ /* unmap transfers */ ++ if (same_buffer) { ++ dma_unmap_sg(NULL, in, nents, DMA_BIDIRECTIONAL); ++ } else { ++ dma_unmap_sg(NULL, in, nents, DMA_TO_DEVICE); ++ dma_unmap_sg(NULL, out, nents, DMA_FROM_DEVICE); ++ } ++ ++ status = ox800_aeslrw_driver.result; ++ } else { ++ /* free any allocated dma channels */ ++ if (dma_in) ++ hipox_dma_free( dma_in ); ++ if (dma_out) ++ hipox_dma_free( dma_out ); ++ status = -EBUSY; ++ } ++ /* return an indication of success */ ++ return status; ++} ++ ++/** ++ * Performs LRW-AES encryption. ++ * @param in Source of data ++ * @param out Location to place encrypted data ++ * @param nents Number of entries in scatter list, in and out must have the same ++ * number of entries ++ * @param iv I-Value ++ * @param cipher_key 16 byte array that is the cipher key ++ * @param tweak_key 16 byte array that is the I-Value tweak key ++ * @return error code or 0 for success ++ */ ++int ox800_aeslrw_encrypt( struct scatterlist* in, ++ struct scatterlist* out, ++ unsigned int nents, ++ u8* iv, ++ u8* cipher_key, ++ u8* tweak_key) ++{ ++ int localresult; ++ ++ VPRINTK(KERN_INFO"in %p, out %p, nents %d, iv %08x%08x, ckey %p, tkey %p\n", ++ in, out, nents, *((u32* )(&iv[4])), *((u32* )(&iv[0])), cipher_key, tweak_key ); ++ ++ /* get cipher core */ ++ while( down_interruptible(&ox800_aeslrw_driver.core) ) ; ++ ++ VPRINTK(KERN_INFO"got core\n"); ++ ++ ox800_aeslrw_setkeys(cipher_key, tweak_key); ++ localresult = ox800_aeslrw_gencrypt( 1, in, out, nents, iv); ++ ++ up(&ox800_aeslrw_driver.core); ++ VPRINTK(KERN_INFO"released\n"); ++ ++ return localresult; ++} ++ ++/** ++ * Performs LRW-AES decryption. ++ * @param in Source of data ++ * @param out Location to place decrypted data ++ * @param nents Number of entries in scatter list, in and out must have the same ++ * number of entries ++ * @param iv I-Value ++ * @param cipher_key 16 byte array that is the cipher key ++ * @param tweak_key 16 byte array that is the I-Value tweak key ++ * @return error code or 0 for success ++ */ ++int ox800_aeslrw_decrypt( struct scatterlist* in, ++ struct scatterlist* out, ++ unsigned int nents, ++ u8* iv, ++ u8* cipher_key, ++ u8* tweak_key) ++{ ++ int localresult; ++ ++ VPRINTK(KERN_INFO"in %p, out %p, nents %d, iv %08x%08x, ckey %p, tkey%p\n", ++ in, out, nents, *((u32* )(&iv[4])), *((u32* )(&iv[0])), cipher_key, tweak_key ); ++ ++ /* get cipher core */ ++ while( down_interruptible(&ox800_aeslrw_driver.core) ) ; ++ ++ VPRINTK(KERN_INFO"got core\n"); ++ ++ ox800_aeslrw_setkeys(cipher_key, tweak_key); ++ localresult = ox800_aeslrw_gencrypt( 0, in, out, nents, iv); ++ ++ up(&ox800_aeslrw_driver.core); ++ VPRINTK(KERN_INFO"released core \n"); ++ ++ return localresult; ++} ++ ++/** ++ * module initialisation ++ * @return success is 0 ++ */ ++static int __init ox800_aeslrw_init( void ) ++{ ++ VPRINTK(KERN_INFO"\n"); ++ ++ /* Enable the clock to the DPE block */ ++ writel(1UL << SYS_CTRL_CKEN_DPE_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* Bring out of reset */ ++ writel(1UL << SYS_CTRL_RSTEN_DPE_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ /* initialise in unlocked state */ ++ init_MUTEX(&ox800_aeslrw_driver.core); ++ ++ return 0; ++} ++ ++/** ++ * module cleanup ++ */ ++static void __exit ox800_aeslrw_exit( void ) ++{ ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(ox800_aeslrw_init); ++module_exit(ox800_aeslrw_exit); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/dma.c linux-2.6.24-oxe810/arch/arm/mach-hipox/dma.c +--- linux-2.6.24/arch/arm/mach-hipox/dma.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/dma.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,2849 @@ ++/* ++ * linux/arch/arm/mach-hipox/dma.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 <asm/dma.h> ++#include <asm/io.h> ++#include <asm/irq.h> ++#include <asm/arch/hardware.h> ++#include <linux/bitops.h> ++#include <linux/dma-mapping.h> ++#include <linux/dmapool.h> ++#include <linux/init.h> ++#include <linux/interrupt.h> ++#include <linux/delay.h> ++#include <asm/arch/desc_alloc.h> ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#include <asm/checksum.h> ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++//#define DMA_DEBUG ++ ++#ifdef HIPOX_DMA_TEST ++#define DMA_DEBUG ++static void dma_test(unsigned long length); ++#endif // HIPOX_DMA_TEST ++ ++#ifdef HIPOX_DMA_SG_TEST ++#define DMA_DEBUG ++static void dma_sg_test(void); ++#endif // HIPOX_DMA_SG_TEST ++ ++#ifdef HIPOX_DMA_SG_TEST_2 ++#define DMA_DEBUG ++static void dma_sg_test2(void); ++#endif // HIPOX_DMA_SG_TEST_2 ++ ++#ifdef DMA_DEBUG ++#define DBG(args...) printk(args) ++#else ++#define DBG(args...) do { } while(0) ++#endif ++ ++// Normal (non-SG) registers ++#define DMA_REGS_PER_CHANNEL 8 ++ ++#define DMA_CTRL_STATUS 0x0 ++#define DMA_BASE_SRC_ADR 0x4 ++#define DMA_BASE_DST_ADR 0x8 ++#define DMA_BYTE_CNT 0xC ++#define DMA_CURRENT_SRC_ADR 0x10 ++#define DMA_CURRENT_DST_ADR 0x14 ++#define DMA_CURRENT_BYTE_CNT 0x18 ++#define DMA_INTR_ID 0x1C ++#define DMA_INTR_CLEAR_REG (DMA_CURRENT_SRC_ADR) ++ ++// 8 quad-sized registers per channel arranged contiguously ++#define DMA_CALC_REG_ADR(channel, register) (DMA_BASE + ((channel) << 5) + (register)) ++ ++#define DMA_CTRL_STATUS_FAIR_SHARE_ARB (1 << 0) ++#define DMA_CTRL_STATUS_IN_PROGRESS (1 << 1) ++#define DMA_CTRL_STATUS_SRC_DREQ_MASK (0x0000003C) ++#define DMA_CTRL_STATUS_SRC_DREQ_SHIFT 2 ++#define DMA_CTRL_STATUS_DEST_DREQ_MASK (0x000003C0) ++#define DMA_CTRL_STATUS_DEST_DREQ_SHIFT 6 ++#define DMA_CTRL_STATUS_INTR (1 << 10) ++#define DMA_CTRL_STATUS_NXT_FREE (1 << 11) ++#define DMA_CTRL_STATUS_RESET (1 << 12) ++#define DMA_CTRL_STATUS_DIR_MASK (0x00006000) ++#define DMA_CTRL_STATUS_DIR_SHIFT 13 ++#define DMA_CTRL_STATUS_SRC_ADR_MODE (1 << 15) ++#define DMA_CTRL_STATUS_DEST_ADR_MODE (1 << 16) ++#define DMA_CTRL_STATUS_TRANSFER_MODE_A (1 << 17) ++#define DMA_CTRL_STATUS_TRANSFER_MODE_B (1 << 18) ++#define DMA_CTRL_STATUS_SRC_WIDTH_MASK (0x00380000) ++#define DMA_CTRL_STATUS_SRC_WIDTH_SHIFT 19 ++#define DMA_CTRL_STATUS_DEST_WIDTH_MASK (0x01C00000) ++#define DMA_CTRL_STATUS_DEST_WIDTH_SHIFT 22 ++#define DMA_CTRL_STATUS_PAUSE (1 << 25) ++#define DMA_CTRL_STATUS_INTERRUPT_ENABLE (1 << 26) ++#define DMA_CTRL_STATUS_SOURCE_ADDRESS_FIXED (1 << 27) ++#define DMA_CTRL_STATUS_DESTINATION_ADDRESS_FIXED (1 << 28) ++#define DMA_CTRL_STATUS_STARVE_LOW_PRIORITY (1 << 29) ++#define DMA_CTRL_STATUS_INTR_CLEAR_ENABLE (1 << 30) ++ ++#define DMA_BYTE_CNT_MASK ((1 << 21) - 1) ++#define DMA_BYTE_CNT_INC4_SET_MASK (1 << 28) ++#define DMA_BYTE_CNT_HPROT_MASK (1 << 29) ++#define DMA_BYTE_CNT_WR_EOT_MASK (1 << 30) ++#define DMA_BYTE_CNT_RD_EOT_MASK (1 << 31) ++ ++#define DMA_INTR_ID_GET_NUM_CHANNELS(reg_contents) (((reg_contents) >> 16) & 0xFF) ++#define DMA_INTR_ID_GET_VERSION(reg_contents) (((reg_contents) >> 24) & 0xFF) ++#define DMA_INTR_ID_INT_BIT 0 ++#define DMA_INTR_ID_INT_NUM_BITS (MAX_HIPOX_DMA_CHANNELS) ++#define DMA_INTR_ID_INT_MASK (((1 << DMA_INTR_ID_INT_NUM_BITS) - 1) << DMA_INTR_ID_INT_BIT) ++ ++#define DMA_HAS_V4_INTR_CLEAR(version) ((version) > 3) ++ ++// H/W scatter gather controller registers ++#define HIPOX_DMA_NUM_SG_REGS 4 ++ ++#define DMA_SG_CONTROL 0x0 ++#define DMA_SG_STATUS 0x04 ++#define DMA_SG_REQ_PTR 0x08 ++#define DMA_SG_RESETS 0x0C ++ ++#define DMA_SG_CALC_REG_ADR(channel, register) ((DMA_SG_BASE) + ((channel) << 4) + (register)) ++ ++// SG DMA controller control register field definitions ++#define DMA_SG_CONTROL_START_BIT 0 ++#define DMA_SG_CONTROL_QUEUING_ENABLE_BIT 1 ++#define DMA_SG_CONTROL_HBURST_ENABLE_BIT 2 ++ ++// SG DMA controller status register field definitions ++#define DMA_SG_STATUS_ERROR_CODE_BIT 0 ++#define DMA_SG_STATUS_ERROR_CODE_NUM_BITS 6 ++#define DMA_SG_STATUS_BUSY_BIT 7 ++ ++// SG DMA controller sub-block resets register field definitions ++#define DMA_SG_RESETS_CONTROL_BIT 0 ++#define DMA_SG_RESETS_ARBITER_BIT 1 ++#define DMA_SG_RESETS_AHB_BIT 2 ++ ++// hipox_dma_sg_info_t qualifier field definitions ++#define HIPOX_DMA_SG_QUALIFIER_BIT 0 ++#define HIPOX_DMA_SG_QUALIFIER_NUM_BITS 16 ++#define HIPOX_DMA_SG_DST_EOT_BIT 16 ++#define HIPOX_DMA_SG_DST_EOT_NUM_BITS 2 ++#define HIPOX_DMA_SG_SRC_EOT_BIT 20 ++#define HIPOX_DMA_SG_SRC_EOT_NUM_BITS 2 ++#define HIPOX_DMA_SG_CHANNEL_BIT 24 ++#define HIPOX_DMA_SG_CHANNEL_NUM_BITS 8 ++ ++// Valid address bits mask ++#define HIPOX_DMA_ADR_MASK ((1UL << (MEM_MAP_ALIAS_SHIFT)) - 1) ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define HIPOX_DMA_CSUM_ADR_MASK ((HIPOX_DMA_ADR_MASK) | (1UL << (HIPOX_DMA_CSUM_ENABLE_ADR_BIT))) ++#else ++#define HIPOX_DMA_CSUM_ADR_MASK (HIPOX_DMA_ADR_MASK) ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++/* The available buses to which the DMA controller is attached */ ++typedef enum hipox_dma_transfer_bus ++{ ++ HIPOX_DMA_SIDE_A, ++ HIPOX_DMA_SIDE_B ++} hipox_dma_transfer_bus_t; ++ ++/* Direction of data flow between the DMA controller's pair of interfaces */ ++typedef enum hipox_dma_transfer_direction ++{ ++ HIPOX_DMA_A_TO_A, ++ HIPOX_DMA_B_TO_A, ++ HIPOX_DMA_A_TO_B, ++ HIPOX_DMA_B_TO_B ++} hipox_dma_transfer_direction_t; ++ ++/* The available data widths */ ++typedef enum hipox_dma_transfer_width ++{ ++ HIPOX_DMA_TRANSFER_WIDTH_8BITS, ++ HIPOX_DMA_TRANSFER_WIDTH_16BITS, ++ HIPOX_DMA_TRANSFER_WIDTH_32BITS ++} hipox_dma_transfer_width_t; ++ ++/* The mode of the DMA transfer */ ++typedef enum hipox_dma_transfer_mode ++{ ++ HIPOX_DMA_TRANSFER_MODE_SINGLE, ++ HIPOX_DMA_TRANSFER_MODE_BURST ++} hipox_dma_transfer_mode_t; ++ ++/* The available transfer targets */ ++typedef enum hipox_dma_dreq ++{ ++ HIPOX_DMA_DREQ_PATA = 0, ++ HIPOX_DMA_DREQ_SATA = 0, ++ HIPOX_DMA_DREQ_DPE_RX = 1, ++ HIPOX_DMA_DREQ_DPE_TX = 2, ++ HIPOX_DMA_DREQ_AUDIO_TX = 5, ++ HIPOX_DMA_DREQ_AUDIO_RX = 6, ++ HIPOX_DMA_DREQ_MEMORY = 15 ++} hipox_dma_dreq_t; ++ ++/* Pre-defined settings for known DMA devices */ ++hipox_dma_device_settings_t hipox_pata_dma_settings = { ++ .address_ = 0, ++ .fifo_size_ = 16, ++ .dreq_ = HIPOX_DMA_DREQ_PATA, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .write_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .bus_ = HIPOX_DMA_SIDE_A, ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 0 ++}; ++ ++hipox_dma_device_settings_t hipox_sata_dma_settings = { ++ .address_ = SATA_DATA_BASE_PA, ++ .fifo_size_ = 16, ++ .dreq_ = HIPOX_DMA_DREQ_SATA, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .write_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .bus_ = HIPOX_DMA_SIDE_A, ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 0 ++}; ++ ++hipox_dma_device_settings_t hipox_dpe_rx_dma_settings = { ++ .address_ = DPE_BASE_PA, ++ .fifo_size_ = 16, ++ .dreq_ = HIPOX_DMA_DREQ_DPE_RX, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .write_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .bus_ = HIPOX_DMA_SIDE_A, ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 0 ++}; ++ ++hipox_dma_device_settings_t hipox_dpe_tx_dma_settings = { ++ .address_ = DPE_BASE_PA, ++ .fifo_size_ = 16, ++ .dreq_ = HIPOX_DMA_DREQ_DPE_TX, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .write_eot_policy_ = HIPOX_DMA_EOT_FINAL, ++ .bus_ = HIPOX_DMA_SIDE_A, ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 0 ++}; ++ ++/* For use with normal memory to memory transfers as the settings for the source ++ * of the transfer */ ++hipox_dma_device_settings_t hipox_ram_only_src_dma_settings = { ++ .address_ = 0, ++ .fifo_size_ = 0, ++ .dreq_ = HIPOX_DMA_DREQ_MEMORY, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, // Won't interfere with checksumming transfers, as csum only latched if high order address bit set ++ .write_eot_policy_ = HIPOX_DMA_EOT_NONE, ++ .bus_ = HIPOX_DMA_SIDE_A, // Maximise performance with src on side A while dst in on side B ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 1 ++}; ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++/* For use with checksumming transfers as the settings for the source of the ++ * transfer */ ++hipox_dma_device_settings_t hipox_ram_csum_src_dma_settings = { ++ .address_ = 0, ++ .fifo_size_ = 0, ++ .dreq_ = HIPOX_DMA_DREQ_MEMORY, ++ .read_eot_policy_ = HIPOX_DMA_EOT_FINAL, // To enable checksum accumulation ++ .write_eot_policy_ = HIPOX_DMA_EOT_NONE, ++ .bus_ = HIPOX_DMA_SIDE_A, // Checksumming happens on read from side A only ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 1 ++}; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++/* For use in all occasions not covered by hipox_ram_only_src_dma_settings and ++ * hipox_ram_csum_src_dma_settings */ ++hipox_dma_device_settings_t hipox_ram_generic_dma_settings = { ++ .address_ = 0, ++ .fifo_size_ = 0, ++ .dreq_ = HIPOX_DMA_DREQ_MEMORY, ++ .read_eot_policy_ = HIPOX_DMA_EOT_NONE, // Don't interfere with any checksumming transfers ++ .write_eot_policy_ = HIPOX_DMA_EOT_NONE, ++ .bus_ = HIPOX_DMA_SIDE_B, ++ .width_ = HIPOX_DMA_TRANSFER_WIDTH_32BITS, ++ .transfer_mode_ = HIPOX_DMA_TRANSFER_MODE_BURST, ++ .address_mode_ = HIPOX_DMA_MODE_FIXED, ++ .address_really_fixed_ = 1 ++}; ++ ++static hipox_dma_controller_t dma_controller; ++ ++/** ++ * Acquisition of a SG DMA descriptor list entry ++ * If called from non-atomic context the call could block. ++ */ ++static hipox_dma_sg_entry_t* alloc_sg_entry(int in_atomic) ++{ ++ hipox_dma_sg_entry_t* entry = 0; ++ if (in_atomic) { ++ if (down_trylock(&dma_controller.sg_entry_sem_)) { ++ return (hipox_dma_sg_entry_t*)0; ++ } ++ } else { ++ // Wait for an entry to be available ++ while (down_interruptible(&dma_controller.sg_entry_sem_)); ++ } ++ ++ // Serialise while manipulating free list ++ spin_lock_bh(&dma_controller.alloc_spinlock_); ++ ++ // It's an error if there isn't a buffer available at this point ++ BUG_ON(!dma_controller.sg_entry_head_); ++ ++ // Unlink the head entry on the free list and return it to caller ++ entry = dma_controller.sg_entry_head_; ++ dma_controller.sg_entry_head_ = dma_controller.sg_entry_head_->next_; ++ --dma_controller.sg_entry_available_; ++ ++ // Finished manipulating free list ++ spin_unlock_bh(&dma_controller.alloc_spinlock_); ++ ++ return entry; ++} ++ ++static void free_sg_entry(hipox_dma_sg_entry_t* entry) ++{ ++ // Serialise while manipulating free list ++ spin_lock(&dma_controller.alloc_spinlock_); ++ ++ // Insert the freed buffer at the head of the free list ++ entry->next_ = dma_controller.sg_entry_head_; ++ dma_controller.sg_entry_head_ = entry; ++ ++dma_controller.sg_entry_available_; ++ ++ // Finished manipulating free list ++ spin_unlock(&dma_controller.alloc_spinlock_); ++ ++ // Make freed buffer available for allocation ++ up(&dma_controller.sg_entry_sem_); ++} ++ ++void hipox_dma_free_sg_entries(hipox_dma_sg_entry_t* entries) ++{ ++ while (entries) { ++ hipox_dma_sg_entry_t* next = entries->next_; ++ free_sg_entry(entries); ++ entries = next; ++ } ++} ++ ++/** ++ * This implementation is not the most efficient, as it could result in alot ++ * of alloc's only to decide to free them all as not sufficient available, but ++ * in practice we would hope there will not be much contention for entries ++ */ ++int hipox_dma_alloc_sg_entries( ++ hipox_dma_sg_entry_t **entries, ++ unsigned required, ++ int in_atomic) ++{ ++ if (likely(required)) { ++ hipox_dma_sg_entry_t* prev; ++ hipox_dma_sg_entry_t* entry; ++ unsigned acquired = 0; ++ ++ *entries = alloc_sg_entry(in_atomic); ++ if (!*entries) { ++ return 1; ++ } ++ ++ (*entries)->next_ = 0; ++ prev = *entries; ++ ++ while (++acquired < required) { ++ entry = alloc_sg_entry(in_atomic); ++ if (!entry) { ++ // Did not acquire the entry ++ hipox_dma_free_sg_entries(*entries); ++ return 1; ++ } ++ entry->next_ = 0; ++ prev->next_ = entry; ++ prev = entry; ++ } ++ } ++ ++ return 0; ++} ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++/** ++ * Blocking acquisition of the checksum engine ++ */ ++static inline int alloc_csum_engine(int in_atomic) ++{ ++#ifdef CONFIG_LEON_RESERVE_DMA_CHANNEL ++ // Checksum engine is allocated exclusively to the CoPro ++ return 1; ++#else ++ if (in_atomic) { ++ return down_trylock(&dma_controller.csum_engine_sem_); ++ } else { ++ while (1) { ++ if (!down_interruptible(&dma_controller.csum_engine_sem_)) { ++ return 0; ++ } ++ } ++ } ++#endif // CONFIG_LEON_RESERVE_DMA_CHANNEL ++} ++ ++static inline void free_csum_engine(void) ++{ ++ up(&dma_controller.csum_engine_sem_); ++} ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++/** ++ * Optionally blocking acquisition of a DMA channel ++ * May be invoked either at task or softirq level ++ */ ++hipox_dma_channel_t* hipox_dma_request(int block) ++{ ++ hipox_dma_channel_t* channel = HIPOX_DMA_CHANNEL_NUL; ++ while (channel == HIPOX_DMA_CHANNEL_NUL) { ++ if (block) { ++ // Wait for a channel to be available ++ if (down_interruptible(&dma_controller.channel_sem_)) { ++ // Awoken by signal ++ continue; ++ } ++ } else { ++ // Non-blocking test of whether a channel is available ++ if (down_trylock(&dma_controller.channel_sem_)) { ++ // No channel available so return to user immediately ++ break; ++ } ++ } ++ ++ // Serialise while manipulating free list ++ spin_lock_bh(&dma_controller.channel_alloc_spinlock_); ++ ++ // It's an error if there isn't a channel available at this point ++ BUG_ON(!dma_controller.channel_head_); ++ ++ // Unlink the head entry on the free list and return it to caller ++ channel = dma_controller.channel_head_; ++ dma_controller.channel_head_ = dma_controller.channel_head_->next_; ++ ++ // Finished manipulating free list ++ spin_unlock_bh(&dma_controller.channel_alloc_spinlock_); ++ } ++ return channel; ++} ++ ++/** ++ * May be invoked either at task or softirq level ++ */ ++void hipox_dma_free(hipox_dma_channel_t* channel) ++{ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_free() Freeing channel %u while active\n", channel->channel_number_); ++ } ++ ++ // Serialise while manipulating free list ++ spin_lock_bh(&dma_controller.channel_alloc_spinlock_); ++ ++ // Insert the freed buffer at the head of the free list ++ channel->next_ = dma_controller.channel_head_; ++ dma_controller.channel_head_ = channel; ++ ++ // Finished manipulating free list ++ spin_unlock_bh(&dma_controller.channel_alloc_spinlock_); ++ ++ // Make freed buffer available for allocation ++ up(&dma_controller.channel_sem_); ++} ++ ++/** Shared between all DMA interrupts and run with interrupts enabled, thus any ++ * access to shared data structures must be sync'ed ++ */ ++static irqreturn_t hipox_dma_interrupt(int irq, void *dev_id) ++{ ++ hipox_dma_channel_t *channel = 0; ++ unsigned channel_number = 0; ++ int need_bh = 0; ++ ++DBG("hipox_dma_interrupt() from interrupt line %u\n", irq); ++ ++ // Only acknowledge interrupts from the channel directly responsible for the ++ // RPS interrupt line which caused the ISR to be entered, to get around the ++ // problem that the SG-DMA controller can only filter DMA interrupts exter- ++ // nally to the DMA controller, i.e. the DMA controller interrupt status ++ // register always shows all active interrupts for all channels, regardless ++ // of whether the SG-DMA controller is filtering them ++ ++ // Find the DMA channel that can generate interrupts on the RPS interrupt ++ // line which caused the ISR to be invoked. ++ if (likely(irq == DMA_INTERRUPT_4)) { ++ channel = &dma_controller.channels_[4]; ++ } else { ++ channel = &dma_controller.channels_[irq - DMA_INTERRUPT_0]; ++ } ++ channel_number = channel->channel_number_; ++DBG("RPS interrupt %u from channel %u\n", irq, channel_number); ++ ++ // Non-SG transfers have no completion status, so initialise ++ // channel's error code to no-error. If transfer turns out to ++ // have been SG, this status will be overwritten ++ channel->error_code_ = HIPOX_DMA_ERROR_CODE_NONE; ++ ++ // Must finish in bottom half if checksumming or need to invoke callback ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ need_bh = channel->checksumming_ || ++#else // CONFIG_HIPOX_VERSION_0X800 ++ need_bh = ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ (channel->notification_callback_ != HIPOX_DMA_CALLBACK_NUL); ++ ++ // Cope with the DMA controller's ability to have a pair of chained ++ // transfers which have both completed, which causes the interrupt request ++ // to stay active until both have been acknowledged, which is causing the SG ++ // controller problems ++ while (readl(DMA_CALC_REG_ADR(0, DMA_INTR_ID)) & (1 << channel_number)) { ++DBG("Ack'ing interrupt for channel %u\n", channel_number); ++ // Write to the interrupt clear register to clear interrupt ++ writel(0, DMA_CALC_REG_ADR(channel_number, DMA_INTR_CLEAR_REG)); ++ ++ // Record how many interrupts are awaiting service ++ atomic_inc(&channel->interrupt_count_); ++ } ++DBG("Left int ack'ing loop\n"); ++ ++ // If was a SG transfer, record the completion status ++ if (channel->v_sg_info_->v_srcEntries_) { ++ // Record the SG transfer completion status ++ u32 error_code = readl(DMA_SG_CALC_REG_ADR(channel_number, DMA_SG_STATUS)); ++ channel->error_code_ = ++ ((error_code >> DMA_SG_STATUS_ERROR_CODE_BIT) & ++ ((1UL << DMA_SG_STATUS_ERROR_CODE_NUM_BITS) - 1)); ++ ++ if (channel->auto_sg_entries_) { ++ // Must finish in bottom half if we are to manage the SG entries ++DBG("ISR channel %d is auto SG\n", channel->channel_number_); ++ need_bh = 1; ++ } else { ++DBG("ISR channel %d not auto SG\n", channel->channel_number_); ++ // Zeroise SG DMA descriptor info ++ channel->v_sg_info_->p_srcEntries_ = 0; ++ channel->v_sg_info_->v_srcEntries_ = 0; ++ channel->v_sg_info_->p_dstEntries_ = 0; ++ channel->v_sg_info_->v_dstEntries_ = 0; ++ } ++ ++DBG("Return SG controller to idle, error_code = 0x%08x\n", error_code); ++ // Return the SG DMA controller to the IDLE state and clear any SG ++ // controller error interrupt ++ writel(1, DMA_SG_CALC_REG_ADR(channel_number, DMA_SG_STATUS)); ++ } ++ ++ // Can we finish w/o invoking bottom half? ++ if (likely(!need_bh)) { ++DBG("ISR channel %d do not call bh\n", channel->channel_number_); ++ atomic_set(&channel->interrupt_count_, 0); ++ atomic_set(&channel->active_count_, 0); ++ } else { ++DBG("Marking channel %d as requiring its bottom half to run\n", channel_number); ++ // Set a flag for the channel to cause its bottom half to be run ++ set_bit(channel_number, (void*)&dma_controller.run_bh_); ++ ++DBG("Scheduling tasklet\n"); ++ // Signal the bottom half to perform the notifications ++ tasklet_schedule(&dma_controller.tasklet_); ++ } ++ ++DBG("Returning\n"); ++ return IRQ_HANDLED; ++} ++ ++static void fake_interrupt(int channel) ++{ ++ // Set a flag to cause the bottom half handler to be run for the channel ++ set_bit(channel, (void*)&dma_controller.run_bh_); ++ ++ // Signal the bottom half to perform the notifications ++ tasklet_schedule(&dma_controller.tasklet_); ++} ++ ++static void dma_bh(unsigned long data) ++{ ++ // Check for any bottom halves having become ready to run ++ u32 run_bh = atomic_read(&dma_controller.run_bh_); ++ while (run_bh) { ++ unsigned i; ++ ++ // Free any checksumming or SG resources ++ u32 temp_run_bh = run_bh; ++ for (i = 0; i < dma_controller.numberOfChannels_; i++, temp_run_bh >>= 1) { ++ if (temp_run_bh & 1) { ++ hipox_dma_channel_t* channel = &dma_controller.channels_[i]; ++DBG("Bottom halve for channel %u\n", channel->channel_number_); ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ // If this channel computed a checksum ++ if (unlikely(channel->checksumming_)) { ++ // Read the result of the checksum calculation, clearing the ++ // result in the process ++ channel->checksum_ = readl(DMA_CHECKSUM_BASE); ++ channel->checksumming_ = 0; ++ ++ // Relinquish ownership of the checksum engine ++ free_csum_engine(); ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ if (channel->auto_sg_entries_) { ++ // Free SG DMA source descriptor resources ++ hipox_dma_sg_entry_t* sg_entry = channel->v_sg_info_->v_srcEntries_; ++DBG("Freeing SG resources for channel %d\n", channel->channel_number_); ++ while (sg_entry) { ++ hipox_dma_sg_entry_t* next = sg_entry->v_next_; ++ free_sg_entry(sg_entry); ++ sg_entry = next; ++ } ++ ++ // Free SG DMA destination descriptor resources ++ sg_entry = channel->v_sg_info_->v_dstEntries_; ++ while (sg_entry) { ++ hipox_dma_sg_entry_t* next = sg_entry->v_next_; ++ free_sg_entry(sg_entry); ++ sg_entry = next; ++ } ++ ++ // Zeroise SG DMA source descriptor info ++ channel->v_sg_info_->p_srcEntries_ = 0; ++ channel->v_sg_info_->v_srcEntries_ = 0; ++ channel->v_sg_info_->p_dstEntries_ = 0; ++ channel->v_sg_info_->v_dstEntries_ = 0; ++ } ++ } ++ } ++ ++ // Mark that we have serviced the bottom halves. None of the channels ++ // we have just serviced can interrupt again until their active flags ++ // are cleared below ++ atomic_sub(run_bh, &dma_controller.run_bh_); ++ ++ // Notify all listeners of transfer completion ++ for (i = 0; i < dma_controller.numberOfChannels_; i++, run_bh >>= 1) { ++ if (run_bh & 1) { ++ int interrupt_count; ++ hipox_dma_channel_t* channel = &dma_controller.channels_[i]; ++ ++ // Clear the count of received interrupts for the channel now ++ // that we have serviced them all ++ interrupt_count = atomic_read(&channel->interrupt_count_); ++ atomic_sub(interrupt_count, &channel->interrupt_count_); ++ ++ // Decrement the count of active transfers, by the number of ++ // interrupts we've seen. This must occur before we inform any ++ // listeners who are awaiting completion notification. Should ++ // only decrement if greater than zero, in case we see spurious ++ // interrupt events - we can't be fully safe against this sort ++ // of broken h/w, but we can at least stop the count underflowing ++ // active_count_ is only shared with thread level code, so read ++ // and decrement don't need to be atomic ++ if (atomic_read(&channel->active_count_)) { ++ atomic_dec(&channel->active_count_); ++ } ++ ++ // If there is a callback registered, notify the user that the ++ // transfer is complete ++ if (channel->notification_callback_ != HIPOX_DMA_CALLBACK_NUL) { ++DBG("Notifying channel %u, %d outstanding interrupts\n", channel->channel_number_, interrupt_count); ++ (*channel->notification_callback_)( ++ &dma_controller.channels_[i], ++ channel->notification_arg_, ++ channel->error_code_, ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ channel->checksum_, ++#else // CONFIG_HIPOX_VERSION_0X800 ++ 0, ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ interrupt_count); ++ } ++ } ++ } ++ ++ // Check for any more bottom halves having become ready to run ++ run_bh = atomic_read(&dma_controller.run_bh_); ++ } ++} ++ ++void __init hipox_dma_init() ++{ ++ unsigned i; ++ unsigned long intId; ++ hipox_dma_sg_info_t *v_info; ++ dma_addr_t p_info; ++ ++ // Ensure the DMA block is properly reset ++ writel(1UL << SYS_CTRL_RSTEN_DMA_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_DMA_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Ensure the SG-DMA block is properly reset ++ writel(1UL << SYS_CTRL_RSTEN_SGDMA_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_SGDMA_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Enable the clock to the DMA block ++ writel(1UL << SYS_CTRL_CKEN_DMA_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Initialise the DMA controller ++ atomic_set(&dma_controller.run_bh_, 0); ++ spin_lock_init(&dma_controller.spinlock_); ++ spin_lock_init(&dma_controller.alloc_spinlock_); ++ spin_lock_init(&dma_controller.channel_alloc_spinlock_); ++ sema_init(&dma_controller.csum_engine_sem_, 1); ++ ++ // Initialise channel allocation management ++ dma_controller.channel_head_ = 0; ++ sema_init(&dma_controller.channel_sem_, 0); ++ // Initialise SRAM buffer management ++ dma_controller.sg_entry_head_ = 0; ++ sema_init(&dma_controller.sg_entry_sem_, 0); ++ dma_controller.sg_entry_available_ = 0; ++ ++ tasklet_init(&dma_controller.tasklet_, dma_bh, 0); ++ ++ // Discover the number of channels available ++ intId = readl(DMA_CALC_REG_ADR(0, DMA_INTR_ID)); ++ dma_controller.numberOfChannels_ = DMA_INTR_ID_GET_NUM_CHANNELS(intId); ++ if (dma_controller.numberOfChannels_ > MAX_HIPOX_DMA_CHANNELS) { ++ printk(KERN_WARNING "DMA: Too many DMA channels"); ++ dma_controller.numberOfChannels_ = MAX_HIPOX_DMA_CHANNELS; ++ } ++ ++ dma_controller.version_ = DMA_INTR_ID_GET_VERSION(intId); ++ printk(KERN_INFO "Number of DMA channels = %u, version = %u\n", ++ dma_controller.numberOfChannels_, dma_controller.version_); ++ ++ if (!DMA_HAS_V4_INTR_CLEAR(dma_controller.version_)) { ++ panic("DMA: Trying to use v4+ interrupt clearing on DMAC version without support\n"); ++ } ++ ++#ifdef CONFIG_LEON_RESERVE_DMA_CHANNEL ++ // Reserve the last DMA channel for the CoPro's use ++ --dma_controller.numberOfChannels_; ++#endif // CONFIG_LEON_RESERVE_DMA_CHANNEL ++ ++ // Allocate coherent memory for array sg_info structs ++ dma_controller.v_sg_infos_ = (hipox_dma_sg_info_t*)DMA_DESC_ALLOC_START; ++ dma_controller.p_sg_infos_ = DMA_DESC_ALLOC_START_PA; ++ ++ if (!dma_controller.v_sg_infos_) { ++ panic("DMA: Coherent alloc of SG info struct array"); ++ } ++ ++ { ++ // Initialise list of DMA descriptors ++ unsigned long sg_info_alloc_size = (dma_controller.numberOfChannels_ * sizeof(hipox_dma_sg_info_t)); ++ unsigned num_sg_entries = (DMA_DESC_ALLOC_SIZE - sg_info_alloc_size) / sizeof(hipox_dma_sg_entry_t); ++ hipox_dma_sg_entry_t* entry_v = (hipox_dma_sg_entry_t*)(DMA_DESC_ALLOC_START + sg_info_alloc_size); ++ hipox_dma_sg_entry_t* entry_p = (hipox_dma_sg_entry_t*)(DMA_DESC_ALLOC_START_PA + sg_info_alloc_size); ++printk("Allocating %u SRAM generic DMA descriptors\n", num_sg_entries); ++ for (i=0; i < num_sg_entries; ++i, ++entry_v, ++entry_p) { ++ entry_v->paddr_ = (dma_addr_t)entry_p; ++ free_sg_entry(entry_v); ++ } ++ } ++ ++ // Initialise all available DMA channels ++ v_info = dma_controller.v_sg_infos_; ++ p_info = dma_controller.p_sg_infos_; ++ for (i=0; i < dma_controller.numberOfChannels_; i++) { ++ hipox_dma_channel_t *channel = &dma_controller.channels_[i]; ++ ++ channel->channel_number_ = i; ++ channel->notification_callback_ = HIPOX_DMA_CALLBACK_NUL; ++ channel->notification_arg_ = HIPOX_DMA_CALLBACK_ARG_NUL; ++ ++ // Setup physical and virtual addresses of the SG info struct for this ++ // channel ++ channel->v_sg_info_ = v_info++; ++ channel->p_sg_info_ = p_info; ++ p_info += sizeof(hipox_dma_sg_info_t); ++ ++ // Initialise heads of src and dst SG lists to null ++ channel->v_sg_info_->p_srcEntries_ = 0; ++ channel->v_sg_info_->p_dstEntries_ = 0; ++ channel->v_sg_info_->v_srcEntries_ = 0; ++ channel->v_sg_info_->v_dstEntries_ = 0; ++ ++ channel->error_code_ = 0; ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ channel->checksumming_ = 0; ++ channel->checksum_ = 0; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ // Initialise the atomic variable that records the number of interrupts ++ // for the channel that are awaiting service ++ atomic_set(&channel->interrupt_count_, 0); ++ ++ // Initialise the atomic variable maintaining the count of in-progress ++ // transfers for the channel. Currently can be a maximum of two, as ++ // the hardware can only queue details for a pair of transfers ++ atomic_set(&channel->active_count_, 0); ++ ++ // The binary semaphore for the default callback used when abort ++ // requested without a user-registered callback being available ++ sema_init(&channel->default_semaphore_, 0); ++ ++ // Add channel to free list ++ hipox_dma_free(channel); ++ } ++ ++ // Connect the dma interrupt handler ++ dma_controller.channels_[0].rps_interrupt_ = DMA_INTERRUPT_0; ++ if (request_irq(DMA_INTERRUPT_0, &hipox_dma_interrupt, 0, "DMA 0", 0)) { ++ panic("DMA: Failed to allocate interrupt %u\n", DMA_INTERRUPT_0); ++ } ++ dma_controller.channels_[1].rps_interrupt_ = DMA_INTERRUPT_1; ++ if (request_irq(DMA_INTERRUPT_1, &hipox_dma_interrupt, 0, "DMA 1", 0)) { ++ panic("DMA: Failed to allocate interrupt %u\n", DMA_INTERRUPT_1); ++ } ++ dma_controller.channels_[2].rps_interrupt_ = DMA_INTERRUPT_2; ++ if (request_irq(DMA_INTERRUPT_2, &hipox_dma_interrupt, 0, "DMA 2", 0)) { ++ panic("DMA: Failed to allocate interrupt %u\n", DMA_INTERRUPT_2); ++ } ++ dma_controller.channels_[3].rps_interrupt_ = DMA_INTERRUPT_3; ++ if (request_irq(DMA_INTERRUPT_3, &hipox_dma_interrupt, 0, "DMA 3", 0)) { ++ panic("DMA: Failed to allocate interrupt %u\n", DMA_INTERRUPT_3); ++ } ++#ifndef CONFIG_LEON_RESERVE_DMA_CHANNEL ++ dma_controller.channels_[4].rps_interrupt_ = DMA_INTERRUPT_4; ++ if (request_irq(DMA_INTERRUPT_4, &hipox_dma_interrupt, 0, "DMA 4", 0)) { ++ panic("DMA: Failed to allocate interrupt %u\n", DMA_INTERRUPT_4); ++ } ++#endif // CONFIG_LEON_RESERVE_DMA_CHANNEL ++ ++#ifdef HIPOX_DMA_OVERALL_TEST_LOOPS ++ { ++ int j; ++ for (j=0; j < HIPOX_DMA_OVERALL_TEST_LOOPS; ++j) { ++#ifdef HIPOX_DMA_TEST ++ { ++ int i; ++ for (i=0; i < HIPOX_DMA_TEST_ITERATIONS; ++i) { ++ dma_test(512); ++ } ++ } ++#endif // HIPOX_DMA_TEST ++#ifdef HIPOX_DMA_SG_TEST ++ { ++ int i; ++ for (i=0; i < HIPOX_DMA_SG_TEST_ITERATIONS; ++i) { ++ dma_sg_test(); ++ } ++ } ++#endif // HIPOX_DMA_SG_TEST ++#ifdef HIPOX_DMA_SG_TEST_2 ++ { ++ int i; ++ for (i=0; i < HIPOX_DMA_SG_TEST_ITERATIONS; ++i) { ++ dma_sg_test2(); ++ } ++ } ++#endif // HIPOX_DMA_SG_TEST_2 ++#ifdef HIPOX_DMA_TEST ++ { ++ int i; ++ for (i=0; i < HIPOX_DMA_TEST_AFTER_SG_ITERATIONS; ++i) { ++ dma_test(512); ++ } ++ } ++#endif // HIPOX_DMA_TEST ++ } ++ } ++#endif // HIPOX_DMA_OVERALL_TEST_LOOPS ++} ++ ++void hipox_dma_shutdown() ++{ ++ dma_controller.sg_entry_head_ = 0; ++} ++ ++int hipox_dma_is_active(hipox_dma_channel_t* channel) ++{ ++ return atomic_read(&channel->active_count_); ++} ++ ++/** ++ * Get the transfer status directly from the hardware, so for instance the ++ * end of a transfer can be polled for within interrupt context. ++ * ++ * NB If this function indicates the channel is inactive, it does NOT imply that ++ * it can be reused. Reuse is only possible when hipox_dma_is_active() returns ++ * the inactive state ++ */ ++int hipox_dma_raw_isactive(hipox_dma_channel_t* channel) ++{ ++ unsigned long ctrl_status = readl(DMA_CALC_REG_ADR(channel->channel_number_, DMA_CTRL_STATUS)); ++ return ctrl_status & DMA_CTRL_STATUS_IN_PROGRESS; ++} ++ ++/** ++ * Get the SG transfer status directly from the hardware, so for instance the ++ * end of a SG transfer can be polled for within interrupt context. ++ * ++ * NB If this function indicates the channel is inactive, it does NOT imply that ++ * it can be reused. Reuse is only possible when hipox_dma_is_active() returns ++ * the inactive state ++ */ ++int hipox_dma_raw_sg_isactive(hipox_dma_channel_t* channel) ++{ ++ // Record the SG channel status ++ u32 status = readl(DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_STATUS)); ++ return status & (1UL << DMA_SG_STATUS_BUSY_BIT); ++} ++ ++int hipox_dma_get_raw_direction(hipox_dma_channel_t* channel) ++{ ++ unsigned long ctrl_status = readl(DMA_CALC_REG_ADR(channel->channel_number_, DMA_CTRL_STATUS)); ++ return (ctrl_status & DMA_CTRL_STATUS_DIR_MASK) >> DMA_CTRL_STATUS_DIR_SHIFT; ++} ++ ++static unsigned long encode_control_status( ++ hipox_dma_device_settings_t *src_settings, ++ hipox_dma_device_settings_t *dst_settings, ++ int paused) ++{ ++ unsigned long ctrl_status; ++ hipox_dma_transfer_direction_t direction; ++ ++ ctrl_status = paused ? DMA_CTRL_STATUS_PAUSE : 0; // Paused if requested ++ ctrl_status |= (DMA_CTRL_STATUS_INTERRUPT_ENABLE | // Interrupts enabled ++ DMA_CTRL_STATUS_FAIR_SHARE_ARB | // High priority ++ DMA_CTRL_STATUS_INTR_CLEAR_ENABLE); // Use new interrupt clearing register ++ ctrl_status |= (src_settings->dreq_ << DMA_CTRL_STATUS_SRC_DREQ_SHIFT); // Source dreq ++ ctrl_status |= (dst_settings->dreq_ << DMA_CTRL_STATUS_DEST_DREQ_SHIFT); // Destination dreq ++ ++ // Setup the transfer direction and burst/single mode for the two DMA busses ++ if (src_settings->bus_ == HIPOX_DMA_SIDE_A) { ++ // Set the burst/single mode for bus A based on src device's settings ++ if (src_settings->transfer_mode_ == HIPOX_DMA_TRANSFER_MODE_BURST) { ++ ctrl_status |= DMA_CTRL_STATUS_TRANSFER_MODE_A; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_TRANSFER_MODE_A; ++ } ++ ++ if (dst_settings->bus_ == HIPOX_DMA_SIDE_A) { ++ direction = HIPOX_DMA_A_TO_A; ++ } else { ++ direction = HIPOX_DMA_A_TO_B; ++ ++ // Set the burst/single mode for bus B based on dst device's settings ++ if (dst_settings->transfer_mode_ == HIPOX_DMA_TRANSFER_MODE_BURST) { ++ ctrl_status |= DMA_CTRL_STATUS_TRANSFER_MODE_B; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_TRANSFER_MODE_B; ++ } ++ } ++ } else { ++ // Set the burst/single mode for bus B based on src device's settings ++ if (src_settings->transfer_mode_ == HIPOX_DMA_TRANSFER_MODE_BURST) { ++ ctrl_status |= DMA_CTRL_STATUS_TRANSFER_MODE_B; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_TRANSFER_MODE_B; ++ } ++ ++ if (dst_settings->bus_ == HIPOX_DMA_SIDE_A) { ++ direction = HIPOX_DMA_B_TO_A; ++ ++ // Set the burst/single mode for bus A based on dst device's settings ++ if (dst_settings->transfer_mode_ == HIPOX_DMA_TRANSFER_MODE_BURST) { ++ ctrl_status |= DMA_CTRL_STATUS_TRANSFER_MODE_A; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_TRANSFER_MODE_A; ++ } ++ } else { ++ direction = HIPOX_DMA_B_TO_B; ++ } ++ } ++ ctrl_status |= (direction << DMA_CTRL_STATUS_DIR_SHIFT); ++ ++ // Setup source address mode fixed or increment ++ if (src_settings->address_mode_ == HIPOX_DMA_MODE_FIXED) { ++ // Fixed address ++ ctrl_status &= ~(DMA_CTRL_STATUS_SRC_ADR_MODE); ++ ++ // Set up whether fixed address is _really_ fixed ++ if (src_settings->address_really_fixed_) { ++ ctrl_status |= DMA_CTRL_STATUS_SOURCE_ADDRESS_FIXED; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_SOURCE_ADDRESS_FIXED; ++ } ++ } else { ++ // Incrementing address ++ ctrl_status |= DMA_CTRL_STATUS_SRC_ADR_MODE; ++ ctrl_status &= ~DMA_CTRL_STATUS_SOURCE_ADDRESS_FIXED; ++ } ++ ++ // Setup destination address mode fixed or increment ++ if (dst_settings->address_mode_ == HIPOX_DMA_MODE_FIXED) { ++ // Fixed address ++ ctrl_status &= ~(DMA_CTRL_STATUS_DEST_ADR_MODE); ++ ++ // Set up whether fixed address is _really_ fixed ++ if (dst_settings->address_really_fixed_) { ++ ctrl_status |= DMA_CTRL_STATUS_DESTINATION_ADDRESS_FIXED; ++ } else { ++ ctrl_status &= ~DMA_CTRL_STATUS_DESTINATION_ADDRESS_FIXED; ++ } ++ } else { ++ // Incrementing address ++ ctrl_status |= DMA_CTRL_STATUS_DEST_ADR_MODE; ++ ctrl_status &= ~DMA_CTRL_STATUS_DESTINATION_ADDRESS_FIXED; ++ } ++ ++ // Set up the width of the transfers on the DMA buses ++ ctrl_status |= (src_settings->width_ << DMA_CTRL_STATUS_SRC_WIDTH_SHIFT); ++ ctrl_status |= (dst_settings->width_ << DMA_CTRL_STATUS_DEST_WIDTH_SHIFT); ++ ++ // Setup the priority arbitration scheme ++ ctrl_status &= ~DMA_CTRL_STATUS_STARVE_LOW_PRIORITY; // !Starve low priority ++ ++ return ctrl_status; ++} ++ ++static unsigned long encode_eot( ++ hipox_dma_device_settings_t* src_settings, ++ hipox_dma_device_settings_t* dst_settings, ++ unsigned long length, ++ int isFinalTransfer) ++{ ++ // Write the length, with EOT configuration and enable INC4 tranfers and ++ // HPROT. HPROT will delay data reaching memory for a few clock cycles, but ++ // most unlikely to cause a problem for the CPU. ++ unsigned long encoded = length | ++ DMA_BYTE_CNT_INC4_SET_MASK | // Always enable INC4 transfers ++ DMA_BYTE_CNT_HPROT_MASK; // Always enable HPROT assertion ++ ++ // Encode the EOT setting for the src device based on its policy ++ encoded &= ~DMA_BYTE_CNT_RD_EOT_MASK; ++ switch (src_settings->read_eot_policy_) { ++ case HIPOX_DMA_EOT_FINAL: ++ if (!isFinalTransfer) { ++ break; ++ } ++ // Fall through in case of final transfer and EOT required for final ++ // transfer ++ case HIPOX_DMA_EOT_ALL: ++ encoded |= DMA_BYTE_CNT_RD_EOT_MASK; ++ break; ++ default: ++ break; ++ } ++ ++ // Encode the EOT setting for the dst device based on its policy ++ encoded &= ~DMA_BYTE_CNT_WR_EOT_MASK; ++ switch (dst_settings->write_eot_policy_) { ++ case HIPOX_DMA_EOT_FINAL: ++ if (!isFinalTransfer) { ++ break; ++ } ++ // Fall through in case of final transfer and EOT required for final ++ // transfer ++ case HIPOX_DMA_EOT_ALL: ++ encoded |= DMA_BYTE_CNT_WR_EOT_MASK; ++ break; ++ default: ++ break; ++ } ++ ++ return encoded; ++} ++ ++static unsigned long encode_start(unsigned long ctrl_status) ++{ ++ ctrl_status &= ~DMA_CTRL_STATUS_PAUSE; ++ return ctrl_status; ++} ++ ++static void hipox_dma_set_common_lowlevel( ++ hipox_dma_channel_t *channel, ++ unsigned long ctrl_status, ++ dma_addr_t src_address, ++ dma_addr_t dst_address, ++ unsigned long lengthAndEOT) ++{ ++ unsigned channel_number = channel->channel_number_; ++ ++ spin_lock(&dma_controller.spinlock_); ++ ++ // Write the control/status value to the DMAC ++ writel(ctrl_status, DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)); ++ ++ // Ensure control/status word makes it to the DMAC before we write address/length info ++ wmb(); ++ ++ // Write the source addresses to the DMAC ++ writel(src_address, DMA_CALC_REG_ADR(channel_number, DMA_BASE_SRC_ADR)); ++ ++ // Write the destination addresses to the DMAC ++ writel(dst_address, DMA_CALC_REG_ADR(channel_number, DMA_BASE_DST_ADR)); ++ ++ // Write the length, with EOT configuration for the single transfer ++ writel(lengthAndEOT, DMA_CALC_REG_ADR(channel_number, DMA_BYTE_CNT)); ++ ++ // Ensure adr/len info makes it to DMAC before later modifications to ++ // control/status register due to starting the transfer, which happens in ++ // hipox_dma_start() ++ wmb(); ++ ++ spin_unlock(&dma_controller.spinlock_); ++ ++ // Increase count of in-progress transfers on this channel ++ atomic_inc(&channel->active_count_); ++} ++ ++static int hipox_dma_set_common( ++ hipox_dma_channel_t* channel, ++ unsigned long length, ++ hipox_dma_device_settings_t *src_settings, ++ hipox_dma_device_settings_t *dst_settings, ++ int isFinalTransfer, ++ int paused) ++{ ++ int status = 0; ++ ++ if (length > MAX_HIPOX_DMA_TRANSFER_LENGTH) { ++ printk(KERN_WARNING "hipox_dma_set_common() length exceeds hardware allowed maximum\n"); ++ status = 1; ++ } else { ++ hipox_dma_set_common_lowlevel( ++ channel, ++ encode_control_status(src_settings, dst_settings, paused), ++ (dma_addr_t)src_settings->address_, ++ (dma_addr_t)dst_settings->address_, ++ encode_eot(src_settings, dst_settings, length, isFinalTransfer)); ++ } ++ return status; ++} ++ ++int hipox_dma_set( ++ hipox_dma_channel_t *channel, ++ unsigned char *src_adr, // Physical address ++ unsigned long length, ++ unsigned char *dst_adr, // Physical address ++ hipox_dma_mode_t src_mode, ++ hipox_dma_mode_t dst_mode, ++ int do_checksum, ++ int paused) ++{ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_set() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (do_checksum) { ++ // Arbitrate for ownership of the checksum engine ++ if (alloc_csum_engine()) { ++ // Did not obtain the csum engine, so return will failure status ++ return 1; ++ } ++ } ++#else // CONFIG_HIPOX_VERSION_0X800 ++ BUG_ON(do_checksum); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ { ++ // Assemble complete memory settings, accounting for csum generation if ++ // required ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ hipox_dma_device_settings_t src_settings = ++ do_checksum ? hipox_ram_csum_src_dma_settings : ++ hipox_ram_only_src_dma_settings; ++#else // CONFIG_HIPOX_VERSION_0X800 ++ hipox_dma_device_settings_t src_settings = hipox_ram_only_src_dma_settings; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ hipox_dma_device_settings_t dst_settings = hipox_ram_generic_dma_settings; ++ ++ // Assemble the source address ++ src_settings.address_ = (unsigned long)src_adr; ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (do_checksum) { ++ // Record that we are checksumming, so that the result is read on ++ // completion ++ channel->checksumming_ = 1; ++ ++ // To checksum set the high order address bit to enable the engine ++ src_settings.address_ |= (1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ // Ensure only use the valid src address bits are used ++ src_settings.address_ &= HIPOX_DMA_CSUM_ADR_MASK; ++ src_settings.address_mode_ = src_mode; ++ ++ // Ensure only use the valid dst address bits are used ++ dst_settings.address_ = ((unsigned long)dst_adr) & HIPOX_DMA_ADR_MASK; ++ dst_settings.address_mode_ = dst_mode; ++ ++ return hipox_dma_set_common(channel, length, &src_settings, &dst_settings, 1, paused); ++ } ++} ++ ++int hipox_dma_device_set( ++ hipox_dma_channel_t *channel, ++ hipox_dma_direction_t direction, ++ unsigned char *mem_adr, // Physical address ++ unsigned long length, ++ hipox_dma_device_settings_t *device_settings, ++ hipox_dma_mode_t mem_mode, ++ int paused) ++{ ++ hipox_dma_device_settings_t mem_settings; ++ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_device_set() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++ // Assemble complete memory settings, ensuring addresses do not affect the ++ // checksum enabling high order adr bit ++ mem_settings = hipox_ram_generic_dma_settings; ++ mem_settings.address_ = ((unsigned long)mem_adr) & HIPOX_DMA_ADR_MASK; ++ mem_settings.address_mode_ = mem_mode; ++ ++ device_settings->address_ &= HIPOX_DMA_ADR_MASK; ++ ++ return hipox_dma_set_common( ++ channel, ++ length, ++ (direction == HIPOX_DMA_TO_DEVICE) ? &mem_settings : device_settings, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? &mem_settings : device_settings, ++ 1, ++ paused); ++} ++ ++int hipox_dma_device_pair_set( ++ hipox_dma_channel_t* channel, ++ unsigned long length, ++ hipox_dma_device_settings_t *src_device_settings, ++ hipox_dma_device_settings_t *dst_device_settings, ++ int paused) ++{ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_device_pair_set() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++ // Ensure addresses do not affect the checksum enabling high order adr bit ++ src_device_settings->address_ &= HIPOX_DMA_ADR_MASK; ++ dst_device_settings->address_ &= HIPOX_DMA_ADR_MASK; ++ return hipox_dma_set_common(channel, length, src_device_settings, dst_device_settings, 1, paused); ++} ++ ++static int hipox_dma_set_sg_common( ++ hipox_dma_channel_t* channel, ++ struct scatterlist* src_sg, ++ unsigned src_sg_count, ++ struct scatterlist* dst_sg, ++ unsigned dst_sg_count, ++ hipox_dma_device_settings_t* src_settings, ++ hipox_dma_device_settings_t* dst_settings, ++ int in_atomic) ++{ ++ int i; ++ int failed = 0; ++ hipox_dma_sg_entry_t *sg_entry; ++ hipox_dma_sg_entry_t *previous_entry; ++ ++ // Get reference to this channel's top level SG DMA descriptor structure ++ hipox_dma_sg_info_t *sg_info = channel->v_sg_info_; ++ ++ // SG entries have not been provided ++ channel->auto_sg_entries_ = 1; ++ ++ // Initialise list pointers to zero ++ sg_info->v_srcEntries_ = 0; ++ sg_info->p_srcEntries_ = 0; ++ sg_info->v_dstEntries_ = 0; ++ sg_info->p_dstEntries_ = 0; ++ ++ sg_entry = 0; ++ previous_entry = 0; ++ for (i=0; i < src_sg_count; i++) { ++ // Is this entry contiguous with the previous one and would the combined ++ // lengths not exceed the maximum that the hardware is capable of ++#if 0 ++ if (previous_entry && ++ ((previous_entry->addr_ + previous_entry->length_) == (src_sg[i].dma_address & HIPOX_DMA_CSUM_ADR_MASK)) && ++ ((previous_entry->length_ + src_sg[i].length) <= MAX_HIPOX_DMA_TRANSFER_LENGTH)) { ++ // Yes, so coalesce the pair ++ previous_entry->length_ += src_sg[i].length; ++ } else ++#endif ++ { ++ // Allocate space for SG list entry from coherent DMA pool ++ hipox_dma_sg_entry_t *new_sg_entry = alloc_sg_entry(in_atomic); ++ if (!new_sg_entry) { ++ failed = 1; ++ break; ++ } ++ sg_entry = new_sg_entry; ++ ++ if (previous_entry) { ++ // Link the previous SG list entry forward to this one ++ previous_entry->v_next_ = sg_entry; ++ previous_entry->p_next_ = sg_entry->paddr_; ++ } else { ++ // Create a link from the SG info structure to the first SG list entry ++ sg_info->v_srcEntries_ = sg_entry; ++ sg_info->p_srcEntries_ = sg_entry->paddr_; ++ } ++ previous_entry = sg_entry; ++ ++ // Fill in the SG list entry with start address, ensuring only valid ++ // address bits are used, preserving the checksum enabling flag ++ sg_entry->addr_ = src_sg[i].dma_address & HIPOX_DMA_CSUM_ADR_MASK; ++ ++ // Fill in the length, checking that it does not exceed the hardware ++ // allowed maximum ++ sg_entry->length_ = (src_sg[i].length <= MAX_HIPOX_DMA_TRANSFER_LENGTH) ? src_sg[i].length : 0; ++ if (!sg_entry->length_) { ++ printk(KERN_WARNING "hipox_dma_set_sg_common() Source entry too long, zeroing\n"); ++ } ++ } ++ } ++ if (sg_entry) { ++ // Mark the end of the source SG list with nulls ++ sg_entry->p_next_ = 0; ++ sg_entry->v_next_ = 0; ++ } ++ ++ if (failed) { ++ // Failed to allocate all SG src entries, so free those we did get ++ hipox_dma_sg_entry_t* sg_entry = sg_info->v_srcEntries_; ++ while (sg_entry) { ++ hipox_dma_sg_entry_t* next = sg_entry->v_next_; ++ free_sg_entry(sg_entry); ++ sg_entry = next; ++ } ++ channel->v_sg_info_->p_srcEntries_ = 0; ++ channel->v_sg_info_->v_srcEntries_ = 0; ++ return 1; ++ } ++ ++ // Assemble destination descriptors ++ sg_entry = 0; ++ previous_entry = 0; ++ for (i=0; i < dst_sg_count; i++) { ++ // Is this entry contiguous with the previous one? ++#if 0 ++ if (previous_entry && ++ ((previous_entry->addr_ + previous_entry->length_) == (dst_sg[i].dma_address & HIPOX_DMA_CSUM_ADR_MASK)) && ++ ((previous_entry->length_ + dst_sg[i].length) <= MAX_HIPOX_DMA_TRANSFER_LENGTH)) { ++ // Yes, so coalesce the pair ++ previous_entry->length_ += dst_sg[i].length; ++ } else ++#endif ++ { ++ // Allocate space for SG list entry from coherent DMA pool ++ hipox_dma_sg_entry_t *new_sg_entry = alloc_sg_entry(in_atomic); ++ if (!new_sg_entry) { ++ failed = 1; ++ break; ++ } ++ sg_entry = new_sg_entry; ++ ++ if (previous_entry) { ++ // Link the previous SG list entry forward to this one ++ previous_entry->v_next_ = sg_entry; ++ previous_entry->p_next_ = sg_entry->paddr_; ++ } else { ++ // Create a link from the SG info structure to the first SG list entry ++ sg_info->v_dstEntries_ = sg_entry; ++ sg_info->p_dstEntries_ = sg_entry->paddr_; ++ } ++ previous_entry = sg_entry; ++ ++ // Fill in the SG list entry with start address, ensuring address ++ // does not affect the checksum enabling high order adr bit ++ sg_entry->addr_ = dst_sg[i].dma_address & HIPOX_DMA_ADR_MASK; ++ ++ // Fill in the length, checking that it does not exceed the hardware ++ // allowed maximum ++ sg_entry->length_ = (dst_sg[i].length <= MAX_HIPOX_DMA_TRANSFER_LENGTH) ? dst_sg[i].length : 0; ++ if (!sg_entry->length_) { ++ printk(KERN_WARNING "hipox_dma_set_sg_common() Destination entry too long, zeroing\n"); ++ } ++ } ++ } ++ if (sg_entry) { ++ // Mark the end of the destination SG list with nulls ++ sg_entry->p_next_ = 0; ++ sg_entry->v_next_ = 0; ++ } ++ ++ if (failed) { ++ // Failed to allocate all SG dst entries, so free those we did obtain ++ hipox_dma_sg_entry_t* sg_entry = sg_info->v_dstEntries_; ++ while (sg_entry) { ++ hipox_dma_sg_entry_t* next = sg_entry->v_next_; ++ free_sg_entry(sg_entry); ++ sg_entry = next; ++ } ++ sg_info->p_dstEntries_ = 0; ++ sg_info->v_dstEntries_ = 0; ++ ++ // Free all the SG src entries which we did sucessfully obtain ++ sg_entry = sg_info->v_srcEntries_; ++ while (sg_entry) { ++ hipox_dma_sg_entry_t* next = sg_entry->v_next_; ++ free_sg_entry(sg_entry); ++ sg_entry = next; ++ } ++ sg_info->p_srcEntries_ = 0; ++ sg_info->v_srcEntries_ = 0; ++ return 1; ++ } ++ ++ sg_info->qualifer_ = ((channel->channel_number_ << HIPOX_DMA_SG_CHANNEL_BIT) | ++ (src_settings->read_eot_policy_ << HIPOX_DMA_SG_SRC_EOT_BIT) | ++ (dst_settings->write_eot_policy_ << HIPOX_DMA_SG_DST_EOT_BIT) | ++ (1 << HIPOX_DMA_SG_QUALIFIER_BIT)); ++ ++ // Flags are the same for source and destination for each SG transfer component ++ sg_info->control_ = encode_control_status(src_settings, dst_settings, 0); ++ ++ // Increase count of in-progress transfers on this channel ++ atomic_inc(&channel->active_count_); ++ ++ return 0; ++} ++ ++int hipox_dma_set_sg( ++ hipox_dma_channel_t* channel, ++ struct scatterlist* src_sg, ++ unsigned src_sg_count, ++ struct scatterlist* dst_sg, ++ unsigned dst_sg_count, ++ hipox_dma_mode_t src_mode, ++ hipox_dma_mode_t dst_mode, ++ int do_checksum, ++ int in_atomic) ++{ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_set_sg() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (do_checksum) { ++ // Arbitrate for ownership of the checksum engine ++ if (alloc_csum_engine()) { ++ // Failed to obtain csum engine, so return with failure status ++ return 1; ++ } ++ } ++#else // CONFIG_HIPOX_VERSION_0X800 ++ BUG_ON(do_checksum); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ { ++ // Assemble complete memory settings, accounting for csum generation if ++ // required ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ hipox_dma_device_settings_t src_settings = ++ do_checksum ? hipox_ram_csum_src_dma_settings : ++ hipox_ram_only_src_dma_settings; ++#else // CONFIG_HIPOX_VERSION_0X800 ++ hipox_dma_device_settings_t src_settings = hipox_ram_only_src_dma_settings; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ hipox_dma_device_settings_t dst_settings = hipox_ram_generic_dma_settings; ++ ++ // Normal adr bits not used for SG transfers ++ src_settings.address_ = 0; ++ src_settings.address_mode_ = src_mode; ++ ++ // Normal adr bits not used for SG transfers ++ dst_settings.address_ = 0; ++ dst_settings.address_mode_ = dst_mode; ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (do_checksum) { ++ // Record that we are checksumming, so that the result is read on ++ // completion ++ channel->checksumming_ = 1; ++ ++ // The high order address bit enabling the checksum engine will be ++ // set by the caller in the passed scatterlist entries, for those ++ // entries which are required to contribute to the checksum ++ // calculation ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ return hipox_dma_set_sg_common( ++ channel, ++ src_sg, ++ src_sg_count, ++ dst_sg, ++ dst_sg_count, ++ &src_settings, ++ &dst_settings, ++ in_atomic); ++ } ++} ++ ++int hipox_dma_device_set_sg( ++ hipox_dma_channel_t* channel, ++ hipox_dma_direction_t direction, ++ struct scatterlist* mem_sg, ++ unsigned mem_sg_count, ++ hipox_dma_device_settings_t* device_settings, ++ hipox_dma_mode_t mem_mode, ++ int in_atomic) ++{ ++ int i; ++ struct scatterlist *sg; ++ struct scatterlist dev_sg; ++ ++ hipox_dma_device_settings_t mem_settings; ++ ++ if (hipox_dma_is_active(channel)) { ++ printk(KERN_WARNING "hipox_dma_device_set_sg() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++ // Assemble complete memory settings ++ mem_settings = hipox_ram_generic_dma_settings; ++ mem_settings.address_ = 0; // Not used for SG transfers ++ mem_settings.address_mode_ = mem_mode; ++ ++ // Need to total all memory transfer lengths and assign as device single transfer length ++ dev_sg.dma_address = device_settings->address_; ++ for (i=0, sg=mem_sg, dev_sg.length = 0; i < mem_sg_count; i++, sg++) { ++ dev_sg.length += sg->length; ++ } ++ ++ return hipox_dma_set_sg_common( ++ channel, ++ (direction == HIPOX_DMA_TO_DEVICE) ? mem_sg : &dev_sg, ++ (direction == HIPOX_DMA_TO_DEVICE) ? mem_sg_count : 1, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? mem_sg : &dev_sg, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? mem_sg_count : 1, ++ (direction == HIPOX_DMA_TO_DEVICE) ? &mem_settings : device_settings, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? &mem_settings : device_settings, ++ in_atomic); ++} ++ ++static int hipox_dma_set_prd_common( ++ hipox_dma_channel_t *channel, ++ struct ata_prd *src_prd, ++ struct ata_prd *dst_prd, ++ hipox_dma_device_settings_t *src_settings, ++ hipox_dma_device_settings_t *dst_settings, ++ hipox_dma_sg_entry_t *sg_entries) ++{ ++ int i; ++ int failed = 0; ++ hipox_dma_sg_entry_t *sg_entry, *previous_entry, *next_entry; ++ u32 eot; ++ u32 tot_src_len = 0, tot_dst_len = 0; ++ ++ // Get reference to this channel's top level SG DMA descriptor structure ++ hipox_dma_sg_info_t *sg_info = channel->v_sg_info_; ++ ++ // SG entries have been provided ++ channel->auto_sg_entries_ = 0; ++ ++ // Initialise list pointers to zero ++ sg_info->v_srcEntries_ = 0; ++ sg_info->p_srcEntries_ = 0; ++ sg_info->v_dstEntries_ = 0; ++ sg_info->p_dstEntries_ = 0; ++ ++ // Get pointer to first available SG entry ++ sg_entry = previous_entry = 0; ++ next_entry = sg_entries; ++ i=0; ++ do { ++ u32 addr; ++ u32 length; ++ u32 flags_len; ++ ++ addr = src_prd[i].addr; ++ flags_len = le32_to_cpu(src_prd[i++].flags_len); ++ length = flags_len & ~ATA_PRD_EOT; ++ eot = flags_len & ATA_PRD_EOT; ++ ++ // Zero length field means 64KB ++ if (!length) length = 0x10000; ++ ++ // Accumulate the total length of all source elements ++ tot_src_len += length; ++ ++ // Is this entry contiguous with the previous one and would the combined ++ // lengths not exceed the maximum that the hardware is capable of ++#if 0 ++ if (previous_entry && ++ ((previous_entry->addr_ + previous_entry->length_) == (addr & HIPOX_DMA_CSUM_ADR_MASK)) && ++ ((previous_entry->length_ + length) <= MAX_HIPOX_DMA_TRANSFER_LENGTH)) { ++ // Yes, so coalesce the pair ++ previous_entry->length_ += length; ++ } else ++#endif ++ { ++ // Get the next available SG entry ++ if (!next_entry) { ++ failed = 1; ++ break; ++ } ++ sg_entry = next_entry; ++ ++ if (previous_entry) { ++ // Link the previous SG list entry forward to this one ++ previous_entry->v_next_ = sg_entry; ++ previous_entry->p_next_ = sg_entry->paddr_; ++ } else { ++ // Create a link from the SG info structure to the first SG list entry ++ sg_info->v_srcEntries_ = sg_entry; ++ sg_info->p_srcEntries_ = sg_entry->paddr_; ++ } ++ previous_entry = sg_entry; ++ ++ // Fill in the SG list entry with start address, ensuring only valid ++ // address bits are used, preserving the checksum enabling flag ++ sg_entry->addr_ = addr & HIPOX_DMA_CSUM_ADR_MASK; ++ ++ // Fill in the length, checking that it does not exceed the hardware ++ // allowed maximum ++ if (length > MAX_HIPOX_DMA_TRANSFER_LENGTH) { ++ printk(KERN_WARNING "hipox_dma_set_prd_common() Source entry too long (0x%x), zeroing\n", length); ++ sg_entry->length_ = 0; ++ } else { ++ sg_entry->length_ = length; ++ } ++ ++ // Get pointer to next available SG entry ++ next_entry = sg_entry->next_; ++ } ++ } while (!eot); ++ if (sg_entry) { ++ // Mark the end of the source SG list with nulls ++ sg_entry->p_next_ = 0; ++ sg_entry->v_next_ = 0; ++ } ++ ++ if (failed) { ++ // Failed to allocate all SG src entries ++ channel->v_sg_info_->p_srcEntries_ = 0; ++ channel->v_sg_info_->v_srcEntries_ = 0; ++ printk(KERN_WARNING "Too few SG entries to satisfy source requirements\n"); ++ return 1; ++ } ++ ++ // Assemble destination descriptors ++ sg_entry = previous_entry = 0; ++ i=0; ++ do { ++ u32 addr; ++ u32 length; ++ u32 flags_len; ++ ++ addr = dst_prd[i].addr; ++ flags_len = le32_to_cpu(dst_prd[i++].flags_len); ++ length = flags_len & ~ATA_PRD_EOT; ++ eot = flags_len & ATA_PRD_EOT; ++ ++ // Zero length field means 64KB ++ if (!length) length = 0x10000; ++ ++ // Accumulate the total length of all destination elements ++ tot_dst_len += length; ++ ++ // Is this entry contiguous with the previous one? ++#if 0 ++ if (previous_entry && ++ ((previous_entry->addr_ + previous_entry->length_) == (addr & HIPOX_DMA_CSUM_ADR_MASK)) && ++ ((previous_entry->length_ + length) <= MAX_HIPOX_DMA_TRANSFER_LENGTH)) { ++ // Yes, so coalesce the pair ++ previous_entry->length_ += length; ++ } else ++#endif ++ { ++ // Get the next available SG entry ++ if (!next_entry) { ++ failed = 1; ++ break; ++ } ++ sg_entry = next_entry; ++ ++ if (previous_entry) { ++ // Link the previous SG list entry forward to this one ++ previous_entry->v_next_ = sg_entry; ++ previous_entry->p_next_ = sg_entry->paddr_; ++ } else { ++ // Create a link from the SG info structure to the first SG list entry ++ sg_info->v_dstEntries_ = sg_entry; ++ sg_info->p_dstEntries_ = sg_entry->paddr_; ++ } ++ previous_entry = sg_entry; ++ ++ // Fill in the SG list entry with start address, ensuring address ++ // does not affect the checksum enabling high order adr bit ++ sg_entry->addr_ = addr & HIPOX_DMA_ADR_MASK; ++ ++ // Fill in the length, checking that it does not exceed the hardware ++ // allowed maximum ++ if (length > MAX_HIPOX_DMA_TRANSFER_LENGTH) { ++ printk(KERN_WARNING "hipox_dma_set_prd_common() Destination entry too long (0x%x), zeroing\n", length); ++ sg_entry->length_ = 0; ++ } else { ++ sg_entry->length_ = length; ++ } ++ ++ // Get pointer to next available SG entry ++ next_entry = sg_entry->next_; ++ } ++ } while (!eot); ++ if (sg_entry) { ++ // Mark the end of the destination SG list with nulls ++ sg_entry->p_next_ = 0; ++ sg_entry->v_next_ = 0; ++ } ++ ++ if (failed) { ++ // Failed to allocate all SG dst entries ++ sg_info->p_dstEntries_ = 0; ++ sg_info->v_dstEntries_ = 0; ++ sg_info->p_srcEntries_ = 0; ++ sg_info->v_srcEntries_ = 0; ++ printk(KERN_WARNING "Too few SG entries to satisfy destination requirements\n"); ++ return 1; ++ } ++ ++ // Fill in length of single device SG entry from the total length of all the ++ // memory SG entries ++ if ((sg_entry = sg_info->v_srcEntries_) && !sg_entry->v_next_) { ++ sg_entry->length_ = tot_dst_len; ++ } else if ((sg_entry = sg_info->v_dstEntries_) && !sg_entry->v_next_) { ++ sg_entry->length_ = tot_src_len; ++ } ++ ++ sg_info->qualifer_ = ((channel->channel_number_ << HIPOX_DMA_SG_CHANNEL_BIT) | ++ (src_settings->read_eot_policy_ << HIPOX_DMA_SG_SRC_EOT_BIT) | ++ (dst_settings->write_eot_policy_ << HIPOX_DMA_SG_DST_EOT_BIT) | ++ (1 << HIPOX_DMA_SG_QUALIFIER_BIT)); ++ ++ // Flags are the same for source and destination for each SG transfer component ++ sg_info->control_ = encode_control_status(src_settings, dst_settings, 0); ++ ++ // Increase count of in-progress transfers on this channel ++ atomic_inc(&channel->active_count_); ++ ++ return 0; ++} ++ ++int hipox_dma_device_set_prd( ++ hipox_dma_channel_t *channel, ++ hipox_dma_direction_t direction, ++ struct ata_prd *mem_prd, ++ hipox_dma_device_settings_t *device_settings, ++ hipox_dma_mode_t mem_mode, ++ hipox_dma_sg_entry_t *sg_entries) ++{ ++ struct ata_prd dev_prd; ++ hipox_dma_device_settings_t mem_settings; ++ ++ if (unlikely(hipox_dma_is_active(channel))) { ++ printk(KERN_WARNING "hipox_dma_device_set_prd() Trying to use channel %u while active\n", channel->channel_number_); ++ } ++ ++ // Assemble complete memory settings ++ mem_settings = hipox_ram_generic_dma_settings; ++ mem_settings.address_ = 0; // Not used for SG transfers ++ mem_settings.address_mode_ = mem_mode; ++ ++ // Device has only a single SG entry whose length will be assigned once ++ // all the memory transfer lengths have been accumulated ++ dev_prd.addr = device_settings->address_; ++ dev_prd.flags_len = ATA_PRD_EOT; ++ ++ return hipox_dma_set_prd_common( ++ channel, ++ (direction == HIPOX_DMA_TO_DEVICE) ? mem_prd : &dev_prd, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? mem_prd : &dev_prd, ++ (direction == HIPOX_DMA_TO_DEVICE) ? &mem_settings : device_settings, ++ (direction == HIPOX_DMA_FROM_DEVICE) ? &mem_settings : device_settings, ++ sg_entries); ++} ++ ++void hipox_dma_set_callback(hipox_dma_channel_t* channel, hipox_dma_callback_t callback, hipox_callback_arg_t arg) ++{ ++#if defined(HIPOX_DMA_TEST) || defined(HIPOX_DMA_SG_TEST) ++printk("Registering callback 0x%08x for channel %u\n", (unsigned)callback, channel->channel_number_); ++#endif // defined(HIPOX_DMA_TEST) || defined(HIPOX_DMA_SG_TEST) ++ channel->notification_callback_ = callback; ++ channel->notification_arg_ = arg; ++} ++ ++static void default_callback( ++ hipox_dma_channel_t* channel, ++ hipox_callback_arg_t arg, ++ hipox_dma_callback_status_t status, ++ u16 checksum, ++ int interrupt_count) ++{ ++ up(&channel->default_semaphore_); ++} ++ ++void hipox_dma_abort( ++ hipox_dma_channel_t *channel, ++ int in_atomic) ++{ ++ u32 ctrl_status; ++ unsigned channel_number = channel->channel_number_; ++ int must_wait = 0; ++ int callback_registered = 0; ++ ++ // Assert reset for the channel ++ spin_lock(&dma_controller.spinlock_); ++ ctrl_status = readl(DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)); ++ ctrl_status |= DMA_CTRL_STATUS_RESET; ++ writel(ctrl_status, DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)); ++ spin_unlock(&dma_controller.spinlock_); ++ ++ // Wait for the channel to become idle - should be quick as should finish ++ // after the next AHB single or burst transfer ++ while (readl(DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)) & DMA_CTRL_STATUS_IN_PROGRESS); ++ ++ // Deassert reset for the channel ++ spin_lock(&dma_controller.spinlock_); ++ ctrl_status = readl(DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)); ++ ctrl_status &= ~DMA_CTRL_STATUS_RESET; ++ writel(ctrl_status, DMA_CALC_REG_ADR(channel_number, DMA_CTRL_STATUS)); ++ spin_unlock(&dma_controller.spinlock_); ++ ++ // If no user callback is registered, we need to wait here for the DMA ++ // channel to become inactive, i.e. for the ISR to be called and the ++ // channel software returned to the idle state ++ if (channel->notification_callback_ == HIPOX_DMA_CALLBACK_NUL) { ++ must_wait = 1; ++ if (!in_atomic) { ++ // If the callers is not calling us from atomic context we can ++ // register our own callback and sleep until it is invoked ++ hipox_dma_set_callback(channel, default_callback, HIPOX_DMA_CALLBACK_ARG_NUL); ++ callback_registered = 1; ++ } ++ } ++ ++ // Fake an interrupt to cause the channel to be cleaned up by running the ++ // DMA bottom half tasklet ++ fake_interrupt(channel_number); ++ ++ if (must_wait) { ++ if (callback_registered) { ++ // Sleep until the channel becomes inactive ++ down_interruptible(&channel->default_semaphore_); ++ ++ // Deregister the callback ++ hipox_dma_set_callback(channel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ } else { ++ // If we reach here we are in an atomic context and thus must not do ++ // anything that might cause us to sleep ++ // NB. Possible problem here if we're atomic because someone has ++ // called spin_lock_bh(); I'm concerned that calling do_softirq() ++ // under these circumstances might cause issues, althought the net- ++ // working code calls do_softirq() and doesn't appear to worry ++ if (local_softirq_pending()) { ++ // If an interrupt has not arrived and caused the tasklet to ++ // have been run already, cause it to run now. ++ do_softirq(); ++ } ++ ++ // The tasklet should have run by this point and cleaned up the channel ++ BUG_ON(hipox_dma_is_active(channel)); ++ } ++ } ++} ++ ++void hipox_dma_start(hipox_dma_channel_t* channel) ++{ ++ // Are there SG lists setup for this channel? ++ if (channel->v_sg_info_->v_srcEntries_) { ++#ifdef HIPOX_DMA_SG_TEST_DUMP_DESCRIPTORS ++ // Print the desciptor contents for debugging ++ hipox_dma_sg_entry_t* d = channel->v_sg_info_->v_srcEntries_; ++ printk("qualifer_ = 0x%08lx, control_ = 0x%lx\n", channel->v_sg_info_->qualifer_, channel->v_sg_info_->control_); ++ printk("Source Descriptors:\n"); ++ while (d) { ++ printk("v_addr=0x%08x, p_addr=0x%08x, addr_=0x%08x, length_=0x%08lx, next=0x%08x\n", (u32)d, (u32)d->paddr_, d->addr_, d->length_, d->p_next_); ++ d = d->v_next_; ++ } ++ printk("Destination Descriptors:\n"); ++ d = channel->v_sg_info_->v_dstEntries_; ++ while (d) { ++ printk("v_addr=0x%08x, p_addr=0x%08x, addr_=0x%08x, length_=0x%08lx, next=0x%08x\n", (u32)d, (u32)d->paddr_, d->addr_, d->length_, d->p_next_); ++ d = d->v_next_; ++ } ++#endif // HIPOX_DMA_SG_TEST_DUMP_DESCRIPTORS ++ ++ // Write to the SG-DMA channel's reset register to reset the control ++ // in case the previous SG-DMA transfer failed in some way, thus ++ // leaving the SG-DMA controller hung up part way through processing ++ // its SG list. The reset bits are self-clearing ++ writel(1UL << DMA_SG_RESETS_CONTROL_BIT, DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_RESETS)); ++ ++ // Write the pointer to the SG info struct into the Request Pointer reg. ++ writel(channel->p_sg_info_, DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_REQ_PTR)); ++ ++#ifdef HIPOX_DMA_SG_TEST ++printk("p_sg_info_ = 0x%08x written to 0x%08x\n", (u32)channel->p_sg_info_, DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_REQ_PTR)); ++printk("*(DMA_SG_CONTROL) = 0x%08x\n", readl(DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_CONTROL))); ++printk("*(DMA_SG_STATUS) = 0x%08x\n", readl(DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_STATUS))); ++printk("*(DMA_SG_REQ_PTR) = 0x%08x\n", readl(DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_REQ_PTR))); ++#endif // HIPOX_DMA_SG_TEST ++ ++ // Start the transfer ++ writel((1UL << DMA_SG_CONTROL_START_BIT) | ++ (1UL << DMA_SG_CONTROL_QUEUING_ENABLE_BIT) | ++ (1UL << DMA_SG_CONTROL_HBURST_ENABLE_BIT), ++ DMA_SG_CALC_REG_ADR(channel->channel_number_, DMA_SG_CONTROL)); ++ } else { ++ // Single transfer mode, so unpause the DMA controller channel ++ spin_lock(&dma_controller.spinlock_); ++ writel(encode_start(readl(DMA_CALC_REG_ADR(channel->channel_number_, DMA_CTRL_STATUS))), ++ DMA_CALC_REG_ADR(channel->channel_number_, DMA_CTRL_STATUS)); ++ spin_unlock(&dma_controller.spinlock_); ++ } ++} ++ ++void hipox_dma_dump_registers() ++{ ++ unsigned long* adr = (unsigned long*)DMA_CALC_REG_ADR(0, 0); ++ unsigned long* end = (adr + DMA_REGS_PER_CHANNEL); ++ int i; ++ ++ printk("hipox_dma_dump_registers(), adr= 0x%08lx, end=0x%08lx\n", (unsigned long)adr, (unsigned long)(adr + (DMA_REGS_PER_CHANNEL * dma_controller.numberOfChannels_))); ++ ++ for (i=0; i < dma_controller.numberOfChannels_; i++) { ++ for (; adr < end; adr++) { ++ printk("0x%08lx\n", *adr); ++ } ++ printk("SG-Debug: 0x%08x\n", readl(DMA_SG_CALC_REG_ADR(i, DMA_SG_RESETS))); ++ printk("-----------------------\n"); ++ end += DMA_REGS_PER_CHANNEL; ++ } ++ printk("hipox_dma_dump_registers() - end\n"); ++} ++ ++void hipox_dma_dump_registers_single(int channel_number) ++{ ++ unsigned long* adr = (unsigned long*)DMA_CALC_REG_ADR(channel_number, 0); ++ unsigned long* end = (adr + DMA_REGS_PER_CHANNEL); ++ ++ printk("DMA channel %d regs:\n", channel_number); ++ for (; adr < end; adr++) { ++ printk("0x%08lx\n", *adr); ++ } ++} ++ ++#if defined(HIPOX_DMA_TEST) || defined(HIPOX_DMA_SG_TEST) ++static __DECLARE_SEMAPHORE_GENERIC(callback_semaphore, 0); // Binary semaphore for testing ++ ++static void dma_callback( ++ hipox_dma_channel_t *channel, ++ hipox_callback_arg_t arg, ++ hipox_dma_callback_status_t error_code, ++ u16 checksum, ++ int interrupt_count) ++{ ++ printk("dma_callback() for channel %u, arg = 0x%lx, status = 0x%04x, checksum = 0x%04hx, interrupt_count = %d\n", channel->channel_number_, (unsigned long)arg, error_code, checksum, interrupt_count); ++ up(&callback_semaphore); ++} ++ ++#include <linux/dma-mapping.h> ++#include <linux/slab.h> ++ ++#ifdef HIPOX_DMA_TEST ++static void dma_test(unsigned long length) ++{ ++ void* memory1; ++ void* memory2; ++ unsigned long* ptr; ++ unsigned long quads; ++ int i; ++ unsigned long* end; ++ dma_addr_t dma_address1; ++ dma_addr_t dma_address2; ++ hipox_dma_channel_t* channels[MAX_HIPOX_DMA_CHANNELS]; ++ ++ printk("*************************************************************\n"); ++ printk(" \n"); ++ printk("Simple DMA Test, length = %lu, number of channel = %u\n", length, MAX_HIPOX_DMA_CHANNELS); ++ printk(" \n"); ++ printk("*************************************************************\n"); ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ channels[i] = hipox_dma_request(0); ++ if (channels[i] == HIPOX_DMA_CHANNEL_NUL) { ++ printk("No DMA channels[%d] obtained\n", i); ++ } else { ++ printk("Obtained DMA channels[%d] %u, isActive=%d\n", i, channels[i]->channel_number_, hipox_dma_is_active(channels[i])); ++ } ++ } ++ ++ // Allocate some DMA coherent memory ++ printk("Calling kmalloc()\n"); ++ memory1 = kmalloc(length, GFP_KERNEL | GFP_DMA); ++ memory2 = kmalloc(length, GFP_KERNEL | GFP_DMA); ++ ++ // Test each available DMA channel ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ int j; ++ ++ // Fill each memory area with a different pattern ++ ptr = (unsigned long*)memory1; ++ quads = length/sizeof(unsigned long); ++ for (j=0; j < quads; j++) { ++ *ptr++ = 0xdeadbeef; ++ } ++ ptr = (unsigned long*)memory2; ++ for (j=0; j < quads; j++) { ++ *ptr++ = 0xc001babe; ++ } ++ ++ printk("Before:\n"); ++ ptr = (unsigned long*)memory1; ++ end = (unsigned long*)(memory1 + length); ++ while (ptr < end) { ++ for (j=0; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ printk("---------------------------------------------------------\n"); ++ ptr = (unsigned long*)memory2; ++ end = (unsigned long*)(memory2 + length); ++ while (ptr < end) { ++ for (j=0; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ ++ // Get a consistent DMA mapping for the memory to be DMAed from - causing a ++ // flush from the CPU's cache to the memory ++ dma_address1 = dma_map_single(0, memory1, length, DMA_TO_DEVICE); ++ if (dma_mapping_error(dma_address1)) { ++ printk("Consistent DMA mapping 1 failed\n"); ++ } ++ ++ // Get a consistent DMA mapping for the memory to be DMAed to - causing a ++ // flush and invalidation of any entries in the CPU's cache covering the ++ // memory region ++ dma_address2 = dma_map_single(0, memory2, length, DMA_BIDIRECTIONAL); ++ if (dma_mapping_error(dma_address2)) { ++ printk("Consistent DMA mapping 2 failed\n"); ++ } ++ ++ // Setup up DMA from first half to second half on memory, using physical addresses ++ printk("Calling hipox_dma_set(), memory1 = 0x%08lx, memory2 = 0x%08lx\n", (unsigned long)memory1, (unsigned long)memory2); ++ hipox_dma_set( ++ channels[i], ++ (unsigned char*)dma_address1, ++ length, ++ (unsigned char*)dma_address2, ++ HIPOX_DMA_MODE_INC, ++ HIPOX_DMA_MODE_INC, ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ 1, // Calculate checksum over source data ++#else // CONFIG_HIPOX_VERSION_0X800 ++ 0, ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ 1); // Paused ++ ++ // Using notification callback ++ hipox_dma_set_callback(channels[i], dma_callback, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++//printk("Before starting status = 0x%08x, intId = 0x%08x\n", readl(DMA_CALC_REG_ADR(channels[i]->channel_number_, DMA_CTRL_STATUS)), readl(DMA_CALC_REG_ADR(0, DMA_INTR_ID))); ++ // Start the transfer ++ printk("hipox_dma_start() for channel %u\n", channels[i]->channel_number_); ++ hipox_dma_start(channels[i]); ++ ++// Poll for transfer completion ++//while (hipox_dma_raw_isactive(channels[i])) { ++// printk("."); ++//} ++//printk("Found channel inactive, status = 0x%08x, intId = 0x%08x\n", readl(DMA_CALC_REG_ADR(channels[i]->channel_number_, DMA_CTRL_STATUS)), readl(DMA_CALC_REG_ADR(0, DMA_INTR_ID))); ++ ++ printk("Waiting for channel to be inactive\n"); ++ ++ // Sleep until transfer completed ++ while (down_interruptible(&callback_semaphore)); ++ hipox_dma_set_callback(channels[i], HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ // Release the consistent DMA mappings ++ dma_unmap_single(0, dma_address1, length, DMA_TO_DEVICE); ++ dma_unmap_single(0, dma_address2, length, DMA_BIDIRECTIONAL); ++ ++ printk("After:\n"); ++ ptr = (unsigned long*)memory1; ++ end = (unsigned long*)(memory1 + length); ++ while (ptr < end) { ++ for (j=0; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ printk("---------------------------------------------------------\n"); ++ ptr = (unsigned long*)memory2; ++ end = (unsigned long*)(memory2 + length); ++ while (ptr < end) { ++ for (j=0; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ } ++ ++ // Deallocate the memory ++ printk("Calling kfree()\n"); ++ kfree(memory1); ++ kfree(memory2); ++ printk("Returned from kfree()\n"); ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ hipox_dma_free(channels[i]); ++ } ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ channels[i] = hipox_dma_request(0); ++ if (channels[i] == HIPOX_DMA_CHANNEL_NUL) { ++ printk("No DMA channels[%d] obtained\n", i); ++ } else { ++ printk("Obtained DMA channels[%d] %u, isActive=%d\n", i, channels[i]->channel_number_, hipox_dma_is_active(channels[i])); ++ } ++ } ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ hipox_dma_free(channels[i]); ++ } ++} ++#endif // HIPOX_DMA_TEST ++ ++#ifdef HIPOX_DMA_SG_TEST ++static void dma_sg_test(void) ++{ ++ int i; ++ struct scatterlist* src_scatterlist = 0; ++ struct scatterlist* dst_scatterlist = 0; ++ const int num_src_buffers = 8; ++ const int num_dst_buffers = 3; ++ unsigned long src_fill_value = 0; ++ unsigned long total_src_len = 0; ++ int channel_number; ++ hipox_dma_channel_t* channels[MAX_HIPOX_DMA_CHANNELS]; ++ ++ printk("*************************************************************\n"); ++ printk(" \n"); ++ printk("Scatter-Gather DMA Test\n"); ++ printk(" \n"); ++ printk("*************************************************************\n"); ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ channels[i] = hipox_dma_request(0); ++ if (channels[i] == HIPOX_DMA_CHANNEL_NUL) { ++ printk("No DMA channels[%d] obtained\n", i); ++ } else { ++ printk("Obtained DMA channels[%d] %u, isActive=%d\n", i, channels[i]->channel_number_, hipox_dma_is_active(channels[i])); ++ } ++ } ++ ++ for (channel_number=0; channel_number < MAX_HIPOX_DMA_CHANNELS; ++channel_number) { ++ if (num_src_buffers) { ++ printk("Allocating source SG list and entry buffers\n"); ++ // Allocate scatterlist and memory for source buffers - store virtual buffer ++ // addresses in scatterlist.offset for convenience. Include some contiguous ++ // entries to test coalescing ++ src_scatterlist = (struct scatterlist*)kmalloc(sizeof(struct scatterlist) * num_src_buffers, GFP_KERNEL); ++ src_scatterlist[0].offset = (unsigned int)kmalloc(8*1024, GFP_KERNEL | GFP_DMA); ++ src_scatterlist[0].__address = (char*)(8*1024); // Real allocation length ++ src_scatterlist[0].length = 8*1024; ++ src_scatterlist[0].page = (struct page*)0xdeadbeef; // Fill value ++ src_scatterlist[1].offset = (unsigned int)kmalloc(8, GFP_KERNEL | GFP_DMA); ++ src_scatterlist[1].__address = (char*)8; // Real allocation length ++ src_scatterlist[1].length = 8; ++ src_scatterlist[1].page = (struct page*)0xc001babe; // Fill value ++ src_scatterlist[2].offset = (unsigned int)kmalloc(48*1024, GFP_KERNEL | GFP_DMA); ++ src_scatterlist[2].__address = (char*)(48*1024); // Real allocation length ++ src_scatterlist[2].length = 16*1024; ++ src_scatterlist[2].page = (struct page*)0x22222222; // Fill value ++ src_scatterlist[3].offset = src_scatterlist[2].offset + src_scatterlist[2].length; ++ src_scatterlist[3].__address = (char*)0; // No allocation ++ src_scatterlist[3].length = 16*1024; ++ src_scatterlist[3].page = (struct page*)0x33333333; // Fill value ++ src_scatterlist[4].offset = src_scatterlist[3].offset + src_scatterlist[3].length; ++ src_scatterlist[4].__address = (char*)0; // No allocation ++ src_scatterlist[4].length = 16*1024; ++ src_scatterlist[4].page = (struct page*)0x44444444; // Fill value ++ src_scatterlist[5].offset = (unsigned int)kmalloc(64, GFP_KERNEL | GFP_DMA); ++ src_scatterlist[5].__address = (char*)64; // Real allocation length ++ src_scatterlist[5].length = 64; ++ src_scatterlist[5].page = (struct page*)0x55555555; // Fill value ++ src_scatterlist[6].offset = (unsigned int)kmalloc(256, GFP_KERNEL | GFP_DMA); ++ src_scatterlist[6].__address = (char*)256; // Real allocation length ++ src_scatterlist[6].length = 128; ++ src_scatterlist[6].page = (struct page*)0x66666666; // Fill value ++ src_scatterlist[7].offset = src_scatterlist[6].offset + src_scatterlist[6].length; ++ src_scatterlist[7].__address = (char*)0; // No allocation ++ src_scatterlist[7].length = 128; ++ src_scatterlist[7].page = (struct page*)0x77777777; // Fill value ++ } ++ ++ // Fill source memory buffers with stuff ++ for (i=0; i < num_src_buffers; i++) { ++ unsigned long* ptr = (unsigned long*)src_scatterlist[i].offset; ++ int quads = src_scatterlist[i].length/sizeof(unsigned long); ++ int j=0; ++ printk("Filling source buffer %u\n", i); ++ src_fill_value = (unsigned long)(src_scatterlist[i].page); ++ for (; j < quads; j++) { ++ *ptr++ = src_fill_value; ++ } ++ } ++ ++ #ifdef HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ // Print before contents of source buffers ++ printk("Source Before:\n"); ++ for (i=0; i < num_src_buffers; i++) { ++ unsigned long* ptr = (unsigned long*)src_scatterlist[i].offset; ++ unsigned long* end = (unsigned long*)(src_scatterlist[i].offset + src_scatterlist[i].length); ++ printk("Buffer %d\n", i); ++ while (ptr < end) { ++ int j=0; ++ for (; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ } ++ #endif // HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ ++ // Get a consistent DMA mapping for the memory to be DMAed from - causing a ++ // flush from the CPU's cache to the memory ++ for (i=0; i < num_src_buffers; i++) { ++ printk("Creating DMA mappings for source entry buffer %u\n", i); ++ src_scatterlist[i].dma_address = dma_map_single(0, (void*)src_scatterlist[i].offset, src_scatterlist[i].length, DMA_TO_DEVICE); ++ if (dma_mapping_error(src_scatterlist[i].dma_address)) { ++ printk("Consistent source DMA mapping %d failed\n", i); ++ } ++ ++ // Set the checksum enabling high order address bit ++ src_scatterlist[i].dma_address |= (1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ } ++ ++ // Allocate scatterlist and memory for destination buffers - store virtual ++ // buffer addresses in scatterlist.offset for convenience ++ if (num_dst_buffers) { ++ unsigned long dst_length; ++ unsigned long offset; ++ ++ printk("Allocating destination SG list and entry buffers\n"); ++ total_src_len = 0; ++ for (i=0; i < num_src_buffers; i++) { ++ total_src_len += src_scatterlist[i].length; ++ } ++ ++ // Following will only work if no remainder due to divide ++ dst_length = total_src_len / num_dst_buffers; ++ dst_scatterlist = (struct scatterlist*)kmalloc(sizeof(struct scatterlist) * num_dst_buffers, GFP_KERNEL); ++ ++ // First destination segment owns the buffer ++ dst_scatterlist[0].offset = (unsigned int)kmalloc(total_src_len, GFP_KERNEL | GFP_DMA); ++ dst_scatterlist[0].__address = (char*)total_src_len; // Real allocation length ++ dst_scatterlist[0].length = dst_length; ++ ++ offset = dst_length; ++ for (i=1; i < num_dst_buffers; i++) { ++ dst_scatterlist[i].offset = dst_scatterlist[0].offset + offset; ++ dst_scatterlist[i].__address = 0; // No allocation ++ dst_scatterlist[i].length = dst_length; ++ ++ offset += dst_length; ++ } ++ } ++ ++ // Fill destination memory buffers with zero ++ for (i=0; i < num_dst_buffers; i++) { ++ unsigned long* ptr = (unsigned long*)dst_scatterlist[i].offset; ++ int quads = dst_scatterlist[i].length/sizeof(unsigned long); ++ int j=0; ++ printk("Filling destination buffer %u\n", i); ++ for (; j < quads; j++) { ++ *ptr++ = 0x000000; ++ } ++ } ++ ++ //#ifdef HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ // // Print before contents of destination buffers ++ // printk("Destination Before:\n"); ++ // for (i=0; i < num_dst_buffers; i++) { ++ // unsigned long* ptr = (unsigned long*)dst_scatterlist[i].offset; ++ // unsigned long* end = (unsigned long*)(dst_scatterlist[i].offset + dst_scatterlist[i].length); ++ // printk("Buffer %d\n", i); ++ // while (ptr < end) { ++ // int j=0; ++ // for (; j < 8; j++) { ++ // printk("0x%08lx ", *ptr++); ++ // } ++ // printk("\n"); ++ // } ++ // } ++ //#endif // HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ ++ // Get a consistent DMA mapping for the memory to be DMAed to - causing an ++ // invalidate to the CPU's cache ++ for (i=0; i < num_dst_buffers; i++) { ++ printk("Creating DMA mappings for destination entry buffer %u\n", i); ++ dst_scatterlist[i].dma_address = dma_map_single(0, (void*)dst_scatterlist[i].offset, dst_scatterlist[i].length, DMA_BIDIRECTIONAL); ++ if (dma_mapping_error(dst_scatterlist[i].dma_address)) { ++ printk("Consistent destination DMA mapping %d failed\n", i); ++ } ++ } ++ ++ // Setup up SG DMA transfer ++ printk("Setting up transfer\n"); ++ hipox_dma_set_sg( ++ channels[channel_number], ++ src_scatterlist, ++ num_src_buffers, ++ dst_scatterlist, ++ num_dst_buffers, ++ HIPOX_DMA_MODE_INC, ++ HIPOX_DMA_MODE_INC, ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ 1); // Compute checksum ++#else // CONFIG_HIPOX_VERSION_0X800 ++ 0); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ // Using second DMA channel requested ++ hipox_dma_set_callback(channels[channel_number], dma_callback, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ // Start the transfer ++ printk("Starting the transfer\n"); ++ hipox_dma_start(channels[channel_number]); ++ ++ // Sleep until transfer completed ++ printk("Waiting for transfer to complete...\n"); ++ ++ while (down_interruptible(&callback_semaphore)); ++ hipox_dma_set_callback(channels[channel_number], HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ // Release the consistent DMA mappings for the source buffers ++ for (i=0; i < num_src_buffers; i++) { ++ printk("Releasing DMA mappings for source entry buffer %u\n", i); ++ // Ensure the checksum enabling high order address bit is not set, as ++ // this would confuse the DMA mapping release function ++ src_scatterlist[i].dma_address &= ~(1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ dma_unmap_single(0, src_scatterlist[i].dma_address, src_scatterlist[i].length, DMA_TO_DEVICE); ++ } ++ ++ // Release the consistent DMA mappings for the destination buffers ++ for (i=0; i < num_dst_buffers; i++) { ++ printk("Releasing DMA mappings for destination entry buffer %u\n", i); ++ dma_unmap_single(0, dst_scatterlist[i].dma_address, dst_scatterlist[i].length, DMA_BIDIRECTIONAL); ++ } ++ ++ { ++ u32 sw_csum = 0; ++ for (i=0; i < num_src_buffers; i++) { ++ sw_csum = csum_partial((u8*)src_scatterlist[i].offset, src_scatterlist[i].length, sw_csum); ++ } ++ printk("S/W generated src csum = 0x%04hx\n", csum_fold(sw_csum)); ++ ++ sw_csum = 0; ++ for (i=0; i < num_dst_buffers; i++) { ++ sw_csum = csum_partial((u8*)dst_scatterlist[i].offset, dst_scatterlist[i].length, sw_csum); ++ } ++ printk("S/W generated dst csum = 0x%04hx\n", csum_fold(sw_csum)); ++ } ++ ++ #ifdef HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ // // Print after contents of source buffers ++ // printk("Source After:\n"); ++ // for (i=0; i < num_src_buffers; i++) { ++ // unsigned long* ptr = (unsigned long*)src_scatterlist[i].offset; ++ // unsigned long* end = (unsigned long*)(src_scatterlist[i].offset + src_scatterlist[i].length); ++ // printk("Buffer %d\n", i); ++ // while (ptr < end) { ++ // int j=0; ++ // for (; j < 8; j++) { ++ // printk("0x%08lx ", *ptr++); ++ // } ++ // printk("\n"); ++ // } ++ // } ++ ++ // Print after contents of destination buffers ++ printk("Destination After:\n"); ++ for (i=0; i < num_dst_buffers; i++) { ++ unsigned long* ptr = (unsigned long*)dst_scatterlist[i].offset; ++ unsigned long* end = (unsigned long*)(dst_scatterlist[i].offset + dst_scatterlist[i].length); ++ printk("Buffer %d\n", i); ++ while (ptr < end) { ++ int j=0; ++ for (; j < 8; j++) { ++ printk("0x%08lx ", *ptr++); ++ } ++ printk("\n"); ++ } ++ } ++ #endif // HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++ ++ // Free the memory for the source buffers ++ for (i=0; i < num_src_buffers; i++) { ++ // Check that unique allocation made for this entry ++ if (src_scatterlist[i].__address) { ++ printk("Freeing source SG entry buffer, adr = 0x%08x, len = 0x%08x\n", src_scatterlist[i].offset, (u32)src_scatterlist[i].__address); ++ kfree((void*)src_scatterlist[i].offset); ++ } ++ } ++ ++ // Free the memory for the source scatterlist ++ if (src_scatterlist) { ++ printk("Freeing source SG scatter list structure\n"); ++ kfree(src_scatterlist); ++ } ++ ++ // Free the memory for the destination buffers ++ for (i=0; i < num_dst_buffers; i++) { ++ if (dst_scatterlist[i].__address) { ++ printk("Freeing destination SG entry, adr = 0x%08x, len = 0x%08x\n", dst_scatterlist[i].offset, (u32)dst_scatterlist[i].__address); ++ kfree((void*)dst_scatterlist[i].offset); ++ } ++ } ++ ++ // Free the memory for the destination scatterlist ++ if (dst_scatterlist) { ++ printk("Freeing source SG scatter list structure\n"); ++ kfree(dst_scatterlist); ++ } ++ } ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ hipox_dma_free(channels[i]); ++ } ++} ++#endif // HIPOX_DMA_SG_TEST ++ ++#ifdef HIPOX_DMA_SG_TEST_2 ++static void dma_sg_test2() ++{ ++ /** Include initial 2 bytes of pad that real network buffers would contain ++ in order to ensure that IP header and TCP/UDP header are quad aligned */ ++ static const unsigned char bad_src_data0[] = { ++ 0xff, 0xff, 0x00, 0xa0, 0xd2, 0x05, 0x06, 0xec, 0x00, 0xcf, 0x52, 0x49, 0xc3, 0x03, 0x08, 0x00, ++ 0x45, 0x00, 0x05, 0xb4, 0x99, 0x45, 0x40, 0x00, 0x40, 0x06, 0x42, 0xf5, 0xac, 0x1f, 0x00, 0x65, ++ 0xac, 0x1f, 0x00, 0x66 ++ }; ++ ++ static const unsigned char bad_src_data1[] = { ++ 0x04, 0x00, 0x13, 0x89, 0x02, 0x8a, 0x5c, 0x83, 0x52, 0xde, 0xc7, 0x0c, 0x80, 0x19, 0x0b, 0x68, ++ 0x00, 0x00, 0x00, 0x00, 0x01, 0x01, 0x08, 0x0a, 0xff, 0xff, 0xb3, 0x9d, 0x3f, 0x82, 0xf0, 0xff, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, ++ 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, ++ 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, ++ 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, ++ 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, ++ 0x36, 0x37, 0x38, 0x39, 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x30, 0x31 ++ }; ++ ++ /** Include initial 2 bytes of pad that real network buffers would contain ++ in order to ensure that IP header and TCP/UDP header are quad aligned */ ++ static const unsigned char good_src_data0[] = { ++ 0xff, 0xff, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5 ++ }; ++ ++ static const unsigned char good_src_data1[] = { ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, ++ 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5, 0xa5 ++ }; ++ ++ static const int src_offset = 2; // To jump IP quad align padding ++ static const int dst_buffer_size = 512; ++ ++ const unsigned char *src_data0 = bad_src_data0; ++ const unsigned char *src_data1 = bad_src_data1; ++ unsigned long src_data0_len = sizeof(bad_src_data0); ++ unsigned long src_data1_len = sizeof(bad_src_data1); ++ int channel_number; ++ hipox_dma_channel_t* channels[MAX_HIPOX_DMA_CHANNELS]; ++ int i; ++ ++// const unsigned char *src_data0 = good_src_data0; ++// const unsigned char *src_data1 = good_src_data1; ++// unsigned long src_data0_len = sizeof(good_src_data0); ++// unsigned long src_data1_len = sizeof(good_src_data1); ++ ++ printk("*************************************************************\n"); ++ printk(" \n"); ++ printk("Scatter-Gather DMA Test 2\n"); ++ printk(" \n"); ++ printk("*************************************************************\n"); ++ ++ printk("seg0 0x%08x, %lu\n", (u32)src_data0, src_data0_len); ++ printk("seg1 0x%08x, %lu\n", (u32)src_data1, src_data1_len); ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ channels[i] = hipox_dma_request(0); ++ if (channels[i] == HIPOX_DMA_CHANNEL_NUL) { ++ printk("No DMA channels[%d] obtained\n", i); ++ } else { ++ printk("Obtained DMA channels[%d] %u, isActive=%d\n", i, channels[i]->channel_number_, hipox_dma_is_active(channels[i])); ++ } ++ } ++ ++ // Test each available DMA channel ++ for (channel_number=0; channel_number < MAX_HIPOX_DMA_CHANNELS; ++channel_number) { ++ ++ struct scatterlist* src_scatterlist = (struct scatterlist*)kmalloc(sizeof(struct scatterlist) * 2, GFP_KERNEL); ++ ++ unsigned long total_src_length = src_data0_len + src_data1_len; ++ src_scatterlist[0].offset = (unsigned int)kmalloc(total_src_length, GFP_KERNEL | GFP_DMA) + src_offset; ++ src_scatterlist[0].length = src_data0_len - src_offset; ++ memcpy((u8*)src_scatterlist[0].offset, src_data0, src_scatterlist[0].length); ++ ++ src_scatterlist[1].offset = src_scatterlist[0].offset + src_scatterlist[0].length; ++ src_scatterlist[1].length = src_data1_len; ++ memcpy((u8*)src_scatterlist[1].offset, src_data1, src_scatterlist[1].length); ++ ++ unsigned long total_dst_length = total_src_length - src_offset; // Excludes initial IP quad alignment pad ++ unsigned num_dst_buffers = total_dst_length / dst_buffer_size; ++ if ((num_dst_buffers * dst_buffer_size) < total_dst_length) { ++ ++num_dst_buffers; ++ } ++ printk("total_src_length = %lu, src_offset = %u, total_dst_length = %lu, dst_buffer_size = %u, num_dst_buffers = %u\n", total_src_length, src_offset, total_dst_length, dst_buffer_size, num_dst_buffers); ++ struct scatterlist* dst_scatterlist = (struct scatterlist*)kmalloc(sizeof(struct scatterlist) * num_dst_buffers, GFP_KERNEL); ++ ++ int i; ++ unsigned long remainder = total_dst_length; ++ for (i=0; i < num_dst_buffers; ++i) { ++ dst_scatterlist[i].offset = (unsigned int)kmalloc(dst_buffer_size, GFP_KERNEL | GFP_DMA); ++ dst_scatterlist[i].length = (remainder < dst_buffer_size) ? remainder : dst_buffer_size; ++ remainder -= dst_scatterlist[i].length; ++ } ++ ++ int j; ++ for (j=0; j < HIPOX_DMA_SG_TEST2_ITERATIONS; ++j) { ++ src_scatterlist[0].dma_address = dma_map_single(0, (void*)src_scatterlist[0].offset, src_scatterlist[0].length, DMA_TO_DEVICE); ++ if (dma_mapping_error(src_scatterlist[0].dma_address)) { ++ printk("Consistent source DMA mapping 0 failed\n"); ++ } ++ // Set the checksum enabling high order address bit ++ //src_scatterlist[0].dma_address |= (1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ ++ src_scatterlist[1].dma_address = dma_map_single(0, (void*)src_scatterlist[1].offset, src_scatterlist[1].length, DMA_TO_DEVICE); ++ if (dma_mapping_error(src_scatterlist[1].dma_address)) { ++ printk("Consistent source DMA mapping 1 failed\n"); ++ } ++ // Set the checksum enabling high order address bit ++ src_scatterlist[1].dma_address |= (1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ ++ printk("num_dst_buffers = %u\n", num_dst_buffers); ++ for (i=0; i < num_dst_buffers; i++) { ++ memset((void*)dst_scatterlist[i].offset, 0, dst_scatterlist[i].length); ++ ++ dst_scatterlist[i].dma_address = dma_map_single(0, (void*)dst_scatterlist[i].offset, dst_scatterlist[i].length, DMA_BIDIRECTIONAL); ++ if (dma_mapping_error(dst_scatterlist[i].dma_address)) { ++ printk("Consistent destination DMA mapping %d failed\n", i); ++ } ++ } ++ ++ // Setup up SG DMA transfer ++ printk("Setting up transfer\n"); ++ hipox_dma_set_sg( ++ channels[channel_number], ++ src_scatterlist, ++ 2, ++ dst_scatterlist, ++ num_dst_buffers, ++ HIPOX_DMA_MODE_INC, ++ HIPOX_DMA_MODE_INC, ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ 1); // Compute checksum ++#else // CONFIG_HIPOX_VERSION_0X800 ++ 0); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ // Using second DMA channel requested ++ hipox_dma_set_callback(channels[channel_number], dma_callback, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ // Start the transfer ++ printk("Starting the transfer\n"); ++ hipox_dma_start(channels[channel_number]); ++ ++ // Sleep until transfer completed ++ printk("Waiting for transfer to complete...\n"); ++ while (down_interruptible(&callback_semaphore)); ++ hipox_dma_set_callback(channels[channel_number], HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ printk("Error code = %u\n", channels[channel_number]->error_code_); ++ ++ // Release the consistent DMA mappings for the source buffers ++ for (i=0; i < 2; i++) { ++ // Ensure the checksum enabling high order address bit is not set, as ++ // this would confuse the DMA mapping release function ++ src_scatterlist[i].dma_address &= ~(1UL << HIPOX_DMA_CSUM_ENABLE_ADR_BIT); ++ dma_unmap_single(0, src_scatterlist[i].dma_address, src_scatterlist[i].length, DMA_TO_DEVICE); ++ } ++ ++ // Release the consistent DMA mappings for the destination buffers ++ for (i=0; i < num_dst_buffers; i++) { ++ printk("Releasing DMA mappings for destination entry buffer %u\n", i); ++ dma_unmap_single(0, dst_scatterlist[i].dma_address, dst_scatterlist[i].length, DMA_BIDIRECTIONAL); ++ } ++ ++ u32 sw_csum = 0; ++ //sw_csum = csum_partial((u8*)src_scatterlist[0].offset, src_scatterlist[0].length, 0); ++ sw_csum = csum_partial((u8*)src_scatterlist[1].offset, src_scatterlist[1].length, sw_csum); ++ printk("S/W generated src csum = 0x%04hx\n", csum_fold(sw_csum)); ++ ++ sw_csum = 0; ++ unsigned offset = src_scatterlist[0].length; ++ //unsigned offset = 0; ++ for (i=0; i < num_dst_buffers; i++) { ++ sw_csum = csum_partial((u8*)dst_scatterlist[i].offset + offset, dst_scatterlist[i].length - offset, sw_csum); ++ offset = 0; ++ } ++ printk("S/W generated dst csum = 0x%04hx\n", csum_fold(sw_csum)); ++ } ++ ++ for (i=0; i < num_dst_buffers; ++i) { ++ kfree((void*)dst_scatterlist[i].offset); ++ } ++ kfree(dst_scatterlist); ++ ++ kfree((void*)(src_scatterlist[0].offset - src_offset)); ++ kfree(src_scatterlist); ++ } ++ ++ for (i=0; i < MAX_HIPOX_DMA_CHANNELS; ++i) { ++ hipox_dma_free(channels[i]); ++ } ++} ++#endif // HIPOX_DMA_SG_TEST_2 ++#endif // defined(HIPOX_DMA_TEST) || defined(HIPOX_DMA_SG_TEST) ++ ++EXPORT_SYMBOL(hipox_dma_request); ++EXPORT_SYMBOL(hipox_dma_free); ++EXPORT_SYMBOL(hipox_dma_set_callback); ++EXPORT_SYMBOL(hipox_dma_set_common); ++EXPORT_SYMBOL(hipox_dma_is_active); ++EXPORT_SYMBOL(hipox_dma_raw_isactive); ++EXPORT_SYMBOL(hipox_dma_set); ++EXPORT_SYMBOL(hipox_dma_device_set); ++EXPORT_SYMBOL(hipox_dma_abort); ++EXPORT_SYMBOL(hipox_dma_dump_registers); ++EXPORT_SYMBOL(hipox_dma_dump_registers_single); ++EXPORT_SYMBOL(hipox_dma_start); ++ ++EXPORT_SYMBOL(hipox_pata_dma_settings); ++EXPORT_SYMBOL(hipox_sata_dma_settings); ++EXPORT_SYMBOL(hipox_dpe_rx_dma_settings); ++EXPORT_SYMBOL(hipox_dpe_tx_dma_settings); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/dpe_test.c linux-2.6.24-oxe810/arch/arm/mach-hipox/dpe_test.c +--- linux-2.6.24/arch/arm/mach-hipox/dpe_test.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/dpe_test.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,3051 @@ ++/* ++ * /arch/=arm/mach-hipox/dpe-test.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++ ++/** ++ * Test driver for the cipher core ++ * ++ */ ++ ++#include <linux/types.h> ++#include <linux/sched.h> ++#include <linux/interrupt.h> ++#include <linux/types.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/list.h> ++#include <linux/device.h> ++#include <linux/string.h> ++#include <linux/sysdev.h> ++#include <linux/fs.h> ++#include <asm/arch/cipher.h> ++#include <asm/io.h> ++#include <asm/arch/hardware.h> ++#include <linux/dma-mapping.h> ++#include <asm/arch/dma.h> ++ ++/*************************************************************************** ++* CONSTANTS ++***************************************************************************/ ++#define DRIVER_AUTHOR "Oxford Semiconductor Inc." ++#define DRIVER_DESC "Cipher block testing" ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR(DRIVER_AUTHOR); ++MODULE_DESCRIPTION(DRIVER_DESC); ++ ++// uses /dev/dv940led ++#define DEVICE_NAME "ox800dpetst" ++MODULE_SUPPORTED_DEVICE(DEVICE_NAME); ++ ++#define FAILED(reason) {printk(KERN_ERR"%s failed %s\n",__FUNCTION__,reason);++failed;} ++/************************************************************************** ++* PROTOTYPES ++**************************************************************************/ ++#if 0 ++static u32 READL(int a) {u32 v = readl(a);printk("0x%08x <- [0x%08x]\n",v,a);return v;} ++static void WRITEL(int v,int a){printk("0x%08x -> [0x%08x]\n",v,a);writel(v,a);} ++#else ++static u32 READL(int a) {u32 v = readl(a);return v;} ++static void WRITEL(int v,int a){writel(v,a);} ++#endif ++/************************************************************************** ++* STRUCTURES ++**************************************************************************/ ++typedef int (ox800dpe_test_t)(void) ; ++ ++/************************************************************************** ++* FUCTIONS ++* prefix all with "ox800dpe" ++**************************************************************************/ ++ ++/*************************************************************************/ ++static int test1(void) { ++ int failed = 0; ++ u32 reg; ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // 1st data set ++ WRITEL(be32_to_cpu( 0x00112233), OX800DPE_DATA_IN0 ); ++ ++ /* in fifo no longer empty */ ++ reg = READL( OX800DPE_STATUS ); ++ if ( (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo still empty after data input") ++ ++ WRITEL(be32_to_cpu( 0x44556677), OX800DPE_DATA_IN1 ); ++ WRITEL(be32_to_cpu( 0x8899aabb), OX800DPE_DATA_IN2 ); ++ ++ // shouldn't be busy as not enough data ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("core lept into action before putting in all the data"); ++ ++ WRITEL(be32_to_cpu( 0xccddeeff), OX800DPE_DATA_IN3 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be full */ ++ if ( !(reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still empty after encrypting data "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ /* check output */ ++ { ++ u32 data[4]; ++ ++ data[0] = READL( OX800DPE_DATA_OUT0 ); ++ data[1] = READL( OX800DPE_DATA_OUT1 ); ++ data[2] = READL( OX800DPE_DATA_OUT2 ); ++ data[3] = READL( OX800DPE_DATA_OUT3 ); ++ ++ if ((data[0] != cpu_to_be32(0x69c4e0d8)) || ++ (data[1] != cpu_to_be32(0x6a7b0430)) || ++ (data[2] != cpu_to_be32(0xd8cdb780)) || ++ (data[3] != cpu_to_be32(0x70b4c55a))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data[0],data[1],data[2],data[3]); ++ } ++ } ++ ++ /* output should be empty again */ ++ reg = READL( OX800DPE_STATUS ); ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after data read"); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test2(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x00112233); ++ data_in[1] = be32_to_cpu( 0x44556677); ++ data_in[2] = be32_to_cpu( 0x8899aabb); ++ data_in[3] = be32_to_cpu( 0xccddeeff); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x69c4e0d8)) || ++ (data_out[1] != cpu_to_be32(0x6a7b0430)) || ++ (data_out[2] != cpu_to_be32(0xd8cdb780)) || ++ (data_out[3] != cpu_to_be32(0x70b4c55a))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test3(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x69c4e0d8); ++ data_in[1] = be32_to_cpu( 0x6a7b0430); ++ data_in[2] = be32_to_cpu( 0xd8cdb780); ++ data_in[3] = be32_to_cpu( 0x70b4c55a); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x00112233)) || ++ (data_out[1] != cpu_to_be32(0x44556677)) || ++ (data_out[2] != cpu_to_be32(0x8899aabb)) || ++ (data_out[3] != cpu_to_be32(0xccddeeff))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test4(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t out_address; ++ ++ u32* data_out; ++ ++ // setup dmas ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with non expected output ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_PRIMARY_IS_KEY3 | OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY20 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY21 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY22 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY23 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ ++ // 1st data set ++ WRITEL(be32_to_cpu( 0x69c4e0d8), OX800DPE_DATA_IN0 ); ++ WRITEL(be32_to_cpu( 0x6a7b0430), OX800DPE_DATA_IN1 ); ++ WRITEL(be32_to_cpu( 0xd8cdb780), OX800DPE_DATA_IN2 ); ++ WRITEL(be32_to_cpu( 0x70b4c55a), OX800DPE_DATA_IN3 ); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x00112233)) || ++ (data_out[1] != cpu_to_be32(0x44556677)) || ++ (data_out[2] != cpu_to_be32(0x8899aabb)) || ++ (data_out[3] != cpu_to_be32(0xccddeeff))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_out ); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test5(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ dma_addr_t in_address; ++ ++ u32* data_in; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x00112233); ++ data_in[1] = be32_to_cpu( 0x44556677); ++ data_in[2] = be32_to_cpu( 0x8899aabb); ++ data_in[3] = be32_to_cpu( 0xccddeeff); ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_ECB_AES | ++ OX800DPE_CTL_PRIMARY_IS_KEY3 ; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY20 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY21 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY22 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY23 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_in ) ); ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be full */ ++ if ( !(reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still empty after encrypting data "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ ++ /* check output */ ++ { ++ u32 data[4]; ++ ++ data[0] = READL( OX800DPE_DATA_OUT0 ); ++ data[1] = READL( OX800DPE_DATA_OUT1 ); ++ data[2] = READL( OX800DPE_DATA_OUT2 ); ++ data[3] = READL( OX800DPE_DATA_OUT3 ); ++ ++ if ((data[0] != cpu_to_be32(0x69c4e0d8)) || ++ (data[1] != cpu_to_be32(0x6a7b0430)) || ++ (data[2] != cpu_to_be32(0xd8cdb780)) || ++ (data[3] != cpu_to_be32(0x70b4c55a))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data[0],data[1],data[2],data[3]); ++ } ++ } ++ ++ /* output should be empty again */ ++ reg = READL( OX800DPE_STATUS ); ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after data read"); ++ ++ // free dmas ++ kfree(data_in); ++ ++ hipox_dma_free( dma_in ); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test6(void) { ++ int failed = 0; ++ u32 reg; ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for key encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_ENCRYPT_KEY | ++ OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ // data to be encrypted to form a key ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_DATA_IN0 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_DATA_IN1 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_DATA_IN2 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_DATA_IN3 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ /* output should be empty */ ++ reg = READL( OX800DPE_STATUS ); ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ { ++ u32 data[4]; ++ ++ data[0] = READL( OX800DPE_KEY00 ); ++ data[1] = READL( OX800DPE_KEY01 ); ++ data[2] = READL( OX800DPE_KEY02 ); ++ data[3] = READL( OX800DPE_KEY03 ); ++ ++ if ((data[0] != cpu_to_be32(0x4791b833)) || ++ (data[1] != cpu_to_be32(0x7e2d8a69)) || ++ (data[2] != cpu_to_be32(0x290233f1)) || ++ (data[3] != cpu_to_be32(0xf3dff5a9))) ++ { ++ FAILED("encrypted key incorrect"); ++ printk("%08x%08x%08x%08x\n",data[0],data[1],data[2],data[3]); ++ } ++ } ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test7(void) { ++ int failed = 0; ++ u32 reg; ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // setup for key encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_ENCRYPT_KEY | ++ OX800DPE_CTL_MODE_ECB_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ // data to be encrypted to form a key ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_DATA_IN0 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_DATA_IN1 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_DATA_IN2 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_DATA_IN3 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ /* output should be empty */ ++ reg = READL( OX800DPE_STATUS ); ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ { ++ u32 data[4]; ++ ++ data[0] = READL( OX800DPE_KEY00 ); ++ data[1] = READL( OX800DPE_KEY01 ); ++ data[2] = READL( OX800DPE_KEY02 ); ++ data[3] = READL( OX800DPE_KEY03 ); ++ ++ if ((data[0] != cpu_to_be32(0x4791b833)) || ++ (data[1] != cpu_to_be32(0x7e2d8a69)) || ++ (data[2] != cpu_to_be32(0x290233f1)) || ++ (data[3] != cpu_to_be32(0xf3dff5a9))) ++ { ++ FAILED("encrypted key incorrect"); ++ printk("%08x%08x%08x%08x\n",data[0],data[1],data[2],data[3]); ++ } ++ } ++ ++ return failed; ++ ++} ++ ++ ++ ++/**********************************************************************/ ++/* CBC tests */ ++/**********************************************************************/ ++ ++static int test8(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x00112233); ++ data_in[1] = be32_to_cpu( 0x44556677); ++ data_in[2] = be32_to_cpu( 0x8899aabb); ++ data_in[3] = be32_to_cpu( 0xccddeeff); ++ data_in[4] = be32_to_cpu( 0x00112233); ++ data_in[5] = be32_to_cpu( 0x44556677); ++ data_in[6] = be32_to_cpu( 0x8899aabb); ++ data_in[7] = be32_to_cpu( 0xccddeeff); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ data_out[4] = ~0; ++ data_out[5] = ~0; ++ data_out[6] = ~0; ++ data_out[7] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 8 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 8 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 8 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 8 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x69c4e0d8)) || ++ (data_out[1] != cpu_to_be32(0x6a7b0430)) || ++ (data_out[2] != cpu_to_be32(0xd8cdb780)) || ++ (data_out[3] != cpu_to_be32(0x70b4c55a)) || ++ ++ (data_out[4] != cpu_to_be32(0x7d7786be)) || ++ (data_out[5] != cpu_to_be32(0x32d059a6)) || ++ (data_out[6] != cpu_to_be32(0x0ca8021a)) || ++ (data_out[7] != cpu_to_be32(0x65dd9f09))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ printk("%08x%08x%08x%08x\n",data_out[4],data_out[5],data_out[6],data_out[7]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test9(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x69c4e0d8); ++ data_in[1] = be32_to_cpu( 0x6a7b0430); ++ data_in[2] = be32_to_cpu( 0xd8cdb780); ++ data_in[3] = be32_to_cpu( 0x70b4c55a); ++ data_in[4] = be32_to_cpu( 0x7d7786be); ++ data_in[5] = be32_to_cpu( 0x32d059a6); ++ data_in[6] = be32_to_cpu( 0x0ca8021a); ++ data_in[7] = be32_to_cpu( 0x65dd9f09); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ data_out[4] = ~0; ++ data_out[5] = ~0; ++ data_out[6] = ~0; ++ data_out[7] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 8 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 8 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 8 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 8 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x00112233)) || ++ (data_out[1] != cpu_to_be32(0x44556677)) || ++ (data_out[2] != cpu_to_be32(0x8899aabb)) || ++ (data_out[3] != cpu_to_be32(0xccddeeff)) || ++ (data_out[4] != cpu_to_be32(0x00112233)) || ++ (data_out[5] != cpu_to_be32(0x44556677)) || ++ (data_out[6] != cpu_to_be32(0x8899aabb)) || ++ (data_out[7] != cpu_to_be32(0xccddeeff))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ printk("%08x%08x%08x%08x\n",data_out[4],data_out[5],data_out[6],data_out[7]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test10(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x00112233); ++ data_in[1] = be32_to_cpu( 0x44556677); ++ data_in[2] = be32_to_cpu( 0x8899aabb); ++ data_in[3] = be32_to_cpu( 0xccddeeff); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(~0), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(~0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x0bde5b88)) || ++ (data_out[1] != cpu_to_be32(0x114ac430)) || ++ (data_out[2] != cpu_to_be32(0x134e99ee)) || ++ (data_out[3] != cpu_to_be32(0xd3557046))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test11(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x69c4e0d8); ++ data_in[1] = be32_to_cpu( 0x6a7b0430); ++ data_in[2] = be32_to_cpu( 0xd8cdb780); ++ data_in[3] = be32_to_cpu( 0x70b4c55a); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(~0), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(~0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x00112233)) || ++ (data_out[1] != cpu_to_be32(0x44556677)) || ++ (data_out[2] != cpu_to_be32(0x8899aab4)) || ++ (data_out[3] != cpu_to_be32(0x33221100))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test12(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x00112233); ++ data_in[1] = be32_to_cpu( 0x44556677); ++ data_in[2] = be32_to_cpu( 0x8899aabb); ++ data_in[3] = be32_to_cpu( 0xccddeeff); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(1), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ ++ ++ ++ ++ /* check output */ ++ if ((data_out[0] != 0x850d2506) || ++ (data_out[1] != 0xd71056c7) || ++ (data_out[2] != 0xe62c220f) || ++ (data_out[3] != 0xc3dedaf9)) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test13(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = 0x850d2506; ++ data_in[1] = 0xd71056c7; ++ data_in[2] = 0xe62c220f; ++ data_in[3] = 0xc3dedaf9; ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_CBC_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ reg = READL( OX800DPE_STATUS ); ++ // shouldn't be busy ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle even with incomplete data"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx not empty before data input "); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx fifo filling without data"); ++ ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x00010203), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0x04050607), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x08090a0b), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x0c0d0e0f), OX800DPE_KEY03 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // setup initialisation vector ++ WRITEL(be32_to_cpu(1), OX800DPE_DATA_CBC0 ); ++ WRITEL(be32_to_cpu(0), OX800DPE_DATA_CBC1 ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x00112233)) || ++ (data_out[1] != cpu_to_be32(0x44556677)) || ++ (data_out[2] != cpu_to_be32(0x8899aabb)) || ++ (data_out[3] != cpu_to_be32(0xccddeeff))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/**********************************************************************/ ++/* LRW tests */ ++/**********************************************************************/ ++ ++static int test14(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x30313233); ++ data_in[1] = be32_to_cpu( 0x34353637); ++ data_in[2] = be32_to_cpu( 0x38394142); ++ data_in[3] = be32_to_cpu( 0x43444546); ++ data_in[4] = be32_to_cpu( 0x30313233); ++ data_in[5] = be32_to_cpu( 0x34353637); ++ data_in[6] = be32_to_cpu( 0x38394142); ++ data_in[7] = be32_to_cpu( 0x43444546); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ data_out[4] = ~0; ++ data_out[5] = ~0; ++ data_out[6] = ~0; ++ data_out[7] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 8 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 8 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_LRW_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x4562ac25), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0xf828176d), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x4c268414), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0xb5680185), OX800DPE_KEY03 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0x258e2a05), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0xe73e9d03), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xee5a830c), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xcc094c87), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 8 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 8 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* ++ check output. ++ note: first 4 quads contain unwanted data used to set ++ tweek location to 1, they are not checked. ++ */ ++ if ((data_out[4] != cpu_to_be32(0xf1b273cd)) || ++ (data_out[5] != cpu_to_be32(0x65a3df5f)) || ++ (data_out[6] != cpu_to_be32(0xe95d4892)) || ++ (data_out[7] != cpu_to_be32(0x54634eb8))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ printk("%08x%08x%08x%08x\n",data_out[4],data_out[5],data_out[6],data_out[7]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test15(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0xf1b273cd); ++ data_in[1] = be32_to_cpu( 0x65a3df5f); ++ data_in[2] = be32_to_cpu( 0xe95d4892); ++ data_in[3] = be32_to_cpu( 0x54634eb8); ++ data_in[4] = be32_to_cpu( 0xf1b273cd); ++ data_in[5] = be32_to_cpu( 0x65a3df5f); ++ data_in[6] = be32_to_cpu( 0xe95d4892); ++ data_in[7] = be32_to_cpu( 0x54634eb8); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ data_out[4] = ~0; ++ data_out[5] = ~0; ++ data_out[6] = ~0; ++ data_out[7] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 8 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 8 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 8 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_LRW_AES | ++ OX800DPE_CTL_PRIMARY_IS_KEY3; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x4562ac25), OX800DPE_KEY20 ); ++ WRITEL(be32_to_cpu( 0xf828176d), OX800DPE_KEY21 ); ++ WRITEL(be32_to_cpu( 0x4c268414), OX800DPE_KEY22 ); ++ WRITEL(be32_to_cpu( 0xb5680185), OX800DPE_KEY23 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0x258e2a05), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0xe73e9d03), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xee5a830c), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xcc094c87), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 8 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 8 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[4] != cpu_to_be32(0x30313233)) || ++ (data_out[5] != cpu_to_be32(0x34353637)) || ++ (data_out[6] != cpu_to_be32(0x38394142)) || ++ (data_out[7] != cpu_to_be32(0x43444546))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ printk("%08x%08x%08x%08x\n",data_out[4],data_out[5],data_out[6],data_out[7]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test16(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 12 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 12 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[8 ] = be32_to_cpu( 0x30313233); ++ data_in[9 ] = be32_to_cpu( 0x34353637); ++ data_in[10] = be32_to_cpu( 0x38394142); ++ data_in[11] = be32_to_cpu( 0x43444546); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ data_out[4] = ~0; ++ data_out[5] = ~0; ++ data_out[6] = ~0; ++ data_out[7] = ~0; ++ data_out[8] = ~0; ++ data_out[9] = ~0; ++ data_out[10] = ~0; ++ data_out[11] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 12 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 12 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 12 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 12 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_PRIMARY_IS_KEY3 | ++ OX800DPE_CTL_MODE_LRW_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x59704714), OX800DPE_KEY20 ); ++ WRITEL(be32_to_cpu( 0xf557478c), OX800DPE_KEY21 ); ++ WRITEL(be32_to_cpu( 0xd779e80f), OX800DPE_KEY22 ); ++ WRITEL(be32_to_cpu( 0x54887944), OX800DPE_KEY23 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0x0d48f0b7), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0xb15a53ea), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0x1caa6b29), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xc2cafbaf), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 12 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 12 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* ++ check output. ++ note: first 4 quads contain unwanted data used to set ++ tweek location to 1, they are not checked. ++ */ ++ if ((data_out[ 8] != cpu_to_be32(0x00c82bae)) || ++ (data_out[ 9] != cpu_to_be32(0x95bbcde5)) || ++ (data_out[10] != cpu_to_be32(0x274f0769)) || ++ (data_out[11] != cpu_to_be32(0xb260e136))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[8],data_out[9],data_out[10],data_out[11]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test17(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 12 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 12 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[ 8] = be32_to_cpu( 0x00c82bae); ++ data_in[ 9] = be32_to_cpu( 0x95bbcde5); ++ data_in[10] = be32_to_cpu( 0x274f0769); ++ data_in[11] = be32_to_cpu( 0xb260e136); ++ data_out[ 0] = ~0; ++ data_out[ 1] = ~0; ++ data_out[ 2] = ~0; ++ data_out[ 3] = ~0; ++ data_out[ 4] = ~0; ++ data_out[ 5] = ~0; ++ data_out[ 6] = ~0; ++ data_out[ 7] = ~0; ++ data_out[ 8] = ~0; ++ data_out[ 9] = ~0; ++ data_out[10] = ~0; ++ data_out[11] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 12 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 12 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 12 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 12 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_LRW_AES ; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x59704714), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0xf557478c), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0xd779e80f), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x54887944), OX800DPE_KEY03 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0x0d48f0b7), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0xb15a53ea), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0x1caa6b29), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xc2cafbaf), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 12 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 12 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[ 8] != cpu_to_be32(0x30313233)) || ++ (data_out[ 9] != cpu_to_be32(0x34353637)) || ++ (data_out[10] != cpu_to_be32(0x38394142)) || ++ (data_out[11] != cpu_to_be32(0x43444546))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[8],data_out[9],data_out[10],data_out[11]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test18(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x30313233); ++ data_in[1] = be32_to_cpu( 0x34353637); ++ data_in[2] = be32_to_cpu( 0x38394142); ++ data_in[3] = be32_to_cpu( 0x43444546); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_LRW_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0xd82a9134), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0xb26a5650), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x30fe69e2), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x377f9847), OX800DPE_KEY03 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0xcdf90b16), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0x0c648fb6), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xb00d0d1b), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xae85871f), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0x10000000, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* ++ check output. ++ */ ++ if ((data_out[0] != cpu_to_be32(0x76322183)) || ++ (data_out[1] != cpu_to_be32(0xed8ff182)) || ++ (data_out[2] != cpu_to_be32(0xf9596203)) || ++ (data_out[3] != cpu_to_be32(0x690e5e01))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test19(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 8 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x76322183); ++ data_in[1] = be32_to_cpu( 0xed8ff182); ++ data_in[2] = be32_to_cpu( 0xf9596203); ++ data_in[3] = be32_to_cpu( 0x690e5e01); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_MODE_LRW_AES | ++ OX800DPE_CTL_PRIMARY_IS_KEY3; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0xd82a9134), OX800DPE_KEY20 ); ++ WRITEL(be32_to_cpu( 0xb26a5650), OX800DPE_KEY21 ); ++ WRITEL(be32_to_cpu( 0x30fe69e2), OX800DPE_KEY22 ); ++ WRITEL(be32_to_cpu( 0x377f9847), OX800DPE_KEY23 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0xcdf90b16), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0x0c648fb6), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xb00d0d1b), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xae85871f), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0x10000000, OX800DPE_DATA_LRW0 ); ++ WRITEL(0, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[0] != cpu_to_be32(0x30313233)) || ++ (data_out[1] != cpu_to_be32(0x34353637)) || ++ (data_out[2] != cpu_to_be32(0x38394142)) || ++ (data_out[3] != cpu_to_be32(0x43444546))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++/*************************************************************************/ ++static int test20(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory ++ data_in = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 4 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[0] = be32_to_cpu( 0x30313233); ++ data_in[1] = be32_to_cpu( 0x34353637); ++ data_in[2] = be32_to_cpu( 0x38394142); ++ data_in[3] = be32_to_cpu( 0x43444546); ++ data_out[0] = ~0; ++ data_out[1] = ~0; ++ data_out[2] = ~0; ++ data_out[3] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 4 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 4 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 4 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // don't authenticate ++ WRITEL(0 ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for encryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_LRW_AES; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0x4562ac25), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0xf828176d), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x4c268414), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0xb5680185), OX800DPE_KEY03 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0x258e2a05), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0xe73e9d03), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xee5a830c), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xcc094c87), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0x00000000, OX800DPE_DATA_LRW0 ); ++ WRITEL(0x00000008, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until dma done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 4 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 4 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* ++ check output. ++ */ ++ if ((data_out[0] == 0xc0a37fda) ) ++ { ++ FAILED("encryption output indicates most significant bit is ignored."); ++ printk("%08x%08x%08x%08x\n",data_out[0],data_out[1],data_out[2],data_out[3]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*************************************************************************/ ++static int test21(void) { ++ int failed = 0; ++ u32 reg; ++ hipox_dma_channel_t* dma_in; ++ hipox_dma_channel_t* dma_out; ++ dma_addr_t in_address; ++ dma_addr_t out_address; ++ ++ u32* data_in; ++ u32* data_out; ++ ++ // setup dmas ++ dma_in = hipox_dma_request(1); ++ dma_out = hipox_dma_request(1); ++ ++ // get some dma accessable memory (512B + 16B ++ data_in = (u32*)kmalloc( 132 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ data_out = (u32*)kmalloc( 132 * sizeof(u32), GFP_KERNEL|GFP_DMA); ++ ++ // fill with input and non expected output ++ data_in[128] = be32_to_cpu( 0x30313233); ++ data_in[129] = be32_to_cpu( 0x34353637); ++ data_in[130] = be32_to_cpu( 0x38394142); ++ data_in[131] = be32_to_cpu( 0x43444546); ++ data_out[128] = ~0; ++ data_out[129] = ~0; ++ data_out[130] = ~0; ++ data_out[131] = ~0; ++ ++ // map the dma regons ++ in_address = dma_map_single( ++ 0, ++ data_in, ++ 132 * sizeof(u32), ++ DMA_TO_DEVICE); ++ ++ // map the dma regons ++ out_address = dma_map_single( ++ 0, ++ data_out, ++ 132 * sizeof(u32), ++ DMA_FROM_DEVICE); ++ ++ // setup the transfers ++ hipox_dma_device_set( ++ dma_in, ++ HIPOX_DMA_TO_DEVICE, ++ (char*)in_address, ++ 132 * sizeof(u32), ++ &hipox_dpe_rx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ hipox_dma_device_set( ++ dma_out, ++ HIPOX_DMA_FROM_DEVICE, ++ (char*)out_address, ++ 132 * sizeof(u32), ++ &hipox_dpe_tx_dma_settings, ++ HIPOX_DMA_MODE_INC, 1); ++ ++ // authenticate ++ WRITEL(OX800IBW_STAT_AUTHENTICATED ,OX800IBW_STATUS); ++ ++ // toggle cleardown bit to start ++ WRITEL(OX800DPE_CTL_ABORT ,OX800DPE_CONTROL); ++ WRITEL(0 ,OX800DPE_CONTROL); ++ ++ // shouldn't be busy or full ++ reg = READL( OX800DPE_STATUS ); ++ if (! (reg & OX800DPE_STAT_IDLE) ) ++ FAILED("not idle after abort toggle"); ++ if (reg & OX800DPE_STAT_TX_NOTEMPTY) ++ FAILED("tx fifo not empty after abort toggle"); ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx not empty after abort toggle"); ++ ++ // setup for decryption ++ reg = OX800DPE_CTL_DIRECTION_ENC | ++ OX800DPE_CTL_MODE_LRW_AES ; ++ WRITEL(reg ,OX800DPE_CONTROL); ++ ++ // key no 1 ++ WRITEL(be32_to_cpu( 0xd82a9134), OX800DPE_KEY00 ); ++ WRITEL(be32_to_cpu( 0xb26a5650), OX800DPE_KEY01 ); ++ WRITEL(be32_to_cpu( 0x30fe69e2), OX800DPE_KEY02 ); ++ WRITEL(be32_to_cpu( 0x377f9847), OX800DPE_KEY03 ); ++ ++ // key no 2 ++ WRITEL(be32_to_cpu( 0xcdf90b16), OX800DPE_KEY10 ); ++ WRITEL(be32_to_cpu( 0x0c648fb6), OX800DPE_KEY11 ); ++ WRITEL(be32_to_cpu( 0xb00d0d1b), OX800DPE_KEY12 ); ++ WRITEL(be32_to_cpu( 0xae85871f), OX800DPE_KEY13 ); ++ ++ // setup index ++ WRITEL(0x0fffffff, OX800DPE_DATA_LRW0 ); ++ WRITEL(0x00000000, OX800DPE_DATA_LRW1 ); ++ ++ /* wait until done */ ++ while( !(OX800DPE_STAT_IDLE & READL( OX800DPE_STATUS )) ); ++ ++ // start dma transfers ++ hipox_dma_start(dma_out); ++ hipox_dma_start(dma_in); ++ ++ /* wait until done */ ++ while( hipox_dma_is_active( dma_out ) ); ++ ++ reg = READL( OX800DPE_STATUS ); ++ ++ /* output should be empty */ ++ if ( (reg & OX800DPE_STAT_TX_NOTEMPTY) ) ++ FAILED("tx still full after fetching "); ++ ++ /* in empty */ ++ if (! (reg & OX800DPE_STAT_RX_SPACE) ) ++ FAILED("rx still full after encrypting data "); ++ ++ dma_unmap_single(0, in_address, 132 * sizeof(u32), DMA_TO_DEVICE); ++ dma_unmap_single(0, out_address, 132 * sizeof(u32), DMA_FROM_DEVICE); ++ ++ /* check output */ ++ if ((data_out[128] != cpu_to_be32(0x76322183)) || ++ (data_out[129] != cpu_to_be32(0xed8ff182)) || ++ (data_out[130] != cpu_to_be32(0xf9596203)) || ++ (data_out[131] != cpu_to_be32(0x690e5e01))) ++ { ++ FAILED("encryption output incorrect"); ++ printk("%08x%08x%08x%08x\n",data_out[128],data_out[129],data_out[130],data_out[131]); ++ } ++ ++ // free dmas ++ hipox_dma_free( dma_in ); ++ hipox_dma_free( dma_out ); ++ ++ kfree(data_in); ++ kfree(data_out); ++ ++ return failed; ++ ++} ++ ++ ++/*****************************************************************************/ ++#define NOCIPHERTESTS 21 ++static ox800dpe_test_t* tests[NOCIPHERTESTS] = { ++ /* ordinary AES tests */ ++ test1, ++ test2, ++ test3, ++ test4, ++ test5, ++ test6, ++ test7, ++ ++ /* CBC AES tests */ ++ test8, ++ test9, ++ test10, ++ test11, ++ test12, ++ test13, ++ ++ /* LRW AES tests */ ++ test14, ++ test15, ++ test16, ++ test17, ++ test18, ++ test19, ++ test20, ++ test21 ++ ++} ; ++ ++ ++static int __init ox800dpe_init(void) ++{ ++ int i; ++ int result; ++ printk("*******************************************************************\n"); ++ printk("* CIPHER CORE TESTING START *\n"); ++ printk("*******************************************************************\n"); ++ ++ /* Enable the clock to the DPE block */ ++ writel(1UL << SYS_CTRL_CKEN_DPE_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* Bring out of reset */ ++ writel(1UL << SYS_CTRL_RSTEN_DPE_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ ++ ++ ++ for (i = 0; i < NOCIPHERTESTS; ++i) ++ { ++ printk("\nTest %d start\n",i+1); ++ result = (tests[i])(); ++ if (result) ++ printk("Test %d failed with %d faults.\n",i+1,result); ++ else ++ printk("Test %d passed\n",i+1); ++ ++ } ++ ++ printk("*******************************************************************\n"); ++ printk("* CIPHER CORE TESTING END *\n"); ++ printk("*******************************************************************\n"); ++ ++ return 0; ++} ++ ++ ++ ++/***************************************************************************/ ++module_init(ox800dpe_init); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac-napi.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac-napi.c +--- linux-2.6.24/arch/arm/mach-hipox/gmac-napi.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac-napi.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,3637 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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/crc32.h> ++#include <linux/version.h> ++#include <linux/init.h> ++#include <linux/errno.h> ++#include <linux/netdevice.h> ++#include <linux/etherdevice.h> ++#include <linux/dma-mapping.h> ++#include <linux/delay.h> ++#include <linux/in.h> ++#include <net/ip.h> ++#include <linux/tcp.h> ++#include <linux/udp.h> ++#include <asm/io.h> ++#include <asm/arch/hardware.h> ++#include <asm/arch/irqs.h> ++ ++#ifdef CONFIG_LEON_COPRO ++#include <asm/arch/leon-program.h> ++#endif // CONFIG_LEON_COPRO ++ ++//#define GMAC_DEBUG ++#undef GMAC_DEBUG ++ ++#include "gmac.h" ++#include "gmac_ethtool.h" ++#include "gmac_phy.h" ++#include "gmac_desc.h" ++#include "gmac_reg.h" ++ ++//#define DUMP_REGS_ON_GMAC_UP ++ ++#define MAX_GMAC_UNITS 1 ++ ++#define ALLOW_AUTONEG ++ ++//#define ALLOW_OX800_1000M ++ ++//#define SUPPORT_IPV6 ++ ++#ifdef CONFIG_LEON_COPRO ++//#define TEST_COPRO ++#define COPRO_RX_MITIGATION 0 /* No Rx mitigation in CoPro */ ++#define COPRO_RX_MITIGATION_FRAMES 5 ++#define COPRO_RX_MITIGATION_USECS 500 ++ ++#define COPRO_TX_QUEUE_NUM_ENTRIES 4 ++#define COPRO_CMD_QUEUE_NUM_ENTRIES 6 ++#define COPRO_MAX_QUEUED_TX_SKBS 16 ++#endif // CONFIG_LEON_COPRO ++ ++#ifdef CONFIG_LEON_OFFLOAD_TX ++#define NUM_RX_DMA_DESCRIPTORS NUM_GMAC_DMA_DESCRIPTORS ++#define NUM_TX_DMA_DESCRIPTORS 0 ++#else ++#define NUM_RX_DMA_DESCRIPTORS (NUM_GMAC_DMA_DESCRIPTORS / 2) ++#define NUM_TX_DMA_DESCRIPTORS (NUM_GMAC_DMA_DESCRIPTORS - NUM_RX_DMA_DESCRIPTORS) ++#endif // CONFIG_LEON_OFFLOAD_TX ++ ++#if (((NUM_RX_DMA_DESCRIPTORS) + (NUM_TX_DMA_DESCRIPTORS)) > (NUM_GMAC_DMA_DESCRIPTORS)) ++#error "GMAC TX+RX descriptors exceed allocation" ++#endif ++ ++#define DESC_SINCE_REFILL_LIMIT ((NUM_RX_DMA_DESCRIPTORS) / 4) ++ ++static const u32 MAC_BASE_OFFSET = 0x0000; ++static const u32 DMA_BASE_OFFSET = 0x1000; ++ ++static const int MIN_PACKET_SIZE = 68; ++static const int NORMAL_PACKET_SIZE = 1500; ++static const int MAX_JUMBO = 9000; ++ ++#define RX_BUFFER_SIZE 796 // Must be multiple of 4, If not defined will size buffer to hold a single MTU-sized packet ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++static const int EXTRA_RX_SKB_SPACE = 24; // Has extra 2 bytes of Rx payload csum ++#else // CONFIG_HIPOX_VERSION_0X800 ++static const int EXTRA_RX_SKB_SPACE = 22; // Ethernet header 14, VLAN 4, CRC 4 ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++// The amount of header to copy from a receive packet into the skb buffer ++static const int GMAC_HLEN = 66; ++ ++#define GMAC_ALLOC_ORDER 0 ++static const int GMAC_ALLOC_SIZE = ((1 << GMAC_ALLOC_ORDER) * PAGE_SIZE); ++ ++static const u32 AUTO_NEGOTIATION_WAIT_TIMEOUT_MS = 5000; ++ ++static const u32 NAPI_POLL_WEIGHT = 64; ++static const u32 NAPI_OOM_POLL_INTERVAL_MS = 50; ++ ++static const int WATCHDOG_TIMER_INTERVAL = 500*HZ/1000; ++ ++#define AUTO_NEG_MS_WAIT 500 ++static const int AUTO_NEG_INTERVAL = (AUTO_NEG_MS_WAIT)*HZ/1000; ++static const int START_RESET_INTERVAL = 50*HZ/1000; ++static const int RESET_INTERVAL = 10*HZ/1000; ++ ++static const int GMAC_RESET_TIMEOUT_MS = 10000; ++ ++static int debug = 0; ++ ++MODULE_AUTHOR("Brian Clarke (Oxford Semiconductor Ltd)"); ++MODULE_DESCRIPTION("GMAC Network Driver"); ++MODULE_LICENSE("GPL"); ++MODULE_VERSION("v2.0"); ++ ++/* Ethernet MAC adr to assign to interface */ ++static int mac_adr[] = { 0x00, 0x30, 0xe0, 0x00, 0x00, 0x00 }; ++module_param_array(mac_adr, int, NULL, S_IRUGO); ++ ++/* PHY type kernel cmdline options */ ++static int phy_is_rgmii = 0; ++module_param(phy_is_rgmii, int, S_IRUGO); ++ ++/* Parse netdev kernel cmdline options */ ++static int __init do_setup(char *str) ++{ ++ int i; ++ int ints[5]; // Hold arg count and four args ++ u32 mac_hi = 0; ++ u32 mac_lo = 0; ++ ++ /* Get the netdev bootargs parameters */ ++ get_options(str, sizeof(ints)/sizeof(int), ints); ++ for (i=1; i<=ints[0]; i++) { ++ switch (i) { ++ case 3: ++ mac_hi = ints[i]; ++ break; ++ case 4: ++ mac_lo = ints[i]; ++ break; ++ } ++ } ++ ++ /* Break down the mac adr into its components */ ++ for (i=0; i < sizeof(mac_adr)/sizeof(int); i++) { ++ if (i < sizeof(u32)) { ++ mac_adr[i] = ((mac_hi >> (((sizeof(u32)-1)-i)*8)) & 0xff); ++ } else { ++ mac_adr[i] = ((mac_lo >> (((sizeof(u32)+1)-i)*8)) & 0xff); ++ } ++ } ++ ++ return 0; ++} ++__setup("netdev=",do_setup); ++ ++#ifdef DUMP_REGS_ON_GMAC_UP ++static void dump_mac_regs(u32 macBase, u32 dmaBase) ++{ ++ int n = 0; ++ ++ for (n=0; n<0x60; n+=4) { ++ printk(KERN_INFO "MAC Register %08x (%08x) = %08x\n", n, macBase+n, readl(macBase+n)); ++ } ++ ++ for (n=0; n<0x60; n+=4) { ++ printk(KERN_INFO "DMA Register %08x (%08x) = %08x\n", n, dmaBase+n, readl(dmaBase+n)); ++ } ++} ++#endif // DUMP_REGS_ON_GMAC_UP ++ ++#ifdef CONFIG_LEON_COPRO ++static struct semaphore copro_update_semaphore; ++ ++static void copro_update_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ up(&copro_update_semaphore); ++} ++ ++static struct semaphore copro_start_semaphore; ++ ++static void copro_start_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ up(&copro_start_semaphore); ++} ++ ++static struct semaphore copro_rx_enable_semaphore; ++ ++static void copro_rx_enable_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ up(&copro_rx_enable_semaphore); ++} ++#endif // CONFIG_LEON_COPRO ++ ++static void gmac_int_en_set( ++ gmac_priv_t *priv, ++ u32 mask) ++{ ++ unsigned long irq_flags = 0; ++ ++#ifdef CONFIG_LEON_COPRO ++ int cmd_queue_result = -1; ++ while (cmd_queue_result) { ++ if (in_irq()) ++ spin_lock(&priv->cmd_que_lock_); ++ else ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_INT_EN_SET, mask, 0); ++ ++ if (in_irq()) ++ spin_unlock(&priv->cmd_que_lock_); ++ else ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++#else ++ if (in_irq()) ++ spin_lock(&priv->cmd_que_lock_); ++ else ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ ++ dma_reg_set_mask(priv, DMA_INT_ENABLE_REG, mask); ++ ++ if (in_irq()) ++ spin_unlock(&priv->cmd_que_lock_); ++ else ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++#endif // CONFIG_LEON_COPRO ++} ++ ++#ifdef CONFIG_LEON_COPRO ++static struct semaphore copro_int_clr_semaphore; ++static unsigned long copro_int_clr_return; ++ ++static void copro_int_clr_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ copro_int_clr_return = entry->operand_; ++ up(&copro_int_clr_semaphore); ++} ++#endif // CONFIG_LEON_COPRO ++ ++static void gmac_int_en_clr( ++ gmac_priv_t *priv, ++ u32 mask, ++ u32 *new_value, ++ int in_atomic) ++{ ++#ifdef CONFIG_LEON_COPRO ++ unsigned long irq_flags = 0; ++ ++ int cmd_queue_result = -1; ++ while (cmd_queue_result) { ++ if (in_irq()) ++ spin_lock(&priv->cmd_que_lock_); ++ else ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_INT_EN_CLR, mask, copro_int_clr_callback); ++ ++ if (in_irq()) ++ spin_unlock(&priv->cmd_que_lock_); ++ else ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ ++ if (new_value) { ++ // Wait until the CoPro acknowledges that it has stopped ++ if (in_atomic) { ++ while (down_trylock(&copro_int_clr_semaphore)) { ++ udelay(100); ++ } ++ } else { ++ down_interruptible(&copro_int_clr_semaphore); ++ } ++ *new_value = copro_int_clr_return; ++ } ++#else ++ unsigned long temp; ++ unsigned long irq_flags = 0; ++ ++ if (in_irq()) ++ spin_lock(&priv->cmd_que_lock_); ++ else ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ ++ temp = dma_reg_clear_mask(priv, DMA_INT_ENABLE_REG, mask); ++ ++ if (in_irq()) ++ spin_unlock(&priv->cmd_que_lock_); ++ else ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ ++ if (new_value) { ++ *new_value = temp; ++ } ++#endif ++} ++ ++/** ++ * May be invoked from either ISR or process context, so locking must be ++ * invoked appropriate to the return from in_irq() ++ */ ++static void change_rx_enable( ++ gmac_priv_t *priv, ++ u32 start, ++ int waitForAck, ++ int in_atomic) ++{ ++#ifdef CONFIG_LEON_COPRO ++ unsigned long irq_flags = 0; ++ int cmd_queue_result = -1; ++ ++ while (cmd_queue_result) { ++ if (in_irq()) ++ spin_lock(&priv->cmd_que_lock_); ++ else ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ ++ // Request the CoPro to start/stop GMAC receiver ++ cmd_queue_result = ++ cmd_que_queue_cmd(&priv->cmd_queue_, ++ GMAC_CMD_CHANGE_RX_ENABLE, ++ start, ++ waitForAck ? copro_rx_enable_callback : 0); ++ ++ if (in_irq()) ++ spin_unlock(&priv->cmd_que_lock_); ++ else ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ ++ if (waitForAck) { ++ // Wait until the CoPro acknowledges that the receiver has been stopped ++ if (in_atomic) { ++ while (down_trylock(&copro_rx_enable_semaphore)) { ++ udelay(100); ++ } ++ } else { ++ down_interruptible(&copro_rx_enable_semaphore); ++ } ++ } ++#else // CONFIG_LEON_COPRO ++ start ? dma_reg_set_mask(priv, DMA_OP_MODE_REG, 1UL << DMA_OP_MODE_SR_BIT) : ++ dma_reg_clear_mask(priv, DMA_OP_MODE_REG, 1UL << DMA_OP_MODE_SR_BIT); ++#endif // CONFIG_LEON_COPRO ++} ++ ++/** ++ * Invoked from the watchdog timer action routine which runs as softirq, so ++ * must disable interrupts when obtaining locks ++ */ ++static void change_gig_mode(gmac_priv_t *priv) ++{ ++ unsigned int is_gig = priv->mii.using_1000; ++ ++#ifdef CONFIG_LEON_COPRO ++ unsigned long irq_flags = 0; ++ int cmd_queue_result = -1; ++ ++ while (cmd_queue_result) { ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ // Request the CoPro to change gigabit mode ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_CHANGE_GIG_MODE, is_gig, 0); ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++#else // CONFIG_LEON_COPRO ++ static const int MAX_TRIES = 1000; ++ int tries = 0; ++ ++ // Mask to extract the transmit status field from the status register ++ u32 ts_mask = ((1UL << DMA_STATUS_TS_NUM_BITS) - 1) << DMA_STATUS_TS_BIT; ++ ++ // Must stop transmission in order to change store&forward mode ++ dma_reg_clear_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_ST_BIT)); ++ ++ // Transmission only stops after current Tx frame has completed trans- ++ // mission, so wait for the Tx state machine to enter the stopped state ++ while ((dma_reg_read(priv, DMA_STATUS_REG) & ts_mask) != (DMA_STATUS_TS_STOPPED << DMA_STATUS_TS_BIT)) { ++ mdelay(1); ++ if (unlikely(++tries == MAX_TRIES)) { ++ break; ++ } ++ } ++ ++ if (unlikely(tries == MAX_TRIES)) { ++ printk(KERN_WARNING "Timed out of wait for Tx to stop\n"); ++ } ++ ++ if (is_gig) { ++ mac_reg_clear_mask(priv, MAC_CONFIG_REG, (1UL << MAC_CONFIG_PS_BIT)); ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ // In gigabit mode the OX800 cannot support the required data rate to ++ // the GMAC, so must use store&forward and OX800 doesn't support Tx ++ // checksumming in the GMAC ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SF_BIT)); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } else { ++ mac_reg_set_mask(priv, MAC_CONFIG_REG, (1UL << MAC_CONFIG_PS_BIT)); ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ dma_reg_clear_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SF_BIT)); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } ++ ++ // Re-start transmission after store&forward change applied ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_ST_BIT)); ++#endif // CONFIG_LEON_COPRO ++} ++ ++/** ++ * Invoked from the watchdog timer action routine which runs as softirq, so ++ * must disable interrupts when obtaining locks ++ */ ++static void change_pause_mode(gmac_priv_t *priv) ++{ ++#ifdef CONFIG_LEON_COPRO ++ unsigned int enable_pause = priv->mii.using_pause; ++ unsigned long irq_flags = 0; ++ int cmd_queue_result = -1; ++ ++ while (cmd_queue_result) { ++ spin_lock_irqsave(&priv->cmd_que_lock_, irq_flags); ++ // Request the CoPro to change pause mode ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_CHANGE_PAUSE_MODE, enable_pause, 0); ++ spin_unlock_irqrestore(&priv->cmd_que_lock_, irq_flags); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++#else // CONFIG_LEON_COPRO ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ unsigned int enable_pause = priv->mii.using_pause; ++ ++ if (enable_pause) { ++ mac_reg_set_mask(priv, MAC_FLOW_CNTL_REG, (1UL << MAC_FLOW_CNTL_TFE_BIT)); ++ } else { ++ mac_reg_clear_mask(priv, MAC_FLOW_CNTL_REG, (1UL << MAC_FLOW_CNTL_TFE_BIT)); ++ } ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++#endif // CONFIG_LEON_COPRO ++} ++ ++static void refill_rx_ring(struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ int filled = 0; ++ ++ if (unlikely(priv->rx_buffers_per_page)) { ++ // Receive into pages ++ struct page *page = 0; ++ int offset = 0; ++ dma_addr_t phys_adr = 0; ++ ++ // While there are empty RX descriptor ring slots ++ while (1) { ++ int available; ++ int desc; ++ rx_frag_info_t frag_info; ++ ++ // Have we run out of space in the current page? ++ if (offset + NET_IP_ALIGN + priv->rx_buffer_size_ > GMAC_ALLOC_SIZE) { ++ page = 0; ++ offset = 0; ++ } ++ ++ if (!page) { ++ // Start a new page ++ available = available_for_write(&priv->rx_gmac_desc_list_info); ++ if (available < priv->rx_buffers_per_page) { ++ break; ++ } ++ ++ // Allocate a page to hold a received packet ++ page = alloc_pages(GFP_ATOMIC, GMAC_ALLOC_ORDER); ++ if (unlikely(page == NULL)) { ++ printk(KERN_WARNING "refill_rx_ring() Could not alloc page\n"); ++ break; ++ } ++ ++ // Get a consistent DMA mapping for the entire page that will be ++ // DMAed to - causing an invalidation of any entries in the CPU's ++ // cache covering the memory region ++ phys_adr = dma_map_page(0, page, 0, GMAC_ALLOC_SIZE, DMA_FROM_DEVICE); ++ BUG_ON(dma_mapping_error(phys_adr)); ++ } else { ++ // Using the current page again ++ get_page(page); ++ } ++ ++ // Ensure IP header is quad aligned ++ offset += NET_IP_ALIGN; ++ frag_info.page = page; ++ frag_info.length = priv->rx_buffer_size_; ++ frag_info.phys_adr = phys_adr + offset; ++ ++ // Try to associate a descriptor with the fragment info ++ desc = set_rx_descriptor(priv, &frag_info); ++ if (desc >= 0) { ++ filled = 1; ++ } else { ++ // Failed to associate the descriptor, so release the DMA mapping ++ // for the socket buffer ++ dma_unmap_page(0, frag_info.phys_adr, frag_info.length, DMA_FROM_DEVICE); ++ ++ // No more RX descriptor ring entries to refill ++ break; ++ } ++ ++ // Account for the space used in the current page ++ offset += frag_info.length; ++ ++ // Start next packet on a cacheline boundary ++ offset = SKB_DATA_ALIGN(offset); ++ } ++ } else { ++ // Preallocate MTU-sized SKBs ++ while (1) { ++ struct sk_buff *skb; ++ rx_frag_info_t frag_info; ++ int desc; ++ ++ if (!available_for_write(&priv->rx_gmac_desc_list_info)) { ++ break; ++ } ++ ++ // Allocate a new skb for the descriptor ring which is large enough ++ // for any packet received from the link ++ skb = dev_alloc_skb(priv->rx_buffer_size_ + NET_IP_ALIGN); ++ if (!skb) { ++ // Can't refill any more RX descriptor ring entries ++ break; ++ } else { ++ // Despite what the comments in the original code from Synopsys ++ // claimed, the GMAC DMA can cope with non-quad aligned buffers ++ // - it will always perform quad transfers but zero/ignore the ++ // unwanted bytes. ++ skb_reserve(skb, NET_IP_ALIGN); ++ } ++ ++ // Get a consistent DMA mapping for the memory to be DMAed to ++ // causing invalidation of any entries in the CPU's cache covering ++ // the memory region ++ frag_info.page = (struct page*)skb; ++ frag_info.length = skb_tailroom(skb); ++ frag_info.phys_adr = dma_map_single(0, skb->tail, frag_info.length, DMA_FROM_DEVICE); ++ BUG_ON(dma_mapping_error(frag_info.phys_adr)); ++ ++ // Associate the skb with the descriptor ++ desc = set_rx_descriptor(priv, &frag_info); ++ if (desc >= 0) { ++ filled = 1; ++ } else { ++ // No, so release the DMA mapping for the socket buffer ++ dma_unmap_single(0, frag_info.phys_adr, frag_info.length, DMA_FROM_DEVICE); ++ ++ // Free the socket buffer ++ dev_kfree_skb(skb); ++ ++ // No more RX descriptor ring entries to refill ++ break; ++ } ++ } ++ } ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ if (likely(filled)) { ++ // Issue a RX poll demand to restart RX descriptor processing and DFF ++ // mode does not automatically restart descriptor processing after a ++ // descriptor unavailable event ++ dma_reg_write(priv, DMA_RX_POLL_REG, 0); ++ } ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++} ++ ++static inline void set_phy_type_rgmii(void) ++{ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ // Use sysctrl to switch MAC link lines into either (G)MII or RGMII mode ++ u32 reg_contents = readl(SYS_CTRL_GMAC_CTRL); ++ reg_contents |= (1UL << SYS_CTRL_GMAC_RGMII); ++ writel(reg_contents, SYS_CTRL_RSTEN_SET_CTRL); ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++} ++ ++static void initialise_phy(gmac_priv_t* priv) ++{ ++ switch (priv->phy_type) { ++ case PHY_TYPE_VITESSE_VSC8201XVZ: ++ { ++ // Allow s/w to override mode/duplex pin settings ++ u32 acsr = priv->mii.mdio_read(priv->netdev, priv->mii.phy_id, VSC8201_MII_ACSR); ++ ++ printk(KERN_INFO "%s: PHY is Vitesse VSC8201XVZ\n", priv->netdev->name); ++ acsr |= (1UL << VSC8201_MII_ACSR_MDPPS_BIT); ++ priv->mii.mdio_write(priv->netdev, priv->mii.phy_id, VSC8201_MII_ACSR, acsr); ++ } ++ break; ++ case PHY_TYPE_REALTEK_RTL8211BGR: ++ printk(KERN_INFO "%s: PHY is Realtek RTL8211BGR\n", priv->netdev->name); ++ set_phy_type_rgmii(); ++ break; ++ case PHY_TYPE_LSI_ET1011C: ++ case PHY_TYPE_LSI_ET1011C2: ++ { ++ u32 phy_reg; ++ ++ printk(KERN_INFO "%s: PHY is LSI ET1011C\n", priv->netdev->name); ++ ++ // Configure clocks ++ phy_reg = priv->mii.mdio_read(priv->netdev, priv->mii.phy_id, ET1011C_MII_CONFIG); ++ phy_reg &= ~(((1UL << ET1011C_MII_CONFIG_IFMODESEL_NUM_BITS) - 1) << ET1011C_MII_CONFIG_IFMODESEL); ++ phy_reg |= (ET1011C_MII_CONFIG_IFMODESEL_GMII_MII << ET1011C_MII_CONFIG_IFMODESEL); ++ phy_reg |= ((1UL << ET1011C_MII_CONFIG_SYSCLKEN) | ++ (1UL << ET1011C_MII_CONFIG_TXCLKEN) | ++ (1UL << ET1011C_MII_CONFIG_TBI_RATESEL) | ++ (1UL << ET1011C_MII_CONFIG_CRS_TX_EN)); ++ priv->mii.mdio_write(priv->netdev, priv->mii.phy_id, ET1011C_MII_CONFIG, phy_reg); ++ ++ // Enable Tx/Rx LED ++ phy_reg = priv->mii.mdio_read(priv->netdev, priv->mii.phy_id, ET1011C_MII_LED2); ++ phy_reg &= ~(((1UL << ET1011C_MII_LED2_LED_NUM_BITS) - 1) << ET1011C_MII_LED2_LED_TXRX); ++ phy_reg |= (ET1011C_MII_LED2_LED_TXRX_ACTIVITY << ET1011C_MII_LED2_LED_TXRX); ++ priv->mii.mdio_write(priv->netdev, priv->mii.phy_id, ET1011C_MII_LED2, phy_reg); ++ } ++ break; ++ case PHY_TYPE_ICPLUS_IP1001: ++ printk(KERN_INFO "%s: PHY is ICPlus 1001\n", priv->netdev->name); ++ break; ++ } ++} ++ ++static struct kobj_type ktype_gmac_link_state = { ++ .release = 0, ++ .sysfs_ops = 0, ++ .default_attrs = 0, ++}; ++ ++static int gmac_link_state_hotplug_filter(struct kset* kset, struct kobject* kobj) { ++ return get_ktype(kobj) == &ktype_gmac_link_state; ++} ++ ++static const char* gmac_link_state_hotplug_name(struct kset* kset, struct kobject* kobj) { ++ return "gmac_link_state"; ++} ++ ++static struct kset_uevent_ops gmac_link_state_uevent_ops = { ++ .filter = gmac_link_state_hotplug_filter, ++ .name = gmac_link_state_hotplug_name, ++ .uevent = NULL, ++}; ++ ++static int gmac_link_state_init_sysfs(gmac_priv_t* priv) ++{ ++ int err = 0; ++ ++ /* Prepare the sysfs interface for use */ ++ kobject_set_name(&priv->link_state_kset.kobj, "gmac_link_state"); ++ priv->link_state_kset.ktype = &ktype_gmac_link_state; ++ ++ err = subsystem_register(&priv->link_state_kset); ++ if (err) ++ return err; ++ ++ /* Setup hotplugging */ ++ priv->link_state_kset.uevent_ops = &gmac_link_state_uevent_ops; ++ ++ /* Setup the heirarchy, the name will be set on detection */ ++ kobject_init(&priv->link_state_kobject); ++ priv->link_state_kobject.kset = kset_get(&priv->link_state_kset); ++ priv->link_state_kobject.parent = &priv->link_state_kset.kobj; ++ ++ /* Build the sysfs entry */ ++ kobject_set_name(&priv->link_state_kobject, "gmac_link_state-1"); ++ return kobject_add(&priv->link_state_kobject); ++} ++ ++static void work_handler(struct work_struct *ws) { ++ gmac_priv_t *priv = container_of(ws, gmac_priv_t, link_state_change_work); ++ ++ kobject_uevent(&priv->link_state_kobject, priv->link_state ? KOBJ_ONLINE : KOBJ_OFFLINE); ++} ++ ++static void link_state_change_callback( ++ int link_state, ++ void *arg) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)arg; ++ ++ priv->link_state = link_state; ++ schedule_work(&priv->link_state_change_work); ++} ++ ++static void start_watchdog_timer(gmac_priv_t* priv) ++{ ++ priv->watchdog_timer.expires = jiffies + WATCHDOG_TIMER_INTERVAL; ++ priv->watchdog_timer_shutdown = 0; ++ mod_timer(&priv->watchdog_timer, priv->watchdog_timer.expires); ++} ++ ++static void delete_watchdog_timer(gmac_priv_t* priv) ++{ ++ // Ensure link/PHY state watchdog timer won't be invoked again ++ priv->watchdog_timer_shutdown = 1; ++ del_timer_sync(&priv->watchdog_timer); ++} ++ ++static inline int is_auto_negotiation_in_progress(gmac_priv_t* priv) ++{ ++ return !(phy_read(priv->netdev, priv->phy_addr, MII_BMSR) & BMSR_ANEGCOMPLETE); ++} ++ ++static void watchdog_timer_action(unsigned long arg) ++{ ++ typedef enum watchdog_state { ++ WDS_IDLE, ++ WDS_RESETTING, ++ WDS_NEGOTIATING ++ } watchdog_state_t; ++ ++ static int state = WDS_IDLE; ++ ++ gmac_priv_t* priv = (gmac_priv_t*)arg; ++ unsigned long new_timeout = jiffies + WATCHDOG_TIMER_INTERVAL; ++#ifndef ARMULATING ++ int ready; ++ int duplex_changed; ++ int gigabit_changed; ++ int pause_changed; ++ ++ // Interpret the PHY/link state. ++ if (priv->phy_force_negotiation || (state == WDS_RESETTING)) { ++ mii_check_link(&priv->mii); ++ ready = 0; ++ } else { ++ duplex_changed = mii_check_media_ex(&priv->mii, 1, priv->mii_init_media, &gigabit_changed, &pause_changed, link_state_change_callback, priv); ++ priv->mii_init_media = 0; ++ ready = netif_carrier_ok(priv->netdev); ++ } ++ ++ if (!ready) { ++ if (priv->phy_force_negotiation) { ++ if (netif_carrier_ok(priv->netdev)) { ++ state = WDS_RESETTING; ++ } else { ++ state = WDS_IDLE; ++ } ++ ++ priv->phy_force_negotiation = 0; ++ } ++ ++ // May be a good idea to restart everything here, in an attempt to clear ++ // out any fault conditions ++ if ((state == WDS_NEGOTIATING) && is_auto_negotiation_in_progress(priv)) { ++ new_timeout = jiffies + AUTO_NEG_INTERVAL; ++ } else { ++ switch (state) { ++ case WDS_IDLE: ++ // Reset the PHY to get it into a known state ++ start_phy_reset(priv); ++ new_timeout = jiffies + START_RESET_INTERVAL; ++ state = WDS_RESETTING; ++ break; ++ case WDS_RESETTING: ++ if (!is_phy_reset_complete(priv)) { ++ new_timeout = jiffies + RESET_INTERVAL; ++ } else { ++ // Force or auto-negotiate PHY mode ++ set_phy_negotiate_mode(priv->netdev); ++ ++ // Set PHY specfic features ++ initialise_phy(priv); ++ ++ state = WDS_NEGOTIATING; ++ new_timeout = jiffies + AUTO_NEG_INTERVAL; ++ } ++ break; ++ default: ++ DBG(1, KERN_ERR "watchdog_timer_action() %s: Unexpected state\n", priv->netdev->name); ++ state = WDS_IDLE; ++ break; ++ } ++ } ++ } else { ++ state = WDS_IDLE; ++ if (duplex_changed) { ++ priv->mii.full_duplex ? mac_reg_set_mask(priv, MAC_CONFIG_REG, (1UL << MAC_CONFIG_DM_BIT)) : ++ mac_reg_clear_mask(priv, MAC_CONFIG_REG, (1UL << MAC_CONFIG_DM_BIT)); ++ } ++ ++ if (gigabit_changed) { ++ change_gig_mode(priv); ++ } ++ ++ if (pause_changed) { ++ change_pause_mode(priv); ++ } ++ } ++#endif // !ARMULATING ++ ++ // Re-trigger the timer, unless some other thread has requested it be stopped ++ if (!priv->watchdog_timer_shutdown) { ++ // Restart the timer ++ mod_timer(&priv->watchdog_timer, new_timeout); ++ } ++} ++ ++static int inline is_ip_packet(unsigned short eth_protocol) ++{ ++ return (eth_protocol == ETH_P_IP) ++#ifdef SUPPORT_IPV6 ++ || (eth_protocol == ETH_P_IPV6) ++#endif // SUPPORT_IPV6 ++ ; ++} ++ ++static int inline is_ipv4_packet(unsigned short eth_protocol) ++{ ++ return eth_protocol == ETH_P_IP; ++} ++ ++#ifdef SUPPORT_IPV6 ++static int inline is_ipv6_packet(unsigned short eth_protocol) ++{ ++ return eth_protocol == ETH_P_IPV6; ++} ++#endif // SUPPORT_IPV6 ++ ++static int inline is_hw_checksummable(unsigned short protocol) ++{ ++ return (protocol == IPPROTO_TCP) || (protocol == IPPROTO_UDP) ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ || (protocol == IPPROTO_ICMP) ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ; ++} ++ ++static u32 unmap_rx_page( ++ gmac_priv_t *priv, ++ dma_addr_t phys_adr) ++{ ++ u32 offset = phys_adr & ~PAGE_MASK; ++ u32 next_offset = offset + priv->rx_buffer_size_; ++ next_offset = SKB_DATA_ALIGN(next_offset); ++ next_offset += NET_IP_ALIGN; ++ ++ // If this is the last packet in a page ++ if (next_offset > GMAC_ALLOC_SIZE) { ++ // Release the DMA mapping for the page ++ dma_unmap_page(0, phys_adr & PAGE_MASK, GMAC_ALLOC_SIZE, DMA_FROM_DEVICE); ++ } ++ ++ return offset; ++} ++ ++#define FCS_LEN 4 // Ethernet CRC length ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define HW_CSUM_LEN 2 // The OX800 H/W appending partial csum length ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++static inline int get_desc_len( ++ u32 desc_status, ++ int last) ++{ ++ int length = get_rx_length(desc_status); ++ ++ if (last) { ++ length -= FCS_LEN; ++#if defined(CONFIG_HIPOX_VERSION_0X800) && defined(USE_RX_CSUM) ++ length -= HW_CSUM_LEN; ++#endif // CONFIG_HIPOX_VERSION_0X800 && USE_RX_CSUM ++ } ++ ++ return length; ++} ++ ++static int process_rx_packet_skb(gmac_priv_t *priv) ++{ ++ int desc; ++ int last; ++ u32 desc_status = 0; ++ rx_frag_info_t frag_info; ++ int packet_len; ++ struct sk_buff *skb; ++ int valid; ++ int ip_summed; ++ ++ desc = get_rx_descriptor(priv, &last, &desc_status, &frag_info); ++ if (desc < 0) { ++ return 0; ++ } ++ ++ // Release the DMA mapping for the received data ++ dma_unmap_single(0, frag_info.phys_adr, frag_info.length, DMA_FROM_DEVICE); ++ ++ // Get the packet data length ++ packet_len = get_desc_len(desc_status, last); ++ ++ // Get pointer to the SKB ++ skb = (struct sk_buff*)frag_info.page; ++ ++ // Is the packet entirely contained within the descriptors and without errors? ++ valid = !(desc_status & (1UL << RDES0_ES_BIT)); ++ ++ if (unlikely(!valid)) { ++ goto not_valid_skb; ++ } ++ ++ ip_summed = CHECKSUM_NONE; ++ ++#ifdef USE_RX_CSUM ++ // Has the h/w flagged an IP header checksum failure? ++ valid = !(desc_status & (1UL << RDES0_IPC_BIT)); ++ ++ if (likely(valid)) { ++ // Determine whether Ethernet frame contains an IP packet - ++ // only bother with Ethernet II frames, but do cope with ++ // 802.1Q VLAN tag presence ++ int vlan_offset = 0; ++ unsigned short eth_protocol = ntohs(((struct ethhdr*)skb->data)->h_proto); ++ int is_ip = is_ip_packet(eth_protocol); ++ ++ if (!is_ip) { ++ // Check for VLAN tag ++ if (eth_protocol == ETH_P_8021Q) { ++ // Extract the contained protocol type from after ++ // the VLAN tag ++ eth_protocol = ntohs(*(unsigned short*)(skb->data + ETH_HLEN)); ++ is_ip = is_ip_packet(eth_protocol); ++ ++ // Adjustment required to skip the VLAN stuff and ++ // get to the IP header ++ vlan_offset = 4; ++ } ++ } ++ ++ // Only offload checksum calculation for IP packets ++ if (is_ip) { ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ u16 payload_length = 0; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ struct iphdr* ipv4_header = 0; ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ if (unlikely(desc_status & (1UL << RDES0_PCE_BIT))) { ++ valid = 0; ++ } else ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ if (is_ipv4_packet(eth_protocol)) { ++ ipv4_header = (struct iphdr*)(skb->data + ETH_HLEN + vlan_offset); ++ ++ // H/W can only checksum non-fragmented IP packets ++ if (!(ipv4_header->frag_off & htons(IP_MF | IP_OFFSET))) { ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ switch (ipv4_header->protocol) { ++ case IPPROTO_TCP: ++ // Compute TCP pseudo-header checksum ++ payload_length = ntohs(ipv4_header->tot_len) - (ipv4_header->ihl*4); ++ break; ++ case IPPROTO_UDP: ++ { ++ struct udphdr* udp_header = (struct udphdr*)((u8*)ipv4_header + (ipv4_header->ihl*4)); ++ payload_length = ntohs(udp_header->len); ++ } ++ break; ++ default: ++ // Not supporting any other than TCP/UDP ++ break; ++ } ++#else // CONFIG_HIPOX_VERSION_0X800 ++ if (is_hw_checksummable(ipv4_header->protocol)) { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } ++ } ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ else { ++#ifdef SUPPORT_IPV6 ++ struct ipv6hdr* ipv6_header = (struct ipv6hdr*)(skb->data + ETH_HLEN + vlan_offset); ++ ++ if (is_hw_checksummable(ipv6_header->nexthdr)) { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++#endif // SUPPORT_IPV6 ++ } ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (payload_length) { ++ // Get the hardware generated payload checksum from ++ // the end of the received packet, reverse the 1's ++ // complement operation that the h/w applies and add ++ // to the pseudo-header checksum, in network order ++ u16 hw_csum = ~(*(u16*)(skb->data + packet_len + FCS_LEN)); ++ ++ // Calculate checksum of pseudo header and payload ++ if (csum_tcpudp_magic( ++ ipv4_header->saddr, ++ ipv4_header->daddr, ++ payload_length, ++ ipv4_header->protocol, ++ hw_csum)) { ++ // Bad checksum, so indicate in descriptor status ++ desc_status |= (1UL << RDES0_IPC_BIT); ++ valid = 0; ++ } else { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } ++ } ++ ++ if (unlikely(!valid)) { ++ goto not_valid_skb; ++ } ++#endif // USE_RX_CSUM ++ ++ // Increase the skb's data pointer to account for the RX packet that has ++ // been DMAed into it ++ skb_put(skb, packet_len); ++ ++ // Set the device for the skb ++ skb->dev = priv->netdev; ++ ++ // Set packet protocol ++ skb->protocol = eth_type_trans(skb, priv->netdev); ++ ++ // Record whether h/w checksumed the packet ++ skb->ip_summed = ip_summed; ++ ++ // Send the packet up the network stack ++ netif_receive_skb(skb); ++ ++ // Update receive statistics ++ priv->netdev->last_rx = jiffies; ++ ++priv->stats.rx_packets; ++ priv->stats.rx_bytes += packet_len; ++ ++ return 1; ++ ++not_valid_skb: ++ dev_kfree_skb(skb); ++ ++ DBG(2, KERN_WARNING "process_rx_packet() %s: Received packet has bad desc_status = 0x%08x\n", priv->netdev->name, desc_status); ++ ++ // Update receive statistics from the descriptor status ++ if (is_rx_collision_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Collision (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.collisions; ++ } ++ if (is_rx_crc_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: CRC error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_crc_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_frame_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: frame error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_length_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Length error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_length_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_csum_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Checksum error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ } ++ ++ return 0; ++} ++ ++static int process_rx_packet(gmac_priv_t *priv) ++{ ++ struct sk_buff *skb = NULL; ++ int last; ++ u32 desc_status; ++ rx_frag_info_t frag_info; ++ int desc; ++ u32 offset; ++ int desc_len; ++ unsigned char *packet; ++ int valid; ++ int desc_used = 0; ++ int hlen = 0; ++ int partial_len = 0; ++ int first = 1; ++ ++ // Check that there is at least one Rx descriptor available. Cache the ++ // descriptor information so we don't have to touch the uncached/unbuffered ++ // descriptor memory more than necessary when we come to use that descriptor ++ if (!rx_available_for_read(&priv->rx_gmac_desc_list_info, &desc_status)) { ++ return 0; ++ } ++ ++ // Attempt to allocate an skb before we change anything on the Rx descriptor ring ++ skb = dev_alloc_skb(GMAC_HLEN + NET_IP_ALIGN); ++ if (unlikely(skb == NULL)) { ++ return 0; ++ } ++ ++ // Align IP header start in header storage ++ skb_reserve(skb, NET_IP_ALIGN); ++ ++ // Process all descriptors associated with the packet ++ while (1) { ++ int prev_len; ++ ++ // First call to get_rx_descriptor() will use the status read from the ++ // first descriptor by the call to rx_available_for_read() above ++ while ((desc = get_rx_descriptor(priv, &last, &desc_status, &frag_info)) < 0) { ++ // We are part way through processing a multi-descriptor packet ++ // and the GMAC hasn't finished with the next descriptor for the ++ // packet yet, so have to poll until it becomes available ++ desc_status = 0; ++ udelay(1); ++ } ++ ++ // We've consumed a descriptor ++ ++desc_used; ++ ++ if (!frag_info.page) { ++ panic("process_rx_packet() %s: Found RX descriptor without attached page\n", priv->netdev->name); ++ } ++ ++ // If this is the last packet in the page, release the DMA mapping ++ offset = unmap_rx_page(priv, frag_info.phys_adr); ++ if (!first) { ++ // The buffer adr of descriptors associate with middle or last ++ // parts of a packet have ls 2 bits of buffer adr ignored by GMAC DMA ++ offset &= ~0x3; ++ } ++ ++ // Get the length of the packet excluding CRC, h/w csum etc. ++ prev_len = partial_len; ++ partial_len = get_desc_len(desc_status, last); ++ desc_len = partial_len - prev_len; ++ ++ // Get a pointer to the start of the packet data received into page ++ packet = page_address(frag_info.page) + offset; ++ ++ // Is the packet entirely contained within the desciptors and without errors? ++ valid = !(desc_status & (1UL << RDES0_ES_BIT)); ++ ++ if (unlikely(!valid)) { ++ goto not_valid; ++ } ++ ++ if (first) { ++ // Store headers in skb buffer ++ hlen = min(GMAC_HLEN, desc_len); ++ ++ // Copy header into skb buffer ++ memcpy(skb->data, packet, hlen); ++ skb->tail += hlen; ++ ++ if (desc_len > hlen) { ++ // Point skb frags array at remaining packet data in pages ++ skb_shinfo(skb)->nr_frags = 1; ++ skb_shinfo(skb)->frags[0].page = frag_info.page; ++ skb_shinfo(skb)->frags[0].page_offset = offset + hlen; ++ skb_shinfo(skb)->frags[0].size = desc_len - hlen; ++ } else { ++ // Entire packet now in skb buffer so don't require page anymore ++ put_page(frag_info.page); ++ } ++ ++ first = 0; ++ } else { ++ // Store intermediate descriptor data into packet ++ int frag_index = skb_shinfo(skb)->nr_frags; ++ skb_shinfo(skb)->frags[frag_index].page = frag_info.page; ++ skb_shinfo(skb)->frags[frag_index].page_offset = offset; ++ skb_shinfo(skb)->frags[frag_index].size = desc_len; ++ ++skb_shinfo(skb)->nr_frags; ++ } ++ ++ if (last) { ++ int ip_summed = CHECKSUM_NONE; ++ ++ // Update total packet length skb metadata ++ skb->len = partial_len; ++ skb->data_len = skb->len - hlen; ++ skb->truesize = skb->len + sizeof(struct sk_buff); ++ ++#ifdef USE_RX_CSUM ++ // Has the h/w flagged an IP header checksum failure? ++ valid = !(desc_status & (1UL << RDES0_IPC_BIT)); ++ ++ // Are we offloading RX checksuming? ++ if (likely(valid)) { ++ // Determine whether Ethernet frame contains an IP packet - ++ // only bother with Ethernet II frames, but do cope with ++ // 802.1Q VLAN tag presence ++ int vlan_offset = 0; ++ unsigned short eth_protocol = ntohs(((struct ethhdr*)skb->data)->h_proto); ++ int is_ip = is_ip_packet(eth_protocol); ++ ++ if (!is_ip) { ++ // Check for VLAN tag ++ if (eth_protocol == ETH_P_8021Q) { ++ // Extract the contained protocol type from after ++ // the VLAN tag ++ eth_protocol = ntohs(*(unsigned short*)(skb->data + ETH_HLEN)); ++ is_ip = is_ip_packet(eth_protocol); ++ ++ // Adjustment required to skip the VLAN stuff and ++ // get to the IP header ++ vlan_offset = 4; ++ } ++ } ++ ++ // Only offload checksum calculation for IP packets ++ if (is_ip) { ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ u16 payload_length = 0; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ struct iphdr* ipv4_header = 0; ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ if (unlikely(desc_status & (1UL << RDES0_PCE_BIT))) { ++ valid = 0; ++ } else ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ if (is_ipv4_packet(eth_protocol)) { ++ ipv4_header = (struct iphdr*)(skb->data + ETH_HLEN + vlan_offset); ++ ++ // H/W can only checksum non-fragmented IP packets ++ if (!(ipv4_header->frag_off & htons(IP_MF | IP_OFFSET))) { ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ switch (ipv4_header->protocol) { ++ case IPPROTO_TCP: ++ // Compute TCP pseudo-header checksum ++ payload_length = ntohs(ipv4_header->tot_len) - (ipv4_header->ihl*4); ++ break; ++ case IPPROTO_UDP: ++ { ++ struct udphdr* udp_header = (struct udphdr*)((u8*)ipv4_header + (ipv4_header->ihl*4)); ++ payload_length = ntohs(udp_header->len); ++ } ++ break; ++ default: ++ // Not supporting any other than TCP/UDP ++ break; ++ } ++#else // CONFIG_HIPOX_VERSION_0X800 ++ if (is_hw_checksummable(ipv4_header->protocol)) { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } ++ } ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ else { ++#ifdef SUPPORT_IPV6 ++ struct ipv6hdr* ipv6_header = (struct ipv6hdr*)(skb->data + ETH_HLEN + vlan_offset); ++ ++ if (is_hw_checksummable(ipv6_header->nexthdr)) { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++#endif // SUPPORT_IPV6 ++ } ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ if (payload_length) { ++ // Get the hardware generated payload checksum from ++ // the end of the received packet, reverse the 1's ++ // complement operation that the h/w applies and add ++ // to the pseudo-header checksum, in network order ++ u16 hw_csum = ~(*(u16*)(packet + desc_len + FCS_LEN)); ++ ++ // Calculate checksum of pseudo header and payload ++ if (csum_tcpudp_magic( ++ ipv4_header->saddr, ++ ipv4_header->daddr, ++ payload_length, ++ ipv4_header->protocol, ++ hw_csum)) { ++ // Bad checksum, so indicate in descriptor status ++ desc_status |= (1UL << RDES0_IPC_BIT); ++ valid = 0; ++ } else { ++ ip_summed = CHECKSUM_UNNECESSARY; ++ } ++ } ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ } ++ } ++ ++ if (unlikely(!valid)) { ++ goto not_valid; ++ } ++#endif // USE_RX_CSUM ++ ++ // Initialise other required skb header fields ++ skb->dev = priv->netdev; ++ skb->protocol = eth_type_trans(skb, priv->netdev); ++ ++ // Record whether h/w checksumed the packet ++ skb->ip_summed = ip_summed; ++ ++ // Send the skb up the network stack ++ netif_receive_skb(skb); ++ ++ // Update receive statistics ++ priv->netdev->last_rx = jiffies; ++ ++priv->stats.rx_packets; ++ priv->stats.rx_bytes += partial_len; ++ ++ break; ++ } ++ ++ // Want next call to get_rx_descriptor() to read status from descriptor ++ desc_status = 0; ++ } ++ return desc_used; ++ ++not_valid: ++ if (!skb_shinfo(skb)->nr_frags) { ++ // Free the page as it wasn't attached to the skb ++ put_page(frag_info.page); ++ } ++ ++ dev_kfree_skb(skb); ++ ++ DBG(2, KERN_WARNING "process_rx_packet() %s: Received packet has bad desc_status = 0x%08x\n", priv->netdev->name, desc_status); ++ ++ // Update receive statistics from the descriptor status ++ if (is_rx_collision_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Collision (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.collisions; ++ } ++ if (is_rx_crc_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: CRC error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_crc_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_frame_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: frame error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_length_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Length error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_length_errors; ++ ++priv->stats.rx_errors; ++ } ++ if (is_rx_csum_error(desc_status)) { ++ DBG(20, KERN_INFO "process_rx_packet() %s: Checksum error (0x%08x:%u bytes)\n", priv->netdev->name, desc_status, desc_len); ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ } ++ ++ return desc_used; ++} ++ ++/* ++ * NAPI receive polling method ++ */ ++static int poll( ++ struct napi_struct *napi, ++ int budget) ++{ ++ gmac_priv_t *priv = container_of(napi, gmac_priv_t, napi_struct); ++ struct net_device *dev = priv->netdev; ++ int rx_work_limit = budget; ++ int work_done = 0; ++ int continue_polling; ++ int finished; ++ int available; ++ int desc_since_refill = 0; ++ ++ finished = 0; ++ do { ++ u32 status; ++ ++ // While there are receive polling jobs to be done ++ while (rx_work_limit) { ++ int desc_used; ++ ++ if (unlikely(priv->rx_buffers_per_page)) { ++ desc_used = process_rx_packet(priv); ++ } else { ++ desc_used = process_rx_packet_skb(priv); ++ } ++ ++ if (!desc_used) { ++ break; ++ } ++ ++ // Increment count of processed packets ++ ++work_done; ++ ++ // Decrement our remaining budget ++ if (rx_work_limit > 0) { ++ --rx_work_limit; ++ } ++ ++ // Rx overflows seem to upset the GMAC, so try to ensure we never see them ++ desc_since_refill += desc_used; ++ if (desc_since_refill >= DESC_SINCE_REFILL_LIMIT) { ++ desc_since_refill = 0; ++ refill_rx_ring(dev); ++ } ++ } ++ ++ if (rx_work_limit) { ++ // We have unused budget remaining, but apparently no Rx packets to ++ // process ++ available = 0; ++ ++ // Clear any RI status so we don't immediately get reinterrupted ++ // when we leave polling, due to either a new RI event, or a left ++ // over interrupt from one of the RX descriptors we've already ++ // processed ++ status = dma_reg_read(priv, DMA_STATUS_REG); ++ if (status & (1UL << DMA_STATUS_RI_BIT)) { ++ // Ack the RI, including the normal summary sticky bit ++ dma_reg_write(priv, DMA_STATUS_REG, ((1UL << DMA_STATUS_RI_BIT) | ++ (1UL << DMA_STATUS_NIS_BIT))); ++ ++ // Must check again for available RX descriptors, in case the RI ++ // status came from a new RX descriptor ++ available = rx_available_for_read(&priv->rx_gmac_desc_list_info, 0); ++ } ++ ++ if (!available) { ++ // We have budget left but no Rx packets to process so stop ++ // polling ++ continue_polling = 0; ++ finished = 1; ++ } ++ } else { ++ // If we have consumed all our budget, don't cancel the ++ // poll, the NAPI instructure assumes we won't ++ continue_polling = 1; ++ ++ // Must leave poll() routine as no budget left ++ finished = 1; ++ } ++ } while (!finished); ++ ++ // Attempt to fill any empty slots in the RX ring ++ refill_rx_ring(dev); ++ ++ // Decrement the budget even if we didn't process any packets ++ if (!work_done) { ++ work_done = 1; ++ } ++ ++ if (!continue_polling) { ++ // No more received packets to process so return to interrupt mode ++ netif_rx_complete(dev, napi); ++ ++ // Enable interrupts caused by received packets that may have been ++ // disabled in the ISR before entering polled mode ++ gmac_int_en_set(priv, (1UL << DMA_INT_ENABLE_RI_BIT) | ++ (1UL << DMA_INT_ENABLE_RU_BIT) | ++ (1UL << DMA_INT_ENABLE_OV_BIT)); ++ } ++ ++ return work_done; ++} ++ ++#if defined(CONFIG_LEON_COPRO) && defined(CONFIG_LEON_OFFLOAD_TX) ++static void copro_fill_tx_job( ++ volatile gmac_tx_que_ent_t *job, ++ struct sk_buff *skb) ++{ ++ int i; ++ int nr_frags = skb_shinfo(skb)->nr_frags; ++ unsigned short flags = 0; ++ dma_addr_t hdr_dma_address; ++ ++ // if too many fragments call sbk_linearize() ++ // and take the CPU memory copies hit ++ if (nr_frags > COPRO_NUM_TX_FRAGS_DIRECT) { ++ int err; ++ printk(KERN_WARNING "Fill: linearizing socket buffer as required %d frags and have only %d\n", nr_frags, COPRO_NUM_TX_FRAGS_DIRECT); ++ err = skb_linearize(skb); ++ if (err) { ++ panic("Fill: No free memory"); ++ } ++ ++ // update nr_frags ++ nr_frags = skb_shinfo(skb)->nr_frags; ++ } ++ ++ // Get a DMA mapping of the packet's data ++ hdr_dma_address = dma_map_single(0, skb->data, skb_headlen(skb), DMA_TO_DEVICE); ++ BUG_ON(dma_mapping_error(hdr_dma_address)); ++ ++ // Allocate storage for remainder of fragments and create DMA mappings ++ // Get a DMA mapping for as many fragments as will fit into the first level ++ // fragment info. storage within the job structure ++ for (i=0; i < nr_frags; ++i) { ++ struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[i]; ++ job->frag_ptr_[i] = dma_map_page(0, frag->page, frag->page_offset, frag->size, DMA_TO_DEVICE); ++ job->frag_len_[i] = frag->size; ++ } ++ ++ // Is h/w checksumming and possibly TSO required ++ if (likely((skb->ip_summed == CHECKSUM_PARTIAL) && ++ (ntohs(skb->protocol) == ETH_P_IP))) { ++ flags |= (1UL << TX_JOB_FLAGS_ACCELERATE_BIT); ++ } ++ ++ // Fill the job description with information about the packet ++ job->skb_ = (u32)skb; ++ job->len_ = skb->len; ++ job->data_len_ = skb->data_len; ++ job->ethhdr_ = hdr_dma_address; ++ job->iphdr_ = hdr_dma_address + (skb_network_header(skb) - skb->data); ++ job->iphdr_csum_ = ((struct iphdr*)skb_network_header(skb))->check; ++ job->tso_segs_ = skb_shinfo(skb)->gso_segs; ++ job->tso_size_ = skb_shinfo(skb)->gso_size; ++ job->flags_ = flags; ++ job->statistics_ = 0; ++} ++ ++static void copro_free_tx_resources(volatile gmac_tx_que_ent_t* job) ++{ ++ int i; ++ struct sk_buff* skb = (struct sk_buff*)job->skb_; ++ int nr_frags = skb_shinfo(skb)->nr_frags; ++ ++ // This should never happen, since we check space when we filled ++ // the job in copro_fill_tx_job ++ if (nr_frags > COPRO_NUM_TX_FRAGS_DIRECT) { ++ panic("Free: Insufficient fragment storage, required %d, have only %d", nr_frags, COPRO_NUM_TX_FRAGS_DIRECT); ++ } ++ ++ // Release the DMA mapping for the data directly referenced by the SKB ++ dma_unmap_single(0, job->ethhdr_, skb_headlen(skb), DMA_TO_DEVICE); ++ ++ // Release the DMA mapping for any fragments in the first level fragment ++ // info. storage within the job structure ++ for (i=0; (i < nr_frags) && (i < COPRO_NUM_TX_FRAGS_DIRECT); ++i) { ++ dma_unmap_page(0, job->frag_ptr_[i], job->frag_len_[i], DMA_TO_DEVICE); ++ } ++ ++ // Inform the network stack that we've finished with the packet ++ dev_kfree_skb_irq(skb); ++} ++ ++static void copro_process_pending_tx_skbs( ++ struct net_device *dev, ++ volatile gmac_tx_que_ent_t *job) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ // Process pending SKBs, oldest first ++ do { ++ // Get the oldest pending SKB ++ struct sk_buff *skb; ++ struct list_head *entry = priv->copro_tx_skb_list_.next; ++ BUG_ON(!entry); ++ list_del(entry); ++ ++ skb = list_entry(entry, struct sk_buff, cb); ++ BUG_ON(!skb); ++ ++ // Keep track of how many entries are in the pending SKB list ++ --priv->copro_tx_skb_list_count_; ++ ++ // Fill the Tx offload job with the network packet's details ++ copro_fill_tx_job(job, skb); ++ ++ // Enqueue the new Tx offload job with the CoPro ++ tx_que_new_job(dev, job); ++ ++ if (list_empty(&priv->copro_tx_skb_list_)) { ++ // No more pending SKBs ++ break; ++ } ++ } while ((job = tx_que_get_idle_job(dev))); ++} ++ ++static void finish_xmit(struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ volatile gmac_tx_que_ent_t *job; ++ ++ // Process all available completed jobs ++ while ((job = tx_que_get_finished_job(dev))) { ++ int aborted; ++ int carrier; ++ int collisions; ++ u32 statistics = job->statistics_; ++ ++ copro_free_tx_resources(job); ++ ++ // Accumulate TX statistics returned by CoPro in the job structure ++ priv->stats.tx_bytes += (statistics & TX_JOB_STATS_BYTES_MASK) >> TX_JOB_STATS_BYTES_BIT; ++ priv->stats.tx_packets += (statistics & TX_JOB_STATS_PACKETS_MASK) >> TX_JOB_STATS_PACKETS_BIT; ++ aborted = (statistics & TX_JOB_STATS_ABORT_MASK) >> TX_JOB_STATS_ABORT_BIT; ++ carrier = (statistics & TX_JOB_STATS_CARRIER_MASK) >> TX_JOB_STATS_CARRIER_BIT; ++ collisions = (statistics & TX_JOB_STATS_COLLISION_MASK) >> TX_JOB_STATS_COLLISION_BIT; ++ priv->stats.tx_aborted_errors += aborted; ++ priv->stats.tx_carrier_errors += carrier; ++ priv->stats.collisions += collisions; ++ priv->stats.tx_errors += (aborted + carrier); ++ } ++ ++ // Process any queued pending SKBs for which resources are available ++ if (priv->copro_tx_skb_list_count_ && (job = tx_que_get_idle_job(dev))) { ++ copro_process_pending_tx_skbs(dev, job); ++ ++ // Record start of transmission, so timeouts will work once they're ++ // implemented ++ dev->trans_start = jiffies; ++ ++ // Interrupt the CoPro to cause it to examine the Tx offload queue ++ wmb(); ++ writel(1UL << COPRO_SEM_INT_TX, SYS_CTRL_SEMA_SET_CTRL); ++ } ++ ++ // If the network stack's Tx queue was stopped and we now have resources ++ // to process more Tx offload jobs ++ if (netif_queue_stopped(dev) && ++ !tx_que_is_full(&priv->tx_queue_) && ++ !priv->copro_tx_skb_list_count_) { ++ // Restart the network stack's TX queue ++ netif_wake_queue(dev); ++ } ++} ++#else ++static void finish_xmit(struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned descriptors_freed = 0; ++ u32 desc_status = 0; ++ ++ // Handle transmit descriptors for the completed packet transmission ++ while (1) { ++ struct sk_buff *skb; ++ tx_frag_info_t fragment; ++ int buffer_owned; ++ int desc_index; ++ ++ // Get tx descriptor content, accumulating status for all buffers ++ // contributing to each packet ++ desc_index = get_tx_descriptor(priv, &skb, &desc_status, &fragment, &buffer_owned); ++ ++ if (desc_index < 0) { ++ // No more completed Tx packets ++ break; ++ } ++ ++ // Only unmap DMA buffer if descriptor owned the buffer ++ if (buffer_owned) { ++ // Release the DMA mapping for the buffer ++ dma_unmap_single(0, fragment.phys_adr, fragment.length, DMA_TO_DEVICE); ++ } ++ ++ // When all buffers contributing to a packet have been processed ++ if (skb) { ++ // Check the status of the transmission ++ if (likely(is_tx_valid(desc_status))) { ++ priv->stats.tx_bytes += skb->len; ++ priv->stats.tx_packets++; ++ } else { ++ priv->stats.tx_errors++; ++ if (is_tx_aborted(desc_status)) { ++ ++priv->stats.tx_aborted_errors; ++ } ++ if (is_tx_carrier_error(desc_status)) { ++ ++priv->stats.tx_carrier_errors; ++ } ++ } ++ ++ if (unlikely(is_tx_collision_error(desc_status))) { ++ ++priv->stats.collisions; ++ } ++ ++ // Inform the network stack that packet transmission has finished ++ dev_kfree_skb_irq(skb); ++ ++ // Start accumulating status for the next packet ++ desc_status = 0; ++ } ++ ++ // Track how many descriptors we make available, so we know ++ // if we need to re-start of network stack's TX queue processing ++ ++descriptors_freed; ++ } ++ ++ // If the TX queue is stopped, there may be a pending TX packet waiting to ++ // be transmitted ++ if (unlikely(netif_queue_stopped(dev))) { ++ // No locking with hard_start_xmit() required, as queue is already ++ // stopped so hard_start_xmit() won't touch the h/w ++ ++ // If any TX descriptors have been freed and there is an outstanding TX ++ // packet waiting to be queued due to there not having been a TX ++ // descriptor available when hard_start_xmit() was presented with an skb ++ // by the network stack ++ if (priv->tx_pending_skb) { ++ // Construct the GMAC specific DMA descriptor ++ if (set_tx_descriptor(priv, ++ priv->tx_pending_skb, ++ priv->tx_pending_fragments, ++ priv->tx_pending_fragment_count, ++ priv->tx_pending_skb->ip_summed == CHECKSUM_PARTIAL) >= 0) { ++ // No TX packets now outstanding ++ priv->tx_pending_skb = 0; ++ priv->tx_pending_fragment_count = 0; ++ ++ // We have used one of the TX descriptors freed by transmission ++ // completion processing having occured above ++ --descriptors_freed; ++ ++ // Issue a TX poll demand to restart TX descriptor processing, as we ++ // have just added one, in case it had found there were no more ++ // pending transmission ++ dma_reg_write(priv, DMA_TX_POLL_REG, 0); ++ } ++ } ++ ++ // If there are TX descriptors available we should restart the TX queue ++ if (descriptors_freed) { ++ // The TX queue had been stopped by hard_start_xmit() due to lack of ++ // TX descriptors, so restart it now that we've freed at least one ++ netif_wake_queue(dev); ++ } ++ } ++} ++#endif // CONFIG_LEON_COPRO && CONFIG_LEON_OFFLOAD_TX ++ ++#ifndef CONFIG_LEON_COPRO ++static void process_non_dma_ints(u32 raw_status) ++{ ++ printk(KERN_ERR "Found GPI/GMI/GLI interrupt\n"); ++} ++#endif // !CONFIG_LEON_COPRO ++ ++#ifdef CONFIG_LEON_COPRO ++static void copro_fwd_intrs_handler( ++ void *dev_id, ++ u32 status) ++{ ++ struct net_device *dev = (struct net_device *)dev_id; ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ int restart_watchdog = 0; ++ int restart_tx = 0; ++ int poll_tx = 0; ++ ++ // Test for normal receive interrupt ++ if (status & (1UL << DMA_STATUS_RI_BIT)) { ++ if (netif_rx_schedule_prep(dev, &priv->napi_struct)) { ++ // Tell system we have work to be done ++ __netif_rx_schedule(dev, &priv->napi_struct); ++ } else { ++ printk(KERN_ERR "copro_fwd_intrs_handler() %s: RX interrupt while in poll\n", dev->name); ++ } ++ } ++ ++ // Test for unavailable RX buffers - CoPro should have disabled ++ if (unlikely(status & (1UL << DMA_STATUS_RU_BIT))) { ++ DBG(30, KERN_INFO "int_handler() %s: RX buffer unavailable\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_over_errors; ++ ++priv->stats.rx_errors; ++ } ++ ++ // Test for Rx overflow - CoPro should have disabled ++ if (unlikely(status & (1UL << DMA_STATUS_OVF_BIT))) { ++ DBG(30, KERN_INFO "int_handler() %s: Rx overflow\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_fifo_errors; ++ ++priv->stats.rx_errors; ++ } ++ ++ // Test for normal TX interrupt ++ if (status & ((1UL << DMA_STATUS_TI_BIT) | ++ (1UL << DMA_STATUS_ETI_BIT))) { ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ // Finish packet transmision started by start_xmit ++ finish_xmit(dev); ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ } ++ ++ // Test for abnormal transmitter interrupt where there may be completed ++ // packets waiting to be processed ++ if (unlikely(status & ((1UL << DMA_STATUS_TJT_BIT) | ++ (1UL << DMA_STATUS_UNF_BIT)))) { ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ // Complete processing of any TX packets closed by the DMA ++ finish_xmit(dev); ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ ++ if (status & (1UL << DMA_STATUS_TJT_BIT)) { ++ // A transmit jabber timeout causes the transmitter to enter the ++ // stopped state ++ DBG(50, KERN_INFO "int_handler() %s: TX jabber timeout\n", dev->name); ++ restart_tx = 1; ++ } else { ++ DBG(51, KERN_INFO "int_handler() %s: TX underflow\n", dev->name); ++ } ++ ++ // Issue a TX poll demand in an attempt to restart TX descriptor ++ // processing ++ poll_tx = 1; ++ } ++ ++ // Test for any of the error states which we deal with directly within ++ // this interrupt service routine. ++ if (unlikely(status & ((1UL << DMA_STATUS_ERI_BIT) | ++ (1UL << DMA_STATUS_RWT_BIT) | ++ (1UL << DMA_STATUS_RPS_BIT) | ++ (1UL << DMA_STATUS_TPS_BIT) | ++ (1UL << DMA_STATUS_FBE_BIT)))) { ++ // Test for early RX interrupt ++ if (status & (1UL << DMA_STATUS_ERI_BIT)) { ++ // Don't expect to see this, as never enable it ++ DBG(30, KERN_WARNING "int_handler() %s: Early RX \n", dev->name); ++ } ++ ++ if (status & (1UL << DMA_STATUS_RWT_BIT)) { ++ DBG(30, KERN_INFO "int_handler() %s: RX watchdog timeout\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ restart_watchdog = 1; ++ } ++ ++ if (status & (1UL << DMA_STATUS_RPS_BIT)) { ++ // Mask to extract the receive status field from the status register ++// u32 rs_mask = ((1UL << DMA_STATUS_RS_NUM_BITS) - 1) << DMA_STATUS_RS_BIT; ++// u32 rs = (status & rs_mask) >> DMA_STATUS_RS_BIT; ++// printk("int_handler() %s: RX process stopped 0x%x\n", dev->name, rs); ++ ++priv->stats.rx_errors; ++ restart_watchdog = 1; ++ ++ // Restart the receiver ++ DBG(35, KERN_INFO "int_handler() %s: Restarting receiver\n", dev->name); ++ change_rx_enable(priv, 1, 0, 1); ++ } ++ ++ if (status & (1UL << DMA_STATUS_TPS_BIT)) { ++ // Mask to extract the transmit status field from the status register ++// u32 ts_mask = ((1UL << DMA_STATUS_TS_NUM_BITS) - 1) << DMA_STATUS_TS_BIT; ++// u32 ts = (status & ts_mask) >> DMA_STATUS_TS_BIT; ++// printk("int_handler() %s: TX process stopped 0x%x\n", dev->name, ts); ++ ++priv->stats.tx_errors; ++ restart_watchdog = 1; ++ restart_tx = 1; ++ } ++ ++ // Test for pure error interrupts ++ if (status & (1UL << DMA_STATUS_FBE_BIT)) { ++ // Mask to extract the bus error status field from the status register ++// u32 eb_mask = ((1UL << DMA_STATUS_EB_NUM_BITS) - 1) << DMA_STATUS_EB_BIT; ++// u32 eb = (status & eb_mask) >> DMA_STATUS_EB_BIT; ++// printk("int_handler() %s: Bus error 0x%x\n", dev->name, eb); ++ restart_watchdog = 1; ++ } ++ ++ if (restart_watchdog) { ++ // Restart the link/PHY state watchdog immediately, which will ++ // attempt to restart the system ++ mod_timer(&priv->watchdog_timer, jiffies); ++ restart_watchdog = 0; ++ } ++ } ++ ++ if (unlikely(restart_tx)) { ++ // Restart the transmitter, causes am implicit Tx descriptor list poll ++ DBG(35, KERN_INFO "int_handler() %s: Restarting transmitter\n", dev->name); ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_ST_BIT)); ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ poll_tx = 0; ++ } ++ ++ if (unlikely(poll_tx)) { ++ // Issue a TX poll demand in an attempt to restart TX descriptor ++ // processing ++ DBG(33, KERN_INFO "int_handler() %s: Issuing Tx poll demand\n", dev->name); ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ dma_reg_write(priv, DMA_TX_POLL_REG, 0); ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ } ++} ++#else // CONFIG_LEON_COPRO ++static irqreturn_t int_handler(int int_num, void* dev_id) ++{ ++ struct net_device *dev = (struct net_device *)dev_id; ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ u32 int_enable; ++ int rx_polling; ++ u32 raw_status; ++ u32 status; ++ ++ /** Read the interrupt enable register to determine if we're in rx poll mode ++ * Id like to get rid of this read, if a more efficient way of determining ++ * whether we are polling is available */ ++ spin_lock(&priv->cmd_que_lock_); ++ int_enable = dma_reg_read(priv, DMA_INT_ENABLE_REG); ++ spin_unlock(&priv->cmd_que_lock_); ++ ++ rx_polling = !(int_enable & (1UL << DMA_INT_ENABLE_RI_BIT)); ++ ++ // Get interrupt status ++ raw_status = dma_reg_read(priv, DMA_STATUS_REG); ++ ++ // MMC, PMT and GLI interrupts are not masked by the interrupt enable ++ // register, so must deal with them on the raw status ++ if (unlikely(raw_status & ((1UL << DMA_STATUS_GPI_BIT) | ++ (1UL << DMA_STATUS_GMI_BIT) | ++ (1UL << DMA_STATUS_GLI_BIT)))) { ++ process_non_dma_ints(raw_status); ++ } ++ ++ // Get status of enabled interrupt sources ++ status = raw_status & int_enable; ++ ++ while (status) { ++ // Whether the link/PHY watchdog timer should be restarted ++ int restart_watchdog = 0; ++ int restart_tx = 0; ++ int poll_tx = 0; ++ u32 int_disable_mask = 0; ++ ++ // Test for RX interrupt resulting from sucessful reception of a packet- ++ // must do this before ack'ing, else otherwise can get into trouble with ++ // the sticky summary bits when we try to disable further RI interrupts ++ if (status & (1UL << DMA_STATUS_RI_BIT)) { ++//printk("RI "); ++ // Disable interrupts caused by received packets as henceforth ++ // we shall poll for packet reception ++ int_disable_mask |= (1UL << DMA_INT_ENABLE_RI_BIT); ++ ++ // Do NAPI compatible receive processing for RI interrupts ++ if (likely(netif_rx_schedule_prep(dev, &priv->napi_struct))) { ++ // Remember that we are polling, so we ignore RX events for the ++ // remainder of the ISR ++ rx_polling = 1; ++ ++ // Tell system we have work to be done ++ __netif_rx_schedule(dev, &priv->napi_struct); ++ } else { ++ printk(KERN_ERR "int_handler() %s: RX interrupt while in poll\n", dev->name); ++ } ++ } ++ ++ // Test for unavailable RX buffers - must do this before ack'ing, else ++ // otherwise can get into trouble with the sticky summary bits ++ if (unlikely(status & (1UL << DMA_STATUS_RU_BIT))) { ++ printk(/*DBG(30, KERN_INFO */"int_handler() %s: RX buffer unavailable\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_over_errors; ++ ++priv->stats.rx_errors; ++ ++ // Disable RX buffer unavailable reporting, so we don't get swamped ++ int_disable_mask |= (1UL << DMA_INT_ENABLE_RU_BIT); ++ } ++ ++ if (unlikely(status & (1UL << DMA_STATUS_OVF_BIT))) { ++ printk(/*DBG(30, KERN_INFO */"int_handler() %s: RX overflow\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_fifo_errors; ++ ++priv->stats.rx_errors; ++ ++ // Disable RX overflow reporting, so we don't get swamped ++ int_disable_mask |= (1UL << DMA_INT_ENABLE_OV_BIT); ++ } ++ ++ // Do any interrupt disabling with a single register write ++ if (int_disable_mask) { ++ gmac_int_en_clr(priv, int_disable_mask, 0); ++ ++ // Update our record of the current interrupt enable status ++ int_enable &= ~int_disable_mask; ++ } ++ ++ // The broken GMAC interrupt mechanism with its sticky summary bits ++ // means that we have to ack all asserted interrupts here; we can't not ++ // ack the RI interrupt source as we might like to (in order that the ++ // poll() routine could examine the status) because if it was asserted ++ // prior to being masked above, then the summary bit(s) would remain ++ // asserted and cause an immediate re-interrupt. ++ dma_reg_write(priv, DMA_STATUS_REG, status | ((1UL << DMA_STATUS_NIS_BIT) | ++ (1UL << DMA_STATUS_AIS_BIT))); ++ ++ // Test for normal TX interrupt ++ if (status & ((1UL << DMA_STATUS_TI_BIT) | ++ (1UL << DMA_STATUS_ETI_BIT))) { ++ // Finish packet transmision started by start_xmit ++ finish_xmit(dev); ++ } ++ ++ // Test for abnormal transmitter interrupt where there may be completed ++ // packets waiting to be processed ++ if (unlikely(status & ((1UL << DMA_STATUS_TJT_BIT) | ++ (1UL << DMA_STATUS_UNF_BIT)))) { ++ // Complete processing of any TX packets closed by the DMA ++ finish_xmit(dev); ++ ++ if (status & (1UL << DMA_STATUS_TJT_BIT)) { ++ // A transmit jabber timeout causes the transmitter to enter the ++ // stopped state ++ DBG(50, KERN_INFO "int_handler() %s: TX jabber timeout\n", dev->name); ++ restart_tx = 1; ++ } else { ++ DBG(51, KERN_INFO "int_handler() %s: TX underflow\n", dev->name); ++ } ++ ++ // Issue a TX poll demand in an attempt to restart TX descriptor ++ // processing ++ poll_tx = 1; ++ } ++ ++ // Test for any of the error states which we deal with directly within ++ // this interrupt service routine. ++ if (unlikely(status & ((1UL << DMA_STATUS_ERI_BIT) | ++ (1UL << DMA_STATUS_RWT_BIT) | ++ (1UL << DMA_STATUS_RPS_BIT) | ++ (1UL << DMA_STATUS_TPS_BIT) | ++ (1UL << DMA_STATUS_FBE_BIT)))) { ++ // Test for early RX interrupt ++ if (status & (1UL << DMA_STATUS_ERI_BIT)) { ++ // Don't expect to see this, as never enable it ++ DBG(30, KERN_WARNING "int_handler() %s: Early RX \n", dev->name); ++ } ++ ++ if (status & (1UL << DMA_STATUS_RWT_BIT)) { ++ DBG(30, KERN_INFO "int_handler() %s: RX watchdog timeout\n", dev->name); ++ // Accumulate receive statistics ++ ++priv->stats.rx_frame_errors; ++ ++priv->stats.rx_errors; ++ restart_watchdog = 1; ++ } ++ ++ if (status & (1UL << DMA_STATUS_RPS_BIT)) { ++ // Mask to extract the receive status field from the status register ++ u32 rs_mask = ((1UL << DMA_STATUS_RS_NUM_BITS) - 1) << DMA_STATUS_RS_BIT; ++ u32 rs = (status & rs_mask) >> DMA_STATUS_RS_BIT; ++ printk(/*DBG(30, KERN_INFO */"int_handler() %s: RX process stopped 0x%x\n", dev->name, rs); ++ ++priv->stats.rx_errors; ++ restart_watchdog = 1; ++ ++ // Restart the receiver ++ printk(/*DBG(35, KERN_INFO */"int_handler() %s: Restarting receiver\n", dev->name); ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SR_BIT)); ++ } ++ ++ if (status & (1UL << DMA_STATUS_TPS_BIT)) { ++ // Mask to extract the transmit status field from the status register ++// u32 ts_mask = ((1UL << DMA_STATUS_TS_NUM_BITS) - 1) << DMA_STATUS_TS_BIT; ++// u32 ts = (status & ts_mask) >> DMA_STATUS_TS_BIT; ++// DBG(30, KERN_INFO "int_handler() %s: TX process stopped 0x%x\n", dev->name, ts); ++ ++priv->stats.tx_errors; ++ restart_watchdog = 1; ++ restart_tx = 1; ++ } ++ ++ // Test for pure error interrupts ++ if (status & (1UL << DMA_STATUS_FBE_BIT)) { ++ // Mask to extract the bus error status field from the status register ++// u32 eb_mask = ((1UL << DMA_STATUS_EB_NUM_BITS) - 1) << DMA_STATUS_EB_BIT; ++// u32 eb = (status & eb_mask) >> DMA_STATUS_EB_BIT; ++// DBG(30, KERN_INFO "int_handler() %s: Bus error 0x%x\n", dev->name, eb); ++ restart_watchdog = 1; ++ } ++ ++ if (restart_watchdog) { ++ // Restart the link/PHY state watchdog immediately, which will ++ // attempt to restart the system ++ mod_timer(&priv->watchdog_timer, jiffies); ++ restart_watchdog = 0; ++ } ++ } ++ ++ if (unlikely(restart_tx)) { ++ // Restart the transmitter ++ DBG(35, KERN_INFO "int_handler() %s: Restarting transmitter\n", dev->name); ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_ST_BIT)); ++ } ++ ++ if (unlikely(poll_tx)) { ++ // Issue a TX poll demand in an attempt to restart TX descriptor ++ // processing ++ DBG(33, KERN_INFO "int_handler() %s: Issuing Tx poll demand\n", dev->name); ++ dma_reg_write(priv, DMA_TX_POLL_REG, 0); ++ } ++ ++ // Read the record of current interrupt requests again, in case some ++ // more arrived while we were processing ++ raw_status = dma_reg_read(priv, DMA_STATUS_REG); ++ ++ // MMC, PMT and GLI interrupts are not masked by the interrupt enable ++ // register, so must deal with them on the raw status ++ if (unlikely(raw_status & ((1UL << DMA_STATUS_GPI_BIT) | ++ (1UL << DMA_STATUS_GMI_BIT) | ++ (1UL << DMA_STATUS_GLI_BIT)))) { ++ process_non_dma_ints(raw_status); ++ } ++ ++ // Get status of enabled interrupt sources. ++ status = raw_status & int_enable; ++ } ++ ++ return IRQ_HANDLED; ++} ++#endif // CONFIG_LEON_COPRO ++ ++#ifdef CONFIG_LEON_COPRO ++static struct semaphore copro_stop_semaphore; ++ ++static void copro_stop_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ up(&copro_stop_semaphore); ++} ++#endif // CONFIG_LEON_COPRO ++ ++static void gmac_down(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ int desc; ++ u32 int_enable; ++#ifdef CONFIG_LEON_COPRO ++ tx_que_t *tx_queue = &priv->tx_queue_; ++ int cmd_queue_result; ++#endif // CONFIG_LEON_COPRO ++ ++ // Stop NAPI ++ napi_disable(&priv->napi_struct); ++ ++ // Stop further TX packets being delivered to hard_start_xmit(); ++ netif_stop_queue(dev); ++ netif_carrier_off(dev); ++ ++ // Disable all GMAC interrupts and wait for change to be acknowledged ++ gmac_int_en_clr(priv, ~0UL, &int_enable, 0); ++ ++#ifdef CONFIG_LEON_COPRO ++ // Tell the CoPro to stop network offload operations ++ cmd_queue_result = -1; ++ while (cmd_queue_result) { ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_STOP, 0, copro_stop_callback); ++ spin_unlock(&priv->cmd_que_lock_); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ ++ // Wait until the CoPro acknowledges the STOP command ++ down_interruptible(&copro_stop_semaphore); ++ ++ // Wait until the CoPro acknowledges that it has completed stopping ++ down_interruptible(&priv->copro_stop_complete_semaphore_); ++ ++ // Clear out the Tx offload job queue, deallocating associated resources ++ while (tx_que_not_empty(tx_queue)) { ++ // Free any dynamic fragment ptr/len storage ++ /** @todo */ ++ tx_que_inc_r_ptr(tx_queue); ++ } ++ ++ // Reinitialise the Tx offload queue metadata ++ tx_que_init( ++ &priv->tx_queue_, ++ (gmac_tx_que_ent_t*)descriptors_phys_to_virt(priv->copro_params_.tx_que_head_), ++ priv->copro_tx_que_num_entries_); ++ ++ // Empty the pending SKB queue ++ while (!list_empty(&priv->copro_tx_skb_list_)) { ++ struct sk_buff *skb; ++ ++ // Remove the first entry on the list ++ struct list_head *entry = priv->copro_tx_skb_list_.next; ++ BUG_ON(!entry); ++ list_del(entry); ++ ++ // Get pointer to SKB from it's list_head member ++ skb = list_entry(entry, struct sk_buff, cb); ++ BUG_ON(!skb); ++ ++ // Inform the network stack that we've finished with the packet ++ dev_kfree_skb(skb); ++ } ++ priv->copro_tx_skb_list_count_ = 0; ++#endif // CONFIG_LEON_COPRO ++ ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ // Stop transmitter, take ownership of all tx descriptors ++ dma_reg_clear_mask(priv, DMA_OP_MODE_REG, 1UL << DMA_OP_MODE_ST_BIT); ++ if (priv->desc_vaddr) { ++ tx_take_ownership(&priv->tx_gmac_desc_list_info); ++ } ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ ++ // Stop receiver, waiting until it's really stopped and then take ownership ++ // of all rx descriptors ++ change_rx_enable(priv, 0, 1, 0); ++ ++ if (priv->desc_vaddr) { ++ rx_take_ownership(&priv->rx_gmac_desc_list_info); ++ } ++ ++ // Stop all timers ++ delete_watchdog_timer(priv); ++ ++ if (priv->desc_vaddr) { ++ // Free receive descriptors ++ do { ++ int first_last = 0; ++ rx_frag_info_t frag_info; ++ ++ desc = get_rx_descriptor(priv, &first_last, 0, &frag_info); ++ if (desc >= 0) { ++ if (unlikely(priv->rx_buffers_per_page)) { ++ // If this is the last packet in the page, release the DMA mapping ++ unmap_rx_page(priv, frag_info.phys_adr); ++ put_page(frag_info.page); ++ } else { ++ // Release the DMA mapping for the packet buffer ++ dma_unmap_single(0, frag_info.phys_adr, frag_info.length, DMA_FROM_DEVICE); ++ ++ // Free the skb ++ dev_kfree_skb((struct sk_buff *)frag_info.page); ++ } ++ } ++ } while (desc >= 0); ++ ++ // Free transmit descriptors ++ do { ++ struct sk_buff *skb; ++ tx_frag_info_t frag_info; ++ int buffer_owned; ++ ++ desc = get_tx_descriptor(priv, &skb, 0, &frag_info, &buffer_owned); ++ if (desc >= 0) { ++ if (buffer_owned) { ++ // Release the DMA mapping for the packet buffer ++ dma_unmap_single(0, frag_info.phys_adr, frag_info.length, DMA_FROM_DEVICE); ++ } ++ ++ if (skb) { ++ // Free the skb ++ dev_kfree_skb(skb); ++ } ++ } ++ } while (desc >= 0); ++ ++ // Free any resources associated with the buffers of a pending packet ++ if (priv->tx_pending_fragment_count) { ++ tx_frag_info_t *frag_info = priv->tx_pending_fragments; ++ ++ while (priv->tx_pending_fragment_count--) { ++ dma_unmap_single(0, frag_info->phys_adr, frag_info->length, DMA_FROM_DEVICE); ++ ++frag_info; ++ } ++ } ++ ++ // Free the socket buffer of a pending packet ++ if (priv->tx_pending_skb) { ++ dev_kfree_skb(priv->tx_pending_skb); ++ priv->tx_pending_skb = 0; ++ } ++ } ++ ++ // Power down the PHY ++ phy_powerdown(dev); ++} ++ ++static int stop(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ gmac_down(dev); ++ ++#ifdef CONFIG_LEON_COPRO ++ shutdown_copro(); ++ ++ if (priv->shared_copro_params_) { ++ // Free the DMA coherent parameter space ++ dma_free_coherent(0, sizeof(copro_params_t), priv->shared_copro_params_, priv->shared_copro_params_pa_); ++ priv->shared_copro_params_ = 0; ++ } ++ ++ // Disable semaphore register from causing ARM interrupts ++ *((volatile unsigned long*)SYS_CTRL_SEMA_MASKA_CTRL) = 0; ++ *((volatile unsigned long*)SYS_CTRL_SEMA_MASKB_CTRL) = 0; ++ ++ // Release interrupts lines used by semaphore register interrupts ++ if (priv->copro_a_irq_alloced_) { ++ free_irq(priv->copro_a_irq_, dev); ++ priv->copro_a_irq_alloced_ = 0; ++ } ++ if (priv->copro_b_irq_alloced_) { ++ free_irq(priv->copro_b_irq_, dev); ++ priv->copro_b_irq_alloced_ = 0; ++ } ++#endif // CONFIG_LEON_COPRO ++ ++ // Free the shadow descriptor memory ++ kfree(priv->tx_desc_shadow_); ++ priv->tx_desc_shadow_ = 0; ++ ++ kfree(priv->rx_desc_shadow_); ++ priv->rx_desc_shadow_ = 0; ++ ++ // Release the IRQ ++ if (priv->have_irq) { ++ free_irq(dev->irq, dev); ++ priv->have_irq = 0; ++ } ++ ++ // Disable the clock to the MAC block ++ writel(1UL << SYS_CTRL_CKEN_MAC_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ // Free the sysfs resources ++ kobject_del(&priv->link_state_kobject); ++ subsystem_unregister(&priv->link_state_kset); ++ ++ return 0; ++} ++ ++static void hw_set_mac_address(struct net_device *dev, unsigned char* addr) ++{ ++ u32 mac_lo; ++ u32 mac_hi; ++ ++ mac_lo = (u32)addr[0]; ++ mac_lo |= ((u32)addr[1] << 8); ++ mac_lo |= ((u32)addr[2] << 16); ++ mac_lo |= ((u32)addr[3] << 24); ++ ++ mac_hi = (u32)addr[4]; ++ mac_hi |= ((u32)addr[5] << 8); ++ ++ mac_reg_write(netdev_priv(dev), MAC_ADR0_LOW_REG, mac_lo); ++ mac_reg_write(netdev_priv(dev), MAC_ADR0_HIGH_REG, mac_hi); ++} ++ ++static int set_mac_address(struct net_device *dev, void *p) ++{ ++ struct sockaddr *addr = p; ++ ++ if (!is_valid_ether_addr(addr->sa_data)) { ++ return -EADDRNOTAVAIL; ++ } ++ ++ memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); ++ hw_set_mac_address(dev, addr->sa_data); ++ ++ return 0; ++} ++ ++static void multicast_hash(struct dev_mc_list *dmi, u32 *hash_lo, u32 *hash_hi) ++{ ++ u32 crc = ether_crc_le(dmi->dmi_addrlen, dmi->dmi_addr); ++ u32 mask = 1 << ((crc >> 26) & 0x1F); ++ ++ if (crc >> 31) { ++ *hash_hi |= mask; ++ } else { ++ *hash_lo |= mask; ++ } ++} ++ ++static void set_multicast_list(struct net_device *dev) ++{ ++ gmac_priv_t* priv = netdev_priv(dev); ++ u32 hash_lo=0; ++ u32 hash_hi=0; ++ u32 mode = 0; ++ int i; ++ ++ // Disable promiscuous mode and uni/multi-cast matching ++ mac_reg_write(priv, MAC_FRAME_FILTER_REG, mode); ++ ++ // Disable all perfect match registers ++ for (i=0; i < NUM_PERFECT_MATCH_REGISTERS; ++i) { ++ mac_adrhi_reg_write(priv, i, 0); ++ } ++ ++ // Promiscuous mode overrides all-multi which overrides other filtering ++ if (dev->flags & IFF_PROMISC) { ++ mode |= (1 << MAC_FRAME_FILTER_PR_BIT); ++ } else if (dev->flags & IFF_ALLMULTI) { ++ mode |= (1 << MAC_FRAME_FILTER_PM_BIT); ++ } else { ++ struct dev_mc_list *dmi; ++ ++ if (dev->mc_count <= NUM_PERFECT_MATCH_REGISTERS) { ++ // Use perfect matching registers ++ for (i=0, dmi = dev->mc_list; dmi; dmi = dmi->next, ++i) { ++ u32 addr; ++ ++ addr = dmi->dmi_addr[0]; ++ addr |= (u32)dmi->dmi_addr[1] << 8; ++ addr |= (u32)dmi->dmi_addr[2] << 16; ++ addr |= (u32)dmi->dmi_addr[3] << 24; ++ mac_adrlo_reg_write(priv, i, addr); ++ ++ addr = dmi->dmi_addr[4]; ++ addr |= (u32)dmi->dmi_addr[5] << 8; ++ addr |= (1 << MAC_ADR1_HIGH_AE_BIT); ++ mac_adrhi_reg_write(priv, i, addr); ++ } ++ } else { ++ // Use hashing ++ mode |= (1 << MAC_FRAME_FILTER_HUC_BIT); ++ mode |= (1 << MAC_FRAME_FILTER_HMC_BIT); ++ ++ for (dmi = dev->mc_list; dmi; dmi = dmi->next) { ++ multicast_hash(dmi, &hash_lo, &hash_hi); ++ } ++ } ++ } ++ ++ // Update the filtering rules ++ mac_reg_write(priv, MAC_FRAME_FILTER_REG, mode); ++ ++ // Update the filtering hash table ++ mac_reg_write(priv, MAC_HASH_LOW_REG, hash_lo); ++ mac_reg_write(priv, MAC_HASH_HIGH_REG, hash_hi); ++} ++ ++static int gmac_up(struct net_device *dev) ++{ ++ int status = 0; ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ u32 reg_contents; ++#ifdef CONFIG_LEON_COPRO ++ int cmd_queue_result; ++#endif // CONFIG_LEON_COPRO ++ ++ // Reset the entire GMAC ++ dma_reg_write(priv, DMA_BUS_MODE_REG, 1UL << DMA_BUS_MODE_SWR_BIT); ++ ++ // Ensure reset is performed before testing for completion ++ wmb(); ++ ++ // Wait for the reset operation to complete ++ status = -EIO; ++ printk(KERN_INFO "Resetting GMAC\n"); ++ for (;;) { ++ if (!(dma_reg_read(priv, DMA_BUS_MODE_REG) & (1UL << DMA_BUS_MODE_SWR_BIT))) { ++ status = 0; ++ break; ++ } ++ } ++ ++ // Did the GMAC reset operation fail? ++ if (status) { ++ printk(KERN_ERR "open() %s: GMAC reset failed\n", dev->name); ++ goto gmac_up_err_out; ++ } ++ printk(KERN_INFO "GMAC reset complete\n"); ++ ++ /* Initialise MAC config register contents ++ */ ++ reg_contents = 0; ++ if (!priv->mii.using_1000) { ++ DBG(1, KERN_INFO "open() %s: PHY in 10/100Mb mode\n", dev->name); ++ reg_contents |= (1UL << MAC_CONFIG_PS_BIT); ++ } else { ++ DBG(1, KERN_INFO "open() %s: PHY in 1000Mb mode\n", dev->name); ++ } ++ if (priv->mii.full_duplex) { ++ reg_contents |= (1UL << MAC_CONFIG_DM_BIT); ++ } ++ ++#ifdef USE_RX_CSUM ++ reg_contents |= (1UL << MAC_CONFIG_IPC_BIT); ++#endif // USE_RX_CSUM ++ ++ if (priv->jumbo_) { ++ // Allow passage of jumbo frames through both transmitter and receiver ++ reg_contents |= ((1UL << MAC_CONFIG_JE_BIT) | ++ (1UL << MAC_CONFIG_JD_BIT) | ++ (1UL << MAC_CONFIG_WD_BIT)); ++ } ++ ++ // Enable transmitter and receiver ++ reg_contents |= ((1UL << MAC_CONFIG_TE_BIT) | ++ (1UL << MAC_CONFIG_RE_BIT)); ++ ++ // Select the minimum IFG - I found that 80 bit times caused very poor ++ // IOZone performance, so stcik with the 96 bit times default ++ reg_contents |= (0UL << MAC_CONFIG_IFG_BIT); ++ ++ // Write MAC config setup to the GMAC ++ mac_reg_write(priv, MAC_CONFIG_REG, reg_contents); ++ ++ /* Initialise MAC VLAN register contents ++ */ ++ reg_contents = 0; ++ mac_reg_write(priv, MAC_VLAN_TAG_REG, reg_contents); ++ ++ // Initialise the hardware's record of our primary MAC address ++ hw_set_mac_address(dev, dev->dev_addr); ++ ++ // Initialise multicast and promiscuous modes ++ set_multicast_list(dev); ++ ++ // Disable all MMC interrupt sources ++ mac_reg_write(priv, MMC_RX_MASK_REG, ~0UL); ++ mac_reg_write(priv, MMC_TX_MASK_REG, ~0UL); ++ ++ // Remember how large the unified descriptor array is to be ++ priv->total_num_descriptors = NUM_TX_DMA_DESCRIPTORS + NUM_RX_DMA_DESCRIPTORS; ++ ++ // Initialise the structures managing the TX descriptor list ++ init_tx_desc_list(&priv->tx_gmac_desc_list_info, ++ priv->desc_vaddr, ++ priv->tx_desc_shadow_, ++ NUM_TX_DMA_DESCRIPTORS); ++ ++ // Initialise the structures managing the RX descriptor list ++ init_rx_desc_list(&priv->rx_gmac_desc_list_info, ++ priv->desc_vaddr + NUM_TX_DMA_DESCRIPTORS, ++ priv->rx_desc_shadow_, ++ NUM_RX_DMA_DESCRIPTORS, ++ priv->rx_buffer_size_); ++ ++ // Reset record of pending Tx packet ++ priv->tx_pending_skb = 0; ++ priv->tx_pending_fragment_count = 0; ++ ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ // Write the physical DMA consistent address of the start of the tx descriptor array ++ dma_reg_write(priv, DMA_TX_DESC_ADR_REG, priv->desc_dma_addr); ++#endif // !CONFIG_LEON_OFFLOAD_TX ++ ++ // Write the physical DMA consistent address of the start of the rx descriptor array ++ dma_reg_write(priv, DMA_RX_DESC_ADR_REG, priv->desc_dma_addr + ++ (priv->tx_gmac_desc_list_info.num_descriptors * sizeof(gmac_dma_desc_t))); ++ ++ // Initialise the GMAC DMA bus mode register ++ dma_reg_write(priv, DMA_BUS_MODE_REG, ((1UL << DMA_BUS_MODE_FB_BIT) | // Force bursts ++ (8UL << DMA_BUS_MODE_PBL_BIT) | // AHB burst size ++ (1UL << DMA_BUS_MODE_DA_BIT))); // Round robin Rx/Tx ++ ++ // Prepare receive descriptors ++ refill_rx_ring(dev); ++ ++ // Clear any pending interrupt requests ++ dma_reg_write(priv, DMA_STATUS_REG, dma_reg_read(priv, DMA_STATUS_REG)); ++ ++ /* Initialise flow control register contents ++ */ ++ // Enable Rx flow control ++ reg_contents = (1UL << MAC_FLOW_CNTL_RFE_BIT); ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ if (priv->mii.using_pause) { ++ // Enable Tx flow control ++ reg_contents |= (1UL << MAC_FLOW_CNTL_TFE_BIT); ++ } ++ ++ // Set the duration of the pause frames generated by the transmitter when ++ // the Rx fifo fill threshold is exceeded ++ reg_contents |= ((0x100UL << MAC_FLOW_CNTL_PT_BIT) | // Pause for 256 slots ++ (0x1UL << MAC_FLOW_CNTL_PLT_BIT)); ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ++ // Write flow control setup to the GMAC ++ mac_reg_write(priv, MAC_FLOW_CNTL_REG, reg_contents); ++ ++ /* Initialise operation mode register contents ++ */ ++ // Initialise the GMAC DMA operation mode register. Set Tx/Rx FIFO thresholds ++ // to make best use of our limited SDRAM bandwidth when operating in gigabit ++ reg_contents = ((DMA_OP_MODE_TTC_256 << DMA_OP_MODE_TTC_BIT) | // Tx threshold ++ (1UL << DMA_OP_MODE_FUF_BIT) | // Forward Undersized good Frames ++ (DMA_OP_MODE_RTC_128 << DMA_OP_MODE_RTC_BIT) | // Rx threshold 128 bytes ++ (1UL << DMA_OP_MODE_OSF_BIT)); // Operate on 2nd frame ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ // Enable hardware flow control ++ reg_contents |= (1UL << DMA_OP_MODE_EFC_BIT); ++ ++ // Set threshold for enabling hardware flow control at (full-4KB) to give ++ // space for upto two in-flight std MTU packets to arrive after pause frame ++ // has been sent. ++ reg_contents |= ((0UL << DMA_OP_MODE_RFA2_BIT) | ++ (3UL << DMA_OP_MODE_RFA_BIT)); ++ ++ // Set threshold for disabling hardware flow control (-7KB) ++ reg_contents |= ((1UL << DMA_OP_MODE_RFD2_BIT) | ++ (2UL << DMA_OP_MODE_RFD_BIT)); ++ ++ // Don't flush Rx frames from FIFO just because there's no descriptor available ++ reg_contents |= (1UL << DMA_OP_MODE_DFF_BIT); ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ++ // Write settings to operation mode register ++ dma_reg_write(priv, DMA_OP_MODE_REG, reg_contents); ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ // Use store&forward when operating in gigabit mode, as OX800 does not have ++ // sufficient SDRAM bandwidth to support gigabit Tx without it and OX800 ++ // does not support Tx checksumming in the GMAC ++ if (priv->mii.using_1000) { ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SF_BIT)); ++ } else { ++ dma_reg_clear_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SF_BIT)); ++ } ++#else // CONFIG_HIPOX_VERSION_0X800 ++ // GMAC requires store&forward in order to compute Tx checksums ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_SF_BIT)); ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++ // Ensure setup is complete, before enabling TX and RX ++ wmb(); ++ ++#ifdef CONFIG_LEON_COPRO ++ // Update the CoPro's parameters with the current MTU ++ priv->copro_params_.mtu_ = dev->mtu; ++ ++ // Only attempt to write to uncached/unbuffered shared parameter storage if ++ // CoPro is started and thus storage has been allocated ++ if (priv->shared_copro_params_) { ++ // Fill the CoPro parameter block ++ memcpy(priv->shared_copro_params_, &priv->copro_params_, sizeof(copro_params_t)); ++ } ++ ++ // Make sure the CoPro parameter block updates have made it to memory (which ++ // is uncached/unbuffered, so just compiler issues to overcome) ++ wmb(); ++ ++ // Tell the CoPro to re-read parameters ++ cmd_queue_result = -1; ++ while (cmd_queue_result) { ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_UPDATE_PARAMS, 0, copro_update_callback); ++ spin_unlock(&priv->cmd_que_lock_); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ ++ // Wait until the CoPro acknowledges that the update of parameters is complete ++ down_interruptible(&copro_update_semaphore); ++ ++ // Tell the CoPro to begin network offload operations ++ cmd_queue_result = -1; ++ while (cmd_queue_result) { ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_queue_result = cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_START, 0, copro_start_callback); ++ spin_unlock(&priv->cmd_que_lock_); ++ } ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ ++ // Wait until the CoPro acknowledges that it has started ++ down_interruptible(&copro_start_semaphore); ++#endif // CONFIG_LEON_COPRO ++ ++ // Start NAPI ++ napi_enable(&priv->napi_struct); ++ ++ // Start the transmitter and receiver ++#ifndef CONFIG_LEON_OFFLOAD_TX ++ dma_reg_set_mask(priv, DMA_OP_MODE_REG, (1UL << DMA_OP_MODE_ST_BIT)); ++#endif // !LEON_OFFLOAD_TX ++ change_rx_enable(priv, 1, 0, 0); ++ ++ // Enable interesting GMAC interrupts ++ gmac_int_en_set(priv, ((1UL << DMA_INT_ENABLE_NI_BIT) | ++ (1UL << DMA_INT_ENABLE_AI_BIT) | ++ (1UL << DMA_INT_ENABLE_FBE_BIT) | ++ (1UL << DMA_INT_ENABLE_RI_BIT) | ++ (1UL << DMA_INT_ENABLE_RU_BIT) | ++ (1UL << DMA_INT_ENABLE_OV_BIT) | ++ (1UL << DMA_INT_ENABLE_RW_BIT) | ++ (1UL << DMA_INT_ENABLE_RS_BIT) | ++ (1UL << DMA_INT_ENABLE_TI_BIT) | ++ (1UL << DMA_INT_ENABLE_UN_BIT) | ++ (1UL << DMA_INT_ENABLE_TJ_BIT) | ++ (1UL << DMA_INT_ENABLE_TS_BIT))); ++ ++ // (Re)start the link/PHY state monitoring timer ++ start_watchdog_timer(priv); ++ ++ // Allow the network stack to call hard_start_xmit() ++ netif_start_queue(dev); ++ ++#ifdef DUMP_REGS_ON_GMAC_UP ++ dump_mac_regs(priv->macBase, priv->dmaBase); ++#endif // DUMP_REGS_ON_GMAC_UP ++ ++ return status; ++ ++gmac_up_err_out: ++ stop(dev); ++ ++ return status; ++} ++ ++static void set_rx_packet_info(struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ int max_packet_buffer_size = dev->mtu + EXTRA_RX_SKB_SPACE; ++ ++ if (max_packet_buffer_size > max_descriptor_length()) { ++#ifndef RX_BUFFER_SIZE ++ priv->rx_buffer_size_ = max_packet_buffer_size; ++#else // !RX_BUFFER_SIZE ++ priv->rx_buffer_size_ = RX_BUFFER_SIZE; ++#endif // ! RX_BUFFER_SIZE ++ priv->rx_buffers_per_page = GMAC_ALLOC_SIZE / (priv->rx_buffer_size_ + NET_IP_ALIGN); ++ } else { ++ priv->rx_buffer_size_ = max_packet_buffer_size; ++ priv->rx_buffers_per_page = 0; ++ } ++} ++ ++static int change_mtu(struct net_device *dev, int new_mtu) ++{ ++ int status = 0; ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ int original_mtu = dev->mtu; ++ ++ // Check that new MTU is within supported range ++ if ((new_mtu < MIN_PACKET_SIZE) || (new_mtu > MAX_JUMBO)) { ++ DBG(1, KERN_WARNING "change_mtu() %s: Invalid MTU %d\n", dev->name, new_mtu); ++ status = -EINVAL; ++ } else { ++ // Put MAC/PHY into quiesent state, causing all current buffers to be ++ // deallocated and the PHY to powerdown ++ gmac_down(dev); ++ ++ // Record the new MTU, so bringing the MAC back up will allocate ++ // resources to suit the new MTU ++ dev->mtu = new_mtu; ++ ++ // Set length etc. of rx packets ++ set_rx_packet_info(dev); ++ ++ // Reset the PHY to get it into a known state and ensure we have TX/RX ++ // clocks to allow the GMAC reset to complete ++ if (phy_reset(priv->netdev)) { ++ DBG(1, KERN_ERR "change_mtu() %s: Failed to reset PHY\n", dev->name); ++ status = -EIO; ++ } else { ++ // Set PHY specfic features ++ initialise_phy(priv); ++ ++ // Record whether jumbo frames should be enabled ++ priv->jumbo_ = (dev->mtu > NORMAL_PACKET_SIZE); ++ ++ // Force or auto-negotiate PHY mode ++ priv->phy_force_negotiation = 1; ++ ++ // Reallocate buffers with new MTU ++ gmac_up(dev); ++ } ++ } ++ ++ // If there was a failure ++ if (status) { ++ // Return the MTU to its original value ++ DBG(1, KERN_INFO "change_mtu() Failed, returning MTU to original value\n"); ++ dev->mtu = original_mtu; ++ } ++ ++ return status; ++} ++ ++#ifdef TEST_COPRO ++DECLARE_MUTEX_LOCKED(start_sem); ++DECLARE_MUTEX_LOCKED(heartbeat_sem); ++ ++void start_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ printk("START callback, operand = 0x%08x\n", entry->operand_); ++ up(&start_sem); ++} ++ ++void heartbeat_callback(volatile gmac_cmd_que_ent_t* entry) ++{ ++ printk("Heartbeat callback, operand = 0x%08x\n", entry->operand_); ++ up(&heartbeat_sem); ++} ++ ++static void test_copro(gmac_priv_t* priv) ++{ ++ unsigned long irq_flags; ++ ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_STOP, 0, 0); ++ spin_unlock(&priv->cmd_que_lock_); ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ mdelay(500); ++ ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_START, 0, start_callback); ++ spin_unlock(&priv->cmd_que_lock_); ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ mdelay(500); ++ ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_HEARTBEAT, 0, heartbeat_callback); ++ spin_unlock(&priv->cmd_que_lock_); ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ mdelay(500); ++ ++ printk("Waiting for start ack...\n"); ++ down_interruptible(&start_sem); ++ printk("Start ack received\n"); ++ ++ printk("Waiting for heartbeat ack...\n"); ++ down_interruptible(&heartbeat_sem); ++ printk("Heartbeat ack received\n"); ++} ++#endif // TEST_COPRO ++ ++#ifdef CONFIG_LEON_COPRO ++#define SEM_INT_FWD 8 ++#define SEM_INT_ACK 16 ++#define SEM_INT_TX 17 ++#define SEM_INT_STOP_ACK 18 ++ ++#define SEM_INTA_MASK (1UL << SEM_INT_FWD) ++#define SEM_INTB_MASK ((1UL << SEM_INT_ACK) | (1UL << SEM_INT_TX) | (1UL << SEM_INT_STOP_ACK)) ++ ++static irqreturn_t copro_sema_intr(int irq, void *dev_id) ++{ ++ struct net_device *dev = (struct net_device *)dev_id; ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ u32 asserted; ++ u32 fwd_intrs_status = 0; ++ int is_fwd_intr; ++ ++ // Read the contents of semaphore A register ++ asserted = (*((volatile unsigned long*)SYS_CTRL_SEMA_STAT) & SEM_INTA_MASK); ++ ++ while (asserted) { ++ // Extract any forwarded interrupts info ++ is_fwd_intr = asserted & (1UL << SEM_INT_FWD); ++ if (is_fwd_intr) { ++ fwd_intrs_status = ((volatile gmac_fwd_intrs_t*)descriptors_phys_to_virt(priv->copro_params_.fwd_intrs_mailbox_))->status_; ++ } ++ ++ // Clear any interrupts directed at the ARM ++ *((volatile unsigned long*)SYS_CTRL_SEMA_CLR_CTRL) = asserted; ++ ++ if (is_fwd_intr) { ++ // Process any forwarded GMAC interrupts ++ copro_fwd_intrs_handler(dev_id, fwd_intrs_status); ++ } ++ ++ // Stay in interrupt routine if interrupt has been re-asserted ++ asserted = (*((volatile unsigned long*)SYS_CTRL_SEMA_STAT) & SEM_INTA_MASK); ++ } ++ ++ return IRQ_HANDLED; ++} ++ ++static irqreturn_t copro_semb_intr(int irq, void *dev_id) ++{ ++ struct net_device *dev = (struct net_device *)dev_id; ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ u32 asserted; ++ ++ // Read the contents of semaphore B register ++ asserted = (*((volatile unsigned long*)SYS_CTRL_SEMA_STAT) & SEM_INTB_MASK); ++ ++ while (asserted) { ++ // Clear any interrupts directed at the ARM ++ *((volatile unsigned long*)SYS_CTRL_SEMA_CLR_CTRL) = asserted; ++ ++ // Process any outstanding command acknowledgements ++ if (asserted & (1UL << SEM_INT_ACK)) { ++ while (!cmd_que_dequeue_ack(&priv->cmd_queue_)); ++ } ++ ++ // Process STOP completion signal ++ if (asserted & (1UL << SEM_INT_STOP_ACK)) { ++ up(&priv->copro_stop_complete_semaphore_); ++ } ++ ++#ifdef CONFIG_LEON_OFFLOAD_TX ++ // Process any completed TX offload jobs ++ if (asserted & (1UL << SEM_INT_TX)) { ++ finish_xmit(dev); ++ } ++#endif // CONFIG_LEON_OFFLOAD_TX ++ ++ // Stay in interrupt routine if interrupt has been re-asserted ++ asserted = (*((volatile unsigned long*)SYS_CTRL_SEMA_STAT) & SEM_INTB_MASK); ++ } ++ ++ return IRQ_HANDLED; ++} ++#endif // CONFIG_LEON_COPRO ++ ++static int open(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ int status; ++ ++ // Ensure the MAC block is properly reset ++ writel(1UL << SYS_CTRL_RSTEN_MAC_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_MAC_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Enable the clock to the MAC block ++ writel(1UL << SYS_CTRL_CKEN_MAC_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Ensure reset and clock operations are complete ++ wmb(); ++ ++ // Reset the PHY to get it into a known state and ensure we have TX/RX clocks ++ // to allow the GMAC reset to complete ++ if (phy_reset(priv->netdev)) { ++ DBG(1, KERN_ERR "open() %s: Failed to reset PHY\n", dev->name); ++ status = -EIO; ++ goto open_err_out; ++ } ++ ++ // Set PHY specfic features ++ initialise_phy(priv); ++ ++ // Check that the MAC address is valid. If it's not, refuse to bring the ++ // device up ++ if (!is_valid_ether_addr(dev->dev_addr)) { ++ DBG(1, KERN_ERR "open() %s: MAC address invalid\n", dev->name); ++ status = -EINVAL; ++ goto open_err_out; ++ } ++ ++#ifdef CONFIG_LEON_COPRO ++ // Register ISRs for the semaphore register interrupt sources, which will ++ // originate from the CoPro ++ if (request_irq(priv->copro_a_irq_, &copro_sema_intr, 0, "SEMA", dev)) { ++ panic("open: Failed to allocate semaphore A %u\n", priv->copro_a_irq_); ++ status = -ENODEV; ++ goto open_err_out; ++ } ++ priv->copro_a_irq_alloced_ = 1; ++ ++ if (request_irq(priv->copro_b_irq_, &copro_semb_intr, 0, "SEMB", dev)) { ++ panic("open: Failed to allocate semaphore B %u\n", priv->copro_b_irq_); ++ status = -ENODEV; ++ goto open_err_out; ++ } ++ priv->copro_b_irq_alloced_ = 1; ++#else // CONFIG_LEON_COPRO ++ // Allocate the IRQ ++ if (request_irq(dev->irq, &int_handler, 0, dev->name, dev)) { ++ DBG(1, KERN_ERR "open() %s: Failed to allocate irq %d\n", dev->name, dev->irq); ++ status = -ENODEV; ++ goto open_err_out; ++ } ++ priv->have_irq = 1; ++#endif // CONFIG_LEON_COPRO ++ ++ // Need a consistent DMA mapping covering all the memory occupied by DMA ++ // unified descriptor array, as both CPU and DMA engine will be reading and ++ // writing descriptor fields. ++ priv->desc_vaddr = (gmac_dma_desc_t*)GMAC_DESC_ALLOC_START; ++ priv->desc_dma_addr = GMAC_DESC_ALLOC_START_PA; ++ ++ if (!priv->desc_vaddr) { ++ DBG(1, KERN_ERR "open() %s: Failed to allocate consistent memory for DMA descriptors\n", dev->name); ++ status = -ENOMEM; ++ goto open_err_out; ++ } ++ ++ // Allocate memory to hold shadow of GMAC descriptors ++ if (!(priv->tx_desc_shadow_ = kmalloc(NUM_TX_DMA_DESCRIPTORS * sizeof(gmac_dma_desc_t), GFP_KERNEL))) { ++ DBG(1, KERN_ERR "open() %s: Failed to allocate memory for Tx descriptor shadows\n", dev->name); ++ status = -ENOMEM; ++ goto open_err_out; ++ } ++ if (!(priv->rx_desc_shadow_ = kmalloc(NUM_RX_DMA_DESCRIPTORS * sizeof(gmac_dma_desc_t), GFP_KERNEL))) { ++ DBG(1, KERN_ERR "open() %s: Failed to allocate memory for Rx descriptor shadows\n", dev->name); ++ status = -ENOMEM; ++ goto open_err_out; ++ } ++ ++ // Record whether jumbo frames should be enabled ++ priv->jumbo_ = (dev->mtu > NORMAL_PACKET_SIZE); ++ ++ set_rx_packet_info(dev); ++ ++#ifdef CONFIG_LEON_COPRO ++ // Allocate SRAM for the command queue entries ++ priv->copro_params_.cmd_que_head_ = DESCRIPTORS_BASE_PA + DESCRIPTORS_SIZE; ++ ++ priv->copro_params_.cmd_que_tail_ = ++ (u32)((gmac_cmd_que_ent_t*)(priv->copro_params_.cmd_que_head_) + priv->copro_cmd_que_num_entries_); ++ priv->copro_params_.fwd_intrs_mailbox_ = priv->copro_params_.cmd_que_tail_; ++ priv->copro_params_.tx_que_head_ = priv->copro_params_.fwd_intrs_mailbox_ + sizeof(gmac_fwd_intrs_t); ++ priv->copro_params_.tx_que_tail_ = ++ (u32)((gmac_tx_que_ent_t*)(priv->copro_params_.tx_que_head_) + priv->copro_tx_que_num_entries_); ++ priv->copro_params_.free_start_ = priv->copro_params_.tx_que_tail_; ++ ++ // Set RX interrupt mitigation behaviour ++ priv->copro_params_.rx_mitigation_ = COPRO_RX_MITIGATION; ++ priv->copro_params_.rx_mitigation_frames_ = COPRO_RX_MITIGATION_FRAMES; ++ priv->copro_params_.rx_mitigation_usec_ = COPRO_RX_MITIGATION_USECS; ++ ++ // Initialise command queue metadata ++ cmd_que_init( ++ &priv->cmd_queue_, ++ (gmac_cmd_que_ent_t*)descriptors_phys_to_virt(priv->copro_params_.cmd_que_head_), ++ priv->copro_cmd_que_num_entries_); ++ ++ // Initialise tx offload queue metadata ++ tx_que_init( ++ &priv->tx_queue_, ++ (gmac_tx_que_ent_t*)descriptors_phys_to_virt(priv->copro_params_.tx_que_head_), ++ priv->copro_tx_que_num_entries_); ++ ++ // Allocate DMA coherent space for the parameter block shared with the CoPro ++ priv->shared_copro_params_ = dma_alloc_coherent(0, sizeof(copro_params_t), &priv->shared_copro_params_pa_, GFP_KERNEL); ++ if (!priv->shared_copro_params_) { ++ DBG(1, KERN_ERR "open() %s: Failed to allocate DMA coherent space for parameters\n"); ++ status = -ENOMEM; ++ goto open_err_out; ++ } ++ ++ // Update the CoPro's parameters with the current MTU ++ priv->copro_params_.mtu_ = dev->mtu; ++ ++ // Fill the shared CoPro parameter block from the ARM's local copy ++ memcpy(priv->shared_copro_params_, &priv->copro_params_, sizeof(copro_params_t)); ++ ++ // Load CoPro program and start it running ++ init_copro(leon_srec, priv->shared_copro_params_pa_); ++ ++ // Enable selected semaphore register bits to cause ARM interrupts ++ *((volatile unsigned long*)SYS_CTRL_SEMA_MASKA_CTRL) = SEM_INTA_MASK; ++ *((volatile unsigned long*)SYS_CTRL_SEMA_MASKB_CTRL) = SEM_INTB_MASK; ++ ++#ifdef TEST_COPRO ++ // Send test commands to the CoPro ++ test_copro(priv); ++#endif // TEST_COPRO ++#endif // CONFIG_LEON_COPRO ++ ++ // Do startup operations that are in common with gmac_down()/_up() processing ++ priv->mii_init_media = 1; ++ priv->phy_force_negotiation = 1; ++ status = gmac_up(dev); ++ if (status) { ++ goto open_err_out; ++ } ++ ++ return 0; ++ ++open_err_out: ++ stop(dev); ++ ++ return status; ++} ++ ++#if defined(CONFIG_LEON_COPRO) && defined(CONFIG_LEON_OFFLOAD_TX) ++static int hard_start_xmit( ++ struct sk_buff *skb, ++ struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ volatile gmac_tx_que_ent_t *job; ++ unsigned long irq_flags; ++ ++ if (skb_shinfo(skb)->frag_list) { ++ panic("Frag list - can't handle this!\n"); ++ } ++ ++ // Protection against concurrent operations in ISR and hard_start_xmit() ++ if (!spin_trylock_irqsave(&priv->tx_spinlock_, irq_flags)) { ++ return NETDEV_TX_LOCKED; ++ } ++ ++ // NETIF_F_LLTX apparently introduces a potential for hard_start_xmit() to ++ // be called when the queue has been stopped (although I think only in SMP) ++ // so do a check here to make sure we should proceed ++ if (netif_queue_stopped(dev)) { ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_flags); ++ return NETDEV_TX_BUSY; ++ } ++ ++ job = tx_que_get_idle_job(dev); ++ if (!job) { ++ // Tx offload queue is full, so add skb to pending skb list ++ list_add_tail((struct list_head*)&skb->cb, &priv->copro_tx_skb_list_); ++ ++ // Keep track of how many entries are in the pending SKB list ++ ++priv->copro_tx_skb_list_count_; ++ ++ // Have we queued the max allowed number of SKBs? ++ if (priv->copro_tx_skb_list_count_ >= COPRO_MAX_QUEUED_TX_SKBS) { ++ // Stop further calls to hard_start_xmit() until some descriptors ++ // are freed up by already queued TX packets being completed ++ netif_stop_queue(dev); ++ } ++ } else { ++ if (priv->copro_tx_skb_list_count_) { ++ // Have queued pending SKBs, so add new SKB to tail of pending list ++ list_add_tail((struct list_head*)&skb->cb, &priv->copro_tx_skb_list_); ++ ++ // Keep track of how many entries are in the pending SKB list ++ ++priv->copro_tx_skb_list_count_; ++ ++ // Process pending SKBs, oldest first ++ copro_process_pending_tx_skbs(dev, job); ++ } else { ++ // Fill the Tx offload job with the network packet's details ++ copro_fill_tx_job(job, skb); ++ ++ // Enqueue the new Tx offload job with the CoPro ++ tx_que_new_job(dev, job); ++ } ++ ++ // Record start of transmission, so timeouts will work once they're ++ // implemented ++ dev->trans_start = jiffies; ++ ++ // Interrupt the CoPro to cause it to examine the Tx offload queue ++ wmb(); ++ writel(1UL << COPRO_SEM_INT_TX, SYS_CTRL_SEMA_SET_CTRL); ++ ++ // If the network stack's Tx queue was stopped and we now have resources ++ // to process more Tx offload jobs ++ if (netif_queue_stopped(dev) && ++ !tx_que_is_full(&priv->tx_queue_) && ++ !priv->copro_tx_skb_list_count_) { ++ // Restart the network stack's TX queue ++ netif_wake_queue(dev); ++ } ++ } ++ ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_flags); ++ ++ return NETDEV_TX_OK; ++} ++#else ++static inline void unmap_fragments( ++ tx_frag_info_t *frags, ++ int count) ++{ ++ while (count--) { ++ dma_unmap_single(0, frags->phys_adr, frags->length, DMA_TO_DEVICE); ++ ++frags; ++ } ++} ++ ++static int hard_start_xmit( ++ struct sk_buff *skb, ++ struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long irq_flags; ++ struct skb_shared_info *shinfo = skb_shinfo(skb); ++ int fragment_count = shinfo->nr_frags + 1; ++ tx_frag_info_t fragments[fragment_count]; ++ int frag_index; ++ ++ // Get consistent DMA mappings for the SDRAM to be DMAed from by the GMAC, ++ // causing a flush from the CPU's cache to the memory. ++ ++ // Do the DMA mappings before acquiring the tx lock, even though it complicates ++ // the later code, as this can be a long operation involving cache flushing ++ ++ // Map the main buffer ++ fragments[0].length = skb_headlen(skb); ++ fragments[0].phys_adr = dma_map_single(0, skb->data, skb_headlen(skb), DMA_TO_DEVICE); ++ BUG_ON(dma_mapping_error(fragments[0].phys_adr)); ++ ++ // Map any SG fragments ++ for (frag_index = 0; frag_index < shinfo->nr_frags; ++frag_index) { ++ skb_frag_t *frag = &shinfo->frags[frag_index]; ++ ++ fragments[frag_index + 1].length = frag->size; ++ fragments[frag_index + 1].phys_adr = dma_map_page(0, frag->page, frag->page_offset, frag->size, DMA_TO_DEVICE); ++ BUG_ON(dma_mapping_error(fragments[frag_index + 1].phys_adr)); ++ } ++ ++ // Protection against concurrent operations in ISR and hard_start_xmit() ++ if (unlikely(!spin_trylock_irqsave(&priv->tx_spinlock_, irq_flags))) { ++ unmap_fragments(fragments, fragment_count); ++ return NETDEV_TX_LOCKED; ++ } ++ ++ // NETIF_F_LLTX apparently introduces a potential for hard_start_xmit() to ++ // be called when the queue has been stopped (although I think only in SMP) ++ // so do a check here to make sure we should proceed ++ if (unlikely(netif_queue_stopped(dev))) { ++ unmap_fragments(fragments, fragment_count); ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_flags); ++ return NETDEV_TX_BUSY; ++ } ++ ++ // Construct the GMAC DMA descriptor ++ if (unlikely(set_tx_descriptor(priv, ++ skb, ++ fragments, ++ fragment_count, ++ skb->ip_summed == CHECKSUM_PARTIAL) < 0)) { ++ // Shouldn't see a full ring without the queue having already been ++ // stopped, and the queue should already have been stopped if we have ++ // already queued a single pending packet ++ if (priv->tx_pending_skb) { ++ printk(KERN_WARNING "hard_start_xmit() Ring full and pending packet already queued\n"); ++ unmap_fragments(fragments, fragment_count); ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_flags); ++ return NETDEV_TX_BUSY; ++ } ++ ++ // Should keep a record of the skb that we haven't been able to queue ++ // for transmission and queue it as soon as a descriptor becomes free ++ priv->tx_pending_skb = skb; ++ priv->tx_pending_fragment_count = fragment_count; ++ ++ // Copy the fragment info to the allocated storage ++ memcpy(priv->tx_pending_fragments, fragments, sizeof(tx_frag_info_t) * fragment_count); ++ ++ // Stop further calls to hard_start_xmit() until some descriptors are ++ // freed up by already queued TX packets being completed ++ netif_stop_queue(dev); ++ } else { ++ // Record start of transmission, so timeouts will work once they're ++ // implemented ++ dev->trans_start = jiffies; ++ ++ // Poke the transmitter to look for available TX descriptors, as we have ++ // just added one, in case it had previously found there were no more ++ // pending transmission ++ dma_reg_write(priv, DMA_TX_POLL_REG, 0); ++ } ++ ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_flags); ++ ++ return NETDEV_TX_OK; ++} ++#endif // CONFIG_LEON_COPRO && CONFIG_LEON_OFFLOAD_TX ++ ++static struct net_device_stats *get_stats(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ return &priv->stats; ++} ++ ++#ifdef CONFIG_NET_POLL_CONTROLLER ++/** ++ * Polling 'interrupt' - used by things like netconsole to send skbs without ++ * having to re-enable interrupts. It's not called while the interrupt routine ++ * is executing. ++ */ ++static void netpoll(struct net_device *netdev) ++{ ++ disable_irq(netdev->irq); ++ int_handler(netdev->irq, netdev, NULL); ++ enable_irq(netdev->irq); ++} ++#endif // CONFIG_NET_POLL_CONTROLLER ++ ++static int probe( ++ struct net_device *netdev, ++ u32 vaddr, ++ u32 irq, ++ int copro_a_irq, ++ int copro_b_irq) ++{ ++ int err = 0; ++ u32 version; ++ int i; ++ unsigned synopsis_version; ++ unsigned vendor_version; ++ gmac_priv_t* priv = netdev_priv(netdev); ++ u32 reg_contents; ++ ++ // Ensure the MAC block is properly reset ++ writel(1UL << SYS_CTRL_RSTEN_MAC_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_MAC_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Enable the clock to the MAC block ++ writel(1UL << SYS_CTRL_CKEN_MAC_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Ensure reset and clock operations are complete ++ wmb(); ++ ++ // Ensure all of the device private data are zero, so we can clean up in ++ // the event of a later failure to initialise all fields ++ priv = (gmac_priv_t*)netdev_priv(netdev); ++ memset(priv, 0, sizeof(gmac_priv_t)); ++ ++ // No debug messages allowed ++ priv->msg_level = 0UL; ++ ++ // Initialise the ISR/hard_start_xmit() lock ++ spin_lock_init(&priv->tx_spinlock_); ++ ++ // Initialise the PHY access lock ++ spin_lock_init(&priv->phy_lock); ++ ++ // Set hardware device base addresses ++ priv->macBase = vaddr + MAC_BASE_OFFSET; ++ priv->dmaBase = vaddr + DMA_BASE_OFFSET; ++ ++ // Initialise IRQ ownership to not owned ++ priv->have_irq = 0; ++ ++ // Lock protecting access to CoPro command queue functions or direct access ++ // to the GMAC interrupt enable register if CoPro is not in use ++ spin_lock_init(&priv->cmd_que_lock_); ++ ++#ifdef CONFIG_LEON_COPRO ++ sema_init(&copro_stop_semaphore, 0); ++ sema_init(&copro_start_semaphore, 0); ++ sema_init(&copro_int_clr_semaphore, 0); ++ sema_init(&copro_update_semaphore, 0); ++ sema_init(&copro_rx_enable_semaphore, 0); ++ priv->copro_a_irq_alloced_ = 0; ++ priv->copro_b_irq_alloced_ = 0; ++ sema_init(&priv->copro_stop_complete_semaphore_, 0); ++ INIT_LIST_HEAD(&priv->copro_tx_skb_list_); ++ priv->copro_tx_skb_list_count_ = 0; ++#endif // CONFIG_LEON_COPRO ++ ++ init_timer(&priv->watchdog_timer); ++ priv->watchdog_timer.function = &watchdog_timer_action; ++ priv->watchdog_timer.data = (unsigned long)priv; ++ ++ // Set pointer to device in private data ++ priv->netdev = netdev; ++ ++ /** Do something here to detect the present or otherwise of the MAC ++ * Read the version register as a first test */ ++ version = mac_reg_read(priv, MAC_VERSION_REG); ++ synopsis_version = version & 0xff; ++ vendor_version = (version >> 8) & 0xff; ++ ++ /** Assume device is at the adr and irq specified until have probing working */ ++ netdev->base_addr = vaddr; ++ netdev->irq = irq; ++#ifdef CONFIG_LEON_COPRO ++ priv->copro_a_irq_ = copro_a_irq; ++ priv->copro_b_irq_ = copro_b_irq; ++#endif // CONFIG_LEON_COPRO ++ ++#ifdef CONFIG_LEON_COPRO ++ // Allocate the CoPro A IRQ ++ err = request_irq(priv->copro_a_irq_, &copro_sema_intr, 0, "SEMA", netdev); ++ if (err) { ++ DBG(1, KERN_ERR "probe() %s: Failed to allocate CoPro irq A (%d)\n", netdev->name, priv->copro_a_irq_); ++ goto probe_err_out; ++ } ++ // Release the CoPro A IRQ again, as open()/stop() should manage IRQ ownership ++ free_irq(priv->copro_a_irq_, netdev); ++ ++ // Allocate the CoPro B IRQ ++ err = request_irq(priv->copro_b_irq_, &copro_semb_intr, 0, "SEMB", netdev); ++ if (err) { ++ DBG(1, KERN_ERR "probe() %s: Failed to allocate CoPro irq B (%d)\n", netdev->name, priv->copro_b_irq_); ++ goto probe_err_out; ++ } ++ // Release the CoPro B IRQ again, as open()/stop() should manage IRQ ownership ++ free_irq(priv->copro_b_irq_, netdev); ++#else // CONFIG_LEON_COPRO ++ // Allocate the IRQ ++ err = request_irq(netdev->irq, &int_handler, 0, netdev->name, netdev); ++ if (err) { ++ DBG(1, KERN_ERR "probe() %s: Failed to allocate irq %d\n", netdev->name, netdev->irq); ++ goto probe_err_out; ++ } ++ ++ // Release the IRQ again, as open()/stop() should manage IRQ ownership ++ free_irq(netdev->irq, netdev); ++#endif // CONFIG_LEON_COPRO ++ ++ // Initialise the ethernet device with std. contents ++ ether_setup(netdev); ++ ++ // Tell the kernel of our MAC address ++ for (i = 0; i < netdev->addr_len; i++) { ++ netdev->dev_addr[i] = (unsigned char)mac_adr[i]; ++ } ++ ++ // Setup operations pointers ++ netdev->open = &open; ++ netdev->hard_start_xmit = &hard_start_xmit; ++ netdev->stop = &stop; ++ netdev->get_stats = &get_stats; ++ netdev->change_mtu = &change_mtu; ++#ifdef CONFIG_NET_POLL_CONTROLLER ++ netdev->poll_controller = &netpoll; ++#endif // CONFIG_NET_POLL_CONTROLLER ++ netdev->set_mac_address = &set_mac_address; ++ netdev->set_multicast_list = &set_multicast_list; ++ ++ // Initialise NAPI support ++ netif_napi_add(netdev, &priv->napi_struct, &poll, NAPI_POLL_WEIGHT); ++ ++ set_ethtool_ops(netdev); ++ ++ if (debug) { ++ netdev->flags |= IFF_DEBUG; ++ } ++ ++#if defined(CONFIG_LEON_COPRO) && defined(CONFIG_LEON_OFFLOAD_TSO) ++ // Do TX H/W checksum and SG list processing ++ netdev->features |= NETIF_F_HW_CSUM; ++ netdev->features |= NETIF_F_SG; ++ ++ // Do hardware TCP/IP Segmentation Offload ++ netdev->features |= NETIF_F_TSO; ++#elif !defined(CONFIG_LEON_COPRO) && !defined(CONFIG_HIPOX_VERSION_0X800) ++ // Do TX H/W checksum and SG list processing ++ netdev->features |= NETIF_F_HW_CSUM; ++ netdev->features |= NETIF_F_SG; ++#endif // USE_TX_CSUM ++ ++ // We take care of our own TX locking ++ netdev->features |= NETIF_F_LLTX; ++ ++ // Initialise PHY support ++ priv->mii.phy_id_mask = 0x1f; ++ priv->mii.reg_num_mask = 0x1f; ++ priv->mii.force_media = 0; ++ priv->mii.full_duplex = 1; ++ priv->mii.using_100 = 0; ++ priv->mii.using_1000 = 1; ++ priv->mii.using_pause = 1; ++ priv->mii.dev = netdev; ++ priv->mii.mdio_read = phy_read; ++ priv->mii.mdio_write = phy_write; ++ ++ priv->gmii_csr_clk_range = 5; // Slowest for now ++ ++ // Use simple mux for 25/125 Mhz clock switching and ++ // enable GMII_GTXCLK to follow GMII_REFCLK - required for gigabit PHY ++ reg_contents = readl(SYS_CTRL_GMAC_CTRL); ++ reg_contents |= ((1UL << SYS_CTRL_GMAC_SIMPLE_MAX) | ++ (1UL << SYS_CTRL_GMAC_CKEN_GTX)); ++ writel(reg_contents, SYS_CTRL_GMAC_CTRL); ++ ++ // Remember whether auto-negotiation is allowed ++#ifdef ALLOW_AUTONEG ++ priv->ethtool_cmd.autoneg = 1; ++ priv->ethtool_pauseparam.autoneg = 1; ++#else // ALLOW_AUTONEG ++ priv->ethtool_cmd.autoneg = 0; ++ priv->ethtool_pauseparam.autoneg = 0; ++#endif // ALLOW_AUTONEG ++ ++ // Set up PHY mode for when auto-negotiation is not allowed ++ priv->ethtool_cmd.speed = SPEED_1000; ++ priv->ethtool_cmd.duplex = DUPLEX_FULL; ++ priv->ethtool_cmd.port = PORT_MII; ++ priv->ethtool_cmd.transceiver = XCVR_INTERNAL; ++ ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ // We can support both reception and generation of pause frames ++ priv->ethtool_pauseparam.rx_pause = 1; ++ priv->ethtool_pauseparam.tx_pause = 1; ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ++ // Initialise the set of features we would like to advertise as being ++ // available for negotiation ++ priv->ethtool_cmd.advertising = (ADVERTISED_10baseT_Half | ++ ADVERTISED_10baseT_Full | ++ ADVERTISED_100baseT_Half | ++ ADVERTISED_100baseT_Full | ++#if !defined(CONFIG_HIPOX_VERSION_0X800) || defined(ALLOW_OX800_1000M) ++ ADVERTISED_1000baseT_Half | ++ ADVERTISED_1000baseT_Full | ++ ADVERTISED_Pause | ++ ADVERTISED_Asym_Pause | ++#endif ++ ADVERTISED_Autoneg | ++ ADVERTISED_MII); ++ ++ // Attempt to locate the PHY ++ phy_detect(netdev); ++ priv->ethtool_cmd.phy_address = priv->mii.phy_id; ++ ++ // Did we find a PHY? ++ if (priv->phy_type == PHY_TYPE_NONE) { ++ printk(KERN_WARNING "%s: No PHY found\n", netdev->name); ++ err = ENXIO; ++ goto probe_err_out; ++ } ++ ++ // Setup the PHY ++ initialise_phy(priv); ++ ++ // Find out what modes the PHY supports ++ priv->ethtool_cmd.supported = get_phy_capabilies(priv); ++#if defined(CONFIG_HIPOX_VERSION_0X800) && !defined(ALLOW_OX800_1000M) ++ // OX800 has broken 1000M support in the MAC ++ priv->ethtool_cmd.supported &= ~(SUPPORTED_1000baseT_Full | SUPPORTED_1000baseT_Half); ++#endif ++ ++ // Register the device with the network intrastructure ++ err = register_netdev(netdev); ++ if (err) { ++ DBG(1, KERN_ERR "probe() %s: Failed to register device\n", netdev->name); ++ goto probe_err_out; ++ } ++ ++ // Record details about the hardware we found ++ printk(KERN_NOTICE "%s: GMAC ver = %u, vendor ver = %u at 0x%lx, IRQ %d\n", netdev->name, synopsis_version, vendor_version, netdev->base_addr, netdev->irq); ++#ifndef ARMULATING ++ printk(KERN_NOTICE "%s: Found PHY at address %u, type 0x%08x -> %s\n", priv->netdev->name, priv->phy_addr, priv->phy_type, (priv->ethtool_cmd.supported & SUPPORTED_1000baseT_Full) ? "10/100/1000" : "10/100"); ++#endif // !ARMULATING ++ printk(KERN_NOTICE "%s: Ethernet addr: ", priv->netdev->name); ++ for (i = 0; i < 5; i++) { ++ printk("%02x:", netdev->dev_addr[i]); ++ } ++ printk("%02x\n", netdev->dev_addr[5]); ++ ++#ifdef CONFIG_LEON_COPRO ++ // Define sizes of queues for communicating with the CoPro ++ priv->copro_cmd_que_num_entries_ = COPRO_CMD_QUEUE_NUM_ENTRIES; ++ priv->copro_tx_que_num_entries_ = COPRO_TX_QUEUE_NUM_ENTRIES; ++#endif // CONFIG_LEON_COPRO ++ ++ // Initialise sysfs for link state reporting ++ err = gmac_link_state_init_sysfs(priv); ++ if (err) { ++ DBG(1, KERN_ERR "probe() %s: Failed to initialise sysfs support\n", netdev->name); ++ goto probe_err_out; ++ } ++ ++ // Initialise the work queue entry to be used to issue hotplug events to userspace ++ INIT_WORK(&priv->link_state_change_work, work_handler); ++ ++ return 0; ++ ++probe_err_out: ++#ifdef CONFIG_LEON_COPRO ++ shutdown_copro(); ++ ++ if (priv->shared_copro_params_) { ++ // Free the DMA coherent parameter space ++ dma_free_coherent(0, sizeof(copro_params_t), priv->shared_copro_params_, priv->shared_copro_params_pa_); ++ priv->shared_copro_params_ = 0; ++ } ++#endif // CONFIG_LEON_COPRO ++ ++ // Disable the clock to the MAC block ++ writel(1UL << SYS_CTRL_CKEN_MAC_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ return err; ++} ++ ++static int gmac_found_count = 0; ++static struct net_device* gmac_netdev[MAX_GMAC_UNITS]; ++ ++/** ++ * External entry point to the driver, called from Space.c to detect a card ++ */ ++struct net_device* __init synopsys_gmac_probe(int unit) ++{ ++ int err = 0; ++ struct net_device *netdev = alloc_etherdev(sizeof(gmac_priv_t)); ++ ++ printk(KERN_NOTICE "Probing for Synopsis GMAC, unit %d\n", unit); ++ ++ // Will allocate private data later, as may want descriptors etc in special memory ++ if (!netdev) { ++ printk(KERN_WARNING "synopsys_gmac_probe() failed to alloc device\n"); ++ err = -ENODEV; ++ } else { ++ if (unit >= 0) { ++ sprintf(netdev->name, "eth%d", unit); ++ ++ netdev_boot_setup_check(netdev); ++ ++ if (gmac_found_count >= MAX_GMAC_UNITS) { ++ err = -ENODEV; ++ } else { ++ err = probe(netdev, MAC_BASE, MAC_INTERRUPT, SEM_A_INTERRUPT, SEM_B_INTERRUPT); ++ if (err) { ++ printk(KERN_WARNING "synopsys_gmac_probe() Probing failed for %s\n", netdev->name); ++ } else { ++ ++gmac_found_count; ++ } ++ } ++ } ++ ++ if (err) { ++ netdev->reg_state = NETREG_UNREGISTERED; ++ free_netdev(netdev); ++ } else { ++ gmac_netdev[unit] = netdev; ++ } ++ } ++ ++ return ERR_PTR(err); ++} ++ ++static int __init gmac_module_init(void) ++{ ++ return (int)synopsys_gmac_probe(0); ++} ++module_init(gmac_module_init); ++ ++static void __exit gmac_module_cleanup(void) ++{ ++ int i; ++ for (i=0; i < gmac_found_count; i++) { ++ stop(gmac_netdev[i]); ++ gmac_netdev[i]->reg_state = NETREG_UNREGISTERED; ++ free_netdev(gmac_netdev[i]); ++ } ++} ++module_exit(gmac_module_cleanup); ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,194 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#if !defined(__GMAC_H__) ++#define __GMAC_H__ ++ ++#include <asm/semaphore.h> ++#include <asm/types.h> ++#include <linux/mii.h> ++#include <linux/netdevice.h> ++#include <linux/spinlock.h> ++#include <linux/workqueue.h> ++#include <linux/list.h> ++#include <linux/ethtool.h> ++#include <linux/kobject.h> ++#include <asm/arch/desc_alloc.h> ++#include <asm/arch/dma.h> ++#ifdef CONFIG_LEON_COPRO ++#include <asm/arch/leon.h> ++#include "gmac_offload.h" ++#endif // CONFIG_LEON_COPRO ++ ++#ifdef GMAC_DEBUG ++#define DBG(n, args...)\ ++ do {\ ++ if ((n) <= priv->msg_level)\ ++ printk(args);\ ++ } while (0) ++#else ++#define DBG(n, args...) do { } while(0) ++#endif ++ ++#define MS_TO_JIFFIES(x) (((x) < (1000/(HZ))) ? 1 : (x) * (HZ) / 1000) ++ ++#define USE_RX_CSUM ++//#define ARMULATING ++ ++typedef struct gmac_desc_list_info { ++ volatile gmac_dma_desc_t *base_ptr; ++ gmac_dma_desc_t *shadow_ptr; ++ int num_descriptors; ++ int empty_count; ++ int full_count; ++ int r_index; ++ int w_index; ++} gmac_desc_list_info_t; ++ ++#ifdef CONFIG_LEON_COPRO ++typedef struct copro_params { ++ u32 cmd_que_head_; ++ u32 cmd_que_tail_; ++ u32 fwd_intrs_mailbox_; ++ u32 tx_que_head_; ++ u32 tx_que_tail_; ++ u32 free_start_; ++ u32 mtu_; ++ u32 rx_mitigation_; ++ u32 rx_mitigation_frames_; ++ u32 rx_mitigation_usec_; ++} __attribute ((aligned(4),packed)) copro_params_t; ++#endif // CONFIG_LEON_COPRO ++ ++typedef struct tx_frag_info { ++ dma_addr_t phys_adr; ++ u16 length; ++} tx_frag_info_t; ++ ++// Private data structure for the GMAC driver ++typedef struct gmac_priv { ++ /** Base address of GMAC MAC registers */ ++ u32 macBase; ++ /** Base address of GMAC DMA registers */ ++ u32 dmaBase; ++ ++ struct net_device* netdev; ++ ++ struct net_device_stats stats; ++ ++ u32 msg_level; ++ ++ /** Whether we own an IRQ */ ++ int have_irq; ++ ++ /** Pointer to outstanding tx packet that has not yet been queued due to ++ * lack of descriptors */ ++ struct sk_buff *tx_pending_skb; ++ tx_frag_info_t tx_pending_fragments[18]; ++ int tx_pending_fragment_count; ++ ++ /** DMA consistent physical address of outstanding tx packet */ ++ dma_addr_t tx_pending_dma_addr; ++ unsigned long tx_pending_length; ++ ++ /** To synchronise ISR and thread TX activities' access to private data */ ++ spinlock_t tx_spinlock_; ++ ++ /** To synchronise access to the PHY */ ++ spinlock_t phy_lock; ++ ++ /** The timer for NAPI polling when out of memory when trying to fill RX ++ * descriptor ring */ ++ ++ /** PHY related info */ ++ struct mii_if_info mii; ++ struct ethtool_cmd ethtool_cmd; ++ struct ethtool_pauseparam ethtool_pauseparam; ++ u32 phy_addr; ++ u32 phy_type; ++ int gmii_csr_clk_range; ++ ++ /** Periodic timer to check link status etc */ ++ struct timer_list watchdog_timer; ++ volatile int watchdog_timer_shutdown; ++ ++ /** The number of descriptors in the gmac_dma_desc_t array holding both the TX and ++ * RX descriptors. The TX descriptors reside at the start of the array */ ++ unsigned total_num_descriptors; ++ /** The CPU accessible virtual address of the start of the descriptor array */ ++ gmac_dma_desc_t* desc_vaddr; ++ /** The hardware accessible physical address of the start of the descriptor array */ ++ dma_addr_t desc_dma_addr; ++ ++ /** Descriptor list management */ ++ gmac_desc_list_info_t tx_gmac_desc_list_info; ++ gmac_desc_list_info_t rx_gmac_desc_list_info; ++ ++ /** Record of disabling RX overflow interrupts */ ++ unsigned rx_overflow_ints_disabled; ++ ++ /** The result of the last H/W DMA generated checksum operation */ ++ u16 tx_csum_result_; ++ ++ /** Whether we deal in jumbo frames */ ++ int jumbo_; ++ ++ volatile int mii_init_media; ++ volatile int phy_force_negotiation; ++ ++#ifdef CONFIG_LEON_COPRO ++ /** DMA coherent memory for CoPro's parameter storage */ ++ copro_params_t *shared_copro_params_; ++ dma_addr_t shared_copro_params_pa_; ++ ++ /** ARM's local CoPro parameter storage */ ++ copro_params_t copro_params_; ++ ++ /** Queue for commands/acks to/from CoPro */ ++ int copro_a_irq_; ++ int copro_a_irq_alloced_; ++ int copro_b_irq_; ++ int copro_b_irq_alloced_; ++ cmd_que_t cmd_queue_; ++ tx_que_t tx_queue_; ++ int copro_cmd_que_num_entries_; ++ int copro_tx_que_num_entries_; ++ struct semaphore copro_stop_complete_semaphore_; ++ struct list_head copro_tx_skb_list_; ++ int copro_tx_skb_list_count_; ++#endif // CONFIG_LEON_COPRO ++ ++ spinlock_t cmd_que_lock_; ++ u32 rx_buffer_size_; ++ int rx_buffers_per_page; ++ ++ gmac_dma_desc_t *tx_desc_shadow_; ++ gmac_dma_desc_t *rx_desc_shadow_; ++ ++ struct napi_struct napi_struct; ++ ++ /** sysfs dir tree root for recovery button driver */ ++ struct kset link_state_kset; ++ struct kobject link_state_kobject; ++ struct work_struct link_state_change_work; ++ int link_state; ++} gmac_priv_t; ++ ++#endif // #if !defined(__GMAC_H__) ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_desc.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_desc.c +--- linux-2.6.24/arch/arm/mach-hipox/gmac_desc.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_desc.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,452 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_desc.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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/delay.h> ++ ++//#define GMAC_DEBUG ++#undef GMAC_DEBUG ++ ++#include "gmac.h" ++#include "gmac_desc.h" ++ ++void init_rx_desc_list( ++ gmac_desc_list_info_t *desc_list, ++ volatile gmac_dma_desc_t *base_ptr, ++ gmac_dma_desc_t *shadow_ptr, ++ int num_descriptors, ++ u16 rx_buffer_length) ++{ ++ int i; ++ ++ desc_list->base_ptr = base_ptr; ++ desc_list->shadow_ptr = shadow_ptr; ++ desc_list->num_descriptors = num_descriptors; ++ desc_list->empty_count = num_descriptors; ++ desc_list->full_count = 0; ++ desc_list->r_index = 0; ++ desc_list->w_index = 0; ++ ++ for (i=0; i < num_descriptors; ++i) { ++ gmac_dma_desc_t *shadow = shadow_ptr + i; ++ volatile gmac_dma_desc_t *desc = base_ptr + i; ++ ++ // Initialise the shadow descriptor ++ shadow->status = 0; ++ shadow->length = (rx_buffer_length << RDES1_RBS1_BIT); ++ if (i == (num_descriptors - 1)) { ++ shadow->length |= (1UL << RDES1_RER_BIT); ++ } ++ shadow->buffer1 = 0; ++ shadow->buffer2 = 0; ++ ++ // Copy the shadow descriptor into the real descriptor ++ desc->status = shadow->status; ++ desc->length = shadow->length; ++ desc->buffer1 = shadow->buffer1; ++ desc->buffer2 = shadow->buffer2; ++ } ++} ++ ++void init_tx_desc_list( ++ gmac_desc_list_info_t *desc_list, ++ volatile gmac_dma_desc_t *base_ptr, ++ gmac_dma_desc_t *shadow_ptr, ++ int num_descriptors) ++{ ++ int i; ++ ++ desc_list->base_ptr = base_ptr; ++ desc_list->shadow_ptr = shadow_ptr; ++ desc_list->num_descriptors = num_descriptors; ++ desc_list->empty_count = num_descriptors; ++ desc_list->full_count = 0; ++ desc_list->r_index = 0; ++ desc_list->w_index = 0; ++ ++ for (i=0; i < num_descriptors; ++i) { ++ gmac_dma_desc_t *shadow = shadow_ptr + i; ++ volatile gmac_dma_desc_t *desc = base_ptr + i; ++ ++ // Initialise the shadow descriptor ++ shadow->status = 0; ++ shadow->length = (1UL << TDES1_IC_BIT); ++ if (i == (num_descriptors - 1)) { ++ shadow->length |= (1UL << TDES1_TER_BIT); ++ } ++ shadow->buffer1 = 0; ++ shadow->buffer2 = 0; ++ ++ // Copy the shadow descriptor into the real descriptor ++ desc->status = shadow->status; ++ desc->length = shadow->length; ++ desc->buffer1 = shadow->buffer1; ++ desc->buffer2 = shadow->buffer2; ++ } ++} ++ ++void rx_take_ownership(gmac_desc_list_info_t* desc_list) ++{ ++ int i; ++ for (i=0; i < desc_list->num_descriptors; ++i) { ++ (desc_list->base_ptr + i)->status &= ~(1UL << RDES0_OWN_BIT); ++ } ++ ++ // Ensure all write to the descriptor shared with MAC have completed ++ wmb(); ++} ++ ++void tx_take_ownership(gmac_desc_list_info_t* desc_list) ++{ ++ int i; ++ for (i=0; i < desc_list->num_descriptors; ++i) { ++ (desc_list->base_ptr + i)->status &= ~(1UL << TDES0_OWN_BIT); ++ } ++ ++ // Ensure all write to the descriptor shared with MAC have completed ++ wmb(); ++} ++ ++int set_rx_descriptor( ++ gmac_priv_t *priv, ++ rx_frag_info_t *frag_info) ++{ ++ int index = -1; ++ ++ // Is there a Rx descriptor available for writing by the CPU? ++ if (available_for_write(&priv->rx_gmac_desc_list_info)) { ++ // Setup the descriptor required to describe the RX packet ++ volatile gmac_dma_desc_t *descriptor; ++ gmac_dma_desc_t *shadow; ++ ++ // Get the index of the next RX descriptor available for writing by the CPU ++ index = priv->rx_gmac_desc_list_info.w_index; ++ ++ // Get a pointer to the next RX descriptor available for writing by the CPU ++ descriptor = priv->rx_gmac_desc_list_info.base_ptr + index; ++ shadow = priv->rx_gmac_desc_list_info.shadow_ptr + index; ++ ++ // Set first buffer pointer to buffer from skb ++ descriptor->buffer1 = shadow->buffer1 = frag_info->phys_adr; ++ ++ // Remember the skb associated with the buffer ++ shadow->buffer2 = (u32)frag_info->page; ++ ++ // Ensure all prior writes to the descriptor shared with MAC have ++ // completed before setting the descriptor ownership flag to transfer ++ // ownership to the GMAC ++ wmb(); ++ ++ // Set RX descriptor status to transfer ownership to the GMAC ++ descriptor->status = (1UL << RDES0_OWN_BIT); ++ ++ // Update the index of the next descriptor available for writing by the CPU ++ priv->rx_gmac_desc_list_info.w_index = (shadow->length & (1UL << RDES1_RER_BIT)) ? 0 : index + 1; ++ ++ // Account for the descriptor used to hold the new packet ++ --priv->rx_gmac_desc_list_info.empty_count; ++ ++priv->rx_gmac_desc_list_info.full_count; ++ } ++ ++ return index; ++} ++ ++int get_rx_descriptor( ++ gmac_priv_t *priv, ++ int *last, ++ u32 *status, ++ rx_frag_info_t *frag_info) ++{ ++ int index; ++ volatile gmac_dma_desc_t *descriptor; ++ gmac_dma_desc_t *shadow; ++ u32 desc_status; ++ ++ if (!priv->rx_gmac_desc_list_info.full_count) { ++ return -2; ++ } ++ ++ // Get the index of the descriptor released the longest time ago by the GMAC DMA ++ index = priv->rx_gmac_desc_list_info.r_index; ++ descriptor = priv->rx_gmac_desc_list_info.base_ptr + index; ++ shadow = priv->rx_gmac_desc_list_info.shadow_ptr + index; ++ ++ if (status && *status) { ++ desc_status = *status; ++ } else { ++ desc_status = descriptor->status; ++ } ++ ++ if (desc_status & (1UL << RDES0_OWN_BIT)) { ++ return -1; ++ } ++ ++ // Update the index of the next descriptor with which the GMAC DMA may have finished ++ priv->rx_gmac_desc_list_info.r_index = (shadow->length & (1UL << RDES1_RER_BIT)) ? 0 : index + 1; ++ ++ // Account for the descriptor which is now no longer waiting to be processed by the CPU ++ ++priv->rx_gmac_desc_list_info.empty_count; ++ --priv->rx_gmac_desc_list_info.full_count; ++ ++ // Get packet details from the descriptor ++ frag_info->page = (struct page*)(shadow->buffer2); ++ frag_info->phys_adr = shadow->buffer1; ++ frag_info->length = get_rx_length(desc_status); ++ ++ // Is this descriptor the last contributing to a packet ++ *last = desc_status & (1UL << RDES0_LS_BIT); ++ ++ // Accumulate the status ++ if (status && !*status) { ++ *status = desc_status; ++ } ++ ++ return index; ++} ++ ++static inline int num_descriptors_needed(u16 length) ++{ ++ static const int GMAC_MAX_DESC_ORDER = 11; ++ static const u16 GMAC_MAX_DESC_MASK = ((1 << (GMAC_MAX_DESC_ORDER)) - 1); ++ ++ int count = length >> GMAC_MAX_DESC_ORDER; ++ if (length & GMAC_MAX_DESC_MASK) { ++ ++count; ++ } ++ if ((count * max_descriptor_length()) < length) { ++ ++count; ++ } ++ ++ return count; ++} ++ ++int set_tx_descriptor( ++ gmac_priv_t *priv, ++ struct sk_buff *skb, ++ tx_frag_info_t *frag_info, ++ int frag_count, ++ int use_hw_csum) ++{ ++ int first_descriptor_index = -1; ++ int num_descriptors = frag_count; ++ int frag_index = 0; ++ int check_oversized_frags = priv->netdev->mtu >= (max_descriptor_length() - ETH_HLEN); ++ ++ if (unlikely(check_oversized_frags)) { ++ // Calculate the number of extra descriptors required due to fragments ++ // being longer than the maximum buffer size that can be described by a ++ // single descriptor ++ num_descriptors = 0; ++ do { ++ // How many descriptors are required to describe the fragment? ++ num_descriptors += num_descriptors_needed(frag_info[frag_index].length); ++ } while (++frag_index < frag_count); ++ } ++ ++ // Are sufficicent descriptors available for writing by the CPU? ++ if (available_for_write(&priv->tx_gmac_desc_list_info) < num_descriptors) { ++ return -1; ++ } ++ ++ { ++ volatile gmac_dma_desc_t *previous_descriptor = 0; ++ gmac_dma_desc_t *previous_shadow = 0; ++ volatile gmac_dma_desc_t *descriptors[num_descriptors]; ++ int desc_index = 0; ++ ++ frag_index = 0; ++ do { ++ int last_frag = (frag_index == (frag_count - 1)); ++ u16 part_length = frag_info[frag_index].length; ++ dma_addr_t phys_adr = frag_info[frag_index].phys_adr; ++ int part = 0; ++ int parts = 1; ++ ++ if (unlikely(check_oversized_frags)) { ++ // How many descriptors are required to describe the fragment? ++ parts = num_descriptors_needed(part_length); ++ } ++ ++ // Setup a descriptor for each part of the fragment that can be ++ // described by a single descriptor ++ do { ++ int last_part = (part == (parts - 1)); ++ int index = priv->tx_gmac_desc_list_info.w_index; ++ volatile gmac_dma_desc_t *descriptor = priv->tx_gmac_desc_list_info.base_ptr + index; ++ gmac_dma_desc_t *shadow = priv->tx_gmac_desc_list_info.shadow_ptr + index; ++ u32 length = shadow->length; ++ u32 buffer2 = 0; ++ ++ // Remember descriptor pointer for final passing of ownership to GMAC ++ descriptors[desc_index++] = descriptor; ++ ++ // May have a second chained descriptor, but never a second buffer, ++ // so clear the flag indicating whether there is a chained descriptor ++ length &= ~(1UL << TDES1_TCH_BIT); ++ ++ // Clear the first/last descriptor flags ++ length &= ~((1UL << TDES1_LS_BIT) | (1UL << TDES1_FS_BIT)); ++ ++ // Set the Tx checksum mode ++ length &= ~(((1UL << TDES1_CIC_NUM_BITS) - 1) << TDES1_CIC_BIT); ++ if (use_hw_csum) { ++ // Don't want full mode as network stack will have already ++ // computed the TCP/UCP pseudo header and placed in into the ++ // TCP/UCP checksum field ++ length |= (TDES1_CIC_PAYLOAD << TDES1_CIC_BIT); ++ } ++ // Set fragment buffer length ++ length &= ~(((1UL << TDES1_TBS1_NUM_BITS) - 1) << TDES1_TBS1_BIT); ++ length |= ((part_length > max_descriptor_length() ? max_descriptor_length() : part_length) << TDES1_TBS1_BIT); ++ ++ // Set fragment buffer address ++ descriptor->buffer1 = shadow->buffer1 = phys_adr; ++ ++ if (previous_shadow) { ++ // Make the previous descriptor chain to the current one ++ previous_shadow->length |= (1UL << TDES1_TCH_BIT); ++ previous_descriptor->length = previous_shadow->length; ++ ++ previous_shadow->buffer2 |= descriptors_virt_to_phys((u32)descriptor); ++ previous_descriptor->buffer2 = previous_shadow->buffer2; ++ } ++ ++ // Is this the first desciptor for the packet? ++ if (!frag_index && !part) { ++ // Need to return index of first descriptor used for packet ++ first_descriptor_index = index; ++ ++ // Set flag indicating is first descriptor for packet ++ length |= (1UL << TDES1_FS_BIT); ++ } ++ ++ // Is this the last descriptor for the packet? ++ if (last_frag && last_part) { ++ // Store the skb pointer with the last descriptor for packet, in ++ // which the second buffer address will be unused as we do not use ++ // second buffers and only intermedate buffers may use the chained ++ // descriptor address ++ buffer2 = (u32)skb; ++ ++ // Set flag indicating is last descriptor for packet ++ length |= (1UL << TDES1_LS_BIT); ++ } else { ++ // For descriptor chaining need to remember previous descriptor ++ previous_descriptor = descriptor; ++ previous_shadow = shadow; ++ ++ // Is this descriptor not the last describing a single fragment ++ // buffer? ++ if (!last_part) { ++ // This descriptor does not own the fragment buffer, so use ++ // the (h/w ignored) lsb of buffer2 to encode this info. ++ buffer2 = 1; ++ ++ // Update the fragment buffer part details ++ part_length -= max_descriptor_length(); ++ phys_adr += max_descriptor_length(); ++ } ++ } ++ ++ // Write the assembled length descriptor entry to the descriptor ++ descriptor->length = shadow->length = length; ++ ++ // Write the assembled buffer2 descriptor entry to the descriptor ++ shadow->buffer2 = buffer2; ++ ++ // Update the index of the next descriptor available for writing by the CPU ++ priv->tx_gmac_desc_list_info.w_index = (length & (1UL << TDES1_TER_BIT)) ? 0 : index + 1; ++ } while (++part < parts); ++ } while (++frag_index < frag_count); ++ ++ // Ensure all prior writes to the descriptors shared with MAC have ++ // completed before setting the descriptor ownership flags to transfer ++ // ownership to the GMAC ++ wmb(); ++ ++ // Transfer descriptors to GMAC's ownership in reverse order, so when ++ // GMAC begins processing the first descriptor all others are already ++ // owned by the GMAC ++ for (desc_index = (num_descriptors - 1); desc_index >= 0; --desc_index) { ++ descriptors[desc_index]->status = (1UL << TDES0_OWN_BIT); ++ } ++ } ++ ++ // Account for the number of descriptors used to hold the new packet ++ priv->tx_gmac_desc_list_info.empty_count -= (num_descriptors); ++ priv->tx_gmac_desc_list_info.full_count += (num_descriptors); ++ ++ return first_descriptor_index; ++} ++ ++int get_tx_descriptor( ++ gmac_priv_t *priv, ++ struct sk_buff **skb, ++ u32 *status, ++ tx_frag_info_t *frag_info, ++ int *buffer_owned) ++{ ++ int index = -1; ++ u32 local_status; ++ ++ // Find the first available Tx descriptor ++ if (tx_available_for_read(&priv->tx_gmac_desc_list_info, &local_status)) { ++ gmac_dma_desc_t *shadow; ++ u32 length; ++ u32 buffer2; ++ ++ // Get the descriptor released the longest time ago by the GMAC DMA ++ index = priv->tx_gmac_desc_list_info.r_index; ++ shadow = priv->tx_gmac_desc_list_info.shadow_ptr + index; ++ ++ // Get the length of the buffer ++ length = shadow->length; ++ frag_info->length = ((length >> TDES1_TBS1_BIT) & ((1UL << TDES1_TBS1_NUM_BITS) - 1)); ++ ++ // Get a pointer to the buffer ++ frag_info->phys_adr = shadow->buffer1; ++ ++ // Get buffer ownership or skb info ++ buffer2 = shadow->buffer2; ++ ++ // Check that chained buffer not is use before setting skb from buffer2 ++ if (!(length & (1UL << TDES1_TCH_BIT))) { ++ *skb = (struct sk_buff*)buffer2; ++ *buffer_owned = 1; ++ } else { ++ // The lsb (h/w ignored) is used to encode buffer ownership ++ *buffer_owned = !(buffer2 & 1); ++ *skb = 0; ++ } ++ ++ // Accumulate status ++ if (status) { ++ *status |= local_status; ++ } ++ ++ // Update the index of the next descriptor with which the GMAC DMA may have finished ++ priv->tx_gmac_desc_list_info.r_index = (length & (1UL << TDES1_TER_BIT)) ? 0 : index + 1; ++ ++ // Account for the descriptor which is now no longer waiting to be processed by the CPU ++ ++priv->tx_gmac_desc_list_info.empty_count; ++ --priv->tx_gmac_desc_list_info.full_count; ++ } ++ ++ return index; ++} ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_desc.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_desc.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac_desc.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_desc.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,315 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_desc.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#if !defined(__GMAC_DESC_H__) ++#define __GMAC_DESC_H__ ++ ++#include <asm/types.h> ++#include "gmac.h" ++ ++typedef enum rdes0 { ++ RDES0_OWN_BIT = 31, ++ RDES0_AFM_BIT = 30, ++ RDES0_FL_BIT = 16, ++ RDES0_ES_BIT = 15, ++ RDES0_DE_BIT = 14, ++ RDES0_SAF_BIT = 13, ++ RDES0_LE_BIT = 12, ++ RDES0_OE_BIT = 11, ++ RDES0_IPC_BIT = 10, ++ RDES0_FS_BIT = 9, ++ RDES0_LS_BIT = 8, ++ RDES0_VLAN_BIT = 7, ++ RDES0_LC_BIT = 6, ++ RDES0_FT_BIT = 5, ++ RDES0_RWT_BIT = 4, ++ RDES0_RE_BIT = 3, ++ RDES0_DRE_BIT = 2, ++ RDES0_CE_BIT = 1, ++ RDES0_PCE_BIT = 0 ++} rdes0_t; ++ ++#define RX_DESC_STATUS_FL_NUM_BITS 14 ++ ++typedef enum rdes1 { ++ RDES1_DIC_BIT = 31, ++ RDES1_RER_BIT = 25, ++ RDES1_RCH_BIT = 24, ++ RDES1_RBS2_BIT = 11, ++ RDES1_RBS1_BIT = 0, ++} rdes1_t; ++ ++#define RX_DESC_LENGTH_RBS2_NUM_BITS 11 ++#define RX_DESC_LENGTH_RBS1_NUM_BITS 11 ++ ++typedef enum tdes0 { ++ TDES0_OWN_BIT = 31, ++ TDES0_IHE_BIT = 16, ++ TDES0_ES_BIT = 15, ++ TDES0_JT_BIT = 14, ++ TDES0_FF_BIT = 13, ++ TDES0_PCE_BIT = 12, ++ TDES0_LOC_BIT = 11, ++ TDES0_NC_BIT = 10, ++ TDES0_LC_BIT = 9, ++ TDES0_EC_BIT = 8, ++ TDES0_VF_BIT = 7, ++ TDES0_CC_BIT = 3, ++ TDES0_ED_BIT = 2, ++ TDES0_UF_BIT = 1, ++ TDES0_DB_BIT = 0 ++} tdes0_t; ++ ++#define TDES0_CC_NUM_BITS 4 ++ ++typedef enum tdes1 { ++ TDES1_IC_BIT = 31, ++ TDES1_LS_BIT = 30, ++ TDES1_FS_BIT = 29, ++ TDES1_CIC_BIT = 27, ++ TDES1_DC_BIT = 26, ++ TDES1_TER_BIT = 25, ++ TDES1_TCH_BIT = 24, ++ TDES1_DP_BIT = 23, ++ TDES1_TBS2_BIT = 11, ++ TDES1_TBS1_BIT = 0 ++} tdes1_t; ++ ++#define TDES1_CIC_NUM_BITS 2 ++#define TDES1_TBS2_NUM_BITS 11 ++#define TDES1_TBS1_NUM_BITS 11 ++ ++#define TDES1_CIC_NONE 0 ++#define TDES1_CIC_HDR 1 ++#define TDES1_CIC_PAYLOAD 2 ++#define TDES1_CIC_FULL 3 ++ ++extern void init_rx_desc_list( ++ gmac_desc_list_info_t *desc_list, ++ volatile gmac_dma_desc_t *base_ptr, ++ gmac_dma_desc_t *shadow_ptr, ++ int num_descriptors, ++ u16 rx_buffer_length); ++ ++extern void init_tx_desc_list( ++ gmac_desc_list_info_t *desc_list, ++ volatile gmac_dma_desc_t *base_ptr, ++ gmac_dma_desc_t *shadow_ptr, ++ int num_descriptors); ++ ++/** Force ownership of all descriptors in the specified list to being owned by ++ * the CPU ++ */ ++extern void rx_take_ownership(gmac_desc_list_info_t* desc_list); ++ ++/** Force ownership of all descriptors in the specified list to being owned by ++ * the CPU ++ */ ++extern void tx_take_ownership(gmac_desc_list_info_t* desc_list); ++ ++/** Return the number of descriptors available for the CPU to fill with new ++ * packet info */ ++static inline int available_for_write(gmac_desc_list_info_t* desc_list) ++{ ++ return desc_list->empty_count; ++} ++ ++/** Return non-zero if there is a descriptor available with a packet with which ++ * the GMAC DMA has finished */ ++static inline int tx_available_for_read( ++ volatile gmac_desc_list_info_t *desc_list, ++ u32 *status) ++{ ++ if (!desc_list->full_count) { ++ return 0; ++ } ++ ++ *status = (desc_list->base_ptr + desc_list->r_index)->status; ++ ++ if (*status & (1UL << TDES0_OWN_BIT)) { ++ return 0; ++ } ++ ++ return 1; ++} ++ ++/** ++ * Return non-zero if there is a descriptor available with a packet with which ++ * the GMAC DMA has finished. ++ */ ++static inline int rx_available_for_read( ++ volatile gmac_desc_list_info_t *desc_list, ++ u32 *status) ++{ ++ u32 local_status; ++ ++ if (!desc_list->full_count) { ++ return 0; ++ } ++ ++ local_status = (desc_list->base_ptr + desc_list->r_index)->status; ++ ++ if (local_status & (1UL << RDES0_OWN_BIT)) { ++ return 0; ++ } ++ ++ if (status) { ++ *status = local_status; ++ } ++ ++ return 1; ++} ++ ++typedef struct rx_frag_info { ++ struct page *page; ++ dma_addr_t phys_adr; ++ u16 length; ++} rx_frag_info_t; ++ ++/** ++ * Fill a RX descriptor and pass ownership to DMA engine ++ */ ++extern int set_rx_descriptor( ++ gmac_priv_t *priv, ++ rx_frag_info_t *frag_info); ++ ++/** ++ * Extract data from the next available descriptor with which the GMAC DMA ++ * controller has finished. ++ * The caller indicates via the 'first_last' argument whether the first ++ * descriptor contributing to a packet is expected. The 'first_last' argument ++ * will be returned set to indicate whether the descriptor was the last ++ * contributing to a packet. ++ * If the 'status' argument is non-null it will have the status from the ++ * descriptor or'ed into it, thus enabling the compound status for all ++ * descriptors contributing to a packet to be built up ++ */ ++extern int get_rx_descriptor( ++ gmac_priv_t *priv, ++ int *last, ++ u32 *status, ++ rx_frag_info_t *frag_info); ++ ++/** ++ * Fill in descriptors describing all fragments in a single Tx packet and pass ++ * ownership to the GMAC. The 'frag_info' argument points to an array describing ++ * each buffer that is to contribute to the transmitted packet. The 'frag_count' ++ * argument gives the number of elements in that array ++ */ ++extern int set_tx_descriptor( ++ gmac_priv_t *priv, ++ struct sk_buff *skb, ++ tx_frag_info_t *frag_info, ++ int frag_count, ++ int use_hw_csum); ++ ++/** ++ * Extract information about the TX packet transmitted the longest time ago. ++ * If the 'status' argument is non-null it will have the status from the ++ * descriptor or'ed into it. ++ */ ++extern int get_tx_descriptor( ++ gmac_priv_t *priv, ++ struct sk_buff **skb, ++ u32 *status, ++ tx_frag_info_t *frag_info, ++ int *buffer_owned); ++ ++/** ++ * @param A u32 containing the status from a received frame's DMA descriptor ++ * @return An int which is non-zero if a valid received frame has no error ++ * condititions flagged ++ */ ++static inline int is_rx_valid(u32 status) ++{ ++ return !(status & (1UL << RDES0_ES_BIT)) && ++ !(status & (1UL << RDES0_IPC_BIT)); ++} ++ ++static inline int is_rx_dribbling(u32 status) ++{ ++ return status & (1UL << RDES0_DRE_BIT); ++} ++ ++static inline u32 get_rx_length(u32 status) ++{ ++ return (status >> RDES0_FL_BIT) & ((1UL << RX_DESC_STATUS_FL_NUM_BITS) - 1); ++} ++ ++static inline int is_rx_collision_error(u32 status) ++{ ++ return status & ((1UL << RDES0_OE_BIT) | (1UL << RDES0_LC_BIT)); ++} ++ ++static inline int is_rx_crc_error(u32 status) ++{ ++ return status & (1UL << RDES0_CE_BIT); ++} ++ ++static inline int is_rx_frame_error(u32 status) ++{ ++ return status & (1UL << RDES0_DE_BIT); ++} ++ ++static inline int is_rx_length_error(u32 status) ++{ ++ return status & (1UL << RDES0_LE_BIT); ++} ++ ++static inline int is_rx_csum_error(u32 status) ++{ ++ return (status & (1UL << RDES0_IPC_BIT)) ++#ifndef CONFIG_HIPOX_VERSION_0X800 ++ || (status & (1UL << RDES0_PCE_BIT)) ++#endif // !CONFIG_HIPOX_VERSION_0X800 ++ ; ++} ++ ++static inline int is_rx_long_frame(u32 status) ++{ ++ return status & (1UL << RDES0_VLAN_BIT); ++} ++ ++static inline int is_tx_valid(u32 status) ++{ ++ return !(status & (1UL << TDES0_ES_BIT)); ++} ++ ++static inline int is_tx_collision_error(u32 status) ++{ ++ return (status & (((1UL << TDES0_CC_NUM_BITS) - 1) << TDES0_CC_BIT)) >> TDES0_CC_BIT; ++} ++ ++static inline int is_tx_aborted(u32 status) ++{ ++ return status & ((1UL << TDES0_LC_BIT) | (1UL << TDES0_EC_BIT)); ++} ++ ++static inline int is_tx_carrier_error(u32 status) ++{ ++ return status & ((1UL << TDES0_LOC_BIT) | (1UL << TDES0_NC_BIT)); ++} ++ ++static inline u16 max_descriptor_length(void) { ++ static const int GMAC_MAX_DESC_LEN = 2047; ++ ++ return GMAC_MAX_DESC_LEN; ++} ++#endif // #if !defined(__GMAC_DESC_H__) ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_ethtool.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_ethtool.c +--- linux-2.6.24/arch/arm/mach-hipox/gmac_ethtool.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_ethtool.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,275 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_ethtool.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 <asm/types.h> ++#include <linux/errno.h> ++#include <linux/ethtool.h> ++#include <linux/netdevice.h> ++#include <asm/io.h> ++#include <asm/arch/leon.h> ++ ++//#define GMAC_DEBUG ++#undef GMAC_DEBUG ++ ++#include "gmac.h" ++#include "gmac_desc.h" ++ ++static int get_settings(struct net_device* dev, struct ethtool_cmd* cmd) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long irq_flags; ++ int status; ++ ++ spin_lock_irqsave(&priv->phy_lock, irq_flags); ++ status = mii_ethtool_gset(&priv->mii, cmd); ++ spin_unlock_irqrestore(&priv->phy_lock, irq_flags); ++ ++ return status; ++} ++ ++static int set_settings(struct net_device* dev, struct ethtool_cmd* cmd) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long irq_flags; ++ int status; ++ ++ spin_lock_irqsave(&priv->phy_lock, irq_flags); ++ status = mii_ethtool_sset(&priv->mii, cmd); ++ spin_unlock_irqrestore(&priv->phy_lock, irq_flags); ++ ++ return status; ++} ++ ++static void get_drvinfo(struct net_device* dev, struct ethtool_drvinfo* drvinfo) ++{ ++ strncpy(drvinfo->driver, "GMAC", 32); ++ strncpy(drvinfo->version, "1.0", 32); ++ strncpy(drvinfo->fw_version, "1.0", 32); // Version of CoPro s/w ++ strncpy(drvinfo->bus_info, "AMBA", 32); ++} ++ ++static int nway_reset(struct net_device* dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long irq_flags; ++ int status; ++ ++ spin_lock_irqsave(&priv->phy_lock, irq_flags); ++ status = mii_nway_restart(&priv->mii); ++ spin_unlock_irqrestore(&priv->phy_lock, irq_flags); ++ ++ return status; ++} ++ ++static u32 get_msglevel(struct net_device* dev) ++{ ++ return ((gmac_priv_t*)netdev_priv(dev))->msg_level; ++} ++ ++static void set_msglevel(struct net_device* dev, u32 data) ++{ ++ ((gmac_priv_t*)netdev_priv(dev))->msg_level = data; ++} ++ ++static u32 get_rx_csum(struct net_device* dev) ++{ ++#ifdef USE_RX_CSUM ++ return 1; ++#else ++ return 0; ++#endif ++} ++ ++static int set_rx_csum(struct net_device* dev, u32 data) ++{ ++ return 0; ++} ++ ++static int get_regs_len(struct net_device* dev) ++{ ++ return 0; ++} ++ ++static void get_regs(struct net_device* dev, struct ethtool_regs* regs, void *p) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long irq_state; ++ u32 status; ++ ++ printk("RX ring info:\n"); ++ printk(" num_descriptors = %d\n", priv->rx_gmac_desc_list_info.num_descriptors); ++ printk(" empty_count = %d\n", priv->rx_gmac_desc_list_info.empty_count); ++ printk(" full_count = %d\n", priv->rx_gmac_desc_list_info.full_count); ++ printk(" r_index = %d\n", priv->rx_gmac_desc_list_info.r_index); ++ printk(" w_index = %d\n", priv->rx_gmac_desc_list_info.w_index); ++ printk(" available_for_write = %d\n", available_for_write(&priv->rx_gmac_desc_list_info)); ++ printk(" available_for_read %s\n", rx_available_for_read(&priv->rx_gmac_desc_list_info, 0) ? "yes" :"no"); ++ ++ spin_lock_irqsave(&priv->tx_spinlock_, irq_state); ++ printk("TX ring info:\n"); ++ printk(" num_descriptors = %d\n", priv->tx_gmac_desc_list_info.num_descriptors); ++ printk(" empty_count = %d\n", priv->tx_gmac_desc_list_info.empty_count); ++ printk(" full_count = %d\n", priv->tx_gmac_desc_list_info.full_count); ++ printk(" r_index = %d\n", priv->tx_gmac_desc_list_info.r_index); ++ printk(" w_index = %d\n", priv->tx_gmac_desc_list_info.w_index); ++ printk(" available_for_write = %d\n", available_for_write(&priv->tx_gmac_desc_list_info)); ++ printk(" available_for_read %s\n", tx_available_for_read(&priv->tx_gmac_desc_list_info, &status) ? "yes" : "no"); ++ spin_unlock_irqrestore(&priv->tx_spinlock_, irq_state); ++} ++ ++static void get_wol(struct net_device* dev, struct ethtool_wolinfo* wol_info) ++{ ++} ++ ++static int set_wol(struct net_device* dev, struct ethtool_wolinfo* wol_info) ++{ ++ return -EINVAL; ++} ++ ++static int get_coalesce(struct net_device* dev, struct ethtool_coalesce *ethtool_coalesce) ++{ ++#ifdef CONFIG_LEON_COPRO ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ if (priv->copro_params_.rx_mitigation_) { ++ ethtool_coalesce->rx_max_coalesced_frames = priv->copro_params_.rx_mitigation_frames_; ++ ethtool_coalesce->rx_coalesce_usecs = priv->copro_params_.rx_mitigation_usec_; ++printk("get_coalesce() %u packets, %u usec\n", ethtool_coalesce->rx_max_coalesced_frames, ethtool_coalesce->rx_coalesce_usecs); ++ } ++#endif // CONFIG_LEON_COPRO ++ return 0; ++} ++ ++static int set_coalesce(struct net_device* dev, struct ethtool_coalesce *ethtool_coalesce) ++{ ++#ifdef CONFIG_LEON_COPRO ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ if (priv->copro_params_.rx_mitigation_) { ++printk("set_coalesce() %u packets, %u usec\n", ethtool_coalesce->rx_max_coalesced_frames, ethtool_coalesce->rx_coalesce_usecs); ++ priv->copro_params_.rx_mitigation_frames_ = ethtool_coalesce->rx_max_coalesced_frames; ++ priv->copro_params_.rx_mitigation_usec_ = ethtool_coalesce->rx_coalesce_usecs; ++ ++ // Only attempt to write to uncached/unbuffered shared parameter storage ++ // if CoPro is started and thus storage has been allocated ++ if (priv->shared_copro_params_) { ++ // Fill the CoPro parameter block ++ memcpy(priv->shared_copro_params_, &priv->copro_params_, sizeof(copro_params_t)); ++ } ++ ++ // Make sure the CoPro parameter block updates have made it to memory (which ++ // is uncached/unbuffered, so just compiler issues to overcome) ++ wmb(); ++ ++ spin_lock(&priv->cmd_que_lock_); ++ cmd_que_queue_cmd(&priv->cmd_queue_, GMAC_CMD_UPDATE_PARAMS, 0, 0); ++ spin_unlock(&priv->cmd_que_lock_); ++ ++ // Interrupt the CoPro so it sees the new command ++ writel(1UL << COPRO_SEM_INT_CMD, SYS_CTRL_SEMA_SET_CTRL); ++ } ++#endif // CONFIG_LEON_COPRO ++ ++ return 0; ++} ++ ++static void get_ringparam(struct net_device* dev, struct ethtool_ringparam *ethtool_ringparam) ++{ ++} ++ ++static int set_ringparam(struct net_device* dev, struct ethtool_ringparam *ethtool_ringparam) ++{ ++ return -EINVAL; ++} ++ ++static void get_pauseparam(struct net_device* dev, struct ethtool_pauseparam* ethtool_pauseparam) ++{ ++} ++ ++static int set_pauseparam(struct net_device* dev, struct ethtool_pauseparam* ethtool_pauseparam) ++{ ++ return -EINVAL; ++} ++ ++static int self_test_count(struct net_device* dev) ++{ ++ return -EINVAL; ++} ++ ++static void self_test(struct net_device* dev, struct ethtool_test* ethtool_test, u64 *data) ++{ ++} ++ ++static void get_strings(struct net_device* dev, u32 stringset, u8 *data) ++{ ++} ++ ++static int phys_id(struct net_device* dev, u32 data) ++{ ++ return -EINVAL; ++} ++ ++static int get_stats_count(struct net_device* dev) ++{ ++ return -EINVAL; ++} ++ ++static void get_ethtool_stats(struct net_device* dev, struct ethtool_stats* ethtool_stats, u64 *data) ++{ ++} ++ ++static struct ethtool_ops ethtool_ops = { ++ .get_settings = get_settings, ++ .set_settings = set_settings, ++ .get_drvinfo = get_drvinfo, ++ .get_regs_len = get_regs_len, ++ .get_regs = get_regs, ++ .get_wol = get_wol, ++ .set_wol = set_wol, ++ .get_msglevel = get_msglevel, ++ .set_msglevel = set_msglevel, ++ .nway_reset = nway_reset, ++ .get_link = ethtool_op_get_link, ++ .get_coalesce = get_coalesce, ++ .set_coalesce = set_coalesce, ++ .get_ringparam = get_ringparam, ++ .set_ringparam = set_ringparam, ++ .get_pauseparam = get_pauseparam, ++ .set_pauseparam = set_pauseparam, ++ .get_rx_csum = get_rx_csum, ++ .set_rx_csum = set_rx_csum, ++ .get_tx_csum = ethtool_op_get_tx_csum, ++ .set_tx_csum = ethtool_op_set_tx_csum, ++ .get_sg = ethtool_op_get_sg, ++ .set_sg = ethtool_op_set_sg, ++ .get_tso = ethtool_op_get_tso, ++ .set_tso = ethtool_op_set_tso, ++ .self_test_count = self_test_count, ++ .self_test = self_test, ++ .get_strings = get_strings, ++ .phys_id = phys_id, ++ .get_stats_count = get_stats_count, ++ .get_ethtool_stats = get_ethtool_stats ++}; ++ ++void set_ethtool_ops(struct net_device *netdev) ++{ ++ SET_ETHTOOL_OPS(netdev, ðtool_ops); ++} +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_ethtool.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_ethtool.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac_ethtool.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_ethtool.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,26 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_ethtool.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#if !defined(__GMAC_ETHTOOL_H__) ++#define __GMAC_ETHTOOL_H__ ++ ++extern void set_ethtool_ops(struct net_device *netdev); ++ ++#endif // #if !defined(__GMAC_ETHTOOL_H__) ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_offload.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_offload.c +--- linux-2.6.24/arch/arm/mach-hipox/gmac_offload.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_offload.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,223 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac-offload.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#ifdef CONFIG_LEON_COPRO ++ ++#include <linux/slab.h> ++#include "gmac.h" ++ ++void cmd_que_init( ++ cmd_que_t *queue, ++ gmac_cmd_que_ent_t *start, ++ int num_entries) ++{ ++ // Initialise queue management metadata ++ INIT_LIST_HEAD(&queue->ack_list_); ++ queue->head_ = start; ++ queue->tail_ = start + num_entries; ++ queue->w_ptr_ = queue->head_; ++ ++ // Zeroise all entries in the queue ++ memset(start, 0, num_entries * sizeof(gmac_cmd_que_ent_t)); ++} ++ ++int cmd_que_dequeue_ack(cmd_que_t *queue) ++{ ++ struct list_head *list_entry; ++ cmd_que_ack_t *ack; ++ ++ if (list_empty(&queue->ack_list_)) { ++ return -1; ++ } ++ ++ // Remove the first entry on the acknowledgement list ++ list_entry = queue->ack_list_.next; ++ BUG_ON(!list_entry); ++ ++ // Get pointer to ack entry from it's list_head member ++ ack = list_entry(list_entry, cmd_que_ack_t, list_); ++ BUG_ON(!ack); ++ BUG_ON(!ack->entry_); ++ BUG_ON(!ack->callback_); ++ ++ // Has the CoPro acknowledged the command yet? ++ if (!(ack->entry_->opcode_ & (1UL << GMAC_CMD_QUE_SKP_BIT))) { ++ // No, so no further acknowledgements can be pending as CoPro executes ++ // commands/acks in order ++ return -1; ++ } ++ ++ // Going to process the acknowledgement, so remove it from the pending list ++ list_del(list_entry); ++ ++//printk("ak=0x%08x:0x%08x\n", ack->entry_->opcode_, ack->entry_->operand_); ++ // Invoke the acknowledgement handler routine ++ ack->callback_(ack->entry_); ++ ++ // Reset ACK flag in command queue entry ++ ack->entry_->opcode_ &= ~(1UL << GMAC_CMD_QUE_ACK_BIT); ++ ++ kfree(ack); ++ return 0; ++} ++ ++#define OPCODE_FLAGS_MASK ((1UL << (GMAC_CMD_QUE_OWN_BIT)) |\ ++ (1UL << (GMAC_CMD_QUE_ACK_BIT)) |\ ++ (1UL << (GMAC_CMD_QUE_SKP_BIT))) ++ ++int cmd_que_queue_cmd( ++ cmd_que_t *queue, ++ u32 opcode, ++ u32 operand, ++ cmd_que_ack_callback callback) ++{ ++ int result = -1; ++ ++ do { ++ volatile gmac_cmd_que_ent_t* entry = queue->w_ptr_; ++ u32 old_opcode = entry->opcode_; ++ ++ if (old_opcode & (1UL << GMAC_CMD_QUE_OWN_BIT)) { ++ // Queue is full as we've run into an entry still owned by the CoPro ++ break; ++ } ++ ++ if (!(old_opcode & (1UL << GMAC_CMD_QUE_ACK_BIT))) { ++ // We've found an entry we own that isn't waiting for the contained ++ // ack to be processed, so we can use it for the new command ++ opcode &= ~(OPCODE_FLAGS_MASK); ++ opcode |= (1UL << GMAC_CMD_QUE_OWN_BIT); ++ ++ if (callback) { ++ // Register ack. handler before releasing entry to CoPro ++ cmd_que_ack_t *ack = kmalloc(sizeof(cmd_que_ack_t), GFP_ATOMIC); ++ BUG_ON(!ack); ++ ++ ack->entry_ = queue->w_ptr_; ++ ack->callback_ = callback; ++ INIT_LIST_HEAD(&ack->list_); ++ list_add_tail(&ack->list_, &queue->ack_list_); ++ ++ // Mark the entry as requiring an ack. ++ opcode |= (1UL << GMAC_CMD_QUE_ACK_BIT); ++ } ++ ++ // Copy the command into the queue entry and pass ownership to the ++ // CoPro, being sure to set the OWN flag last ++//printk("op=0x%08x:0x%08x\n", opcode, operand); ++ queue->w_ptr_->operand_ = operand; ++ wmb(); ++ queue->w_ptr_->opcode_ = opcode; ++ // Ensure the OWN flag gets to memory before any following interrupt ++ // to the CoPro is issued ++ wmb(); ++ ++ result = 0; ++ } ++ ++ // Make the write pointer point to the next potentially available entry ++ if (++queue->w_ptr_ == queue->tail_) { ++ queue->w_ptr_ = queue->head_; ++ } ++ } while (result); ++ ++ return result; ++} ++ ++void tx_que_init( ++ tx_que_t *queue, ++ gmac_tx_que_ent_t *start, ++ int num_entries) ++{ ++ // Initialise queue management metadata ++ queue->head_ = start; ++ queue->tail_ = start + num_entries; ++ queue->w_ptr_ = queue->head_; ++ queue->r_ptr_ = queue->head_; ++ queue->full_ = 0; ++ ++ // Zeroise all entries in the queue ++ memset(start, 0, num_entries * sizeof(gmac_tx_que_ent_t)); ++} ++ ++static inline void tx_que_inc_w_ptr(tx_que_t *queue) ++{ ++ if (++queue->w_ptr_ == queue->tail_) { ++ queue->w_ptr_ = queue->head_; ++ } ++ queue->full_ = (queue->w_ptr_ == queue->r_ptr_); ++} ++ ++volatile gmac_tx_que_ent_t* tx_que_get_finished_job(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ tx_que_t *queue = &priv->tx_queue_; ++ volatile gmac_tx_que_ent_t *entry = 0; ++ ++ if (tx_que_not_empty(queue)) { ++ entry = queue->r_ptr_; ++ if (entry->flags_ & (1UL << TX_JOB_FLAGS_OWN_BIT)) { ++ entry = (volatile gmac_tx_que_ent_t*)0; ++ } else { ++ tx_que_inc_r_ptr(queue); ++ } ++ } ++ ++ return entry; ++} ++ ++/** ++ * A call to tx_que_get_idle_job() must be followed by a call to tx_que_new_job() ++ * before any subsequent call to tx_que_get_idle_job() ++ */ ++volatile gmac_tx_que_ent_t* tx_que_get_idle_job(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ tx_que_t *queue = &priv->tx_queue_; ++ volatile gmac_tx_que_ent_t *entry = 0; ++ ++ // Must not reuse completed Tx packets returned by CoPro until the queue ++ // reader has had a chance to process them ++ if (!tx_que_is_full(queue)) { ++ entry = queue->w_ptr_; ++ } ++ ++ return entry; ++} ++ ++/** ++ * A call to tx_que_get_idle_job() must be followed by a call to tx_que_new_job() ++ * before any subsequent call to tx_que_get_idle_job() ++ */ ++void tx_que_new_job( ++ struct net_device *dev, ++ volatile gmac_tx_que_ent_t *entry) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ // Make sure any modifications to Tx job structures make it to memory before ++ // setting the OWN flag to pass ownership to the CoPro ++ wmb(); ++ ++ entry->flags_ |= (1UL << TX_JOB_FLAGS_OWN_BIT); ++ ++ tx_que_inc_w_ptr(&priv->tx_queue_); ++} ++#endif // #ifdef CONFIG_LEON_COPRO ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_offload.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_offload.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac_offload.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_offload.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,163 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac-offload.h ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#ifdef CONFIG_LEON_COPRO ++ ++#if !defined(__GMAC_OFFLOAD_H__) ++#define __GMAC_OFFLOAD_H__ ++ ++#include <linux/kernel.h> ++#include <linux/list.h> ++ ++#define GMAC_CMD_QUE_OWN_BIT 31 // 0-Owned by ARM, 1-Owned by CoPro ++#define GMAC_CMD_QUE_ACK_BIT 30 ++#define GMAC_CMD_QUE_SKP_BIT 29 ++ ++typedef struct gmac_cmd_que_ent { ++ u32 opcode_; ++ u32 operand_; ++} __attribute ((aligned(4),packed)) gmac_cmd_que_ent_t; ++ ++#define GMAC_CMD_STOP 0 ++#define GMAC_CMD_START 1 ++#define GMAC_CMD_INT_EN_SET 2 ++#define GMAC_CMD_INT_EN_CLR 3 ++#define GMAC_CMD_HEARTBEAT 4 ++#define GMAC_CMD_UPDATE_PARAMS 5 ++#define GMAC_CMD_CHANGE_GIG_MODE 6 ++#define GMAC_CMD_CHANGE_RX_ENABLE 7 ++#define GMAC_CMD_CLEAR_RX_INTS 8 ++#define GMAC_CMD_CHANGE_PAUSE_MODE 9 ++ ++typedef void (*cmd_que_ack_callback)(volatile gmac_cmd_que_ent_t* entry); ++ ++typedef struct cmd_que_ack { ++ struct list_head list_; ++ volatile gmac_cmd_que_ent_t *entry_; ++ cmd_que_ack_callback callback_; ++} cmd_que_ack_t; ++ ++typedef struct cmd_que { ++ gmac_cmd_que_ent_t *head_; ++ gmac_cmd_que_ent_t *tail_; ++ volatile gmac_cmd_que_ent_t *w_ptr_; ++ struct list_head ack_list_; ++} cmd_que_t; ++ ++extern void cmd_que_init( ++ cmd_que_t *queue, ++ gmac_cmd_que_ent_t *start, ++ int num_entries); ++ ++extern int cmd_que_dequeue_ack(cmd_que_t *queue); ++ ++extern int cmd_que_queue_cmd( ++ cmd_que_t *queue, ++ u32 opcode, ++ u32 operand, ++ cmd_que_ack_callback callback); // non-zero if ack. required ++ ++#define COPRO_SEM_INT_CMD 0 ++#define COPRO_SEM_INT_TX 1 ++ ++typedef struct gmac_fwd_intrs { ++ u32 status_; ++} __attribute ((aligned(4),packed)) gmac_fwd_intrs_t; ++ ++#define TX_JOB_FLAGS_OWN_BIT 0 ++#define TX_JOB_FLAGS_COPRO_RESERVED_1_BIT 1 ++#define TX_JOB_FLAGS_ACCELERATE_BIT 2 ++ ++#define TX_JOB_STATS_BYTES_BIT 0 ++#define TX_JOB_STATS_BYTES_NUM_BITS 16 ++#define TX_JOB_STATS_BYTES_MASK (((1UL << TX_JOB_STATS_BYTES_NUM_BITS) - 1) << TX_JOB_STATS_BYTES_BIT) ++#define TX_JOB_STATS_PACKETS_BIT 16 ++#define TX_JOB_STATS_PACKETS_NUM_BITS 6 ++#define TX_JOB_STATS_PACKETS_MASK (((1UL << TX_JOB_STATS_PACKETS_NUM_BITS) - 1) << TX_JOB_STATS_PACKETS_BIT) ++#define TX_JOB_STATS_ABORT_BIT 22 ++#define TX_JOB_STATS_ABORT_NUM_BITS 3 ++#define TX_JOB_STATS_ABORT_MASK (((1UL << TX_JOB_STATS_ABORT_NUM_BITS) - 1) << TX_JOB_STATS_ABORT_BIT) ++#define TX_JOB_STATS_CARRIER_BIT 25 ++#define TX_JOB_STATS_CARRIER_NUM_BITS 3 ++#define TX_JOB_STATS_CARRIER_MASK (((1UL << TX_JOB_STATS_CARRIER_NUM_BITS) - 1) << TX_JOB_STATS_CARRIER_BIT) ++#define TX_JOB_STATS_COLLISION_BIT 28 ++#define TX_JOB_STATS_COLLISION_NUM_BITS 4 ++#define TX_JOB_STATS_COLLISION_MASK (((1UL << TX_JOB_STATS_COLLISION_NUM_BITS) - 1) << TX_JOB_STATS_COLLISION_BIT) ++ ++/* Make even number else gmac_tx_que_ent_t struct below alignment will be wrong */ ++#define COPRO_NUM_TX_FRAGS_DIRECT 18 ++ ++typedef struct gmac_tx_que_ent { ++ u32 skb_; ++ u32 len_; ++ u32 data_len_; ++ u32 ethhdr_; ++ u32 iphdr_; ++ u16 iphdr_csum_; ++ u16 tso_segs_; ++ u16 tso_size_; ++ u16 flags_; ++ u32 frag_ptr_[COPRO_NUM_TX_FRAGS_DIRECT]; ++ u16 frag_len_[COPRO_NUM_TX_FRAGS_DIRECT]; ++ u32 statistics_; ++} __attribute ((aligned(4),packed)) gmac_tx_que_ent_t; ++ ++typedef struct tx_que { ++ gmac_tx_que_ent_t *head_; ++ gmac_tx_que_ent_t *tail_; ++ volatile gmac_tx_que_ent_t *w_ptr_; ++ volatile gmac_tx_que_ent_t *r_ptr_; ++ int full_; ++} tx_que_t; ++ ++extern void tx_que_init( ++ tx_que_t *queue, ++ gmac_tx_que_ent_t *start, ++ int num_entries); ++ ++static inline int tx_que_not_empty(tx_que_t *queue) ++{ ++ return (queue->r_ptr_ != queue->w_ptr_) || queue->full_; ++} ++ ++static inline int tx_que_is_full(tx_que_t *queue) ++{ ++ return queue->full_; ++} ++ ++static inline void tx_que_inc_r_ptr(tx_que_t *queue) ++{ ++ if (++queue->r_ptr_ == queue->tail_) { ++ queue->r_ptr_ = queue->head_; ++ } ++ if (queue->full_) { ++ queue->full_ = 0; ++ } ++} ++ ++extern volatile gmac_tx_que_ent_t* tx_que_get_finished_job(struct net_device *dev); ++ ++extern volatile gmac_tx_que_ent_t* tx_que_get_idle_job(struct net_device *dev); ++ ++extern void tx_que_new_job( ++ struct net_device *dev, ++ volatile gmac_tx_que_ent_t *entry); ++ ++#endif // #if !defined(__GMAC_OFFLOAD_H__) ++#endif // CONFIG_LEON_COPRO +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_phy.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_phy.c +--- linux-2.6.24/arch/arm/mach-hipox/gmac_phy.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_phy.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,318 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_phy.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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/delay.h> ++ ++//#define GMAC_DEBUG ++#undef GMAC_DEBUG ++ ++#include "gmac.h" ++#include "gmac_phy.h" ++#include "gmac_reg.h" ++ ++static const int PHY_TRANSFER_TIMEOUT_MS = 100; ++ ++/* ++ * Reads a register from the MII Management serial interface ++ */ ++int phy_read(struct net_device *dev, int phyaddr, int phyreg) ++{ ++ int data = 0; ++#ifndef ARMULATING ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long end; ++ ++ u32 addr = (phyaddr << MAC_GMII_ADR_PA_BIT) | ++ (phyreg << MAC_GMII_ADR_GR_BIT) | ++ (priv->gmii_csr_clk_range << MAC_GMII_ADR_CR_BIT) | ++ (1UL << MAC_GMII_ADR_GB_BIT); ++ ++ mac_reg_write(priv, MAC_GMII_ADR_REG, addr); ++ ++ end = jiffies + MS_TO_JIFFIES(PHY_TRANSFER_TIMEOUT_MS); ++ while (time_before(jiffies, end)) { ++ if (!(mac_reg_read(priv, MAC_GMII_ADR_REG) & (1UL << MAC_GMII_ADR_GB_BIT))) { ++ // Successfully read from PHY ++ data = mac_reg_read(priv, MAC_GMII_DATA_REG) & 0xFFFF; ++ break; ++ } ++ } ++ ++ DBG(1, KERN_INFO "phy_read() %s: phyaddr=0x%x, phyreg=0x%x, phydata=0x%x\n", dev->name, phyaddr, phyreg, data); ++#endif // ARMULATING ++ ++ return data; ++} ++ ++/* ++ * Writes a register to the MII Management serial interface ++ */ ++void phy_write(struct net_device *dev, int phyaddr, int phyreg, int phydata) ++{ ++#ifndef ARMULATING ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ unsigned long end; ++ ++ u32 addr = (phyaddr << MAC_GMII_ADR_PA_BIT) | ++ (phyreg << MAC_GMII_ADR_GR_BIT) | ++ (priv->gmii_csr_clk_range << MAC_GMII_ADR_CR_BIT) | ++ (1UL << MAC_GMII_ADR_GW_BIT) | ++ (1UL << MAC_GMII_ADR_GB_BIT); ++ ++ mac_reg_write(priv, MAC_GMII_DATA_REG, phydata); ++ mac_reg_write(priv, MAC_GMII_ADR_REG, addr); ++ ++ end = jiffies + MS_TO_JIFFIES(PHY_TRANSFER_TIMEOUT_MS); ++ while (time_before(jiffies, end)) { ++ if (!(mac_reg_read(priv, MAC_GMII_ADR_REG) & (1UL << MAC_GMII_ADR_GB_BIT))) { ++ break; ++ } ++ } ++ ++ DBG(1, KERN_INFO "phy_write() %s: phyaddr=0x%x, phyreg=0x%x, phydata=0x%x\n", dev->name, phyaddr, phyreg, phydata); ++#endif // ARMULATING ++} ++ ++/* ++ * Finds and reports the PHY address ++ */ ++void phy_detect(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++#ifdef ARMULATING ++ priv->mii.phy_id = 0; ++ priv->phy_type = 0x22 << 16 | 0x1619; ++ priv->phy_addr = 0; ++#else // ARMULATING ++ int phyaddr; ++ ++ DBG(2, KERN_INFO "phy_detect() %s: Entered\n", priv->netdev->name); ++ ++ // Scan all 32 PHY addresses if necessary ++ priv->phy_type = 0; ++ for (phyaddr = 1; phyaddr < 33; ++phyaddr) { ++ unsigned int id1, id2; ++ ++ // Read the PHY identifiers ++ id1 = phy_read(priv->netdev, phyaddr & 31, MII_PHYSID1); ++ id2 = phy_read(priv->netdev, phyaddr & 31, MII_PHYSID2); ++ ++ DBG(2, KERN_INFO "phy_detect() %s: PHY adr = %u -> phy_id1=0x%x, phy_id2=0x%x\n", priv->netdev->name, phyaddr, id1, id2); ++ ++ // Make sure it is a valid identifier ++ if (id1 != 0x0000 && id1 != 0xffff && id1 != 0x8000 && ++ id2 != 0x0000 && id2 != 0xffff && id2 != 0x8000) { ++ DBG(2, KERN_NOTICE "phy_detect() %s: Found PHY at address = %u\n", priv->netdev->name, phyaddr); ++ priv->mii.phy_id = phyaddr & 31; ++ priv->phy_type = id1 << 16 | id2; ++ priv->phy_addr = phyaddr; ++ break; ++ } ++ } ++#endif // ARMULATING ++} ++ ++void start_phy_reset(gmac_priv_t* priv) ++{ ++ // Ask the PHY to reset ++ phy_write(priv->netdev, priv->phy_addr, MII_BMCR, BMCR_RESET); ++} ++ ++int is_phy_reset_complete(gmac_priv_t* priv) ++{ ++#ifdef ARMULATING ++ return 1; ++#else // ARMULATING ++ int complete = 0; ++ int bmcr; ++ ++ // Read back the status until it indicates reset, or we timeout ++ bmcr = phy_read(priv->netdev, priv->phy_addr, MII_BMCR); ++ if (!(bmcr & BMCR_RESET)) { ++ complete = 1; ++ } ++ ++ return complete; ++#endif // ARMULATING ++} ++ ++int phy_reset(struct net_device *dev) ++{ ++#ifdef ARMULATING ++ return 0; ++#else // ARMULATING ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ int complete = 0; ++ unsigned long end; ++ ++ // Start the reset operation ++ start_phy_reset(priv); ++ ++ // Total time to wait for reset to complete ++ end = jiffies + MS_TO_JIFFIES(PHY_TRANSFER_TIMEOUT_MS); ++ ++ // Should apparently wait at least 50mS before reading back from PHY; this ++ // could just be a nasty feature of the SMC91x MAC/PHY and not apply to us ++ msleep(50); ++ ++ // Read back the status until it indicates reset, or we timeout ++ while (!(complete = is_phy_reset_complete(priv)) && time_before(jiffies, end)) { ++ msleep(1); ++ } ++ ++ return !complete; ++#endif // ARMULATING ++} ++ ++void phy_powerdown(struct net_device *dev) ++{ ++ gmac_priv_t* priv = (gmac_priv_t*)netdev_priv(dev); ++ ++ unsigned int bmcr = phy_read(dev, priv->phy_addr, MII_BMCR); ++ phy_write(dev, priv->phy_addr, MII_BMCR, bmcr | BMCR_PDOWN); ++} ++ ++void set_phy_negotiate_mode(struct net_device *dev) ++{ ++ gmac_priv_t *priv = (gmac_priv_t*)netdev_priv(dev); ++ struct mii_if_info *mii = &priv->mii; ++ struct ethtool_cmd *ecmd = &priv->ethtool_cmd; ++ u32 bmcr; ++ ++ bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR); ++ ++ if (ecmd->autoneg == AUTONEG_ENABLE) { ++ u32 advert, tmp; ++ u32 advert2 = 0, tmp2 = 0; ++ ++//printk("set_phy_negotiate_mode() Auto negotiating link mode\n"); ++ // Advertise only what has been requested ++ advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE); ++ tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ++ ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); ++ ++ if (ecmd->supported & (SUPPORTED_1000baseT_Full | ADVERTISE_1000HALF)) { ++ advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); ++ tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL); ++ } ++ ++ if (ecmd->advertising & ADVERTISED_10baseT_Half) { ++ tmp |= ADVERTISE_10HALF; ++ } ++ if (ecmd->advertising & ADVERTISED_10baseT_Full) { ++ tmp |= ADVERTISE_10FULL; ++ } ++ if (ecmd->advertising & ADVERTISED_100baseT_Half) { ++ tmp |= ADVERTISE_100HALF; ++ } ++ if (ecmd->advertising & ADVERTISED_100baseT_Full) { ++ tmp |= ADVERTISE_100FULL; ++ } ++ if ((ecmd->supported & SUPPORTED_1000baseT_Half) && ++ (ecmd->advertising & ADVERTISED_1000baseT_Half)) { ++ tmp2 |= ADVERTISE_1000HALF; ++ } ++ if ((ecmd->supported & SUPPORTED_1000baseT_Full) && ++ (ecmd->advertising & ADVERTISED_1000baseT_Full)) { ++ tmp2 |= ADVERTISE_1000FULL; ++ } ++ ++ if (ecmd->advertising & ADVERTISED_Pause) { ++ tmp |= ADVERTISE_PAUSE_CAP; ++ } ++ if (ecmd->advertising & ADVERTISED_Asym_Pause) { ++ tmp |= ADVERTISE_PAUSE_ASYM; ++ } ++ ++ if (advert != tmp) { ++//printk("set_phy_negotiate_mode() Setting MII_ADVERTISE to 0x%08x\n", tmp); ++ mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp); ++ mii->advertising = tmp; ++ } ++ if (advert2 != tmp2) { ++//printk("set_phy_negotiate_mode() Setting MII_CTRL1000 to 0x%08x\n", tmp2); ++ mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2); ++ } ++ ++ // Auto-negotiate the link state ++ bmcr |= (BMCR_ANRESTART | BMCR_ANENABLE); ++ mii->mdio_write(dev, mii->phy_id, MII_BMCR, bmcr); ++ } else { ++ u32 tmp; ++//printk("set_phy_negotiate_mode() Unilaterally setting link mode\n"); ++ ++ // Turn off auto negotiation, set speed and duplicitly unilaterally ++ tmp = bmcr & ~(BMCR_ANENABLE | BMCR_SPEED100 | BMCR_SPEED1000 | BMCR_FULLDPLX); ++ if (ecmd->speed == SPEED_1000) { ++ tmp |= BMCR_SPEED1000; ++ } else if (ecmd->speed == SPEED_100) { ++ tmp |= BMCR_SPEED100; ++ } ++ ++ if (ecmd->duplex == DUPLEX_FULL) { ++ tmp |= BMCR_FULLDPLX; ++ mii->full_duplex = 1; ++ } else { ++ mii->full_duplex = 0; ++ } ++ ++ if (bmcr != tmp) { ++ mii->mdio_write(dev, mii->phy_id, MII_BMCR, tmp); ++ } ++ } ++} ++ ++u32 get_phy_capabilies(gmac_priv_t* priv) ++{ ++ struct mii_if_info *mii = &priv->mii; ++ ++ // Ask the PHY for it's capabilities ++ u32 reg = mii->mdio_read(priv->netdev, mii->phy_id, MII_BMSR); ++ ++ // Assume PHY has MII interface ++ u32 features = SUPPORTED_MII; ++ ++ if (reg & BMSR_ANEGCAPABLE) { ++ features |= SUPPORTED_Autoneg; ++ } ++ if (reg & BMSR_100FULL) { ++ features |= SUPPORTED_100baseT_Full; ++ } ++ if (reg & BMSR_100HALF) { ++ features |= SUPPORTED_100baseT_Half; ++ } ++ if (reg & BMSR_10FULL) { ++ features |= SUPPORTED_10baseT_Full; ++ } ++ if (reg & BMSR_10HALF) { ++ features |= SUPPORTED_10baseT_Half; ++ } ++ ++ // Does the PHY have the extended status register? ++ if (reg & BMSR_ESTATEN) { ++ reg = mii->mdio_read(priv->netdev, mii->phy_id, MII_ESTATUS); ++ ++ if (reg & ESTATUS_1000_TFULL) ++ features |= SUPPORTED_1000baseT_Full; ++ if (reg & ESTATUS_1000_THALF) ++ features |= SUPPORTED_1000baseT_Half; ++ } ++ ++ return features; ++} +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_phy.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_phy.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac_phy.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_phy.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,78 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_phy.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#if !defined(__GMAC_PHY_H__) ++#define __GMAC_PHY_H__ ++ ++#include <asm/types.h> ++#include <linux/netdevice.h> ++#include <linux/mii.h> ++#include "gmac.h" ++ ++#define PHY_TYPE_NONE 0 ++#define PHY_TYPE_MICREL_KS8721BL 0x00221619 ++#define PHY_TYPE_VITESSE_VSC8201XVZ 0x000fc413 ++#define PHY_TYPE_REALTEK_RTL8211BGR 0x001cc912 ++#define PHY_TYPE_LSI_ET1011C 0x0282f013 ++#define PHY_TYPE_LSI_ET1011C2 0x0282f014 ++#define PHY_TYPE_ICPLUS_IP1001 0x02430d90 ++ ++#define VSC8201_MII_ACSR 0x1c // Vitesse VCS8201 gigabit PHY Auxillary Control and Status register ++#define VSC8201_MII_ACSR_MDPPS_BIT 2 // Mode/Duplex Pin Priority Select ++ ++#define ET1011C_MII_CONFIG 0x16 ++#define ET1011C_MII_CONFIG_IFMODESEL 0 ++#define ET1011C_MII_CONFIG_IFMODESEL_NUM_BITS 3 ++#define ET1011C_MII_CONFIG_SYSCLKEN 4 ++#define ET1011C_MII_CONFIG_TXCLKEN 5 ++#define ET1011C_MII_CONFIG_TBI_RATESEL 8 ++#define ET1011C_MII_CONFIG_CRS_TX_EN 15 ++ ++#define ET1011C_MII_CONFIG_IFMODESEL_GMII_MII 0 ++#define ET1011C_MII_CONFIG_IFMODESEL_TBI 1 ++#define ET1011C_MII_CONFIG_IFMODESEL_GMII_MII_GTX 2 ++ ++#define ET1011C_MII_LED2 0x1c ++#define ET1011C_MII_LED2_LED_TXRX 12 ++#define ET1011C_MII_LED2_LED_NUM_BITS 4 ++ ++#define ET1011C_MII_LED2_LED_TXRX_ON 0xe ++#define ET1011C_MII_LED2_LED_TXRX_ACTIVITY 0x7 ++ ++extern int phy_read(struct net_device *dev, int phyaddr, int phyreg); ++ ++extern void phy_write(struct net_device *dev, int phyaddr, int phyreg, int phydata); ++ ++extern void phy_detect(struct net_device *dev); ++ ++extern int phy_reset(struct net_device *dev); ++ ++extern void phy_powerdown(struct net_device *dev); ++ ++extern void start_phy_reset(gmac_priv_t* priv); ++ ++extern int is_phy_reset_complete(gmac_priv_t* priv); ++ ++extern void set_phy_negotiate_mode(struct net_device *dev); ++ ++extern u32 get_phy_capabilies(gmac_priv_t* priv); ++ ++extern u32 get_phy_capabilies(gmac_priv_t* priv); ++#endif // #if !defined(__GMAC_PHY_H__) ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gmac_reg.h linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_reg.h +--- linux-2.6.24/arch/arm/mach-hipox/gmac_reg.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gmac_reg.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,508 @@ ++/* ++ * linux/arch/arm/mach-hipox/gmac_reg.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#if !defined(__GMAC_REG_H__) ++#define __GMAC_REG_H__ ++ ++#include <asm/io.h> ++#include "gmac.h" ++ ++/** ++ * MAC register access functions ++ */ ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the MAC register to access ++ */ ++static inline u32 mac_reg_read(gmac_priv_t* priv, int reg_num) ++{ ++//printk("$WReading MAC register %u at byte adr 0x%08x\n", reg_num, priv->macBase + (reg_num << 2)); ++ return readl(priv->macBase + (reg_num << 2)); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the MAC register to access ++ */ ++static inline void mac_reg_write(gmac_priv_t* priv, int reg_num, u32 value) ++{ ++//printk("$WWriting MAC register %u at byte adr 0x%08x with 0x%08x\n", reg_num, priv->macBase + (reg_num << 2), value); ++ writel(value, priv->macBase + (reg_num << 2)); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the MAC register to access ++ * @param bits_to_clear A u32 specifying which bits of the specified register to ++ * clear. A set bit in this parameter will cause the matching bit in the ++ * register to be cleared ++ */ ++static inline void mac_reg_clear_mask(gmac_priv_t* priv, int reg_num, u32 bits_to_clear) ++{ ++ mac_reg_write(priv, reg_num, mac_reg_read(priv, reg_num) & ~bits_to_clear); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the MAC register to access ++ * @param bits_to_set A u32 specifying which bits of the specified register to ++ * set. A set bit in this parameter will cause the matching bit in the register ++ * to be set ++ */ ++static inline void mac_reg_set_mask(gmac_priv_t* priv, int reg_num, u32 bits_to_set) ++{ ++ mac_reg_write(priv, reg_num, mac_reg_read(priv, reg_num) | bits_to_set); ++} ++ ++/** ++ * DMA register access functions ++ */ ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the DMA register to access ++ */ ++static inline u32 dma_reg_read(gmac_priv_t* priv, int reg_num) ++{ ++//printk("$WReading DMA register %u at byte adr 0x%08x\n", reg_num, priv->dmaBase + (reg_num << 2)); ++ return readl(priv->dmaBase + (reg_num << 2)); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the DMA register to access ++ */ ++static inline void dma_reg_write(gmac_priv_t* priv, int reg_num, u32 value) ++{ ++//printk("$WWriting DMA register %u at byte adr 0x%08x with 0x%08x\n", reg_num, priv->dmaBase + (reg_num << 2), value); ++ writel(value, priv->dmaBase + (reg_num << 2)); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the DMA register to access ++ * @param bits_to_clear A u32 specifying which bits of the specified register to ++ * clear. A set bit in this parameter will cause the matching bit in the ++ * register to be cleared ++ * @return An u32 containing the new value written to the register ++ */ ++static inline u32 dma_reg_clear_mask(gmac_priv_t* priv, int reg_num, u32 bits_to_clear) ++{ ++ u32 new_value = dma_reg_read(priv, reg_num) & ~bits_to_clear; ++ dma_reg_write(priv, reg_num, new_value); ++ return new_value; ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the DMA register to access ++ * @param bits_to_set A u32 specifying which bits of the specified register to ++ * set. A set bit in this parameter will cause the matching bit in the register ++ * to be set ++ * @return An u32 containing the new value written to the register ++ */ ++static inline u32 dma_reg_set_mask(gmac_priv_t* priv, int reg_num, u32 bits_to_set) ++{ ++ u32 new_value = dma_reg_read(priv, reg_num) | bits_to_set; ++ dma_reg_write(priv, reg_num, new_value); ++ return new_value; ++} ++ ++#define NUM_PERFECT_MATCH_REGISTERS 15 ++ ++/** ++ * MAC register indices ++ */ ++typedef enum gmac_mac_regs { ++ MAC_CONFIG_REG = 0, ++ MAC_FRAME_FILTER_REG = 1, ++ MAC_HASH_HIGH_REG = 2, ++ MAC_HASH_LOW_REG = 3, ++ MAC_GMII_ADR_REG = 4, ++ MAC_GMII_DATA_REG = 5, ++ MAC_FLOW_CNTL_REG = 6, ++ MAC_VLAN_TAG_REG = 7, ++ MAC_VERSION_REG = 8, ++ MAC_ADR0_HIGH_REG = 16, ++ MAC_ADR0_LOW_REG = 17, ++ MAC_ADR1_HIGH_REG = 18, ++ MAC_ADR1_LOW_REG = 19, ++ MAC_ADR2_HIGH_REG = 20, ++ MAC_ADR2_LOW_REG = 21, ++ MAC_ADR3_HIGH_REG = 22, ++ MAC_ADR3_LOW_REG = 23, ++ MAC_ADR4_HIGH_REG = 24, ++ MAC_ADR4_LOW_REG = 25, ++ MAC_ADR5_HIGH_REG = 26, ++ MAC_ADR5_LOW_REG = 27, ++ MAC_ADR6_HIGH_REG = 28, ++ MAC_ADR6_LOW_REG = 29, ++ MAC_ADR7_HIGH_REG = 30, ++ MAC_ADR7_LOW_REG = 31, ++ MAC_ADR8_HIGH_REG = 32, ++ MAC_ADR8_LOW_REG = 33, ++ MAC_ADR9_HIGH_REG = 34, ++ MAC_ADR9_LOW_REG = 35, ++ MAC_ADR10_HIGH_REG = 36, ++ MAC_ADR10_LOW_REG = 37, ++ MAC_ADR11_HIGH_REG = 38, ++ MAC_ADR11_LOW_REG = 39, ++ MAC_ADR12_HIGH_REG = 40, ++ MAC_ADR12_LOW_REG = 41, ++ MAC_ADR13_HIGH_REG = 42, ++ MAC_ADR13_LOW_REG = 43, ++ MAC_ADR14_HIGH_REG = 44, ++ MAC_ADR14_LOW_REG = 45, ++ MAC_ADR15_HIGH_REG = 46, ++ MAC_ADR15_LOW_REG = 47 ++} gmac_mac_regs_t; ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the perfect matching low register ++ * @param value A u32 specifying the value to write to the register ++ */ ++static inline void mac_adrlo_reg_write(gmac_priv_t* priv, int reg_num, u32 value) ++{ ++ mac_reg_write(priv, MAC_ADR1_LOW_REG + (2*reg_num), value); ++} ++ ++/** ++ * @param priv A gmac_priv_t* pointing to private device data ++ * @param reg_num An int specifying the index of the perfect matching high register ++ * @param value A u32 specifying the value to write to the register ++ */ ++static inline void mac_adrhi_reg_write(gmac_priv_t* priv, int reg_num, u32 value) ++{ ++ mac_reg_write(priv, MAC_ADR1_HIGH_REG + (2*reg_num), value); ++} ++ ++/** ++ * MAC register field definitions ++ */ ++typedef enum gmac_config_reg { ++ MAC_CONFIG_WD_BIT = 23, ++ MAC_CONFIG_JD_BIT = 22, ++ MAC_CONFIG_BE_BIT = 21, ++ MAC_CONFIG_JE_BIT = 20, ++ MAC_CONFIG_IFG_BIT = 17, ++ MAC_CONFIG_PS_BIT = 15, ++ MAC_CONFIG_DO_BIT = 13, ++ MAC_CONFIG_LM_BIT = 12, ++ MAC_CONFIG_DM_BIT = 11, ++ MAC_CONFIG_IPC_BIT = 10, ++ MAC_CONFIG_DR_BIT = 9, ++ MAC_CONFIG_ACS_BIT = 7, ++ MAC_CONFIG_BL_BIT = 5, ++ MAC_CONFIG_DC_BIT = 4, ++ MAC_CONFIG_TE_BIT = 3, ++ MAC_CONFIG_RE_BIT = 2 ++} gmac_config_reg_t; ++ ++#define MAC_CONFIG_IFG_NUM_BITS 3 ++#define MAC_CONFIG_BL_NUM_BITS 2 ++ ++typedef enum gmac_frame_filter_reg { ++ MAC_FRAME_FILTER_RA_BIT = 31, ++ MAC_FRAME_FILTER_SAF_BIT = 9, ++ MAC_FRAME_FILTER_SAIF_BIT = 8, ++ MAC_FRAME_FILTER_PCF_BIT = 6, ++ MAC_FRAME_FILTER_DBF_BIT = 5, ++ MAC_FRAME_FILTER_PM_BIT = 4, ++ MAC_FRAME_FILTER_DAIF_BIT = 3, ++ MAC_FRAME_FILTER_HMC_BIT = 2, ++ MAC_FRAME_FILTER_HUC_BIT = 1, ++ MAC_FRAME_FILTER_PR_BIT = 0 ++} gmac_frame_filter_reg_t; ++ ++#define MAC_FRAME_FILTER_PCF_NUM_BITS 2 ++ ++typedef enum gmac_hash_table_high_reg { ++ MAC_HASH_HIGH_HTH_BIT = 0 ++} gmac_hash_table_high_reg_t; ++ ++typedef enum gmac_hash_table_low_reg { ++ MAC_HASH_LOW_HTL_BIT = 0 ++} gmac_hash_table_low_reg_t; ++ ++typedef enum gmac_gmii_address_reg { ++ MAC_GMII_ADR_PA_BIT = 11, ++ MAC_GMII_ADR_GR_BIT = 6, ++ MAC_GMII_ADR_CR_BIT = 2, ++ MAC_GMII_ADR_GW_BIT = 1, ++ MAC_GMII_ADR_GB_BIT = 0 ++} gmac_gmii_address_reg_t; ++ ++#define MAC_GMII_ADR_PA_NUM_BITS 5 ++#define MAC_GMII_ADR_GR_NUM_BITS 5 ++#define MAC_GMII_ADR_CR_NUM_BITS 3 ++ ++typedef enum gmac_gmii_data_reg { ++ MAC_GMII_DATA_GD_BIT = 0 ++} gmac_gmii_data_reg_t; ++ ++#define MAC_GMII_DATA_GD_NUM_BITS 16 ++ ++typedef enum gmac_flow_control_reg { ++ MAC_FLOW_CNTL_PT_BIT = 16, ++ MAC_FLOW_CNTL_PLT_BIT = 4, ++ MAC_FLOW_CNTL_UP_BIT = 3, ++ MAC_FLOW_CNTL_RFE_BIT = 2, ++ MAC_FLOW_CNTL_TFE_BIT = 1, ++ MAC_FLOW_CNTL_FCB_BPA_BIT = 0 ++} gmac_flow_control_reg_t; ++ ++#define MAC_FLOW_CNTL_PT_NUM_BITS 16 ++#define MAC_FLOW_CNTL_PLT_NUM_BITS 2 ++ ++typedef enum gmac_vlan_tag_reg { ++ MAC_VLAN_TAG_LV_BIT = 0 ++} gmac_vlan_tag_reg_t; ++ ++#define MAC_VLAN_TAG_LV_NUM_BITS 16 ++ ++typedef enum gmac_version_reg { ++ MAC_VERSION_UD_BIT = 8, ++ MAC_VERSION_SD_BIT = 0 ++} gmac_version_reg_t; ++ ++#define MAC_VERSION_UD_NUM_BITS 8 ++#define MAC_VERSION_SD_NUM_BITS 8 ++ ++typedef enum gmac_mac_adr_0_high_reg { ++ MAC_ADR0_HIGH_MO_BIT = 31, ++ MAC_ADR0_HIGH_A_BIT = 0 ++} gmac_mac_adr_0_high_reg_t; ++ ++#define MAC_ADR0_HIGH_A_NUM_BITS 16 ++ ++typedef enum gmac_mac_adr_0_low_reg { ++ MAC_ADR0_LOW_A_BIT = 0 ++} gmac_mac_adr_0_low_reg_t; ++ ++typedef enum gmac_mac_adr_1_high_reg { ++ MAC_ADR1_HIGH_AE_BIT = 31, ++ MAC_ADR1_HIGH_SA_BIT = 30, ++ MAC_ADR1_HIGH_MBC_BIT = 24, ++ MAC_ADR1_HIGH_A_BIT = 0 ++} gmac_mac_adr_1_high_reg_t; ++ ++#define MAC_ADR1_HIGH_MBC_NUM_BITS 6 ++#define MAC_ADR1_HIGH_A_NUM_BITS 16 ++ ++typedef enum gmac_mac_adr_1_low_reg { ++ MAC_ADR1_LOW_A_BIT = 0 ++} gmac_mac_adr_1_low_reg_t; ++ ++ ++/** ++ * MMC register indices - registers accessed via the MAC accessor functions ++ */ ++typedef enum gmac_mmc_regs { ++ MMC_CONTROL_REG = 64, ++ MMC_RX_INT_REG = 65, ++ MMC_TX_INT_REG = 66, ++ MMC_RX_MASK_REG = 67, ++ MMC_TX_MASK_REG = 68 ++} gmac_mmc_regs_t; ++ ++ ++/** ++ * DMA register indices ++ */ ++typedef enum gmac_dma_regs { ++ DMA_BUS_MODE_REG = 0, ++ DMA_TX_POLL_REG = 1, ++ DMA_RX_POLL_REG = 2, ++ DMA_RX_DESC_ADR_REG = 3, ++ DMA_TX_DESC_ADR_REG = 4, ++ DMA_STATUS_REG = 5, ++ DMA_OP_MODE_REG = 6, ++ DMA_INT_ENABLE_REG = 7, ++ DMA_MISSED_OVERFLOW_REG = 8, ++ DMA_CUR_TX_DESC_REG = 18, ++ DMA_CUR_RX_DESC_REG = 19, ++ DMA_CUR_TX_ADR_REG = 20, ++ DMA_CUR_RX_ADR_REG = 21 ++} gmac_dma_regs_t; ++ ++ ++/** ++ * DMA register field definitions ++ */ ++ ++typedef enum gmac_dma_bus_mode_reg { ++ DMA_BUS_MODE_FB_BIT = 16, ++ DMA_BUS_MODE_PR_BIT = 14, ++ DMA_BUS_MODE_PBL_BIT = 8, ++ DMA_BUS_MODE_DSL_BIT = 2, ++ DMA_BUS_MODE_DA_BIT = 1, ++ DMA_BUS_MODE_SWR_BIT = 0 ++} gmac_dma_bus_mode_reg_t; ++ ++#define DMA_BUS_MODE_PR_NUM_BITS 2 ++#define DMA_BUS_MODE_PBL_NUM_BITS 6 ++#define DMA_BUS_MODE_DSL_NUM_BITS 5 ++ ++typedef enum gmac_dma_tx_poll_demand_reg { ++ DMA_TX_POLL_TPD_BIT = 0 ++} gmac_dma_tx_poll_demand_reg_t; ++ ++typedef enum gmac_dma_rx_poll_demand_reg { ++ DMA_RX_POLL_RPD_BIT = 0 ++} gmac_dma_rx_poll_demand_reg_t; ++ ++typedef enum gmac_dma_rx_desc_list_adr_reg { ++ DMA_RX_DESC_ADR_SRL_BIT = 0 ++} gmac_dma_rx_desc_list_adr_reg_t; ++ ++typedef enum gmac_dma_tx_desc_list_adr_reg { ++ DMA_TX_DESC_ADR_STL_BIT = 0 ++} gmac_dma_tx_desc_list_adr_reg_t; ++ ++typedef enum gmac_dma_status_reg { ++ DMA_STATUS_GPI_BIT = 28, ++ DMA_STATUS_GMI_BIT = 27, ++ DMA_STATUS_GLI_BIT = 26, ++ DMA_STATUS_EB_BIT = 23, ++ DMA_STATUS_TS_BIT = 20, ++ DMA_STATUS_RS_BIT = 17, ++ DMA_STATUS_NIS_BIT = 16, ++ DMA_STATUS_AIS_BIT = 15, ++ DMA_STATUS_ERI_BIT = 14, ++ DMA_STATUS_FBE_BIT = 13, ++ DMA_STATUS_ETI_BIT = 10, ++ DMA_STATUS_RWT_BIT = 9, ++ DMA_STATUS_RPS_BIT = 8, ++ DMA_STATUS_RU_BIT = 7, ++ DMA_STATUS_RI_BIT = 6, ++ DMA_STATUS_UNF_BIT = 5, ++ DMA_STATUS_OVF_BIT = 4, ++ DMA_STATUS_TJT_BIT = 3, ++ DMA_STATUS_TU_BIT = 2, ++ DMA_STATUS_TPS_BIT = 1, ++ DMA_STATUS_TI_BIT = 0 ++} gmac_dma_status_reg_t; ++ ++#define DMA_STATUS_EB_NUM_BITS 3 ++#define DMA_STATUS_TS_NUM_BITS 3 ++#define DMA_STATUS_RS_NUM_BITS 3 ++ ++typedef enum gmac_dma_status_ts_val { ++ DMA_STATUS_TS_CLOSING = 7, ++ DMA_STATUS_TS_SUSPENDED = 6, ++ DMA_STATUS_TS_RESERVED = 5, ++ DMA_STATUS_TS_FLUSHING = 4, ++ DMA_STATUS_TS_READING = 3, ++ DMA_STATUS_TS_WAITING = 2, ++ DMA_STATUS_TS_FETCHING = 1, ++ DMA_STATUS_TS_STOPPED = 0 ++} gmac_dma_status_ts_val_t; ++ ++typedef enum gmac_dma_op_mode_reg { ++ DMA_OP_MODE_DT_BIT = 26, ++ DMA_OP_MODE_RSF_BIT = 25, ++ DMA_OP_MODE_DFF_BIT = 24, ++ DMA_OP_MODE_RFA2_BIT = 23, ++ DMA_OP_MODE_RFD2_BIT = 22, ++ DMA_OP_MODE_SF_BIT = 21, ++ DMA_OP_MODE_FTF_BIT = 20, ++ DMA_OP_MODE_TTC_BIT = 14, ++ DMA_OP_MODE_ST_BIT = 13, ++ DMA_OP_MODE_RFD_BIT = 11, ++ DMA_OP_MODE_RFA_BIT = 9, ++ DMA_OP_MODE_EFC_BIT = 8, ++ DMA_OP_MODE_FEF_BIT = 7, ++ DMA_OP_MODE_FUF_BIT = 6, ++ DMA_OP_MODE_RTC_BIT = 3, ++ DMA_OP_MODE_OSF_BIT = 2, ++ DMA_OP_MODE_SR_BIT = 1 ++} gmac_dma_op_mode_reg_t; ++ ++#define DMA_OP_MODE_TTC_NUM_BITS 3 ++ ++typedef enum gmac_dma_op_mode_ttc_val { ++ DMA_OP_MODE_TTC_16 = 7, ++ DMA_OP_MODE_TTC_24 = 6, ++ DMA_OP_MODE_TTC_32 = 5, ++ DMA_OP_MODE_TTC_40 = 4, ++ DMA_OP_MODE_TTC_256 = 3, ++ DMA_OP_MODE_TTC_192 = 2, ++ DMA_OP_MODE_TTC_128 = 1, ++ DMA_OP_MODE_TTC_64 = 0 ++} gmac_dma_op_mode_ttc_val_t; ++ ++#define DMA_OP_MODE_RFD_NUM_BITS 2 ++#define DMA_OP_MODE_RFA_NUM_BITS 2 ++#define DMA_OP_MODE_RTC_NUM_BITS 2 ++ ++typedef enum gmac_dma_op_mode_rtc_val { ++ DMA_OP_MODE_RTC_128 = 3, ++ DMA_OP_MODE_RTC_96 = 2, ++ DMA_OP_MODE_RTC_32 = 1, ++ DMA_OP_MODE_RTC_64 = 0 ++} gmac_dma_op_mode_rtc_val_t; ++ ++typedef enum gmac_dma_intr_enable_reg { ++ DMA_INT_ENABLE_NI_BIT = 16, ++ DMA_INT_ENABLE_AI_BIT = 15, ++ DMA_INT_ENABLE_ERE_BIT = 14, ++ DMA_INT_ENABLE_FBE_BIT = 13, ++ DMA_INT_ENABLE_ETE_BIT = 10, ++ DMA_INT_ENABLE_RW_BIT = 9, ++ DMA_INT_ENABLE_RS_BIT = 8, ++ DMA_INT_ENABLE_RU_BIT = 7, ++ DMA_INT_ENABLE_RI_BIT = 6, ++ DMA_INT_ENABLE_UN_BIT = 5, ++ DMA_INT_ENABLE_OV_BIT = 4, ++ DMA_INT_ENABLE_TJ_BIT = 3, ++ DMA_INT_ENABLE_TU_BIT = 2, ++ DMA_INT_ENABLE_TS_BIT = 1, ++ DMA_INT_ENABLE_TI_BIT = 0 ++} gmac_dma_intr_enable_reg_t; ++ ++typedef enum gmac_dma_missed_overflow_reg { ++ DMA_MISSED_OVERFLOW_OFOC_BIT = 28, // Overflow bit for FIFO Overflow Counter ++ DMA_MISSED_OVERFLOW_AMFC_BIT = 17, // Application Missed Frames Count ++ DMA_MISSED_OVERFLOW_OAMFO_BIT = 16, // Overflow bit for Application Missed Frames Count ++ DMA_MISSED_OVERFLOW_CMFC_BIT = 0 // Controller Missed Frames Count ++} gmac_dma_missed_overflow_reg_t; ++ ++#define DMA_MISSED_OVERFLOW_OAMFO_NUM_BITS 11 ++#define DMA_MISSED_OVERFLOW_CMFC_NUM_BITS 16 ++ ++typedef enum gmac_dma_current_tx_desc_reg { ++ DMA_CUR_TX_DESC_A_BIT = 0 ++} gmac_dma_current_tx_desc_reg_t; ++ ++typedef enum gmac_dma_current_rx_desc_reg { ++ DMA_CUR_RX_DESC_A_BIT = 0 ++} gmac_dma_current_rx_desc_reg_t; ++ ++typedef enum gmac_dma_current_tx_adr_reg { ++ DMA_CUR_TX_ADR_A_BIT = 0 ++} gmac_dma_current_tx_adr_reg_t; ++ ++typedef enum gmac_dma_current_rx_adr_reg { ++ DMA_CUR_RX_ADR_A_BIT = 0 ++} gmac_dma_current_rx_adr_reg_t; ++ ++#endif // #if !defined(__GMAC_REG_H__) ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/gpioTest.c linux-2.6.24-oxe810/arch/arm/mach-hipox/gpioTest.c +--- linux-2.6.24/arch/arm/mach-hipox/gpioTest.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/gpioTest.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,657 @@ ++#include <asm/io.h> ++#include <asm/bitops.h> ++#include <asm/uaccess.h> // copy_to_user and copy_from_user ++#include <linux/init.h> // modules ++#include <linux/module.h> // module ++#include <linux/types.h> // dev_t type ++#include <linux/fs.h> // chrdev allocation ++#include <linux/slab.h> // kmalloc and kfree ++#include <linux/cdev.h> // struct cdev ++#include <linux/errno.h> // error codes ++#include <linux/interrupt.h> ++#include <linux/delay.h> ++#include <asm/arch/hardware.h> ++ ++MODULE_LICENSE("GPL v2"); ++ ++MODULE_AUTHOR("C Ford"); ++MODULE_DESCRIPTION("gpioTest first version"); ++ ++struct gpioTest_dev { ++ struct semaphore sem; // Mutual exclusion semaphore ++ struct cdev cdev; // Char device structure ++ int found; ++}; ++ ++struct gpioTest_dev * gpioTest_device; // Contains the gpioTest devices ++ ++dev_t dev; // Contains major and first minor number ++static wait_queue_head_t ir_block; ++ ++//////////////////////////// ++// LINKED LIST OPERATIONS // ++//////////////////////////// ++ ++ ++/////////////// ++// CALLBACKS // ++/////////////// ++ ++#define GPIO_TEST_SCL (1UL << CONFIG_HIPOX_I2C_SCL) ++#define GPIO_TEST_SDA (1UL << CONFIG_HIPOX_I2C_SDA) ++ ++void DumpGPIO( void ) ++{ ++ printk( KERN_INFO "================= GPIO Dump\n" ++ " GPIO_A_DATA 0x%08x\n" ++ " GPIO_A_OUTPUT_ENABLE 0x%08x\n" ++ " GPIO_A_INTERRUPT_ENABLE 0x%08x\n" ++ " GPIO_A_INTERRUPT_EVENT 0x%08x\n" ++ " GPIO_A_OUTPUT_VALUE 0x%08x\n" ++ " GPIO_A_OUTPUT_SET 0x%08x\n" ++ " GPIO_A_OUTPUT_CLEAR 0x%08x\n" ++ " GPIO_A_OUTPUT_ENABLE_SET 0x%08x\n" ++ " GPIO_A_OUTPUT_ENABLE_CLEAR 0x%08x\n" ++ " GPIO_A_INPUT_DEBOUNCE_ENABLE 0x%08x\n" ++ " GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE 0x%08x\n" ++ " GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE 0x%08x\n" ++ " GPIO_A_RISING_EDGE_DETECT 0x%08x\n" ++ " GPIO_A_FALLING_EDGE_DETECT 0x%08x\n" ++ " GPIO_A_LEVEL_INTERRUPT_ENABLE 0x%08x\n" ++ " GPIO_A_INTERRUPT_STATUS_REGISTER 0x%08x\n", ++ readl( GPIO_A_DATA ), ++ readl( GPIO_A_OUTPUT_ENABLE ), ++ readl( GPIO_A_INTERRUPT_ENABLE ), ++ readl( GPIO_A_INTERRUPT_EVENT ), ++ readl( GPIO_A_OUTPUT_VALUE ), ++ readl( GPIO_A_OUTPUT_SET ), ++ readl( GPIO_A_OUTPUT_CLEAR ), ++ readl( GPIO_A_OUTPUT_ENABLE_SET ), ++ readl( GPIO_A_OUTPUT_ENABLE_CLEAR ), ++ readl( GPIO_A_INPUT_DEBOUNCE_ENABLE ), ++ readl( GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ), ++ readl( GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ), ++ readl( GPIO_A_RISING_EDGE_DETECT ), ++ readl( GPIO_A_FALLING_EDGE_DETECT ), ++ readl( GPIO_A_LEVEL_INTERRUPT_ENABLE ), ++ readl( GPIO_A_INTERRUPT_STATUS_REGISTER ) ); ++ ++} ++ ++irqreturn_t irqHandler( int irq, void* dev_id) ++{ ++ // is this interrupt fors us?? ++ struct gpioTest_dev* pGPIO = (struct gpioTest_dev*) dev_id; ++ unsigned int temp = readl( (volatile unsigned long *) GPIO_A_INTERRUPT_STATUS_REGISTER ); ++ ++ if ( !(temp & (GPIO_TEST_SCL | GPIO_TEST_SDA) ) ) ++ { ++ printk("Not for us...\n"); ++ return IRQ_NONE; ++ } ++ ++ // apparantly it is, for simplicity, we will stop the intterupting pin, ++ // and clear its source, then signal the bottmo half to continue ++ if ( test_bit( CONFIG_HIPOX_I2C_SCL, (volatile unsigned long *) &temp ) ) ++ { ++ printk("Int Found CONFIG_HIPOX_I2C_SCL\n"); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SCL); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SCL); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SCL); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_DETECT ) &= ~(1UL << CONFIG_HIPOX_I2C_SCL); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_DETECT ) &= ~(1UL << CONFIG_HIPOX_I2C_SCL); ++ pGPIO->found |= GPIO_TEST_SCL; ++ } ++ ++ if ( test_bit( CONFIG_HIPOX_I2C_SDA, (volatile unsigned long *) &temp ) ) ++ { ++ printk("Int Found CONFIG_HIPOX_I2C_SDA\n"); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SDA); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SDA); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) &= ~(1UL << CONFIG_HIPOX_I2C_SDA); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_DETECT ) &= ~(1UL << CONFIG_HIPOX_I2C_SDA); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_DETECT ) &= ~(1UL << CONFIG_HIPOX_I2C_SDA); ++ pGPIO->found |= GPIO_TEST_SDA; ++ } ++ ++ if ( pGPIO->found ) ++ { ++ printk("Int cleared\n"); ++ wake_up_interruptible(&ir_block); ++ } ++ ++ return IRQ_HANDLED; ++} ++ ++int gpioTest_go(void) ++{ ++ unsigned long flags; ++ unsigned int temp; ++ unsigned int i; ++ ++ //assert( CONFIG_HIPOX_I2C_SDA < CONFIG_HIPOX_I2C_SCL ); ++ ++ printk( KERN_ERR "****************************************************************\n"); ++ printk( KERN_ERR "************************************************** gpioTest_go:\n"); ++ printk( KERN_ERR "Please connect I2c SDA to I2C SCLK, and optionally attach scope:\n\n"); ++ ++ printk( KERN_ERR "Test 1: setup all inputs (and check for pull up res)\n"); ++ ++ // Setting lines to GPIO ++ *( (volatile unsigned long *) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) &= ~(1UL << (CONFIG_HIPOX_I2C_SDA & 0x0000001F) ); ++ *( (volatile unsigned long *) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) &= ~(1UL << (CONFIG_HIPOX_I2C_SCL & 0x0000001F) ); ++ ++ *( (volatile unsigned long *) SYS_CTRL_GPIO_SECSEL_CTRL_0 ) &= ~(1UL << (CONFIG_HIPOX_I2C_SDA & 0x0000001F) ); ++ *( (volatile unsigned long *) SYS_CTRL_GPIO_SECSEL_CTRL_0 ) &= ~(1UL << (CONFIG_HIPOX_I2C_SCL & 0x0000001F) ); ++ ++// Setting lines to Input ++/* ++temp = readl( GPIO_A_OUTPUT_ENABLE ); ++temp |= (GPIO_TEST_SCL | GPIO_TEST_SDA | GPIO_TEST_SCS); ++writel( temp, GPIO_A_OUTPUT_ENABLE ); ++for (i=0; i<65000; ++i) ++{ ++ temp = (i & 0x00000007) << CONFIG_HIPOX_I2C_SCL; ++ flags = readl( GPIO_A_OUTPUT_VALUE ); ++ flags &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA | GPIO_TEST_SCS); ++ flags |= temp; ++ writel( flags, GPIO_A_OUTPUT_VALUE ); ++ printk( "reads 0x%08x ",readl( GPIO_A_DATA ) ); ++ udelay(100); ++ printk( " 0x%08x\n",readl( GPIO_A_DATA ) ); ++ ++} ++*/ ++DumpGPIO(); ++ // Setting lines to Input ++ temp = readl( GPIO_A_OUTPUT_ENABLE ); ++ temp &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( temp, GPIO_A_OUTPUT_ENABLE ); ++ udelay(1); ++ if ( *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SDA) || ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SCL)) ++ { ++ printk( KERN_ERR "Test 1: Failed to clear GPIO Output Enable register)\n"); ++ return -1; ++ } ++ ++ udelay(1); ++ // read the input value: it should be one due to the pull up ++ if ( !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) )) ++ { ++ printk( KERN_ERR "Test 1: Failed to read 1 on the input(check for pull up res.))\n"); ++ return -1; ++ } ++ ++ printk( KERN_ERR "===== Passed Test 1 ======= Created GPIO inputs, and read correct values\n"); ++ ++ // Test 2: set output using direct setting, first set the output latches to zero on all lines ++ printk( KERN_ERR "Test 2: output testing and OE testing\n"); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << (CONFIG_HIPOX_I2C_SDA & 0x0000001F) ); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << (CONFIG_HIPOX_I2C_SCL & 0x0000001F) ); ++ for (i=CONFIG_HIPOX_I2C_SCL; i<=CONFIG_HIPOX_I2C_SDA; ++i) ++ { ++ // from all input, set output using direct write. Assume all input at start. ++ temp = readl( GPIO_A_OUTPUT_ENABLE ); ++ temp |= ((0x00000001) << i); ++ writel( temp, GPIO_A_OUTPUT_ENABLE ); ++ ++ udelay(1); ++ if ( ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) )) ++ { ++ printk( KERN_ERR "Test 2: Failed to read 0 on the %d input (output enabled with direct write.))\n", i); ++ return -1; ++ } ++ ++ // Setting lines to Input ++ temp = readl( GPIO_A_OUTPUT_ENABLE ); ++ temp &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( temp, GPIO_A_OUTPUT_ENABLE ); ++ ++ udelay(1); ++ if ( ( *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ ( *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SCL) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) ) ) ++ { ++ printk( KERN_ERR "Test 2: Failed to reset to clean state 1)\n"); ++ return -1; ++ } ++ ++ // from all inputs, set an output enable usign output enable set ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_SET ) |= (1UL << i); ++ ++ udelay(1); ++ if ( ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) ) ) ++ { ++ printk( KERN_ERR "Test 2: Failed to read 0 on the input %d (output enabled with direct write.))\n", i); ++ return -1; ++ } ++ ++ // now exercise the setting and clearing of the output value ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_SET ) |= (1UL << i); ++ ++ udelay(1); ++ if ( !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) ) ) ++ { ++ printk( KERN_ERR "Test 2: Failed to read 1 on the input after settin %d ahs high)\n", i); ++ return -1; ++ } ++ ++ // now exercise the setting and clearing of the output value ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << i); ++ ++ udelay(1); ++ if ( ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ ( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) ) ) ++ { ++ printk( KERN_ERR "Test 2: Failed to read 1 on the input after settin %d ahs high)\n", i); ++ return -1; ++ } ++ ++ // from i as output, set all inputs , set an output enable usign output enable set ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_CLEAR ) |= (1UL << i); ++ ++ udelay(1); ++ if ( temp != readl( GPIO_A_OUTPUT_ENABLE ) || ++ ( *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ ( *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE) & (1UL << CONFIG_HIPOX_I2C_SCL) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SDA) ) || ++ !( *( (volatile unsigned long *) GPIO_A_DATA) & (1UL << CONFIG_HIPOX_I2C_SCL) ) ) ++ { ++ printk( KERN_ERR "Test 2: Failed to reset to clean state 2)\n"); ++ return -1; ++ } ++ } ++ ++ printk( KERN_ERR "===== Passed Test 2 ======= Used all Set and clear methods for both OE and OV\n"); ++ ++ // Test 3, now exercise the interrupt. ++ printk( KERN_ERR "Test 3: Interrupt testing\n"); ++ init_waitqueue_head(&ir_block); ++ ++ request_irq( ++ (int) GPIO_1_INTERRUPT, // unsigned int irq, ++ &irqHandler, // irqreturn_t (*handler)(int, void *, struct pt_regs *), ++ IRQF_SHARED, // unsigned long irq_flags, ++ "GPIO Test Module", // const char * devname, ++ (void*) gpioTest_device ); // void * dev_id) ++ ++ ++ // set int condiiton.... ++ for (i=CONFIG_HIPOX_I2C_SCL; i<=CONFIG_HIPOX_I2C_SDA; ++i) ++ { ++ int tmo; ++ int drv = i+1 > CONFIG_HIPOX_I2C_SDA ? CONFIG_HIPOX_I2C_SCL : i+1; // BHC - This is rubbish, there's no contract saying SDA has to be on a higher numbered GPIO than SCL ++ ++ ++ // ================================================= level detect ++ // set an interrupt on i being high-level ++ printk( KERN_INFO "Test %d level int High against OP %d\n", i, drv); ++ local_irq_save(flags); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ local_irq_restore(flags); ++ ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++printk("tmo1 == 0x%08x / 0x%08x\n", tmo, 1*HZ ); ++ if ( !(gpioTest_device->found & ((0x00000001 << i))) ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 timed out 1 sec with no interrupt " ++ "While waiting for level high int....\n"); ++ return -1; ++ } ++ ++ // Next try setting the lines low, and ensure that the devices times out ++ local_irq_save(flags); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_SET ) |= (1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ ++ local_irq_restore(flags); ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++printk("tmo2 == 0x%08x\n", tmo ); ++ if ( gpioTest_device->found ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 did not timed out " ++ "While waiting for level high int with 0 input....\n"); ++ return -1; ++ } ++ ++ // set the int acive low level now. ++ printk( KERN_INFO "Test %d level int Low against OP %d\n", i, drv); ++ local_irq_save(flags); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ ++ local_irq_restore(flags); ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++printk("tmo3 == 0x%08x / 0x%08x\n", tmo, 1*HZ ); ++ if ( !(gpioTest_device->found & ((0x00000001 << i))) ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 timed out 1 sec with no interrupt " ++ "While waiting for level low int....\n"); ++ return -1; ++ } ++ ++ // Next try setting the lines high, and ensure that the devices times out ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_CLEAR ) |= ~(1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ ++ local_irq_restore(flags); ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++printk("tmo4 == 0x%08x\n", tmo ); ++ if ( gpioTest_device->found ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 did not timed out " ++ "While waiting for level low int with 1 input....\n"); ++ return -1; ++ } ++ ++ // Setting lines to Input -------------------------------------- ++ temp = readl( GPIO_A_OUTPUT_ENABLE ); ++ temp &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( temp, GPIO_A_OUTPUT_ENABLE ); ++ // ================================================= Edge detect ++ ++ // set an interrupt on i being high-level ++ local_irq_save(flags); ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ ++ printk( KERN_INFO "Test %d rising edge int High against falling edge on OP %d\n", i, drv); ++ local_irq_restore(flags); ++ ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_SET ) |= (1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << drv); ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++ if ( gpioTest_device->found || tmo ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 found int on %d falling edge, when set to rising...\n", i); ++ return -1; ++ } ++ ++ // now do th rising edge... ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_SET ) |= (1UL << drv); ++ ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++ if ( !(gpioTest_device->found & (0x00000001 << i)) || (tmo == 0) ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 did not find int on %d rising edge, when set to rising...\n", i); ++ return -1; ++ } ++ ++ // set the int acive low level now. ++ local_irq_save(flags); ++ ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_SET ) |= (1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR ) |= (1UL << drv); ++ ++ *( (volatile unsigned long *) GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ) |= (1UL << i); ++ *( (volatile unsigned long *) GPIO_A_LEVEL_INTERRUPT_ENABLE ) &= ~(1UL << i); ++ *( (volatile unsigned long *) GPIO_A_INTERRUPT_EVENT ) |= (1UL << i); ++ gpioTest_device->found = 0; ++ ++ printk( KERN_INFO "Test %d falling edge int against rising edge on OP %d\n", i, drv); ++ local_irq_restore(flags); ++ ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_ENABLE_SET ) |= (1UL << drv); ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_SET ) |= (1UL << drv); ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++ if ( gpioTest_device->found || tmo ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 found int on %d falling edge, when set to rising...\n", i); ++ return -1; ++ } ++ ++ // now do th rising edge... ++ *( (volatile unsigned long *) GPIO_A_OUTPUT_CLEAR) |= (1UL << drv); ++ ++ tmo = wait_event_interruptible_timeout(ir_block, gpioTest_device->found, 1*HZ); ++ if ( !(gpioTest_device->found & (0x00000001 << i)) || (tmo == 0) ) ++ { ++ ++ printk( KERN_ERR "$R FAILED Test 3 did not find int on %d rising edge, when set to rising...\n", i); ++ return -1; ++ } ++ ++ ++ ++ // Setting lines to Input -------------------------------------- ++ temp = readl( GPIO_A_OUTPUT_ENABLE ); ++ temp &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( temp, GPIO_A_OUTPUT_ENABLE ); ++ } ++ ++ ++ printk("$G All gpiuo tests passed.\n"); ++ ++ return 0; ++} ++ ++ ++/* ++Read callback: ++-> filp, contains the device in its private data ++-> buf, the buffer in userspace ++-> count, amount of that to be read ++-> f_pos, the starting point of the data ++-> return:number of bytes read ++*/ ++ssize_t gpioTest_read(struct file *filp, char __user *buf, size_t count,loff_t *f_pos){ ++// dev was stored in filp during the open call. ++// struct gpioTest_dev *dev = filp->private_data; ++ ++ printk( KERN_ERR "gpioTest_read:\n"); ++ ++// Copy this quantum (from the offset, to the end of this quantum) ++// to userspace ++// if(copy_to_user(buf, dptr->data[s_pos] + q_pos, count)){ ++// retval = -EFAULT; ++// goto out; ++// } ++ ++// Update the file offset ++// *f_pos += count; ++// retval = count; ++// out: ++// up(&dev->sem); ++ return 0; ++} ++ ++/* ++Write callback ++-> filp, contains the device in its private data ++-> buf, the buffer in userspace ++-> count, amount of that to be written ++-> f_pos, the starting point of the data ++-> return:number of bytes written ++*/ ++ssize_t gpioTest_write(struct file *filp, const char __user *buf, size_t count, loff_t *f_pos){ ++ ++// struct gpioTest_dev *dev = filp->private_data; ++ ++ printk( KERN_ERR "gpioTest_write:\n"); ++ ++ ++ // Copy the data to be written from userspace ++ // if(copy_from_user(dptr->data[s_pos]+q_pos, buf, count)){ ++ // retval = -EFAULT; ++ // } ++ // ++ // *f_pos+=count; ++ // retval = count; ++ ++ // Update the size ++ // if(dev->size < *f_pos){ ++ // dev->size = *f_pos; ++ // } ++ ++// out: ++ // up(&dev->sem); ++ return 0; ++} ++ ++ ++ ++/* ++Release callback ++*/ ++int gpioTest_release(struct inode *inode, struct file *filp) ++{ ++ printk( KERN_ERR "gpioTest_release:\n"); ++ return 0; ++} ++ ++/* ++Open callback ++*/ ++int gpioTest_open(struct inode *inode, struct file *filp){ ++// struct gpioTest_dev *dev; ++ ++ printk( KERN_ERR "gpioTest_open:\n"); ++ // This macro takes a pointer to a field of type 'container_field', within ++ // a strcture of type 'container_type' and returns a pointer to the containing ++ // structure. ++ // dev = container_of(inode->i_cdev, struct gpioTest_dev, cdev); ++ // Store the pointer for future access ++ // filp->private_data = dev; ++ ++ return 0; ++} ++ ++ ++ ++ ++////////////////// ++// MODULE STUFF // ++////////////////// ++ ++// File operations for this charater device ++struct file_operations gpioTest_fops = { ++ .owner = THIS_MODULE, ++ //.llseek = gpioTest_llseek, ++ .read = gpioTest_read, ++ .write = gpioTest_write, ++ // .ioctl = gpioTest_ioctl, ++ .open = gpioTest_open, ++ .release = gpioTest_release, ++}; ++ ++ ++/* ++ Module loading ++*/ ++static int gpioTest_init(void){ ++ ++ // alloc_chrdev_region return 0 on success ++ int res = alloc_chrdev_region( ++ &dev, ++ 0, ++ 1, ++ "GPIOTest"); ++ ++ printk( KERN_ERR "gpioTest_init:\n"); ++ ++ if(res){ ++ printk(KERN_WARNING "gpioTest: could not allocate device\n"); ++ return res; ++ }else{ ++ printk(KERN_WARNING "gpioTest: registered with major number:%i\n", MAJOR(dev)); ++ } ++ ++ ++ // Allocate memory for gpioTest_COUNT gpioTest_devices ++ gpioTest_device = kmalloc(sizeof(struct gpioTest_dev), GFP_KERNEL); ++ if(gpioTest_device == NULL){ ++ res = -ENOMEM; ++ goto fail; ++ } ++ ++ // Fill the gpioTest_devices region with zeros ++ memset(gpioTest_device, 0, sizeof(struct gpioTest_dev)); ++ ++ // Initialise the devices ++ ++ // Register the cdev, gpioTest_fops contains all the defined callbacks ++ cdev_init(&gpioTest_device->cdev,&gpioTest_fops); ++ gpioTest_device->cdev.owner = THIS_MODULE; ++ gpioTest_device->cdev.ops = &gpioTest_fops; ++ res = cdev_add(&gpioTest_device->cdev,MKDEV(MAJOR(dev), MINOR(dev)) ,1); ++ if(res){ ++ printk(KERN_NOTICE "Error %d adding gpioTest\n", res); ++ }else{ ++ printk(KERN_NOTICE "gpioTest added\n"); ++ } ++ ++ // perform a test ++ res = readl( GPIO_A_INPUT_DEBOUNCE_ENABLE ); ++ res &= ~(GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( res, GPIO_A_INPUT_DEBOUNCE_ENABLE ); ++ if ( gpioTest_go() ) ++ { ++ DumpGPIO(); ++ } ++ ++ // perform a test again with debounce. ++ res = readl( GPIO_A_INPUT_DEBOUNCE_ENABLE ); ++ res |= (GPIO_TEST_SCL | GPIO_TEST_SDA); ++ writel( res, GPIO_A_INPUT_DEBOUNCE_ENABLE ); ++ if ( gpioTest_go() ) ++ { ++ DumpGPIO(); ++ } ++ ++ ++ ++ return 0; ++ ++fail: ++ // do cleanup; ++ return res; ++} ++ ++ ++/* ++ Module unloading ++*/ ++static void gpioTest_exit(void){ ++ // Free the devices ++ printk( KERN_ERR "gpioTest_exit:\n"); ++ cdev_del(&gpioTest_device->cdev); ++ kfree(gpioTest_device); ++ gpioTest_device = NULL; ++ unregister_chrdev_region(dev,1); ++} ++ ++module_init(gpioTest_init); ++module_exit(gpioTest_exit); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/i2s.c linux-2.6.24-oxe810/arch/arm/mach-hipox/i2s.c +--- linux-2.6.24/arch/arm/mach-hipox/i2s.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/i2s.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,352 @@ ++/* ++ * procfs3.c - create a "file" in /proc, use the file_operation way ++ * to manage the file. ++ */ ++ ++#include <linux/types.h> ++#include <linux/errno.h> ++#include <linux/init.h> ++#include <linux/kernel.h> /* We're doing kernel work */ ++#include <linux/module.h> /* Specifically, a module */ ++#include <linux/proc_fs.h> /* Necessary because we use proc fs */ ++#include <asm/uaccess.h> /* for copy_*_user */ ++#include "asm/arch-hipox/i2s.h" ++#include "asm/io.h" ++ ++#define DRV_NAME "i2s" ++#define DRV_VERSION "0.1" ++#define PROC_ENTRY_FILENAME "i2s" ++#define PROCFS_MAX_SIZE 2048 ++ ++ ++ ++MODULE_AUTHOR("Chris Ford"); ++MODULE_DESCRIPTION("I2S Test module"); ++MODULE_LICENSE("GPL"); ++MODULE_VERSION(DRV_VERSION); ++ ++/** ++ * The buffer (2k) for this module ++ * ++ */ ++static char procfs_buffer[PROCFS_MAX_SIZE]; ++ ++/** ++ * The size of the data hold in the buffer ++ * ++ */ ++static unsigned long procfs_buffer_size = 0; ++ ++/** ++ * The structure keeping information about the /proc file ++ * ++ */ ++static struct proc_dir_entry *Our_Proc_File; ++ ++ ++void RefreshI2SRegisters(void) ++{ ++ int iLen = sprintf( procfs_buffer, ++ "DumpI2SRegisters----------------------------------\n" ++ " \n" ++ " TX_CONTROL = 0x%08x\n" ++ " TX_SETUP = 0x%08x\n" ++ " TX_SETUP1 = 0x%08x\n" ++ " TX_STATUS = 0x%08x\n" ++ " RX_CONTROL = 0x%08x\n" ++ " RX_SETUP = 0x%08x\n" ++ " RX_SETUP1 = 0x%08x\n" ++ " RX_STATUS = 0x%08x\n" ++ " TX_DEBUG = 0x%08x\n" ++ " TX_DEBUG2 = 0x%08x\n" ++ " TX_DEBUG3 = 0x%08x\n" ++ " RX_DEBUG_ = 0x%08x\n" ++ " RX_DEBUG2 = 0x%08x\n" ++ " RX_DEBUG3 = 0x%08x\n" ++ " TX_BUFFER_LEVEL = 0x%08x\n" ++ " TX_BUFFER_INTERRUPT_LEVEL = 0x%08x\n" ++ " RX_BUFFER_LEVEL = 0x%08x\n" ++ " RX_BUFFER_INTERRUPT_LEVEL = 0x%08x\n" ++ " RX_SPDIF_DEBUG = 0x%08x\n" ++ " RX_SPDIF_DEBUG2 = 0x%08x\n", ++ (u32) __raw_readl( TX_CONTROL ), ++ (u32) __raw_readl( TX_SETUP ), ++ (u32) __raw_readl( TX_SETUP1 ), ++ (u32) __raw_readl( TX_STATUS ), ++ (u32) __raw_readl( RX_CONTROL ), ++ (u32) __raw_readl( RX_SETUP ), ++ (u32) __raw_readl( RX_SETUP1 ), ++ (u32) __raw_readl( RX_STATUS ), ++ (u32) __raw_readl( TX_DEBUG ), ++ (u32) __raw_readl( TX_DEBUG2 ), ++ (u32) __raw_readl( TX_DEBUG3 ), ++ (u32) __raw_readl( RX_DEBUG_ ), ++ (u32) __raw_readl( RX_DEBUG2 ), ++ (u32) __raw_readl( RX_DEBUG3 ), ++ (u32) __raw_readl( TX_BUFFER_LEVEL ), ++ (u32) __raw_readl( TX_BUFFER_INTERRUPT_LEVEL ), ++ (u32) __raw_readl( RX_BUFFER_LEVEL ), ++ (u32) __raw_readl( RX_BUFFER_INTERRUPT_LEVEL ), ++ (u32) __raw_readl( RX_SPDIF_DEBUG ), ++ (u32) __raw_readl( RX_SPDIF_DEBUG2 ) ); ++ ++ procfs_buffer_size = iLen + sprintf( procfs_buffer + iLen, ++ " INTERRUPT_CONTROL_STATUS = 0x%08x\n" ++ " INTERRUPT_MASK = 0x%08x\n" ++ " VERSION = 0x%08x\n" ++ " TX_DATA_IN_FORMAT = 0x%08x\n" ++ " TX_CHANNELS_ENABLE = 0x%08x\n" ++ " TX_WRITES_TO = 0x%08x\n" ++ " RX_DATA_OUT_FORMAT = 0x%08x\n" ++ " RX_CHANNELS_ENABLE = 0x%08x\n" ++ " RX_READS_FROM = 0x%08x\n" ++ " TX_CPU_DATA_WRITES_ALT = 0x%08x\n" ++ " RX_CPU_DATA_READS_ALT = 0x%08x\n" ++ " TX_CPU_DATA_WRITES = 0x%08x\n" ++ " RX_CPU_DATA_READS = 0x%08x\n" ++ "\n" ++ "--------------------------------------------------\n", ++ (u32) __raw_readl( INTERRUPT_CONTROL_STATUS ), ++ (u32) __raw_readl( INTERRUPT_MASK ), ++ (u32) __raw_readl( VERSION ), ++ (u32) __raw_readl( TX_DATA_IN_FORMAT ), ++ (u32) __raw_readl( TX_CHANNELS_ENABLE ), ++ (u32) __raw_readl( TX_WRITES_TO ), ++ (u32) __raw_readl( RX_DATA_OUT_FORMAT ), ++ (u32) __raw_readl( RX_CHANNELS_ENABLE ), ++ (u32) __raw_readl( RX_READS_FROM ), ++ (u32) __raw_readl( TX_CPU_DATA_WRITES_ALT ), ++ (u32) __raw_readl( RX_CPU_DATA_READS_ALT ), ++ (u32) __raw_readl( TX_CPU_DATA_WRITES ), ++ (u32) __raw_readl( RX_CPU_DATA_READS ) ); ++} ++ ++ ++void DumpI2SRegisters(void) ++{ ++ RefreshI2SRegisters(); ++ printk( KERN_INFO "%s", procfs_buffer ); ++ return; ++} ++ ++ ++/** ++ * This funtion is called when the /proc file is read ++ * ++ */ ++static ssize_t procfs_read( ++ struct file *filp, /* see include/linux/fs.h */ ++ char *buffer, /* buffer to fill with data */ ++ size_t length, /* length of the buffer */ ++ loff_t * offset) ++{ ++ static int finished = 0; ++ ++ /* ++ * We return 0 to indicate end of file, that we have ++ * no more information. Otherwise, processes will ++ * continue to read from us in an endless loop. ++ */ ++ if ( finished ) { ++ printk(KERN_INFO "procfs_read: END\n"); ++ finished = 0; ++ return 0; ++ } ++ ++ finished = 1; ++ ++ /* ++ * We use put_to_user to copy the string from the kernel's ++ * memory segment to the memory segment of the process ++ * that called us. get_from_user, BTW, is ++ * used for the reverse. ++ */ ++ if ( copy_to_user(buffer, procfs_buffer, procfs_buffer_size) ) { ++ return -EFAULT; ++ } ++ ++ printk(KERN_INFO "procfs_read: read %lu bytes\n", procfs_buffer_size); ++ ++ return procfs_buffer_size; /* Return the number of bytes "read" */ ++} ++ ++/* ++ * This function is called when /proc is written ++ */ ++static ssize_t ++procfs_write(struct file *file, const char *buffer, size_t len, loff_t * off) ++{ ++ if ( len > PROCFS_MAX_SIZE ) { ++ procfs_buffer_size = PROCFS_MAX_SIZE; ++ } ++ else { ++ procfs_buffer_size = len; ++ } ++ ++ if ( copy_from_user(procfs_buffer, buffer, procfs_buffer_size) ) { ++ return -EFAULT; ++ } ++ ++ printk(KERN_INFO "procfs_write: write %s\n",buffer); ++ printk(KERN_INFO "procfs_write: write %lu bytes\n", procfs_buffer_size); ++ ++ return procfs_buffer_size; ++} ++ ++/* ++ * This function decides whether to allow an operation ++ * (return zero) or not allow it (return a non-zero ++ * which indicates why it is not allowed). ++ * ++ * The operation can be one of the following values: ++ * 0 - Execute (run the "file" - meaningless in our case) ++ * 2 - Write (input to the kernel module) ++ * 4 - Read (output from the kernel module) ++ * ++ * This is the real function that checks file ++ * permissions. The permissions returned by ls -l are ++ * for referece only, and can be overridden here. ++ */ ++ ++static int module_permission(struct inode *inode, int op, struct nameidata *foo) ++{ ++ /* ++ * We allow everybody to read from our module, but ++ * only root (uid 0) may write to it ++ */ ++ if (op == 4 || (op == 2 && current->euid == 0)) { ++ printk( KERN_INFO "Insufficient permissions\n"); ++ return 0; ++ } ++ ++ /* ++ * If it's anything else, access is denied ++ */ ++ return -EACCES; ++} ++ ++/* ++ * The file is opened - we don't really care about ++ * that, but it does mean we need to increment the ++ * module's reference count. ++ */ ++int procfs_open(struct inode *inode, struct file *file) ++{ ++ u32 temp = 0; ++ ++ /* Open an entry on the proc filesystem */ ++ printk(KERN_INFO "I2S::procfs_open\n"); ++ try_module_get(THIS_MODULE); ++ ++ // printk(KERN_INFO "I2S::pre-reg set..\n"); ++ // RefreshI2SRegisters(); ++ ++ /* Setup the I2S TX Core... */ ++ temp = 1 << TX_CONTROL_ENABLE | ++ 1 << TX_CONTROL_FLUSH | ++ 0 << TX_CONTROL_MUTE | ++ 0 << TX_CONTROL_TRICK | ++ 0 << TX_CONTROL_SPEED | ++ 1 << TX_CONTROL_ABORT_DMA | ++ 0 << TX_CONTROL_AHB_ENABLE | ++ 1 << TX_CONTROL_QUAD_BURSTS; ++ __raw_writel( temp, TX_CONTROL ); ++ ++ temp = TRUE_I2S << TX_SETUP_FORMAT | ++ I2S_SLAVE << TX_SETUP_MODE | ++ 0 << TX_SETUP_FLOW_INVERT | ++ 0 << TX_SETUP_POS_EDGE | ++ 0 << TX_SETUP_CLOCK_STOP | ++ 0 << TX_SETUP_SPLIT_QUAD | ++ 0 << TX_SETUP_SPDIF_EN; ++ __raw_writel( temp, TX_SETUP ); ++ ++ temp = TWOS_COMPLIMENT << TX_SETUP1_INPUT | ++ 0 << TX_SETUP1_REVERSE | ++ 0 << TX_SETUP1_INVERT | ++ 0 << TX_SETUP1_BIG_ENDIAN | ++ 0 << TX_SETUP1_QUAD_ENDIAN | ++ 0 << TX_SETUP1_QUAD_SAMPLES | ++ 0 << TX_SETUP1_FLOW_CONTROL; ++ __raw_writel( temp, TX_SETUP1 ); ++ ++ /* Setup the I2S RX Core... */ ++ ++ printk(KERN_INFO "\n\nI2S::post-reg set..\n"); ++ RefreshI2SRegisters(); ++ return 0; ++} ++ ++/* ++ * The file is closed - again, interesting only because ++ * of the reference count. ++ */ ++int procfs_close(struct inode *inode, struct file *file) ++{ ++ printk(KERN_INFO "I2S::procfs_close\n"); ++ module_put(THIS_MODULE); ++ return 0; /* success */ ++} ++ ++static struct file_operations File_Ops_4_Our_Proc_File = { ++ .read = procfs_read, ++ .write = procfs_write, ++ .open = procfs_open, ++ .release = procfs_close, ++}; ++ ++/* ++ * Inode operations for our proc file. We need it so ++ * we'll have some place to specify the file operations ++ * structure we want to use, and the function we use for ++ * permissions. It's also possible to specify functions ++ * to be called for anything else which could be done to ++ * an inode (although we don't bother, we just put ++ * NULL). ++ */ ++ ++static struct inode_operations Inode_Ops_4_Our_Proc_File = { ++ .permission = module_permission, /* check for permissions */ ++}; ++ ++/* ++ * Module initialization and cleanup ++ */ ++static int __init hipox_i2s_init_module(void) ++{ ++ printk(KERN_INFO "I2S::init_module\n"); ++ ++ /* create the /proc file */ ++ Our_Proc_File = create_proc_entry(PROC_ENTRY_FILENAME, 0644, NULL); ++ ++ /* check if the /proc file was created successfuly */ ++ if (Our_Proc_File == NULL){ ++ printk(KERN_ALERT "Error: Could not initialize /proc/%s\n", ++ PROC_ENTRY_FILENAME); ++ return -ENOMEM; ++ } ++ ++ Our_Proc_File->owner = THIS_MODULE; ++ Our_Proc_File->proc_iops = &Inode_Ops_4_Our_Proc_File; ++ Our_Proc_File->proc_fops = &File_Ops_4_Our_Proc_File; ++ Our_Proc_File->mode = S_IFREG | S_IRUGO | S_IWUSR; ++ Our_Proc_File->uid = 0; ++ Our_Proc_File->gid = 0; ++ Our_Proc_File->size = 80; ++ ++ printk(KERN_INFO "/proc/%s created\n", PROC_ENTRY_FILENAME); ++ ++ return 0; /* success */ ++} ++ ++static void __exit hipox_i2s_cleanup_module(void) ++{ ++ printk(KERN_INFO "I2S::cleanup_module\n"); ++ remove_proc_entry(PROC_ENTRY_FILENAME, &proc_root); ++ printk(KERN_INFO "/proc/%s removed\n", PROC_ENTRY_FILENAME); ++} ++ ++module_init(hipox_i2s_init_module); ++module_exit(hipox_i2s_cleanup_module); ++ ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/irq.c linux-2.6.24-oxe810/arch/arm/mach-hipox/irq.c +--- linux-2.6.24/arch/arm/mach-hipox/irq.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/irq.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,59 @@ ++/* ++ * linux/arch/arm/mach-hipox/irq.c ++ * ++ * 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/init.h> ++#include <linux/list.h> ++#include <asm/hardware.h> ++#include <asm/irq.h> ++#include <asm/mach/irq.h> ++ ++static void HIPOX_mask_irq(unsigned int irq) ++{ ++ *((volatile unsigned long*)(RPS_IRQ_DISABLE)) = (1UL << irq); ++} ++ ++static void HIPOX_unmask_irq(unsigned int irq) ++{ ++ *((volatile unsigned long*)RPS_IRQ_ENABLE) = (1UL << irq); ++} ++ ++static struct irq_chip HIPOX_chip = { ++ .name = "HIPOX", ++ .ack = HIPOX_mask_irq, ++ .mask = HIPOX_mask_irq, ++ .unmask = HIPOX_unmask_irq, ++}; ++ ++void __init hipox_init_irq(void) ++{ ++ unsigned irq; ++ ++ // Disable all IRQs ++ *((volatile unsigned long*)(RPS_IRQ_DISABLE)) = ~0UL; ++ ++ // Disable FIQ ++ *((volatile unsigned long*)(RPS_FIQ_DISABLE)) = ~0UL; ++ ++ // Initialise IRQ tracking structures ++ for (irq=0; irq < NR_IRQS; irq++) ++ { ++ set_irq_chip(irq, &HIPOX_chip); ++ set_irq_handler(irq, handle_level_irq); ++ set_irq_flags(irq, IRQF_VALID | IRQF_PROBE); ++ } ++} ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/leds.c linux-2.6.24-oxe810/arch/arm/mach-hipox/leds.c +--- linux-2.6.24/arch/arm/mach-hipox/leds.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/leds.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,212 @@ ++/* ++ * linux/arch/arm/mach-hipox/leds.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#define DEBUG ++ ++#include <linux/kernel.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/timer.h> ++#include <linux/interrupt.h> ++ ++#include <linux/platform_device.h> ++ ++ ++#include <linux/leds.h> ++ ++#include <asm/hardware.h> ++ ++#define DEBUG_PRINT(A) printk(KERN_NOTICE A) ++ ++#define writel(data,address) (*(volatile u32 *) address = data) ++#define readl(address) (*(volatile u32 *) address) ++ ++/* run pwm refresh at approximately 100Hz to avoid flicker */ ++/* resolution is 8bits, sys clock 200MHz divider is therefore 7812 less 1 cycle */ ++#define PWM_PERIOD (7811) ++ ++#define MAX_PWMS 16 ++ ++static void ramp_power_on_leds(unsigned long data); ++ ++DEFINE_TIMER (power_ramp_timer, ramp_power_on_leds, 0, 0); ++ ++enum { POWER_ON, ++ NUMBER_LEDS}; ++ ++static struct platform_device *hipox_leds; ++static u16 offset[NUMBER_LEDS] = {25}; ++ ++static u16 led [NUMBER_LEDS]; ++ ++#define MAX_BRIGHTNESS 255 ++ ++static void set_led(u16 led, u16 value) ++{ ++ u16 led_index = offset[led] % MAX_PWMS; ++ ++ writel(value, (PWM_DATA_REGISTER_BASE+4*led_index)); ++ ++} ++ ++static void ramp_power_on_leds(unsigned long data) ++{ ++ if (led[POWER_ON] < MAX_BRIGHTNESS) { ++ set_led(POWER_ON, ++led[POWER_ON]); ++ mod_timer(&power_ramp_timer, (power_ramp_timer.expires + msecs_to_jiffies(64)) ); ++ } ++ else del_timer(&power_ramp_timer); ++} ++ ++static void hipoxled_power_on_set(struct led_classdev *led_cdev, enum led_brightness value) ++{ ++ if (value == 0) { ++ current_bright = 0; ++ led[POWER_ON]=0; ++ set_led(POWER_ON, 0); ++ ++ } ++ else ++ { ++ power_ramp_timer.expires = jiffies + msecs_to_jiffies(64); ++ add_timer(&power_ramp_timer); ++ } ++} ++ ++static struct led_classdev hipox_power_on_led = { ++ .name = "hipox:power_on", ++ .brightness_set = hipoxled_power_on_set, ++}; ++ ++ ++#ifdef CONFIG_PM ++ ++// TODO implement led suspend operation on NAS ++static int hipoxled_suspend(struct platform_device *dev, pm_message_t state) ++{ ++#ifdef CONFIG_LEDS_TRIGGERS ++ if (hipox_amber_led.trigger && strcmp(hipox_amber_led.trigger->name, "sharpsl-charge")) ++#endif ++ led_classdev_suspend(&hipox_amber_led); ++ led_classdev_suspend(&hipox_green_led); ++ return 0; ++} ++// TODO implement led resume operation on NAS ++static int hipoxled_resume(struct platform_device *dev) ++{ ++ led_classdev_resume(&hipox_amber_led); ++ led_classdev_resume(&hipox_green_led); ++ return 0; ++} ++#endif ++ ++static int hipoxled_probe(struct platform_device *pdev) ++{ ++ int ret; ++ int i; ++ ++ writel(PWM_PERIOD, PWM_CLOCK_REGISTER); ++ ++ ++ /* enable PWM drives outputs */ ++ for (i=0; i < NUMBER_LEDS ; ++i) ++ { ++ if (offset[i] < 32) { ++ writel(readl(SYS_CTRL_GPIO_PWMSEL_CTRL_0) | (1 << offset[i]), SYS_CTRL_GPIO_PWMSEL_CTRL_0); ++ } ++ else { ++ writel(readl(SYS_CTRL_GPIO_PWMSEL_CTRL_1) | (1 << (offset[i]% 32)), SYS_CTRL_GPIO_PWMSEL_CTRL_1); ++ } ++ } ++ ++ ret = led_classdev_register(&pdev->dev, &hipox_power_on_led); ++ ++ if (ret < 0) goto error_1; ++ ++ return ret; ++ ++error_1: ++ return ret; ++} ++ ++static int hipoxled_remove(struct platform_device *pdev) ++{ ++ int i; ++ ++ led_classdev_unregister(&hipox_power_on_led); ++ ++ /* disable PWM drives outputs */ ++ for (i=0; i < NUMBER_LEDS ; ++i) ++ { ++ if (offset[i] < 32) { ++ writel(readl(SYS_CTRL_GPIO_PWMSEL_CTRL_0) & ~((u32)1 << offset[i]), SYS_CTRL_GPIO_PWMSEL_CTRL_0); ++ } ++ else { ++ writel(readl(SYS_CTRL_GPIO_PWMSEL_CTRL_1) & ~((u32)1 << (offset[i]% 32)), SYS_CTRL_GPIO_PWMSEL_CTRL_1); ++ } ++ } ++ ++ writel(PWM_CLOCK_REGISTER, 0); ++ ++ return 0; ++} ++ ++ ++static struct platform_driver hipoxled_driver = { ++ .probe = hipoxled_probe, ++ .remove = hipoxled_remove, ++#ifdef CONFIG_PM ++ .suspend = hipoxled_suspend, ++ .resume = hipoxled_resume, ++#endif ++ .driver = { ++ .name = "hipox-leds", ++ .owner = THIS_MODULE, ++ }, ++}; ++ ++static int __init hipoxled_init(void) ++{ ++ int ret; ++ ++ ret = platform_driver_register(&hipoxled_driver); ++ ++ ++ ++ /* now register the devices on the bus so they can be associated with the driver */ ++ if (!ret) ++ hipox_leds=platform_device_register_simple("hipox-leds", -1, NULL, 0); ++ return ret; ++} ++ ++static void __exit hipoxled_exit(void) ++{ ++ if (hipox_leds) { ++ platform_device_unregister(hipox_leds); ++ } ++ ++ platform_driver_unregister(&hipoxled_driver); ++} ++ ++module_init(hipoxled_init); ++module_exit(hipoxled_exit); ++ ++MODULE_AUTHOR("John Larkworthy <john.larkworthy@oxsem.com"); ++MODULE_DESCRIPTION("HIPOX front panel LED driver"); ++MODULE_LICENSE("GPL"); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/ledtrig_sata.c linux-2.6.24-oxe810/arch/arm/mach-hipox/ledtrig_sata.c +--- linux-2.6.24/arch/arm/mach-hipox/ledtrig_sata.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/ledtrig_sata.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,69 @@ ++/* ++ * linux/arch/arm/mach-hipox/leds.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/module.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/timer.h> ++#include <linux/leds.h> ++ ++static void ledtrig_ide_timerfunc(unsigned long data); ++ ++DEFINE_LED_TRIGGER(ledtrig_ide); ++static DEFINE_TIMER(ledtrig_ide_timer, ledtrig_ide_timerfunc, 0, 0); ++static int ide_activity; ++static int ide_lastactivity; ++ ++void ledtrig_sata_activity(void) ++{ ++ ide_activity++; ++ if (!timer_pending(&ledtrig_ide_timer)) ++ mod_timer(&ledtrig_ide_timer, jiffies + msecs_to_jiffies(10)); ++} ++EXPORT_SYMBOL(ledtrig_sata_activity); ++ ++static void ledtrig_ide_timerfunc(unsigned long data) ++{ ++ if (ide_lastactivity != ide_activity) { ++ ide_lastactivity = ide_activity; ++ led_trigger_event(ledtrig_ide, LED_FULL); ++ mod_timer(&ledtrig_ide_timer, jiffies + msecs_to_jiffies(10)); ++ } else { ++ led_trigger_event(ledtrig_ide, LED_OFF); ++ } ++} ++ ++static int __init ledtrig_ide_init(void) ++{ ++ led_trigger_register_simple("sata-disk", &ledtrig_ide); ++ return 0; ++} ++ ++static void __exit ledtrig_ide_exit(void) ++{ ++ led_trigger_unregister_simple(ledtrig_ide); ++} ++ ++module_init(ledtrig_ide_init); ++module_exit(ledtrig_ide_exit); ++ ++MODULE_AUTHOR("John Larkworthy <john.larkworthy@hipox.com>"); ++MODULE_DESCRIPTION("LED SATA Disk Activity Trigger"); ++MODULE_LICENSE("GPL"); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/leon.c linux-2.6.24-oxe810/arch/arm/mach-hipox/leon.c +--- linux-2.6.24/arch/arm/mach-hipox/leon.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/leon.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,244 @@ ++/* ++ * linux/arch/arm/mach-hipox/leon.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#ifdef CONFIG_SUPPORT_LEON ++ ++#include <asm/io.h> ++#include <asm/types.h> ++#include <asm/arch/hardware.h> ++#include <linux/ctype.h> ++#include <linux/delay.h> ++#include <linux/dma-mapping.h> ++#include <linux/errno.h> ++#include <linux/init.h> ++#include <linux/interrupt.h> ++#include <linux/kernel.h> ++#include <linux/slab.h> ++#include <asm/arch/leon.h> ++ ++static u8 asciihex_to_decimal(u8 ascii) ++{ ++ return isdigit(ascii) ? (ascii - '0') : (isalpha(ascii) ? ((toupper(ascii) - 'A') + 10) : 0); ++} ++ ++static u8 srec_read_u8(const s8** srec) ++{ ++ u8 first_ascii = **srec; ++ u8 second_ascii = *++*srec; ++ ++*srec; ++ return ((asciihex_to_decimal(first_ascii) << 4) | asciihex_to_decimal(second_ascii)); ++} ++ ++static u32 srec_read_u32(const s8** srec) ++{ ++ u32 word = ((u32)srec_read_u8(srec) << 24); ++ word |= ((u32)srec_read_u8(srec) << 16); ++ word |= ((u16)srec_read_u8(srec) << 8); ++ word |= srec_read_u8(srec); ++ return word; ++} ++ ++static void skip_to_next_record(const s8** srec) ++{ ++ while (*++*srec != '\n'); ++ ++*srec; ++} ++ ++/** ++ * @param srec An const s8** pointing to the position in the input s-record ++ * array at which to begin parsing ++ * @param buf An u8* into which any extracted record in to be placed ++ * @param adr An u8** into which either the extracted record's load address is ++ * to be written, or the execution start address ++ * @param len An u8* into which the length in bytes of the extracted record is ++ * to be written ++ * @return An int which is zero if another record is available, else if non-zero ++ * indicated that the execution start address is available in the ++ * adr argument ++ */ ++static void read_record(u8 len, const s8** srec, u8* buf) ++{ ++ int quads = len/sizeof(u32); ++ int spare = len - (quads*sizeof(u32)); ++ ++ int i=0; ++ while (i < quads) { ++ ((u32*)buf)[i++] = srec_read_u32(srec); ++ } ++ i = len-spare; ++ while (i < len) { ++ buf[i++] = srec_read_u8(srec); ++ } ++} ++ ++static int get_next_record(const s8** srec, u8* buf, u8** adr, u8* len) ++{ ++ int again; ++ int last = 1; ++ ++ *adr = 0; ++ do { ++ again = 0; ++ if (**srec == 'S') { ++ switch (*++*srec) { ++ case '0': ++ skip_to_next_record(srec); ++ again = 1; ++ break; ++ case '3': ++ ++*srec; ++ *len = srec_read_u8(srec) - sizeof(u32) - 1; ++ *adr = (u8*)srec_read_u32(srec); ++ read_record(*len, srec, buf); ++ skip_to_next_record(srec); ++ last = 0; ++ break; ++ case '7': ++ ++*srec; ++ *len = srec_read_u8(srec) - 1; ++ if (*len >= sizeof(u32)) { ++ *adr = (u8*)srec_read_u32(srec); ++ } ++ break; ++ default: ++ break; ++ } ++ } ++ } while (again); ++ ++ return last; ++} ++ ++static const u32 ENDIAN_LITTLE_READ_BIT = 30; ++static const u32 ENDIAN_BIG_WRITE_BIT = 31; ++ ++static u8* convert_adr_to_virt(u8* adr) ++{ ++ static const u32 ARM_HIGH_ORDER_ADR_BIT = 30; ++ ++ u32 virt = (u32)adr; ++ ++ // Zero the Leon endian control bits ++ virt &= ~((1UL << ENDIAN_BIG_WRITE_BIT) | (1UL << ENDIAN_LITTLE_READ_BIT)); ++ ++ // Convert to an ARM physical address ++ virt |= (1UL << ARM_HIGH_ORDER_ADR_BIT); ++ ++ // Is address sane? ++ if (virt < LEON_IMAGE_BASE_PA) { ++ panic("CoPro SRAM load address 0x%08x below mapped region beginning at 0x%08lx\n", (u32)adr, LEON_IMAGE_BASE_PA); ++ } else { ++ virt -= LEON_IMAGE_BASE_PA; ++ virt += LEON_IMAGE_BASE; ++ } ++ ++ return (u8*)virt; ++} ++ ++static void leon_load_image(const s8 *srec) ++{ ++ u8 *buf; ++ u8 *adr; ++ u8 len; ++ u32 code_base; ++ ++ // Copy each record to the specified address ++ // Convert the LEON physical address to an ARM virtual address before ++ // attempting to get the ARM to access it ++ // NB must endian-swap any trailing non-quad multiple bytes, as LEON will ++ // expect its instruction data in big endian format, whereas the ARM is ++ // little endian ++ buf = kmalloc(512, GFP_KERNEL); ++ while (!get_next_record(&srec, buf, &adr, &len)) { ++ int i=0; ++ int quads = len/sizeof(u32); ++ int spare = len - (quads*sizeof(u32)); ++ int padded_len = len+(sizeof(u32)-spare); ++ u32* quad_ptr; ++ ++ adr = convert_adr_to_virt(adr); ++ ++ quad_ptr = (u32*)adr; ++ while (i < quads) { ++ *quad_ptr++ = ((u32*)buf)[i++]; ++ } ++ adr = (u8*)quad_ptr; ++ for (i=len; i < padded_len; i++) { ++ buf[i] = 0; ++ } ++ i = padded_len-1; ++ while (i >= (len-spare)) { ++ *adr++ = buf[i--]; ++ } ++ } ++ kfree(buf); ++ ++ // Start LEON execution at the address specified by the S-records, with ++ // correct endianess. Use the address unchanged, as the LEON required ++ // physical addresses and may make use of alternative upper nibble values ++ code_base = (((u32)adr & ~((1UL << ENDIAN_BIG_WRITE_BIT) | (1UL << ENDIAN_LITTLE_READ_BIT))) | (1UL << ENDIAN_BIG_WRITE_BIT)); ++ ++ // Set the LEON's start address ++ printk(KERN_NOTICE "CoPro: Programming start address as 0x%08x (basic adr = 0x%08x)\n", code_base, (u32)adr); ++ writel(code_base, SYS_CTRL_COPRO_CTRL); ++ ++ // Ensure start address has been loaded before release the LEON from reset ++ wmb(); ++} ++ ++void init_copro(const s8 *srec, unsigned long arg) ++{ ++ // Ensure the LEON is in reset ++ writel(1UL << SYS_CTRL_RSTEN_COPRO_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ ++ // Enable the clock to the LEON ++ writel(1UL << SYS_CTRL_CKEN_COPRO_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Ensure reset and clock operations are complete ++ wmb(); ++ ++ // Place LEON context argument in top quad of SRAM ++ *((u32*)(LEON_IMAGE_BASE+LEON_IMAGE_SIZE-sizeof(u32))) = arg; ++ ++ // Load LEON's program and data and execution start address ++ leon_load_image(srec); ++ ++ // Release the LEON from reset so it begins execution of the loaded code ++ writel(1UL << SYS_CTRL_RSTEN_COPRO_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Give the LEON a chance to stabilise before giving it any commands ++ mdelay(100); ++ return; ++} ++EXPORT_SYMBOL_GPL(init_copro); ++ ++void shutdown_copro(void) ++{ ++ // Ensure the LEON is in reset ++ writel(1UL << SYS_CTRL_RSTEN_COPRO_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ ++ // Disable the clock to the LEON ++ writel(1UL << SYS_CTRL_CKEN_COPRO_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ // Ensure reset and clock operations are complete ++ wmb(); ++} ++EXPORT_SYMBOL_GPL(shutdown_copro); ++ ++#endif // CONFIG_SUPPORT_LEON +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/hipox-ahb-monitor.c linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox-ahb-monitor.c +--- linux-2.6.24/arch/arm/mach-hipox/hipox-ahb-monitor.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox-ahb-monitor.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,374 @@ ++/* ++ * arch/arm/mach-hipox/hipox-ahb-monitor.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/types.h> ++#include <linux/module.h> ++#include <linux/errno.h> ++#include <linux/miscdevice.h> ++#include <linux/smp_lock.h> ++#include <linux/kernel.h> ++#include <linux/delay.h> ++#include <linux/sched.h> ++#include <linux/i2c.h> ++#include <linux/proc_fs.h> ++#include <linux/capability.h> ++#include <linux/slab.h> ++#include <linux/init.h> ++#include <linux/spinlock.h> ++#include <linux/smp_lock.h> ++#include <linux/wait.h> ++#include <linux/suspend.h> ++#include <linux/kthread.h> ++#include <linux/moduleparam.h> ++ ++#include <asm/io.h> ++#include <asm/system.h> ++#include <asm/sections.h> ++#include <asm/uaccess.h> ++#include <asm/bitops.h> ++ ++#include <asm/hardware.h> ++ ++ ++/* usb test masks and offsets */ ++#define TEST_MASK 0xF ++#define TEST_OFFSET 16 ++ ++#define MODULE_VERS "0.1" ++#define MODULE_NAME "hipox-test" ++MODULE_AUTHOR( "John Larkworthy" ); ++MODULE_DESCRIPTION( "Driver to access the test hardware in hipox units" ); ++MODULE_LICENSE( "GPL" ); ++ ++ ++static struct proc_dir_entry *proc_dir_usb_test_read, *hipox_test_dir; ++ ++ ++static struct { ++ void * address; ++ char * name; ++ long unsigned low_add; ++ long unsigned high_add; ++ unsigned burst; ++ unsigned burst_mask; ++ unsigned hprot; ++ unsigned hprot_mask; ++ unsigned mode; ++} monitor[] = ++{ ++ { (void *) 0x00000, "ARM_Data", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x10000, "Arm_Inst", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x20000, "DMA_A", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x30000, "DMA_B", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x40000, "CoPro", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x50000, "USBHS", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x60000, "GMAC", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 }, ++ { (void *) 0x70000, "PCI", 0, 0xFFFFFFFFl, 0, 0, 0, 0, 0 } ++}; ++#define NO_MONITORS (sizeof(monitor)/sizeof(monitor[0])) ++ ++/* create proc filing system entries to accept configuration data */ ++static int usb_test_write_entries(const char *name, write_proc_t *w, read_proc_t *r, int data) ++{ ++ struct proc_dir_entry * entry = create_proc_entry(name, 0222, hipox_test_dir); ++ if (entry) { ++ entry->write_proc = w; ++ entry->read_proc =r; ++ entry->data = (void *)data; ++ entry->owner = THIS_MODULE; ++ return 0; ++ } ++ else ++ { ++ return -ENOMEM; ++ } ++} ++ ++static int ++hipox_test_read(char *buf, char **start, off_t offset, ++ int count, int *eof, void *unused) ++{ ++ ++ int i; ++ int len = 0; ++ long unsigned *rd_monitor; ++ ++ ++ for (i=0; i < NO_MONITORS; i++) ++ { ++ rd_monitor = (long unsigned *) (AHB_MON_BASE + monitor[i].address); ++ len += sprintf(buf+len, "%s CL:%ld EV:%ld hld:%ld slw:%lx tm:%ld\n", ++ monitor[i].name, ++ *rd_monitor, ++ *(rd_monitor+1), ++ *(rd_monitor+2), ++ *(rd_monitor+3), ++ (*(rd_monitor+4) & 0xFFFF)); ++ } ++ *eof=1; ++ return len; ++} ++/* ++ * function to clear and start all the timers mainly together. ++ */ ++#define MAX_CMD 5 ++static int ++hipox_test_control(struct file *file, const char *buf, unsigned long count, void * data) ++{ ++ int len; ++ int i; ++ long unsigned *rd_monitor; ++ unsigned cmd = 0; ++ ++ char local[MAX_CMD]; ++ int result; ++ ++ if (count > MAX_CMD-1) ++ len= MAX_CMD-1; ++ else ++ len=count; ++ ++ if (copy_from_user(&local, buf, len)) ++ return -EFAULT; ++ ++ result=sscanf(local, "%d", &cmd); ++ ++ switch (cmd) ++ { ++ case 0: ++ printk(KERN_INFO "hipox-test: stop command\n"); ++ break; ++ case 1: ++ printk(KERN_INFO "hipox-test: run command\n"); ++ break; ++ case 2: ++ printk(KERN_INFO "hipox-test: reset command\n"); ++ break; ++ default: ++ printk(KERN_INFO "hipox-test: ignored command\n"); ++ return len; ++ break; ++ } ++ ++ for (i=0; i < NO_MONITORS; i++) ++ { ++ rd_monitor = (long unsigned *) (AHB_MON_BASE + monitor[i].address); ++ *rd_monitor = (long unsigned) cmd; ++ } ++ return len; ++} ++ ++ ++/* ++ * The write function accepts a line as below: ++ * start_addr, end_addr, mode, burst, burst_mask, hprot, hprot_mask ++ * expected string length is 10 + 10 + 3 + 3 + 4 + 3 + 4 < 40char. ++ * This is decoded by the scanf function into the separate items. - missing items are defaulted. ++ */ ++ ++#define MAX_STRING 40 ++static int ++hipox_test_config_write(struct file *file, const char *buf, unsigned long count, void * data) ++{ ++ ++ int len; ++ int i = (int) data; ++ char local[MAX_STRING]; ++ int result; ++ unsigned long * mon_ptr; ++ ++ if (count > MAX_STRING-1) ++ len= MAX_STRING-1; ++ else ++ len=count; ++ ++ if (copy_from_user(&local, buf, len)) ++ return -EFAULT; ++ ++ /* extract value from buffer and store */ ++ ++ result = sscanf(local, "%li,%li,%i,%i,%i,%i,%i", ++ &monitor[i].low_add, ++ &monitor[i].high_add, ++ &monitor[i].mode, ++ &monitor[i].burst, ++ &monitor[i].burst_mask, ++ &monitor[i].hprot, ++ &monitor[i].hprot_mask ++ ); ++ if (result != 7) ++ return -EINVAL; ++ ++ /* load values on hardware */ ++ ++ mon_ptr=(unsigned long *) (AHB_MON_BASE + monitor[i].address); ++ ++ *(mon_ptr + 1) = monitor[i].mode & 0x3; ++ *(mon_ptr + 2) = monitor[i].low_add; ++ *(mon_ptr + 3) = monitor[i].high_add; ++ *(mon_ptr + 4) = ((monitor[i].burst & 0x7) << 4 | (monitor[i].burst_mask & 0x7)); ++ *(mon_ptr + 5) = ((monitor[i].hprot & 0xf) << 4 | (monitor[i].hprot_mask &0xf)); ++ ++ return len; ++} ++ ++static int ++hipox_test_config_read(char *buf, char **start, off_t offset, ++ int count, int *eof, void *data) ++{ ++ ++ int len = 0; ++ int i = (int) data; ++ ++ len += sprintf(buf+len, "name low high mode burst/mask hprot/mask\n"); ++ ++ len += sprintf(buf+len, "%s 0x%08lx 0x%08lx %d 0x%x/0x%x 0x%x/0x%x\n", ++ monitor[i].name, ++ monitor[i].low_add, ++ monitor[i].high_add, ++ monitor[i].mode, ++ monitor[i].burst, ++ monitor[i].burst_mask, ++ monitor[i].hprot, ++ monitor[i].hprot_mask); ++ ++ ++ *eof=1; ++ return len; ++} ++ ++static int __init hipox_test_init(void) ++{ ++ int rv=0; ++ int i; ++ ++ hipox_test_dir = proc_mkdir(MODULE_NAME, NULL); ++ if (hipox_test_dir == NULL) { ++ printk(KERN_ERR "hipox-test: unable to register /proc/usb-test\n"); ++ rv= -ENOMEM; ++ goto out; ++ } ++ ++ hipox_test_dir->owner= THIS_MODULE; ++ ++ proc_dir_usb_test_read = create_proc_entry("read", 0444, hipox_test_dir); ++ if (proc_dir_usb_test_read) { ++ proc_dir_usb_test_read->read_proc = hipox_test_read; ++ } else { ++ printk(KERN_ERR "hipox-test: unable to register /proc/usb-test/read\n"); ++ rv = -ENOMEM; ++ goto no_read; ++ } ++ ++ /* create port write file entries */ ++ for (i=0;i<NO_MONITORS;i++) ++ { ++ rv = usb_test_write_entries(monitor[i].name, &hipox_test_config_write, &hipox_test_config_read, i); ++ if (rv < 0) ++ { ++ while (i != 0) ++ { ++ i--; ++ /* remove any allocated entries */ ++ remove_proc_entry (monitor[i].name, hipox_test_dir); ++ } ++ goto no_write; ++ } ++ } ++ ++ { ++ struct proc_dir_entry * entry = create_proc_entry("control", 0666, hipox_test_dir); ++ if (entry) { ++ entry->write_proc = hipox_test_control; ++ entry->owner = THIS_MODULE; ++ return 0; ++ } ++ else ++ { ++ goto no_control; ++ } ++ } ++ ++ ++ printk(KERN_INFO "%s %s initialised\n", MODULE_NAME, MODULE_VERS); ++ ++ return 0; ++ ++ no_control: ++ for (i = NO_MONITORS; i != 0; ) ++ { ++ i--; ++ /* remove any allocated entries */ ++ remove_proc_entry (monitor[i].name, hipox_test_dir); ++ } ++ ++ no_write: ++ remove_proc_entry("read", hipox_test_dir); ++ no_read: ++ remove_proc_entry(MODULE_NAME, NULL); ++ out: ++ return rv; ++} ++ ++ ++static void __exit hipox_test_exit(void) ++{ ++ int i; ++ ++ remove_proc_entry("control", hipox_test_dir); ++ ++ for (i = 0; i < NO_MONITORS; i++) ++ { ++ remove_proc_entry(monitor[i].name, hipox_test_dir); ++ } ++ ++ remove_proc_entry("read", hipox_test_dir); ++ remove_proc_entry(MODULE_NAME, NULL); ++ ++ printk(KERN_INFO "%s %s removed\n", MODULE_NAME, MODULE_VERS); ++ ++} ++ ++ ++module_init(hipox_test_init); ++module_exit(hipox_test_exit); ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/hipox-wd810-leds.c linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox-wd810-leds.c +--- linux-2.6.24/arch/arm/mach-hipox/hipox-wd810-leds.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox-wd810-leds.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,1021 @@ ++/* ++ * linux/arch/arm/mach-hipox/hipox-wd810-leds.c ++ * ++ * Copyright (c) 2008 Oxford Semiconductor Ltd. ++ * ++ * 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/kernel.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/timer.h> ++#include <linux/interrupt.h> ++#include <linux/platform_device.h> ++#include <linux/leds.h> ++#include <asm/hardware.h> ++#include <asm/io.h> ++ ++ ++/* Timer Values and Pulse Width Modulation */ ++#define PWM_RESOLUTION 255 ++#define TIMER_LED_MODE TIMER_MODE_PERIODIC ++ ++#define LED100 (PWM_RESOLUTION) /* 100% duty cycle */ ++#define LED50 (PWM_RESOLUTION / 2) /* 50% duty cycle */ ++#define LED25 (PWM_RESOLUTION / 4) /* 25% duty cycle */ ++ ++#define STEP_RESOLUTION (16) /* change intensity in 16 steps */ ++ ++ ++/* Setup Timer2 prescaler, operation mode, and start it */ ++#define PERIODIC_INTERRUPT \ ++ ( \ ++ (TIMER_PRESCALE_256 << TIMER_PRESCALE_BIT) | \ ++ (TIMER_LED_MODE << TIMER_MODE_BIT) | \ ++ (TIMER_ENABLE_ENABLE << TIMER_ENABLE_BIT) \ ++ ) ++ ++/* ++ * Target frame rate is 60Hz. Slower frame rates flicker badly. ++ * Since each frame has 16 divisions to perform the pulse width ++ * modulation that means we need the timer set to 960Hz (i.e. 60 * 16) ++ * ++ * With a system clock of 25Mhz and a load register value of (1627) prescaled 256 ++ * to achieve 2Hz: ++ * 25Mhz / 256 / 24414 =~4Hz //1627 = ~60 ++ * ++ * PWM clock = 183MHz/256/814=~877kHz ++ */ ++#define FAST_TIMER_INT 24414 //48828//(1627) /* Timer2 count down */ ++#define SYS_CLOCK CONFIG_NOMINAL_RPSCLK_FREQ /* System clock frequency */ ++#define PRESCALE_VALUE (256) /* Value set in prescaler */ ++#define PWM_PRESCALE 814 /* Value loaded on PWM clock register */ ++#define MAX_PWM 255 ++#define SLOW_TPS ((SYS_CLOCK/PRESCALE_VALUE) / FAST_TIMER_INT) //=~4Hz, 250ms ++ ++ ++ /**** if GPIO31~GPIO16 is used, sift left 16 bits ****//* GPIO bits dedicated to LEDs *///Need to modify if different GPIO used ++#define LED_MASK_CG5 (1 << GPIO_34) /* Capacity Gauge TOP LED */ ++#define LED_MASK_CG4 (1 << GPIO_7) /* Capacity Gauge 4th LED */ ++#define LED_MASK_CG3 (1 << GPIO_6) /* Capacity Gauge 3rd LED */ ++#define LED_MASK_CG2 (1 << GPIO_5) /* Capacity Gauge 2nd LED */ ++#define LED_MASK_CG1 ((1 << GPIO_26)>>16) //sift left 16 bits for PWM10 /* Capacity Gauge 1st LED */ ++#define LED_MASK_CG0 ((1 << GPIO_25)>>16) //sift left 16 bits for PWM9 /* Capacity Gauge BOTTOM LED */ ++ ++/* Mask for all the LEDs in the Fuel Gauge.*/ ++/* Mask for all the LEDs on GPIO_A */ ++ ++#define LED_MASK_GPIO_A \ ++ ( \ ++ (LED_MASK_CG0<<16) | \ ++ (LED_MASK_CG1<<16) | \ ++ LED_MASK_CG2 | \ ++ LED_MASK_CG3 | \ ++ LED_MASK_CG4 \ ++ ) ++ ++/* Mask for all the LEDs on GPIO_B */ ++#define LED_MASK_GPIO_B \ ++ ( \ ++ LED_MASK_CG5 \ ++ ) ++ ++#define LED_MASK_GAUGE \ ++ ( \ ++ LED_MASK_CG0 | \ ++ LED_MASK_CG1 | \ ++ LED_MASK_CG2 | \ ++ LED_MASK_CG3 | \ ++ LED_MASK_CG4 | \ ++ LED_MASK_CG5 \ ++ ) ++ ++#define LED_MASK_GAUGE_ODD \ ++ ( \ ++ LED_MASK_CG0 | \ ++ LED_MASK_CG2 | \ ++ LED_MASK_CG4 \ ++ ) ++ ++#define LED_MASK_GAUGE_EVEN \ ++ ( \ ++ LED_MASK_CG1 | \ ++ LED_MASK_CG3 | \ ++ LED_MASK_CG5 \ ++ ) ++ ++#define LED_MASK_GAUGE_CENTER \ ++ ( \ ++ LED_MASK_CG2 | \ ++ LED_MASK_CG3 \ ++ ) ++ ++#define LED_MASK_GAUGE_MID \ ++ ( \ ++ LED_MASK_CG1 | \ ++ LED_MASK_CG4 \ ++ ) ++ ++#define LED_MASK_GAUGE_OUTER \ ++ ( \ ++ LED_MASK_CG0 | \ ++ LED_MASK_CG5 \ ++ ) ++ ++#define CLEAR(addr, mask) writel(readl(addr) & ~mask, addr) ++ ++ ++/* Variables to hold the number of LED classes created */ ++static int leds_created; ++ ++/* Variables to save/restore timer register values */ ++static u32 timer_load; ++static u32 timer_control; ++ ++/* LED polarity */ ++static int negative_led_logic = 0; ++module_param(negative_led_logic, bool, 0); ++ ++/* ++ * States for the main LED behavior state machine. ++ */ ++enum { ++ STATE_NOP, ++ STANDBY, ++ SHOW_CAPACITY, ++ ACTIVITY, ++ POWER_OFF, ++ RESET, ++ ATTENTION, ++ FAILURE, ++ BOOT_OK, ++ BOOT_stage1, ++ BOOT_stage2, ++ BOOT_stage3, ++ BOOT_stage4, ++ BOOT_stage5, ++ BOOT_stage6, ++}; ++ ++/*Various LED state timing*/ ++#define BOOTOK_RAMP_DIV 11 ++#define STANBY_RAMP_DIV 9 ++#define STANBY_ALT_STEP (SLOW_TPS*4) //16//8//250 //~4sec ++#define POWEROFF_RAMP_DIV 6 ++#define POWEROFF_ALT_STEP ((SLOW_TPS/2)*7) //14//7//200 //~3.5sec ++#define ATTENTION_ALT_STEP (SLOW_TPS/2) // 2 //~2Hz, 0.5sec ++#define FAILURE_RAMP_DIV 6 ++#define FAILURE_ALT_STEP (SLOW_TPS/2) // 2 //~2Hz, 0.5sec ++#define ACTIVITY_RAMP_DIV 1 // 2 ++#define ACTIVITY_ALT_STEP (SLOW_TPS/4) // 2 //~2Hz, 0.5sec ++#define RESET_ALT_STEP (SLOW_TPS/2) // 2 //~2Hz, 0.5sec ++ ++ ++/* Variables for main LED behavior state machine */ ++static int state; ++static u8 start; ++static u8 act; ++static u8 mark; ++static u16 act_led[6] = { ++ LED_MASK_CG0, ++ LED_MASK_CG1, ++ LED_MASK_CG2, ++ LED_MASK_CG3, ++ LED_MASK_CG4, ++ LED_MASK_CG5, ++}; ++static u32 alt = 0; ++static int count; ++static u16 capacity_gauge_bits; /* see LED frame buffer design assumption */ ++static u8 leds_switch; ++static u8 activity_block = 1; ++ ++ ++/* ++ * Declare tasklet for the LED behavior state machine. ++ */ ++void hipox_wd810_leds_behavior(unsigned long); ++DECLARE_TASKLET(hipox_wd810_leds_behavior_tasklet, ++ hipox_wd810_leds_behavior, 0); ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_interrupt */ ++/* */ ++/* PURPOSE: */ ++/* Interrupt handler for the hipox-wd810-leds pulse width modulation */ ++/***************************************************************************/ ++static irqreturn_t hipox_wd810_leds_interrupt(int irq, void *dev_id) ++{ ++ writel(0, TIMER2_CLEAR); ++ ++ tasklet_schedule(&hipox_wd810_leds_behavior_tasklet); ++ ++ return IRQ_HANDLED; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: get_vbar_bits */ ++/* */ ++/* PURPOSE: */ ++/* Convert the bit map of V-bar LEDs into the GPIO bit map */ ++/***************************************************************************/ ++static u16 get_vbar_bits(u16 value) ++{ ++ u16 pattern = 0; ++ ++ // Convert the bit map to the GPIO bit pattern ++ if (value & (1 << 0)) ++ pattern |= LED_MASK_CG0; ++ if (value & (1 << 1)) ++ pattern |= LED_MASK_CG1; ++ if (value & (1 << 2)) ++ pattern |= LED_MASK_CG2; ++ if (value & (1 << 3)) ++ pattern |= LED_MASK_CG3; ++ if (value & (1 << 4)) ++ pattern |= LED_MASK_CG4; ++ if (value & (1 << 5)) ++ pattern |= LED_MASK_CG5; ++ ++ return pattern; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: get_percentage_pattern */ ++/* */ ++/* PURPOSE: */ ++/* Convert a percentage to a V-bar bit map. Note, we never display */ ++/* less than 1 LED for a percentage so that something is alway visible. */ ++/***************************************************************************/ ++static u16 get_percentage_pattern(u16 percentage) ++{ ++ if (percentage >= 50) { ++ if (percentage >= 67) { ++ if (percentage >= 83) { ++ if (percentage >= 97) { ++ return 0x3F; // 6 LEDs is >= 97% ++ } else { ++ return 0x1F; // 5 LEDs is >= 83% ++ } ++ } else { ++ return 0x0F; // 4 LEDs is >= 67% ++ } ++ } else { ++ return 0x07; // 3 LEDs is >= 50% ++ } ++ } else { ++ if (percentage >= 33) { ++ return 0x03; // 2 LEDs is >= 33% ++ } else { ++ return 0x01; // 1 LED is >= 0% ++ } ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: set_led */ ++/* */ ++/* PURPOSE: */ ++/* Set requested brightness on the requested LED(s) */ ++/***************************************************************************/ ++static void set_led(u16 led_bits, u8 value, u16 ramp, u16 ramp_div) ++{ ++ u16 bit; ++ s8 count = 0; ++ u32 reg; ++ ++ if (negative_led_logic) { ++ value = MAX_PWM - value; ++ if (ramp & 0x100) { ++ ramp = ((MAX_PWM - (ramp & 0xFF)) | 0x100); ++ } else ++ ramp = ((MAX_PWM - (ramp & 0xFF))); ++ } ++ ++ reg = ((ramp << 16) | value); ++//printk(KERN_INFO "set_led: reg=%x\n", reg); ++ if (ramp & 0x100) { ++ writel(ramp_div, (PWM_DATA_REGISTER_BASE + 0x404)); ++ } ++ for (bit = 1; bit > 0; bit <<= 1, ++count) { ++ if (bit & led_bits) { ++ writel(reg, ((u32 *) PWM_DATA_REGISTER_BASE + count)); ++ } ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: display_vbar */ ++/* */ ++/* PURPOSE: */ ++/* Set bits for the requested V-bar map */ ++/***************************************************************************/ ++static void display_vbar(u16 vbar_bits) ++{ ++ //printk(KERN_INFO "display_vbar: vbar_bits=%x\n", vbar_bits); ++ ++ //set_led(~vbar_bits & LED_MASK_GAUGE, 0, 0, 0); ++ set_led(LED_MASK_GAUGE, 0, 0, 0); ++ set_led(vbar_bits, LED100, 0, 0); ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_behavior_init */ ++/* */ ++/* PURPOSE: */ ++/* Initialization for LED behavior main state machine */ ++/***************************************************************************/ ++void hipox_wd810_leds_behavior_init(void) ++{ ++ /* State machine variables */ ++ state = BOOT_OK; ++ count = 0; ++ capacity_gauge_bits = 0; ++ leds_switch = 0xFF; ++} ++ ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_behavior */ ++/* */ ++/* PURPOSE: */ ++/* LED behavior main state machine */ ++/***************************************************************************/ ++void hipox_wd810_leds_behavior(unsigned long unused) ++{ ++//printk(KERN_INFO "hipox_wd810_leds_behavior state=%d count=%d\n", state, count); ++ switch (state) { ++ case STANDBY: ++ //All LEDs dim-up and dim-down every 4sec. ++ if (leds_switch & (1 << 0)) { //LEDS display turn on ++ if (count-- != 0) ++ break; ++ alt++; ++ if ((alt % 2) == 1) { ++ set_led(LED_MASK_GAUGE, 0, 0x1FF, STANBY_RAMP_DIV); ++ } else { ++ set_led(LED_MASK_GAUGE, 255, 0x100, STANBY_RAMP_DIV); ++ } ++ count = STANBY_ALT_STEP; ++ } else { ++ printk(KERN_INFO " state STANDBY LED display off \n"); ++ state = STATE_NOP; ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ break; ++ ++ case SHOW_CAPACITY: ++ //Each LED represents 1/6 of the total available capacity. ++ if (leds_switch & (1 << 1)) { //LEDS display turn on ++ display_vbar(capacity_gauge_bits); ++ } else { ++ printk(KERN_INFO " state SHOW_CAPACITY LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ ++ case ACTIVITY: ++ //LEDs illuminate in a up and down "cylon" motion. ++ if (leds_switch & (1 << 2)) { //LEDS display turn on ++ if (count-- != 0) ++ break; ++ ++ if (start == 0) { ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ set_led(act_led[act], 0, 0x1FF, ACTIVITY_RAMP_DIV); ++ start = 1; ++ } else { ++ if ((mark == 0) && (++act < 6)) { ++ set_led(act_led[act], 0, 0x1FF, ACTIVITY_RAMP_DIV); ++ set_led(act_led[act - 1], 255, 0x100, ++ ACTIVITY_RAMP_DIV); ++ goto NEXT; ++ } ++ mark = 1; ++ if ((mark == 1) && (act-- > 1)) { ++ set_led(act_led[act], 255, 0x100, ACTIVITY_RAMP_DIV); ++ set_led(act_led[act - 1], 0, 0x1FF, ACTIVITY_RAMP_DIV); ++ goto NEXT; ++ } ++ mark = 0; ++ state = SHOW_CAPACITY; //Michael TBD ++ } ++ NEXT: ++ count = ACTIVITY_ALT_STEP; ++ } else { ++ printk(KERN_INFO " state ACTIVITY LED display off \n"); ++ state = STATE_NOP; ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ break; ++ ++ case POWER_OFF: ++ //LEDs in the array dim-up/dim-down in an odd/even alternating pattern. ++ if (leds_switch & (1 << 3)) { //LEDS display turn on ++ if (count-- != 0) ++ break; ++ alt++; ++ if ((alt % 2) == 1) { ++ set_led(LED_MASK_GAUGE_ODD, 0, 0x1FF, POWEROFF_RAMP_DIV); ++ set_led(LED_MASK_GAUGE_EVEN, 255, 0x100, ++ POWEROFF_RAMP_DIV); ++ } else { ++ set_led(LED_MASK_GAUGE_ODD, 255, 0x100, POWEROFF_RAMP_DIV); ++ set_led(LED_MASK_GAUGE_EVEN, 0, 0x1FF, POWEROFF_RAMP_DIV); ++ } ++ count = POWEROFF_ALT_STEP; ++ } else { ++ printk(KERN_INFO " state POWER_OFF LED display off \n"); ++ state = STATE_NOP; ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ ++ break; ++ ++ case RESET: ++ //Alternately blink the upper LED and lower LED at 1/2 sec rate. ++ if (leds_switch & (1 << 4)) { //LEDS display turn on ++ if (count-- != 0) ++ break; ++ alt++; ++ if ((alt % 2) == 1) { ++ set_led(act_led[0], 255, 0x000, 0); ++ set_led(act_led[5], 0, 0x000, 0); ++ } else { ++ set_led(act_led[0], 0, 0x000, 0); ++ set_led(act_led[5], 255, 0x000, 0); ++ } ++ count = RESET_ALT_STEP; ++ } else { ++ printk(KERN_INFO " state RESET LED display off \n"); ++ state = STATE_NOP; ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ ++ break; ++ ++ case ATTENTION: ++ //All LEDs flash simultaneously at a 1/2 sec. rate ++ if (count-- != 0) ++ break; ++ alt++; ++ if ((alt % 2) == 1) { ++ set_led(LED_MASK_GAUGE, 255, 0x000, 0); ++ ++ } else { ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ count = ATTENTION_ALT_STEP; ++ ++ break; ++ ++ case FAILURE: ++ //LEDs illuminate in a continous "center out" sweep pattern. ++ if (count-- != 0) ++ break; ++ ++ switch ((alt % 4)) { ++ case 0: ++ set_led(LED_MASK_GAUGE_CENTER, 0, 0x1FF, FAILURE_RAMP_DIV); ++ break; ++ case 1: ++ set_led(LED_MASK_GAUGE_MID, 0, 0x1FF, FAILURE_RAMP_DIV); ++ break; ++ case 2: ++ set_led(LED_MASK_GAUGE_OUTER, 0, 0x1FF, FAILURE_RAMP_DIV); ++ break; ++ case 3: ++ set_led(LED_MASK_GAUGE, 0, 0, 0); ++ break; ++ } ++ alt++; ++ count = FAILURE_ALT_STEP; ++ ++ break; ++ ++ case BOOT_OK: ++ //All 6 LEDs ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 5)) { //LEDS display turn on ++ set_led(LED_MASK_GAUGE, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_OK LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage1: ++ //Bottom LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 6)) { //LEDS display turn on ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ set_led(LED_MASK_CG0, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage1~3 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage2: ++ // 2nd LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 6)) { //LEDS display turn on ++ set_led(LED_MASK_CG1, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage1~3 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage3: ++ // 3rd LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 6)) { //LEDS display turn on ++ set_led(LED_MASK_CG2, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage1~3 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage4: ++ // 4th LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 7)) { //LEDS display turn on ++ set_led(LED_MASK_CG3, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage4~6 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage5: ++ //5th LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 7)) { //LEDS display turn on ++ set_led(LED_MASK_CG4, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage4~6 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case BOOT_stage6: ++ //Top LED ramp up smoothly to full intensity. ++ if (leds_switch & (1 << 7)) { //LEDS display turn on ++ set_led(LED_MASK_CG5, 0, 0x1FF, BOOTOK_RAMP_DIV); ++ } else { ++ printk(KERN_INFO " state BOOT_stage4~6 LED display off \n"); ++ set_led(LED_MASK_GAUGE, 0, 0x000, 0); ++ } ++ state = STATE_NOP; ++ break; ++ ++ case STATE_NOP: ++ default: ++ return; ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_set_switch */ ++/* */ ++/* PURPOSE: */ ++/* Set the LED display "on/off" of each state by Web GUI */ ++/***************************************************************************/ ++static void hipox_wd810_leds_set_switch ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ leds_switch = value; ++} ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_set_state */ ++/* */ ++/* PURPOSE: */ ++/* Set the "state" LED to the requested behavior */ ++/***************************************************************************/ ++static void hipox_wd810_leds_set_state ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ count = 0; ++ alt = 0; ++ state = value; ++ start = 0; ++ act = 0; ++ mark = 0; ++ printk(KERN_INFO "hipox_wd810_leds_state state=%d\n", state); ++ ++ if (state > 3) ++ activity_block = 1; ++ else ++ activity_block = 0; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_set_activity */ ++/* */ ++/* PURPOSE: */ ++/* Trigger activity display behavior */ ++/***************************************************************************/ ++//TBD Michael ++static void hipox_wd810_leds_set_activity ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ if (activity_block == 0) { ++//printk("<1> hipox_wd810_leds_set_activity value=%x\n", value); ++ state = ACTIVITY; ++ } ++} ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_set_capacity_gauge */ ++/* */ ++/* PURPOSE: */ ++/* Set the fuel gauge to the requested value (treated as a percentage) */ ++/***************************************************************************/ ++static void hipox_wd810_leds_set_capacity_gauge ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ capacity_gauge_bits = get_vbar_bits(get_percentage_pattern(value)); ++//printk("<1> hipox_wd810_leds_set_capacity_gauge capacity_gauge_bits=%x\n", capacity_gauge_bits); ++ state = SHOW_CAPACITY; ++ activity_block = 0; ++} ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_switch */ ++/* */ ++/* PURPOSE: */ ++/* Describe the hipox-wd810-leds "switch" on/off */ ++/***************************************************************************/ ++static struct led_classdev hipox_wd810_leds_switch = { ++ .name = "hipox-wd810-leds:switch",.brightness_set = ++ hipox_wd810_leds_set_switch, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_state */ ++/* */ ++/* PURPOSE: */ ++/* Describe the hipox-wd810-leds "power" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev hipox_wd810_leds_state = { ++ .name = "hipox-wd810-leds:state", ++ .brightness_set = hipox_wd810_leds_set_state, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_activity */ ++/* */ ++/* PURPOSE: */ ++/* Describe the hipox-wd810-leds "activity" pseudo-LED */ ++/***************************************************************************/ ++//TBD Michael ++static struct led_classdev hipox_wd810_leds_activity = { ++ .name = "hipox-wd810-leds:activity", ++ .brightness_set = hipox_wd810_leds_set_activity, ++ .default_trigger = "sata-disk" ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_capacity_gauge */ ++/* */ ++/* PURPOSE: */ ++/* Describe the hipox-wd810-leds "capacity-gauge" LEDs (brightness = % full) */ ++/***************************************************************************/ ++static struct led_classdev hipox_wd810_leds_capacity_gauge = { ++ .name = "hipox-wd810-leds:capacity", ++ .brightness_set = hipox_wd810_leds_set_capacity_gauge, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_classes[] */ ++/* */ ++/* PURPOSE: */ ++/* Array of LED classes to create/destroy */ ++/***************************************************************************/ ++static struct led_classdev *hipox_led_classes[] = { ++ &hipox_wd810_leds_switch, ++ &hipox_wd810_leds_state, ++ &hipox_wd810_leds_activity, //TBD ++ &hipox_wd810_leds_capacity_gauge, ++}; ++ ++#ifdef DEBUG ++static ssize_t ++show_registers(struct device *dev, struct device_attribute *attr, ++ char *buf) ++{ ++ char *out = buf; ++ u32 clock_data = readl(PWM_CLOCK_REGISTER); ++ u32 data_ptr = PWM_CLOCK_REGISTER; ++ u8 no_pwms = (clock_data >> 16); ++ u8 i; ++ /* report hardware status here */ ++ out += sprintf(buf, "PWM drive registers\n"); ++ out += ++ sprintf(out, "clock register:0x%08x @ 0x%08x\n", clock_data, ++ data_ptr); ++ ++ for (i = 0; i < no_pwms; ++i) { ++ data_ptr = (u32) ((u32 *) PWM_BASE + i); ++ out += ++ sprintf(out, "%d:%d @ 0x%08x\n", i, (u8) readl(data_ptr), ++ data_ptr); ++ } ++ ++ return out - buf; ++} ++ ++/* create a register 'file' to enbale reading back the pwm drive register status */ ++static DEVICE_ATTR(registers, S_IRUGO, show_registers, NULL); ++ ++static void create_debug_files(struct platform_device *pdev) ++{ ++ struct device *dev = &pdev->dev; ++ device_create_file(dev, &dev_attr_registers); ++} ++ ++static void remove_debug_files(struct platform_device *pdev) ++{ ++ struct device *dev = &pdev->dev; ++ device_remove_file(dev, &dev_attr_registers); ++} ++#endif ++ ++ ++#ifdef CONFIG_PM ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_suspend */ ++/* */ ++/* PURPOSE: */ ++/* Suspend all LED class devices created by this driver */ ++/***************************************************************************/ ++static int ++hipox_wd810_leds_suspend(struct platform_device *pdev, pm_message_t state) ++{ ++ int n = leds_created; ++ while (n > 0) { ++ if (--n < ARRAY_SIZE(hipox_led_classes)) { ++ led_classdev_suspend(hipox_led_classes[n]); ++ } ++ } ++ ++ return 0; ++} ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_resume */ ++/* */ ++/* PURPOSE: */ ++/* Wake up all LED class devices created by this driver */ ++/***************************************************************************/ ++static int ++hipox_wd810_leds_resume(struct platform_device *pdev, pm_message_t state) ++{ ++ int n = leds_created; ++ while (n > 0) { ++ if (--n < ARRAY_SIZE(hipox_led_classes)) { ++ led_classdev_resume(hipox_led_classes[n]); ++ } ++ } ++ ++ return 0; ++} ++#endif /* CONFIG_PM */ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_probe */ ++/* */ ++/* PURPOSE: */ ++/* Perform any necessary probing and initial setup for hipox-wd810-leds device */ ++/***************************************************************************/ ++static int hipox_wd810_leds_probe(struct platform_device *pdev) ++{ ++ int rc; ++ int timer_changed = 0; ++ int interrupt_allocated = 0; ++ leds_created = 0; ++ ++ /* Turn off all the LEDs */ ++ if (negative_led_logic) { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_SET); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_SET); ++ } else { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_CLEAR); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_CLEAR); ++ } ++ /* put PWM module back into reset and disable clock */ ++ writel((1 << SYS_CTRL_RSTEN_MISC_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ // writel(PWM_CLOCK, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ do { ++ /* Enable LED output drivers and disable other uses */ ++ CLEAR(SYS_CTRL_GPIO_PRIMSEL_CTRL_0, LED_MASK_GPIO_A); ++ CLEAR(SYS_CTRL_GPIO_SECSEL_CTRL_0, LED_MASK_GPIO_A); ++ CLEAR(SYS_CTRL_GPIO_TERTSEL_CTRL_0, LED_MASK_GPIO_A); ++ ++ CLEAR(SYS_CTRL_GPIO_PRIMSEL_CTRL_1, LED_MASK_GPIO_B); ++ CLEAR(SYS_CTRL_GPIO_SECSEL_CTRL_1, LED_MASK_GPIO_B); ++ CLEAR(SYS_CTRL_GPIO_TERTSEL_CTRL_1, LED_MASK_GPIO_B); ++ /* Turn off all the LEDs */ ++ if (negative_led_logic) { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_SET); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_SET); ++ } else { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_CLEAR); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_CLEAR); ++ } ++ ++ /* bring PWM module out of reset and enable clock */ ++ writel((1 << SYS_CTRL_RSTEN_MISC_BIT), SYS_CTRL_RSTEN_CLR_CTRL); ++ //writel(PWM_CLOCK, SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* enable PWM clock */ ++ writel(PWM_PRESCALE, PWM_CLOCK_REGISTER); ++ ++ /* Initialize frame buffer to everything off */ ++//printk(KERN_INFO "hipox_wd810_leds_probe: LED_MASK_GAUGE=%x\n",LED_MASK_GAUGE); ++ set_led(LED_MASK_GAUGE, 0, 0, 0); ++ /* Enable output to the LEDs */ ++ writel(LED_MASK_GPIO_A, SYS_CTRL_GPIO_PWMSEL_CTRL_0); ++ writel(LED_MASK_GPIO_B, SYS_CTRL_GPIO_PWMSEL_CTRL_1); ++ ++ /* Initialize the LED behavior state machine */ ++ hipox_wd810_leds_behavior_init(); ++ /* Save Timer2 state for restoring later */ ++ timer_load = readl(TIMER2_LOAD); ++ timer_control = readl(TIMER2_CONTROL); ++ writel(0, TIMER2_CONTROL); ++ timer_changed = 1; ++ /* Setup Timer2 for LED control */ ++ rc = request_irq(TIMER_2_INTERRUPT, hipox_wd810_leds_interrupt, 0, ++ "led_pwm", 0); ++ ++ // rc = request_irq(TIMER_2_INTERRUPT, wdc_leds_interrupt, 0, "led_pwm", 0); ++ if (rc < 0) { ++ printk(KERN_ERR "failed to get IRQ\n"); ++ break; ++ } ++ ++ interrupt_allocated = 1; ++ writel(FAST_TIMER_INT, TIMER2_LOAD); ++ writel(PERIODIC_INTERRUPT, TIMER2_CONTROL); ++ ++ /* Register each LED class device */ ++ while (leds_created < ARRAY_SIZE(hipox_led_classes)) { ++ rc = led_classdev_register(&pdev->dev, ++ hipox_led_classes[leds_created]); ++ if (rc < 0) { ++ printk(KERN_ERR "failed to register led class \"%s\"\n", ++ hipox_led_classes[leds_created]->name); ++ break; ++ } ++ ++ ++leds_created; ++ } ++ } ++ while (0); ++ /* If we failed then perform any needed clean up */ ++ if (rc < 0) { ++ /* Unregister any classes we registered */ ++ while (leds_created > 0) { ++ if (--leds_created < ARRAY_SIZE(hipox_led_classes)) { ++ led_classdev_unregister(hipox_led_classes[leds_created]); ++ } ++ } ++ ++ /* Free the interrupt if we allocated one */ ++ if (interrupt_allocated) { ++ free_irq(TIMER_2_INTERRUPT, 0); ++ } ++ ++ /* Restore Timer2 if we changed it */ ++ if (timer_changed) { ++ writel(timer_load, TIMER2_LOAD); ++ writel(timer_control, TIMER2_CONTROL); ++ } ++ } ++#ifdef DEBUG ++ create_debug_files(pdev); ++#endif ++ return rc; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_remove */ ++/* */ ++/* PURPOSE: */ ++/* Perform steps to remove the hipox-wd810-leds device */ ++/***************************************************************************/ ++static int hipox_wd810_leds_remove(struct platform_device *pdev) ++{ ++ while (leds_created > 0) { ++ if (--leds_created < ARRAY_SIZE(hipox_led_classes)) { ++ led_classdev_unregister(hipox_led_classes[leds_created]); ++ } ++ } ++ ++ writel(0, TIMER2_CONTROL); ++ free_irq(TIMER_2_INTERRUPT, 0); ++ writel(timer_load, TIMER2_LOAD); ++ writel(timer_control, TIMER2_CONTROL); ++ /* Turn off all the LEDs */ ++ if (negative_led_logic) { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_SET); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_SET); ++ } else { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_CLEAR); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_CLEAR); ++ } ++ /* put PWM module back into reset and disable clock */ ++ writel((1 << SYS_CTRL_RSTEN_MISC_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ // writel(PWM_CLOCK, SYS_CTRL_CKEN_CLR_CTRL); ++#ifdef DEBUG ++ remove_debug_files(pdev); ++#endif ++ return 0; ++} ++ ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: hipox_wd810_leds_driver */ ++/* */ ++/* PURPOSE: */ ++/* Describe the hipox-wd810-leds platform device driver */ ++/***************************************************************************/ ++static struct platform_driver hipox_wd810_leds_driver = { ++ .probe = hipox_wd810_leds_probe, ++ .remove = hipox_wd810_leds_remove, ++#ifdef CONFIG_PM ++ .suspend = hipox_wd810_leds_suspend,.resume = hipox_wd810_leds_resume, ++#endif /* CONFIG_PM */ ++ .driver = {.name = "hipox-wd810-leds",}, ++}; ++ ++/* Pointer to device returned by platform_device_register_simple */ ++static struct platform_device *hipox_wd810_leds; ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_init */ ++/* */ ++/* PURPOSE: */ ++/* Perform module initialization */ ++/***************************************************************************/ ++static int __init hipox_wd810_leds_init(void) ++{ ++ int ret; ++ printk(KERN_INFO "hipox-wd810-leds: SLOW_TPS=%d\n", SLOW_TPS); ++ ret = platform_driver_register(&hipox_wd810_leds_driver); ++ if (!ret) { ++ hipox_wd810_leds = ++ platform_device_register_simple("hipox-wd810-leds", -1, NULL, ++ 0); ++ } ++ ++ return ret; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: hipox_wd810_leds_exit */ ++/* */ ++/* PURPOSE: */ ++/* Perform module unloading and cleanup */ ++/***************************************************************************/ ++static void __exit hipox_wd810_leds_exit(void) ++{ ++ if (hipox_wd810_leds) { ++ platform_device_unregister(hipox_wd810_leds); ++ } ++ platform_driver_unregister(&hipox_wd810_leds_driver); ++} ++ ++ ++module_init(hipox_wd810_leds_init); ++module_exit(hipox_wd810_leds_exit); ++MODULE_DESCRIPTION("hipox wd810 1NC/2NC LEDs"); ++MODULE_AUTHOR("Oxford Semiconductor Ltd"); ++MODULE_LICENSE("GPL"); ++/******************************* End of File *********************************/ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/hipox.c linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox.c +--- linux-2.6.24/arch/arm/mach-hipox/hipox.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/hipox.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,1104 @@ ++/* ++ * linux/arch/arm/mach-hipox/hipox.c ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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/delay.h> ++#include <linux/platform_device.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/completion.h> ++#include <linux/serial.h> ++#include <linux/serial_core.h> ++#include <linux/serial_8250.h> ++ ++#include <asm/sizes.h> ++#include <asm/setup.h> ++#include <asm/mach-types.h> ++#include <asm/mach/arch.h> ++#include <asm/mach/map.h> ++#include <asm/arch/hardware.h> ++#include <asm/arch/dma.h> ++ ++#ifdef CONFIG_DO_MEM_TEST ++#include <linux/dma-mapping.h> ++#include <asm/io.h> ++#include <asm/arch/ahb_mon.h> ++#endif // CONFIG_DO_MEM_TEST ++ ++#include <asm/io.h> ++ ++#ifdef CONFIG_LEON_START_EARLY ++#include <asm/arch/leon.h> ++#include <asm/arch/leon-early-prog.h> ++#endif // CONFIG_LEON_START_EARLY ++ ++#ifdef CONFIG_HIPOX_PCI_RESET_GPIO ++#if (CONFIG_HIPOX_PCI_RESET_GPIO < 32) ++#define PCI_RESET_NUM CONFIG_HIPOX_PCI_RESET_GPIO ++#define PCI_RESET_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define PCI_RESET_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define PCI_RESET_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define PCI_RESET_SET_OE_REG GPIO_A_OUTPUT_ENABLE_SET ++#define PCI_RESET_OUTPUT_SET_REG GPIO_A_OUTPUT_SET ++#define PCI_RESET_OUTPUT_CLR_REG GPIO_A_OUTPUT_CLEAR ++#else ++#define PCI_RESET_NUM ((CONFIG_HIPOX_PCI_RESET_GPIO) - 32) ++#define PCI_RESET_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define PCI_RESET_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define PCI_RESET_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define PCI_RESET_SET_OE_REG GPIO_B_OUTPUT_ENABLE_SET ++#define PCI_RESET_OUTPUT_SET_REG GPIO_B_OUTPUT_SET ++#define PCI_RESET_OUTPUT_CLR_REG GPIO_B_OUTPUT_CLEAR ++#endif ++ ++#define PCI_RESET_MASK (1UL << (PCI_RESET_NUM)) ++#endif // CONFIG_HIPOX_PCI_RESET_GPIO ++ ++#define PCI_CLOCK_NUM 10 ++#define PCI_CLOCK_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define PCI_CLOCK_SET_OE_REG GPIO_A_OUTPUT_ENABLE_SET ++#define PCI_CLOCK_MASK (1UL << (PCI_CLOCK_NUM)) ++ ++#ifdef CONFIG_HIPOX_SATA_POWER_GPIO_1 ++#if (CONFIG_HIPOX_SATA_POWER_GPIO_1 < 32) ++#define SATA_POWER_1_NUM CONFIG_HIPOX_SATA_POWER_GPIO_1 ++#define SATA_POWER_1_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define SATA_POWER_1_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define SATA_POWER_1_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define SATA_POWER_1_SET_OE_REG GPIO_A_OUTPUT_ENABLE_SET ++#define SATA_POWER_1_OUTPUT_SET_REG GPIO_A_OUTPUT_SET ++#define SATA_POWER_1_OUTPUT_CLR_REG GPIO_A_OUTPUT_CLEAR ++#else ++#define SATA_POWER_1_NUM ((CONFIG_HIPOX_SATA_POWER_GPIO_1) - 32) ++#define SATA_POWER_1_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define SATA_POWER_1_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define SATA_POWER_1_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define SATA_POWER_1_SET_OE_REG GPIO_B_OUTPUT_ENABLE_SET ++#define SATA_POWER_1_OUTPUT_SET_REG GPIO_B_OUTPUT_SET ++#define SATA_POWER_1_OUTPUT_CLR_REG GPIO_B_OUTPUT_CLEAR ++#endif ++ ++#define SATA_POWER_1_MASK (1UL << (SATA_POWER_1_NUM)) ++#endif // CONFIG_HIPOX_SATA_POWER_GPIO_1 ++ ++#ifdef CONFIG_HIPOX_SATA_POWER_GPIO_2 ++#if (CONFIG_HIPOX_SATA_POWER_GPIO_2 < 32) ++#define SATA_POWER_2_NUM CONFIG_HIPOX_SATA_POWER_GPIO_2 ++#define SATA_POWER_2_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define SATA_POWER_2_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define SATA_POWER_2_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define SATA_POWER_2_SET_OE_REG GPIO_A_OUTPUT_ENABLE_SET ++#define SATA_POWER_2_OUTPUT_SET_REG GPIO_A_OUTPUT_SET ++#define SATA_POWER_2_OUTPUT_CLR_REG GPIO_A_OUTPUT_CLEAR ++#else ++#define SATA_POWER_2_NUM ((CONFIG_HIPOX_SATA_POWER_GPIO_2) - 32) ++#define SATA_POWER_2_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define SATA_POWER_2_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define SATA_POWER_2_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define SATA_POWER_2_SET_OE_REG GPIO_B_OUTPUT_ENABLE_SET ++#define SATA_POWER_2_OUTPUT_SET_REG GPIO_B_OUTPUT_SET ++#define SATA_POWER_2_OUTPUT_CLR_REG GPIO_B_OUTPUT_CLEAR ++#endif ++ ++#define SATA_POWER_2_MASK (1UL << (SATA_POWER_2_NUM)) ++#endif // CONFIG_HIPOX_SATA_POWER_GPIO_2 ++ ++#ifdef CONFIG_HIPOX_USB_HUB_RESET_GPIO ++#if (CONFIG_HIPOX_USB_HUB_RESET_GPIO < 32) ++#define USB_HUB_RESET_NUM CONFIG_HIPOX_USB_HUB_RESET_GPIO ++#define USB_HUB_RESET_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define USB_HUB_RESET_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define USB_HUB_RESET_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define USB_HUB_RESET_SET_OE_REG GPIO_A_OUTPUT_ENABLE_SET ++#define USB_HUB_RESET_OUTPUT_SET_REG GPIO_A_OUTPUT_SET ++#define USB_HUB_RESET_OUTPUT_CLR_REG GPIO_A_OUTPUT_CLEAR ++#else ++#define USB_HUB_RESET_NUM ((CONFIG_HIPOX_USB_HUB_RESET_GPIO) - 32) ++#define USB_HUB_RESET_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define USB_HUB_RESET_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define USB_HUB_RESET_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define USB_HUB_RESET_SET_OE_REG GPIO_B_OUTPUT_ENABLE_SET ++#define USB_HUB_RESET_OUTPUT_SET_REG GPIO_B_OUTPUT_SET ++#define USB_HUB_RESET_OUTPUT_CLR_REG GPIO_B_OUTPUT_CLEAR ++#endif ++ ++#define USB_HUB_RESET_MASK (1UL << (USB_HUB_RESET_NUM)) ++#endif // CONFIG_HIPOX_USB_HUB_RESET_GPIO ++ ++extern void hipox_init_irq(void); ++extern struct sys_timer hipox_timer; ++ ++// The spinlock exported to allow atomic use of GPIO register set ++spinlock_t hipox_gpio_spinlock; ++ ++// To hold LED inversion state ++int hipox_global_invert_leds = 0; ++#include <linux/module.h> ++EXPORT_SYMBOL(hipox_global_invert_leds); ++ ++static struct map_desc hipox_io_desc[] __initdata = { ++ { CORE_MODULE_BASE, __phys_to_pfn(CORE_MODULE_BASE_PA), SZ_4K, MT_DEVICE }, ++ { APB_BRIDGE_A_BASE, __phys_to_pfn(APB_BRIDGE_A_BASE_PA), SZ_16M, MT_DEVICE }, ++ { STATIC_CONTROL_BASE, __phys_to_pfn(STATIC_CONTROL_BASE_PA), SZ_4K, MT_DEVICE }, ++ { STATIC_CS0_BASE, __phys_to_pfn(STATIC_CS0_BASE_PA), SZ_4K, MT_DEVICE }, ++ { STATIC_CS1_BASE, __phys_to_pfn(STATIC_CS1_BASE_PA), SZ_4K, MT_DEVICE }, ++ { STATIC_CS2_BASE, __phys_to_pfn(STATIC_CS2_BASE_PA), SZ_4K, MT_DEVICE }, ++ { APB_BRIDGE_B_BASE, __phys_to_pfn(APB_BRIDGE_B_BASE_PA), SZ_16M, MT_DEVICE }, ++ { USB_BASE, __phys_to_pfn(USB_BASE_PA), SZ_4M, MT_DEVICE }, ++ { MAC_BASE, __phys_to_pfn(MAC_BASE_PA), SZ_4M, MT_DEVICE }, ++ { ROM_BASE, __phys_to_pfn(ROM_BASE_PA), SZ_16K, MT_DEVICE }, ++ { PCI_CSRS_BASE, __phys_to_pfn(PCI_CSRS_BASE_PA), SZ_4K, MT_DEVICE } ++#ifdef CONFIG_SUPPORT_LEON ++#if (CONFIG_LEON_PAGES == 1) ++ ,{ LEON_IMAGE_BASE, __phys_to_pfn(LEON_IMAGE_BASE_PA), SZ_4K, MT_DEVICE } ++#elif (CONFIG_LEON_PAGES == 2) ++ ,{ LEON_IMAGE_BASE, __phys_to_pfn(LEON_IMAGE_BASE_PA), SZ_8K, MT_DEVICE } ++#elif (CONFIG_LEON_PAGES == 3) ++ ,{ LEON_IMAGE_BASE, __phys_to_pfn(LEON_IMAGE_BASE_PA), SZ_8K, MT_DEVICE } ++ ,{ LEON_IMAGE_BASE+0x2000, __phys_to_pfn(LEON_IMAGE_BASE_PA+0x2000), SZ_4K, MT_DEVICE } ++#elif (CONFIG_LEON_PAGES == 4) ++ ,{ LEON_IMAGE_BASE, __phys_to_pfn(LEON_IMAGE_BASE_PA), SZ_8K, MT_DEVICE } ++ ,{ LEON_IMAGE_BASE+0x2000, __phys_to_pfn(LEON_IMAGE_BASE_PA+0x2000), SZ_8K, MT_DEVICE } ++#else ++#error "Unsupported number of Leon code pages" ++#endif // CONFIG_LEON_PAGES ++#endif // CONFIG_SUPPORT_LEON ++ /* ++ * Upto 8 pages for GMAC/DMA descriptors plus ARM/Leon TSO workspace if ++ * Leon TSO is in use ++ */ ++ ,{ SRAM_BASE, __phys_to_pfn(SRAM_PA), SZ_16K, MT_DEVICE } ++ ,{ SRAM_BASE+0x4000, __phys_to_pfn(SRAM_PA+0x4000), SZ_16K, MT_DEVICE } ++}; ++ ++static struct resource usb_resources[] = { ++ [0] = { ++ .start = USB_BASE_PA, ++ .end = USB_BASE_PA + 0x10000 - 1, ++ .flags = IORESOURCE_MEM, ++ }, ++ [1] = { ++ .start = USB_FS_INTERRUPT, ++ .end = USB_FS_INTERRUPT, ++ .flags = IORESOURCE_IRQ, ++ }, ++}; ++ ++static u64 usb_dmamask = ~(u32)0; ++ ++static struct platform_device usb_device = { ++ .name = "hipox-ehci", ++ .id = 0, ++ .dev = { ++ .dma_mask = &usb_dmamask, ++ .coherent_dma_mask = 0xffffffff, ++ }, ++ .num_resources = ARRAY_SIZE(usb_resources), ++ .resource = usb_resources, ++}; ++ ++static struct platform_device *platform_devices[] __initdata = { ++ &usb_device, ++}; ++ ++#define STD_COM_FLAGS (ASYNC_BOOT_AUTOCONF | ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ) ++ ++#define INT_UART_BASE_BAUD (NOMINAL_SYSCLK) ++ ++#ifdef CONFIG_ARCH_HIPOX_UART1 ++static struct uart_port internal_serial_port_1 = { ++ .membase = (char *)(UART_1_BASE), ++ .mapbase = UART_1_BASE_PA, ++ .irq = UART_1_INTERRUPT, ++ .flags = STD_COM_FLAGS, ++ .iotype = UPIO_MEM, ++ .regshift = 0, ++ .uartclk = INT_UART_BASE_BAUD, ++ .line = 0, ++ .type = PORT_16550A, ++ .fifosize = 16 ++}; ++#endif // CONFIG_ARCH_HIPOX_UART1 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART2 ++static struct uart_port internal_serial_port_2 = { ++ .membase = (char *)(UART_2_BASE), ++ .mapbase = UART_2_BASE_PA, ++ .irq = UART_2_INTERRUPT, ++ .flags = STD_COM_FLAGS, ++ .iotype = UPIO_MEM, ++ .regshift = 0, ++ .uartclk = INT_UART_BASE_BAUD, ++ .line = 0, ++ .type = PORT_16550A, ++ .fifosize = 16 ++}; ++#endif // CONFIG_ARCH_HIPOX_UART2 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART3 ++static struct uart_port internal_serial_port_3 = { ++ .membase = (char *)(UART_3_BASE), ++ .mapbase = UART_3_BASE_PA, ++ .irq = UART_3_INTERRUPT, ++ .flags = STD_COM_FLAGS, ++ .iotype = UPIO_MEM, ++ .regshift = 0, ++ .uartclk = INT_UART_BASE_BAUD, ++ .line = 0, ++ .type = PORT_16550A, ++ .fifosize = 16 ++}; ++#endif // CONFIG_ARCH_HIPOX_UART3 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART4 ++static struct uart_port internal_serial_port_4 = { ++ .membase = (char *)(UART_4_BASE), ++ .mapbase = UART_4_BASE_PA, ++ .irq = UART_4_INTERRUPT, ++ .flags = STD_COM_FLAGS, ++ .iotype = UPIO_MEM, ++ .regshift = 0, ++ .uartclk = INT_UART_BASE_BAUD, ++ .line = 0, ++ .type = PORT_16550A, ++ .fifosize = 16 ++}; ++#endif // CONFIG_ARCH_HIPOX_UART4 ++ ++static void __init hipox_mapio(void) ++{ ++ unsigned int uart_line=0; ++ ++//printk("hipox_mapio()\n"); ++ ++ // Setup kernel mappings for hardware cores ++ iotable_init(hipox_io_desc, ARRAY_SIZE(hipox_io_desc)); ++ ++#ifdef CONFIG_ARCH_HIPOX_FPGA ++ // Setup the ARM926-EJ-S integrator module clock and bus clock divider ++ asm volatile( ++ "mov r3,%2,LSL #4;" /* Bus clock divider = ((n+1) << 4) */ ++ "sub r3,r3,#16;" ++ "mov r0,%1;" /* Processor clock frequency */ ++ "sub r0,r0,#8;" /* correction for MHz */ ++ "and r0,r0,#0xFF;" /* ensure byte value */ ++ "mov r2,%0;" /* read CM base value */ ++ "ldr r1,[r2,#8];" /* read CM_OSC */ ++ "bic r1,r1,#0x0FF;" /* clear bottom byte r1 */ ++ "orr r1,r1,r0;" /* write in new clock values */ ++ "ldr r4,[r2,#0x24];" /* read CM_INIT */ ++ "bic r4,r4,#0x070;" /* clear bits [6:4] */ ++ "orr r4,r4,r3;" /* write in new clock values */ ++ "mov r0,#0xA000;" ++ "orr r0,r0,#0x5F;" /* build 0xA05F in r0 */ ++ "str r0,[r2,#0x14];" /* write to unlock CM_LOCK */ ++ "str r1,[r2,#8];" /* write value back */ ++ "str r4,[r2,#0x24];" /* write HCLK value back */ ++ "str r1,[r2,#0x14];" /* write in any value to relock CM_LOCK */ ++ : ++ : "r" (CORE_MODULE_BASE), "r" (CONFIG_HIPOX_CORE_CLK), "r" (CONFIG_HIPOX_CORE_BUS_CLK_DIV) ++ : "r0","r1","r2","r3","r4"); ++#endif // CONFIG_ARCH_HIPOX_FPGA ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ // Configure the DDR controller arbitration scheme ++ *(volatile u32*)DDR_ARB_REG = ((1UL << DDR_ARB_DATDIR_NCH_BIT) | ++ (1UL << DDR_ARB_DATDIR_EN_BIT) | ++ (1UL << DDR_ARB_REQAGE_EN_BIT) | ++ (1UL << DDR_ARB_LRUBANK_EN_BIT) | ++ (1UL << DDR_ARB_MIDBUF_BIT)); ++ ++ // Setup the DDR client read buffers ++ // NB 0X800 ASIC bug means DMA read buffers should never be enabled ++ *(volatile u32*)DDR_AHB_REG = ((1UL << DDR_AHB_NO_RCACHE_ARMD_BIT) | ++ /*(1UL << DDR_AHB_NO_RCACHE_ARMI_BIT) |*/ ++ (1UL << DDR_AHB_NO_RCACHE_COPRO_BIT) | ++ (1UL << DDR_AHB_NO_RCACHE_DMAA_BIT) | ++ (1UL << DDR_AHB_NO_RCACHE_DMAB_BIT) | ++ /* (1UL << DDR_AHB_NO_RCACHE_PCI_BIT) | ++ (1UL << DDR_AHB_NO_RCACHE_GMAC_BIT) |*/ ++ (1UL << DDR_AHB_NO_RCACHE_USB_BIT)); ++ ++ // Ignore HPROT for all clients except ARM data, as ARM Linux interrupt ++ // latency will mask any slight delay in data written by cores getting to ++ // memory after the core raises an interrupt ++ *(volatile u32*)DDR_AHB2_REG = ((1UL << DDR_AHB2_IGNORE_HPROT_ARMI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_COPRO_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_DMAA_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_DMAB_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_PCI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_GMAC_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_USB_BIT)); ++#elif CONFIG_HIPOX_VERSION_0X810 ++ // Configure the DDR controller arbitration scheme ++ *(volatile u32*)DDR_ARB_REG = ((1UL << DDR_ARB_DATDIR_NCH_BIT) | ++ (1UL << DDR_ARB_DATDIR_EN_BIT) | ++ (1UL << DDR_ARB_REQAGE_EN_BIT) | ++ (1UL << DDR_ARB_LRUBANK_EN_BIT) | ++ (1UL << DDR_ARB_MIDBUF_BIT)); ++ ++ // Configure read buffers - Do not disable any read buffers ++ *(volatile u32*)DDR_AHB_REG = 0UL; ++ ++ // Configure wrapping - Ignore wrap ++ // Configure HPROT - Ignore all HPROT except ARM data ++ *(volatile u32*)DDR_AHB2_REG = ((1UL << DDR_AHB2_IGNORE_WRAP_ARMD_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_ARMI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_COPRO_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_DMAA_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_DMAB_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_PCI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_GMAC_BIT) | ++ (1UL << DDR_AHB2_IGNORE_WRAP_US_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_ARMI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_COPRO_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_DMAA_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_DMAB_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_PCI_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_GMAC_BIT) | ++ (1UL << DDR_AHB2_IGNORE_HPROT_USB_BIT)); ++ ++ // Configure burst ordering - Do not disable burst ordering ++ // Configure non-cachable - Do not prevent non-cachable accesses from using read buffers ++ *(volatile u32*)DDR_AHB3_REG = 0UL; ++ ++ // Configure read buffer timeout - Do not enable read buffer invalidate after timeout ++ // Configure write behind - Enable write behind coherency ++ *(volatile u32*)DDR_AHB4_REG = ((1UL << DDR_AHB4_EN_WRBEHIND_ARMD_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_ARMI_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_COPRO_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_DMAA_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_DMAB_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_PCI_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_GMAC_BIT) | ++ (1UL << DDR_AHB4_EN_WRBEHIND_USB_BIT)); ++ ++#endif // CONFIG_HIPOX_VERSION_0X8xx ++ ++ // Enable all DDR client interfaces ++ *(volatile u32*)DDR_BLKEN_REG |= (((1UL << DDR_BLKEN_CLIENTS_NUM_BITS) - 1) << DDR_BLKEN_CLIENTS_BIT); ++ ++#ifdef CONFIG_ARCH_HIPOX_UART1 ++ // Block reset UART1 ++ *(volatile u32*)SYS_CTRL_RSTEN_SET_CTRL = (1UL << SYS_CTRL_RSTEN_UART1_BIT); ++ *(volatile u32*)SYS_CTRL_RSTEN_CLR_CTRL = (1UL << SYS_CTRL_RSTEN_UART1_BIT); ++ ++ // Route UART1 SOUT onto external pin ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x80000000; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x80000000; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x80000000; ++ ++ // Route UART1 SIN onto external pin ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_1 &= ~0x00000001; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_1 &= ~0x00000001; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_1 |= 0x00000001; ++ ++ // Setup GPIO line direction for UART1 SOUT ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x80000000; ++ ++ // Setup GPIO line direction for UART1 SIN ++ *(volatile u32*)GPIO_B_OUTPUT_ENABLE_CLEAR |= 0x00000001; ++ ++#ifdef CONFIG_ARCH_HIPOX_UART1_MODEM ++ // Route UART1 modem control lines onto external pins ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x78000000; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x78000000; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x78000000; ++ ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_1 &= ~0x00000006; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_1 &= ~0x00000006; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_1 |= 0x00000006; ++ ++ // Setup GPIO line directions for UART1 modem control lines ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x08000000; ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_CLEAR |= 0x70000000; ++ ++ *(volatile u32*)GPIO_B_OUTPUT_ENABLE_SET |= 0x00000004; ++ *(volatile u32*)GPIO_B_OUTPUT_ENABLE_CLEAR |= 0x00000002; ++#endif // CONFIG_ARCH_HIPOX_UART1_MODEM ++ ++ // Give Linux a contiguous numbering scheme for available UARTs ++ internal_serial_port_1.line = uart_line++; ++ early_serial_setup(&internal_serial_port_1); ++#endif // CONFIG_ARCH_HIPOX_UART1 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART2 ++ // Block reset UART2 ++ *(volatile u32*)SYS_CTRL_RSTEN_SET_CTRL = (1UL << SYS_CTRL_RSTEN_UART2_BIT); ++ *(volatile u32*)SYS_CTRL_RSTEN_CLR_CTRL = (1UL << SYS_CTRL_RSTEN_UART2_BIT); ++ ++ // Route UART2 SIN/SOUT onto external pin ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x00500000; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x00500000; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x00500000; ++ ++ // Setup GPIO line directions for UART2 SIN/SOUT ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x00100000; ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_CLEAR |= 0x00400000; ++ ++#ifdef CONFIG_ARCH_HIPOX_UART2_MODEM ++ // Route UART2 modem control lines onto external pins ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x07800300; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x07800300; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x07800300; ++ ++ // Setup GPIO line directions for UART2 modem control lines ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x02000200; ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_CLEAR |= 0x05800100; ++#endif // CONFIG_ARCH_HIPOX_UART2_MODEM ++ ++ // Give Linux a contiguous numbering scheme for available UARTs ++ internal_serial_port_2.line = uart_line++; ++ early_serial_setup(&internal_serial_port_2); ++#endif // CONFIG_ARCH_HIPOX_UART2 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART3 ++ // Block reset UART3 ++ *(volatile u32*)SYS_CTRL_RSTEN_SET_CTRL = (1UL << SYS_CTRL_RSTEN_UART3_BIT); ++ *(volatile u32*)SYS_CTRL_RSTEN_CLR_CTRL = (1UL << SYS_CTRL_RSTEN_UART3_BIT); ++ ++ // Route UART3 SIN/SOUT onto external pin ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x000000C0; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x000000C0; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x000000C0; ++ ++ // Setup GPIO line directions for UART3 SIN/SOUT ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x00000080; ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_CLEAR |= 0x00000040; ++ ++ // Enable UART3 interrupt ++ *(volatile u32*)SYS_CTRL_UART_CTRL |= (1UL << SYS_CTRL_UART3_IQ_EN); ++ ++#ifdef CONFIG_ARCH_HIPOX_UART3_MODEM ++ // Route UART3 modem control lines onto external pins ++ *(volatile u32*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0 &= ~0x0000003f; ++ *(volatile u32*)SYS_CTRL_GPIO_SECSEL_CTRL_0 &= ~0x0000003f; ++ *(volatile u32*)SYS_CTRL_GPIO_TERTSEL_CTRL_0 |= 0x0000003f; ++ ++ // Setup GPIO line directions for UART3 modem control lines ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_SET |= 0x00000030; ++ *(volatile u32*)GPIO_A_OUTPUT_ENABLE_CLEAR |= 0x0000000f; ++#endif // CONFIG_ARCH_HIPOX_UART3_MODEM ++ ++ // Give Linux a contiguous numbering scheme for available UARTs ++ internal_serial_port_3.line = uart_line++; ++ early_serial_setup(&internal_serial_port_3); ++#endif // CONFIG_ARCH_HIPOX_UART3 ++ ++#ifdef CONFIG_ARCH_HIPOX_UART4 ++ // Block reset UART4 ++ *(volatile u32*)SYS_CTRL_RSTEN_SET_CTRL = (1UL << SYS_CTRL_RSTEN_UART4_BIT); ++ *(volatile u32*)SYS_CTRL_RSTEN_CLR_CTRL = (1UL << SYS_CTRL_RSTEN_UART4_BIT); ++ ++ // Enable UART4 interrupt ++ *(volatile u32*)SYS_CTRL_UART_CTRL |= (1UL << SYS_CTRL_UART4_IQ_EN); ++ ++ // Enable UART4 to override PCI functions onto GPIOs ++ *(volatile u32*)SYS_CTRL_UART_CTRL |= (1UL << SYS_CTRL_UART4_NOT_PCI_MODE); ++ ++ internal_serial_port_4.line = uart_line++; ++ early_serial_setup(&internal_serial_port_4); ++#endif // CONFIG_ARCH_HIPOX_UART4 ++ ++#ifdef CONFIG_PCI ++ // Block reset PCI core ++ *(volatile u32*)SYS_CTRL_RSTEN_SET_CTRL = (1UL << SYS_CTRL_RSTEN_PCI_BIT); ++ *(volatile u32*)SYS_CTRL_RSTEN_CLR_CTRL = (1UL << SYS_CTRL_RSTEN_PCI_BIT); ++ ++ // Setup the PCI clock divider ++ { ++ static const u32 PCIDIV_MASK = (((1UL << SYS_CTRL_CKCTRL_CTRL_PCIDIV_NUM_BITS) - 1) << SYS_CTRL_CKCTRL_CTRL_PCIDIV_BIT); ++ *(volatile u32*)SYS_CTRL_CKCTRL_CTRL &= ~PCIDIV_MASK; ++ *(volatile u32*)SYS_CTRL_CKCTRL_CTRL |= (PCI_CLOCK_DIVIDER << SYS_CTRL_CKCTRL_CTRL_PCIDIV_BIT); ++ } ++ ++ // Enable clock to PCI core ++ *(volatile u32*)SYS_CTRL_CKEN_SET_CTRL = (1UL << SYS_CTRL_CKEN_PCI_BIT); ++ ++ // Enable auto-arbitration between static and PCI ++ *(u32*)SYS_CTRL_PCI_CTRL1 &= ~(1UL << SYSCTL_PCI_CTRL1_SYSPCI_STATIC_REQ); ++ ++ // Enable primary function on PCI clock line to be looped back ++ writel(readl(PCI_CLOCK_PRISEL_REG) | PCI_CLOCK_MASK, PCI_CLOCK_PRISEL_REG); ++ ++ // Enable GPIO output on PCI clock line to be looped back ++ writel(PCI_CLOCK_MASK, PCI_CLOCK_SET_OE_REG); ++ ++#ifdef CONFIG_HIPOX_PCI_RESET ++ // Disable primary, secondary and teriary GPIO functions on PCI reset line ++ writel(readl(PCI_RESET_PRISEL_REG) & ~PCI_RESET_MASK, PCI_RESET_PRISEL_REG); ++ writel(readl(PCI_RESET_SECSEL_REG) & ~PCI_RESET_MASK, PCI_RESET_SECSEL_REG); ++ writel(readl(PCI_RESET_TERSEL_REG) & ~PCI_RESET_MASK, PCI_RESET_TERSEL_REG); ++ ++ // Assert PCI reset from GPIO line ++ writel(PCI_RESET_MASK, PCI_RESET_OUTPUT_CLR_REG); ++ ++ // Enable GPIO output on PCI reset line ++ writel(PCI_RESET_MASK, PCI_RESET_SET_OE_REG); ++ ++ // Wait awhile for PCI reset to take effect ++ mdelay(100); ++ ++ // Deassert PCI reset from GPIO line ++ writel(PCI_RESET_MASK, PCI_RESET_OUTPUT_SET_REG); ++#endif // CONFIG_HIPOX_PCI_RESET ++#endif // CONFIG_PCI ++ ++#ifdef CONFIG_HIPOX_SATA_POWER_1 ++ // Disable primary, secondary and teriary GPIO functions on SATA 1 power line ++ writel(readl(SATA_POWER_1_PRISEL_REG) & ~SATA_POWER_1_MASK, SATA_POWER_1_PRISEL_REG); ++ writel(readl(SATA_POWER_1_SECSEL_REG) & ~SATA_POWER_1_MASK, SATA_POWER_1_SECSEL_REG); ++ writel(readl(SATA_POWER_1_TERSEL_REG) & ~SATA_POWER_1_MASK, SATA_POWER_1_TERSEL_REG); ++ ++ // Enable power to SATA 1 ++ writel(SATA_POWER_1_MASK, SATA_POWER_1_OUTPUT_SET_REG); ++ ++ // Enable GPIO output on SATA 1 power line ++ writel(SATA_POWER_1_MASK, SATA_POWER_1_SET_OE_REG); ++#endif // CONFIG_HIPOX_SATA_POWER_1 ++ ++#ifdef CONFIG_HIPOX_SATA_POWER_2 ++ // Disable primary, secondary and teriary GPIO functions on SATA 2 power line ++ writel(readl(SATA_POWER_2_PRISEL_REG) & ~SATA_POWER_2_MASK, SATA_POWER_2_PRISEL_REG); ++ writel(readl(SATA_POWER_2_SECSEL_REG) & ~SATA_POWER_2_MASK, SATA_POWER_2_SECSEL_REG); ++ writel(readl(SATA_POWER_2_TERSEL_REG) & ~SATA_POWER_2_MASK, SATA_POWER_2_TERSEL_REG); ++ ++ // Enable power to SATA 2 ++ writel(SATA_POWER_2_MASK, SATA_POWER_2_OUTPUT_SET_REG); ++ ++ // Enable GPIO output on SATA 2 power line ++ writel(SATA_POWER_2_MASK, SATA_POWER_2_SET_OE_REG); ++#endif // CONFIG_HIPOX_SATA_POWER_2 ++ ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES_GPIO ++ // Use GPIO 6 (normally PCI Req 6) for copies instrumentation ++ #define INSTRUMENT_COPIES_GPIO_MASK ((1UL << 6) | (1UL << 7)) ++ ++ // Enable normal GPIO on line ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) & ~INSTRUMENT_COPIES_GPIO_MASK, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) & ~INSTRUMENT_COPIES_GPIO_MASK, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0) & ~INSTRUMENT_COPIES_GPIO_MASK, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ // Set line inactive to begin with ++ writel(INSTRUMENT_COPIES_GPIO_MASK, GPIO_A_OUTPUT_CLEAR); ++ ++ // Enable line as an output ++ writel(INSTRUMENT_COPIES_GPIO_MASK, GPIO_A_OUTPUT_ENABLE_SET); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES_GPIO ++ ++#ifdef CONFIG_HIPOX_USB_CKOUT ++ // Enable secondary function (USB clock out) on GPIO 10 ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) & ~(1UL << 10), SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) | (1UL << 10), SYS_CTRL_GPIO_SECSEL_CTRL_0); ++#endif // CONFIG_HIPOX_USB_CKOUT ++ ++#ifdef CONFIG_HIPOX_USB_HUB_RESET_CONTROL ++ // Disable primary, secondary and teriary GPIO functions on USB hub reset control line ++ writel(readl(USB_HUB_RESET_PRISEL_REG) & ~USB_HUB_RESET_MASK, USB_HUB_RESET_PRISEL_REG); ++ writel(readl(USB_HUB_RESET_SECSEL_REG) & ~USB_HUB_RESET_MASK, USB_HUB_RESET_SECSEL_REG); ++ writel(readl(USB_HUB_RESET_TERSEL_REG) & ~USB_HUB_RESET_MASK, USB_HUB_RESET_TERSEL_REG); ++ ++#ifdef CONFIG_HIPOX_USB_HUB_RESET_TOGGLE ++ // Assert USB hub reset ++ writel(USB_HUB_RESET_MASK, CONFIG_HIPOX_USB_HUB_RESET_ACTIVE_HIGH ? USB_HUB_RESET_OUTPUT_SET_REG : USB_HUB_RESET_OUTPUT_CLR_REG); ++#else ++ // Deassert USB hub reset ++ writel(USB_HUB_RESET_MASK, CONFIG_HIPOX_USB_HUB_RESET_ACTIVE_HIGH ? USB_HUB_RESET_OUTPUT_CLR_REG : USB_HUB_RESET_OUTPUT_SET_REG); ++#endif // CONFIG_HIPOX_USB_HUB_RESET_TOGGLE ++ ++ // Enable GPIO output on USB hub reset line ++ writel(USB_HUB_RESET_MASK, USB_HUB_RESET_SET_OE_REG); ++ ++#ifdef CONFIG_HIPOX_USB_HUB_RESET_TOGGLE ++ if (CONFIG_HIPOX_USB_HUB_RESET_PERIOD_MS > 0) { ++ // Wait for USB hub reset toggle assertion time ++ mdelay(CONFIG_HIPOX_USB_HUB_RESET_PERIOD_MS); ++ } ++ ++ // Deassert USB hub reset ++ writel(USB_HUB_RESET_MASK, CONFIG_HIPOX_USB_HUB_RESET_ACTIVE_HIGH ? USB_HUB_RESET_OUTPUT_CLR_REG : USB_HUB_RESET_OUTPUT_SET_REG); ++#endif // CONFIG_HIPOX_USB_HUB_RESET_TOGGLE ++ ++#endif // CONFIG_HIPOX_USB_HUB_RESET_CONTROL ++} ++ ++static void __init hipox_fixup( ++ struct machine_desc *desc, ++ struct tag *tags, ++ char **cmdline, ++ struct meminfo *mi) ++{ ++ ++ mi->nr_banks = 0; ++ mi->bank[mi->nr_banks].start = SDRAM_PA; ++ mi->bank[mi->nr_banks].size = SDRAM_SIZE; ++ mi->bank[mi->nr_banks].node = mi->nr_banks; ++ ++mi->nr_banks; ++#ifdef CONFIG_DISCONTIGMEM ++ mi->bank[mi->nr_banks].start = SRAM_PA; ++ mi->bank[mi->nr_banks].size = SRAM_SIZE; ++#ifdef LEON_IMAGE_IN_SRAM ++ mi->bank[mi->nr_banks].size -= LEON_IMAGE_SIZE; ++#endif ++ mi->bank[mi->nr_banks].node = mi->nr_banks; ++ ++mi->nr_banks; ++#endif ++ ++//printk(KERN_NOTICE "%d memory %s\n", mi->nr_banks, (mi->nr_banks > 1) ? "regions" : "region"); ++} ++ ++#ifdef CONFIG_DO_MEM_TEST ++static void __init hipox_asm_copy(void* dst, void* src, u32 length) ++{ ++ // Assume the length is consistent with transfering 8 quads per load/store ++ asm volatile( ++ "1:ldmia %0!, {r3, r4, r5, r6, r7, r8, r9, r12};" ++ "subs %2, %2, #32;" ++ "stmia %1!, {r3, r4, r5, r6, r7, r8, r9, r12};" ++ "bne 1b;" ++ : ++ : "r" (src), "r" (dst), "r" (length) ++ : "r3", "r4", "r5", "r6", "r7", "r8", "r9", "r12"); ++} ++ ++static void __init hipox_mem_test(void) ++{ ++ static const unsigned BUFFER_SIZE_CHARS = 16*1024; ++ static const unsigned BUFFER_ELEMENTS = (BUFFER_SIZE_CHARS / sizeof(unsigned long)); ++ ++ dma_addr_t dma_address; ++ unsigned long* buffer; ++ ++ buffer = dma_alloc_coherent(0, BUFFER_SIZE_CHARS, &dma_address, GFP_KERNEL | GFP_DMA); ++ if (!buffer) { ++ printk(KERN_ERR "$RFailed to allocate ucached/unbuffered memory test buffer\n"); ++ } else { ++ static const int ITERATIONS = 10; ++ ++ unsigned long* buf1 = buffer; ++ unsigned long* buf2 = buffer + (BUFFER_ELEMENTS/2); ++ int j; ++ u32* time1 = (u32*)kmalloc(ITERATIONS *sizeof(u32), GFP_KERNEL); ++ u32* time2 = (u32*)kmalloc(ITERATIONS *sizeof(u32), GFP_KERNEL); ++ ++ BUG_ON(!time1 || !time2); ++ ++ printk("Uncached/unbuffered: src = 0x%08x, dst = 0x%08x, length = %u, elements = %u, dma_address = 0x%08x\n", (u32)buf1, (u32)buf2, BUFFER_SIZE_CHARS/2, BUFFER_ELEMENTS/2, dma_address); ++ ++ printk("\nAll accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, 0, 0, 0, 0); ++ ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nNon-burst accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_SINGLE, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nINCR accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_INCR, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nWRAP4 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_WRAP4, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nINCR4 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_INCR4, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nWRAP8 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_WRAP8, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nINCR8 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_INCR8, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nWRAP16 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_WRAP16, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ printk("\nINCR16 accesses:\n"); ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, ~0, AHB_MON_HBURST_INCR16, 0, 0); ++ for (j=0; j < ITERATIONS; j++) { ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ for (j=0; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ dma_free_coherent(0, BUFFER_SIZE_CHARS, buffer, dma_address); ++ ++ kfree(time1); ++ kfree(time2); ++ } ++ ++ buffer = kmalloc(BUFFER_SIZE_CHARS, GFP_KERNEL | GFP_DMA); ++ if (!buffer) { ++ printk(KERN_ERR "$RFailed to allocate cached memory test buffer\n"); ++ } else { ++ static const int ITERATIONS = 100; ++ ++ unsigned long* buf1 = buffer; ++ unsigned long* buf2 = buffer + (BUFFER_ELEMENTS/2); ++ unsigned long* src = buf1; ++ unsigned long* dst = buf2; ++ int j; ++ u32* time1 = (u32*)kmalloc(ITERATIONS *sizeof(u32), GFP_KERNEL); ++ u32* time2 = (u32*)kmalloc(ITERATIONS *sizeof(u32), GFP_KERNEL); ++ ++ BUG_ON(!time1 || !time2); ++ ++ printk("Cached/: src = 0x%08x, dst = 0x%08x, length = %u, elements = %u\n", (u32)buf1, (u32)buf2, BUFFER_SIZE_CHARS/2, BUFFER_ELEMENTS/2); ++ ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, 0, 0, 0, 0); ++ ++ // Measure the first cached iteration separately ++ printk("1st iteration:\n"); ++ restart_ahb_monitors(); ++ time1[0] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[0] = readl(TIMER2_VALUE); ++ read_ahb_monitors(); ++ printk("%u->%lu Bytes/s\n", time1[0]-time2[0], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[0]-time2[0])); ++ ++ printk("Subsequent iterations:\n"); ++ restart_ahb_monitors(); ++ for (j=1; j < ITERATIONS; j++) { ++ src = buf1; ++ dst = buf2; ++// int i; ++ ++ time1[j] = readl(TIMER2_VALUE); ++// memcpy(dst, src, BUFFER_SIZE_CHARS/2); ++ hipox_asm_copy(dst, src, BUFFER_SIZE_CHARS/2); ++// for (i=0; i<BUFFER_ELEMENTS/2; i++) { ++// *dst++ = *src++; ++// } ++ time2[j] = readl(TIMER2_VALUE); ++ } ++ read_ahb_monitors(); ++ ++ for (j=1; j < ITERATIONS; j++) { ++ printk("%u->%lu Bytes/s\n", time1[j]-time2[j], 100000UL * (BUFFER_SIZE_CHARS/2) / (time1[j]-time2[j])); ++ } ++ ++ kfree(time1); ++ kfree(time2); ++ ++ kfree(buffer); ++ } ++} ++#endif // CONFIG_DO_MEM_TEST ++ ++#ifdef CONFIG_HIPOX_LED_TEST ++ ++#define LED_D1 (1UL << 6) ++#define LED_D2 (1UL << 7) ++#define LED_D3 (1UL << 13) ++#define LED_D4 (1UL << 14) ++#define LED_D5 (1UL << 19) ++#define LED_D6 (1UL << 21) ++#define LED_D7 (1UL << 25) ++#define LED_D8 (1UL << 26) ++#define LED_D9 (1UL << 27) ++#define FIRST_LEDS_MASK (LED_D1 | LED_D2 | LED_D3 | LED_D4 | LED_D5 | LED_D6 | LED_D7 | LED_D8 | LED_D9) ++ ++#define LED_D10 (1UL << 1) ++#define SECOND_LEDS_MASK (LED_D10) ++ ++#define PWM_MASK (1UL << 8) ++ ++static void test_leds_and_pwm(void) ++{ ++ // Disable primary, secondary and teriary GPIO functions for first nine LEDS ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) & ~FIRST_LEDS_MASK, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) & ~FIRST_LEDS_MASK, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0) & ~FIRST_LEDS_MASK, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ // Disable primary, secondary and teriary GPIO functions for last LED ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_1) & ~SECOND_LEDS_MASK, SYS_CTRL_GPIO_PRIMSEL_CTRL_1); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_1) & ~SECOND_LEDS_MASK, SYS_CTRL_GPIO_SECSEL_CTRL_1); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_1) & ~SECOND_LEDS_MASK, SYS_CTRL_GPIO_TERTSEL_CTRL_1); ++ ++ // Turn off first nine LEDs ++ writel(FIRST_LEDS_MASK, GPIO_A_OUTPUT_SET); ++ ++ // Turn off tenth LED ++ writel(SECOND_LEDS_MASK, GPIO_B_OUTPUT_SET); ++ ++ // Enable first nine LEDs as outputs ++ writel(FIRST_LEDS_MASK, GPIO_A_OUTPUT_ENABLE_SET); ++ ++ // Enable tenth LED as output ++ writel(SECOND_LEDS_MASK, GPIO_B_OUTPUT_ENABLE_SET); ++ ++ // Turn on first nine LEDs sequentially ++ mdelay(1000); ++ writel(LED_D1, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D2, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D3, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D4, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D5, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D6, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D7, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D8, GPIO_A_OUTPUT_CLEAR); ++ mdelay(1000); ++ writel(LED_D9, GPIO_A_OUTPUT_CLEAR); ++ ++ // Turn on tenth LED ++ mdelay(1000); ++ writel(LED_D10, GPIO_B_OUTPUT_CLEAR); ++ ++ // Disable primary, secondary and teriary GPIO functions for PWN line ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) & ~PWM_MASK, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) & ~PWM_MASK, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0) & ~PWM_MASK, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ // Turn off PWM line ++ writel(PWM_MASK, GPIO_A_OUTPUT_SET); ++ ++ // Enable PWM line as output ++ writel(PWM_MASK, GPIO_A_OUTPUT_ENABLE_SET); ++ ++ // Turn on PWM line ++ mdelay(1000); ++ writel(PWM_MASK, GPIO_A_OUTPUT_CLEAR); ++} ++#endif // CONFIG_HIPOX_LED_TEST ++ ++static void __init hipox_init_machine(void) ++{ ++//printk("hipox_init_machine()\n"); ++ /* Initialise the spinlock used to make GPIO register set access atomic */ ++ spin_lock_init(&hipox_gpio_spinlock); ++ ++ /* ++ * Initialise the support for our multi-channel memory-to-memory DMAC ++ * The interrupt subsystem needs to be available before we can initialise ++ * the DMAC support ++ */ ++ hipox_dma_init(); ++ ++#ifdef CONFIG_DO_MEM_TEST ++ /* ++ * Do memory performance test ++ */ ++ hipox_mem_test(); ++#endif // CONFIG_DO_MEM_TEST ++ ++#ifdef CONFIG_LEON_START_EARLY ++ init_copro(leon_early_srec, 0); ++#endif // CONFIG_LEON_START_EARLY ++ ++#ifdef CONFIG_HIPOX_LED_TEST ++ test_leds_and_pwm(); ++#endif // CONFIG_HIPOX_LED_TEST ++ ++ // Add any platform bus devices ++ platform_add_devices(platform_devices, ARRAY_SIZE(platform_devices)); ++} ++ ++void sata_power_off(void) ++{ ++#ifdef CONFIG_HIPOX_SATA_POWER_1 ++ // Disable power to SATA 1 ++ printk(KERN_INFO "Turning off disk 1\n"); ++ writel(SATA_POWER_1_MASK, SATA_POWER_1_OUTPUT_CLR_REG); ++#endif // CONFIG_HIPOX_SATA_POWER_1 ++ ++#ifdef CONFIG_HIPOX_SATA_POWER_2 ++ // Disable power to SATA 2 ++ printk(KERN_INFO "Turning off disk 2\n"); ++ writel(SATA_POWER_2_MASK, SATA_POWER_2_OUTPUT_CLR_REG); ++#endif // CONFIG_HIPOX_SATA_POWER_2 ++} ++ ++MACHINE_START(OXNAS, "Oxsemi NAS") ++ /* Maintainer: Oxford Semiconductor Ltd */ ++#ifdef CONFIG_ARCH_HIPOX_UART1 ++ .phys_io = UART_1_BASE_PA, ++ .io_pg_offst = (((u32)UART_1_BASE) >> 18) & 0xfffc, ++#elif defined(CONFIG_ARCH_HIPOX_UART2) ++ .phys_io = UART_2_BASE_PA, ++ .io_pg_offst = (((u32)UART_2_BASE) >> 18) & 0xfffc, ++#elif defined(CONFIG_ARCH_HIPOX_UART3) ++ .phys_io = UART_3_BASE_PA, ++ .io_pg_offst = (((u32)UART_3_BASE) >> 18) & 0xfffc, ++#elif defined(CONFIG_ARCH_HIPOX_UART4) ++ .phys_io = UART_4_BASE_PA, ++ .io_pg_offst = (((u32)UART_4_BASE) >> 18) & 0xfffc, ++#endif ++ .boot_params = SDRAM_PA + 0x100, ++ .fixup = hipox_fixup, ++ .map_io = hipox_mapio, ++ .init_irq = hipox_init_irq, ++ .timer = &hipox_timer, ++ .init_machine = hipox_init_machine, ++MACHINE_END ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/pci.c linux-2.6.24-oxe810/arch/arm/mach-hipox/pci.c +--- linux-2.6.24/arch/arm/mach-hipox/pci.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/pci.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,678 @@ ++/* ++ * arch/arm/mach-hipox/pci.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/kernel.h> ++ ++#include <linux/pci.h> ++#include <linux/ptrace.h> ++#include <linux/interrupt.h> ++#include <linux/init.h> ++#include <linux/delay.h> ++ ++#include <asm/io.h> ++#include <asm/hardware.h> ++#include <asm/irq.h> ++#include <asm/system.h> ++#include <asm/mach/pci.h> ++#include <asm/mach-types.h> ++ ++#ifndef CONFIG_PCI ++ ++inline void outb(unsigned char v, u32 p) { *((volatile u8*)(__io(p))) = (v); } ++inline void outw(unsigned short v, u32 p) { *((volatile u16*)(__io(p))) = cpu_to_le16(v); } ++inline void outl(unsigned long v, u32 p) { *((volatile u32*)(__io(p))) = cpu_to_le32(v); } ++ ++inline unsigned char inb(u32 p) { return (*((volatile u8*)(__io(p)))); } ++inline unsigned short inw(u32 p) { return le16_to_cpu(*((volatile u16*)(__io(p)))); } ++inline unsigned long inl(u32 p) { return le32_to_cpu(*((volatile u32*)(__io(p)))); } ++ ++inline void outsb(u32 p, unsigned char * from, u32 len) { while (len--) { outb((*from++),(p) ); } } ++inline void outsw(u32 p, unsigned short * from, u32 len) { while (len--) { outw((*from++),(p) ); } } ++inline void outsl(u32 p, unsigned long * from, u32 len) { while (len--) { outl((*from++),(p) ); } } ++ ++inline void insb(u32 p, unsigned char * to, u32 len) { while (len--) { *to++ = inb(p); } } ++inline void insw(u32 p, unsigned short * to, u32 len) { while (len--) { *to++ = inw(p); } } ++inline void insl(u32 p, unsigned long * to, u32 len) { while (len--) { *to++ = inl(p); } } ++ ++EXPORT_SYMBOL( inb ); ++EXPORT_SYMBOL( inw ); ++EXPORT_SYMBOL( inl ); ++ ++EXPORT_SYMBOL( outb ); ++EXPORT_SYMBOL( outw ); ++EXPORT_SYMBOL( outl ); ++ ++EXPORT_SYMBOL( insb ); ++EXPORT_SYMBOL( insw ); ++EXPORT_SYMBOL( insl ); ++ ++EXPORT_SYMBOL( outsb ); ++EXPORT_SYMBOL( outsw ); ++EXPORT_SYMBOL( outsl ); ++ ++#else // #ifdef CONFIG_PCI ++ ++extern spinlock_t hipox_gpio_spinlock; ++ ++#define PCI_BUS_NONMEM_START 0x00000000 ++#define PCI_BUS_NONMEM_SIZE 0x00080000 ++ ++ ++#define PCI_BUS_PREMEM_START PCI_BUS_NONMEM_START + PCI_BUS_NONMEM_SIZE ++#define PCI_BUS_PREMEM_SIZE 0x00080000 ++ ++#define SYNOPSYS_PCI_MEMORY_BASE_ADDRESS PCI_BASE_ADDRESS_0 ++#define SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS PCI_BASE_ADDRESS_2 ++#define SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS PCI_BASE_ADDRESS_1 // PLEASE NOTE - THESE ARE INCORRECT IN THE DOCUMENT!! ++ ++ ++inline void outb(unsigned char v, u32 p) { pciio_write(v,(u32)__io(p), sizeof(char ) ); } ++inline void outw(unsigned short v, u32 p) { pciio_write(cpu_to_le16(v),(u32)__io(p),sizeof(short) ); } ++inline void outl(unsigned long v, u32 p) { pciio_write(cpu_to_le32(v),(u32)__io(p),sizeof(long ) ); } ++ ++inline unsigned char inb(u32 p) { unsigned int __v = (pciio_read((u32)__io(p),sizeof(char ))); return __v; } ++inline unsigned short inw(u32 p) { unsigned int __v = le16_to_cpu(pciio_read((u32)__io(p),sizeof(short))); return __v; } ++inline unsigned long inl(u32 p) { unsigned int __v = le32_to_cpu(pciio_read((u32)__io(p),sizeof(long ))); return __v; } ++ ++inline void outsb(volatile u32 p, unsigned char * from, u32 len) { while (len--) { pciio_write( (*from++),(u32)__io(p),sizeof(char ) ); } } ++inline void outsw(volatile u32 p, unsigned short * from, u32 len) { while (len--) { pciio_write(cpu_to_le16(*from++),(u32)__io(p),sizeof(short) ); } } ++inline void outsl(volatile u32 p, unsigned long * from, u32 len) { while (len--) { pciio_write(cpu_to_le32(*from++),(u32)__io(p),sizeof(long ) ); } } ++ ++inline void insb(volatile u32 p, unsigned char * to, u32 len) { while (len--) { *to++ = (pciio_read((u32)__io(p),sizeof(char ))); } } ++inline void insw(volatile u32 p, unsigned short * to, u32 len) { while (len--) { *to++ = le16_to_cpu(pciio_read((u32)__io(p),sizeof(short))); } } ++inline void insl(volatile u32 p, unsigned long * to, u32 len) { while (len--) { *to++ = le32_to_cpu(pciio_read((u32)__io(p),sizeof(long ))); } } ++ ++EXPORT_SYMBOL( inb ); ++EXPORT_SYMBOL( inw ); ++EXPORT_SYMBOL( inl ); ++ ++EXPORT_SYMBOL( outb ); ++EXPORT_SYMBOL( outw ); ++EXPORT_SYMBOL( outl ); ++ ++EXPORT_SYMBOL( insb ); ++EXPORT_SYMBOL( insw ); ++EXPORT_SYMBOL( insl ); ++ ++EXPORT_SYMBOL( outsb ); ++EXPORT_SYMBOL( outsw ); ++EXPORT_SYMBOL( outsl ); ++ ++EXPORT_SYMBOL( pciio_read ); ++EXPORT_SYMBOL( pciio_write ); ++ ++static spinlock_t hipox_lock = SPIN_LOCK_UNLOCKED; ++ ++//static int hipox_pci_read_core_config( unsigned int config_register ) ++//{ ++// unsigned long val, flags; ++// //printk(KERN_DEBUG "PCI: hipox_pci_read_core_config( 0x%x )\n", config_register ); ++// spin_lock_irqsave(&hipox_lock, flags); ++// writel( ++// 0x00 << PCI_CRP_BYTE_ENABLES_START | ++// PCI_BUS_CMD_CONFIGURATION_READ << PCI_CRP_CMD_START | ++// config_register << PCI_CRP_ADDRESS_START, ++// PCI_CRP_CMD_AND_ADDR ); ++// wmb(); ++// val = readl( PCI_CRP_READ_DATA ); ++// spin_unlock_irqrestore(&hipox_lock, flags); ++// return val; ++//} ++ ++ ++static void hipox_pci_write_core_config( unsigned int value, unsigned int config_register ) ++{ ++ unsigned long flags; ++ ++ //printk(KERN_DEBUG "PCI: hipox_pci_write_core_config( 0x%x, 0x%x )\n", config_register , value); ++ /* printk(KERN_DEBUG "PCI: writel( 0x%lx, 0x%lx )\n", ++ 0x00 << PCI_CRP_BYTE_ENABLES_START | ++ PCI_BUS_CMD_CONFIGURATION_WRITE << PCI_CRP_CMD_START | ++ config_register << PCI_CRP_ADDRESS_START, ++ PCI_CRP_CMD_AND_ADDR ); */ ++ ++ spin_lock_irqsave(&hipox_lock, flags); ++ writel( ++ 0x00 << PCI_CRP_BYTE_ENABLES_START | ++ PCI_BUS_CMD_CONFIGURATION_WRITE << PCI_CRP_CMD_START | ++ config_register << PCI_CRP_ADDRESS_START, ++ PCI_CRP_CMD_AND_ADDR ); ++ wmb(); ++ ++ // printk(KERN_DEBUG "PCI: writel( 0x%lx, 0x%lx )\n", value, PCI_CRP_WRITE_DATA ); ++ writel( value, PCI_CRP_WRITE_DATA ); ++ spin_unlock_irqrestore(&hipox_lock, flags); ++} ++ ++ ++ ++inline unsigned int CheckAndClearBusError(void) ++{ ++ unsigned int value = readl( PCI_ERROR_MSG ) & 0x00000003; ++ if ( value ) ++ { ++// printk(KERN_DEBUG "PCI: %s ERROR ON PCI BUS Clearing error\n", value & 0x00000001 ? "FATAL" : "PARITY" ); ++ writel( ( value ), PCI_ERROR_MSG ); ++ } ++ ++ return value; ++} ++ ++ ++void pciio_write(unsigned int data, u32 addr, unsigned int size) ++{ ++ // setup byte enables ++ unsigned long flags; ++ unsigned int be = 0x0000000f >> (4-size); ++ unsigned int trunc = (addr & 0x00000003); ++ be <<= trunc; ++ be = (~be) & 0x00000000f; ++ ++ ++ data &= (0xffffffff >> ((4-size)*8)); ++ data <<= (trunc*8); ++ ++ //printk(KERN_DEBUG "$YPCI: pciio_write( 0x%08x = 0x%08x (%x:%x) )\n", addr, data, size, be); ++ ++ /* Setup the io read address (rounded down to word boundry) */ ++ spin_lock_irqsave(&hipox_lock, flags); ++ writel( addr , PCI_CONFIG_IO_CYCLE_ADDR ); ++ wmb(); ++ ++ /* issue the config io read command to the config io cmd reg */ ++ writel( ( be << PCI_CONFIG_IO_BYTE_ENABLES_START) | ++ ( PCI_BUS_CMD_IO_WRITE << PCI_CONFIG_IO_CMD_START ), ++ PCI_CONFIG_IO_BYTE_CMD ); ++ wmb(); ++ ++ writel( data, PCI_CONFIG_IO_WRITE_DATA ); ++ ++ if ( CheckAndClearBusError() ) ++ { ++ printk(KERN_DEBUG "PCI: failed to write io\n"); ++ } ++ spin_unlock_irqrestore(&hipox_lock, flags); ++} ++ ++ ++unsigned int pciio_read(u32 addr, unsigned int size) ++{ ++ // setup byte enables ++ unsigned long flags; ++ unsigned int be = 0x0000000f >> (4-size); ++ unsigned int trunc = (addr & 0x00000003); ++ be <<= trunc; ++ be = (~be) & 0x00000000f; ++ ++ ++ //printk(KERN_DEBUG "$YPCI: pciio_read[ 0x%x ] ( 0x%x == ", size, addr ); ++ ++ /* Setup the io read address (rounded down to word boundry) */ ++ spin_lock_irqsave(&hipox_lock, flags); ++ writel( addr, PCI_CONFIG_IO_CYCLE_ADDR ); ++ wmb(); ++ ++ /* issue the config io read command to the config io cmd reg */ ++ writel( ( be << PCI_CONFIG_IO_BYTE_ENABLES_START) | ++ ( PCI_BUS_CMD_IO_READ << PCI_CONFIG_IO_CMD_START ), ++ PCI_CONFIG_IO_BYTE_CMD ); ++ wmb(); ++ ++ if ( CheckAndClearBusError() ) ++ { ++ printk(KERN_DEBUG "PCI: failed to read io\n"); ++ } ++ ++ be = readl( PCI_CONFIG_IO_READ_DATA ); ++ //printk("0x%x )\n", be); ++ ++ if ( CheckAndClearBusError() ) ++ { ++ printk(KERN_DEBUG "PCI: failed to read io\n"); ++ } ++ ++ spin_unlock_irqrestore(&hipox_lock, flags); ++ ++ be >>= (trunc*8); ++ be &= (0xffffffff >> ((4-size)*8)); ++ ++ ++ return be; ++} ++ ++ ++static int hipox_read_config(struct pci_bus *bus, unsigned int devfn, int where, ++ int size, u32 *value) ++{ ++ // unsigned long flags; ++ unsigned long flags; ++ unsigned int temp; ++ unsigned long addr = ( 0x00000800 << (PCI_SLOT(devfn)-1) ) | ++ ( PCI_FUNC(devfn) << 8 ) | ++ ( where & 0xfc ); ++ ++ /* Setup the config io read address (rounded down to word boundry) */ ++ temp = addr; ++ ++ // printk(KERN_DEBUG "PCI: %s::%u hipox_read_config( %u, %d, %d, )\n", bus->name, bus->number, devfn, where, size ); ++ spin_lock_irqsave(&hipox_lock, flags); ++ CheckAndClearBusError(); ++ ++ // printk(KERN_DEBUG "PCI: writel( 0x%08lx, 0x%08lx)\n", temp, PCI_CONFIG_IO_CYCLE_ADDR ); ++ writel( temp, PCI_CONFIG_IO_CYCLE_ADDR ); ++ wmb(); ++ ++ /* issue the config io read command to the config io cmd reg */ ++ temp = ( ( 0x00 << PCI_CONFIG_IO_BYTE_ENABLES_START) | ++ ( PCI_BUS_CMD_CONFIGURATION_READ << PCI_CONFIG_IO_CMD_START ) ); ++ // printk(KERN_DEBUG "PCI: writel( 0x%08lx, 0x%08lx)\n", temp, PCI_CONFIG_IO_BYTE_CMD); ++ writel( temp, PCI_CONFIG_IO_BYTE_CMD ); ++ wmb(); ++ ++ if ( CheckAndClearBusError() ) ++ { ++ spin_unlock_irqrestore(&hipox_lock, flags); ++// printk(KERN_DEBUG "PCI: failed to read config\n" ); ++ *value = 0xffffffff; ++ return PCIBIOS_DEVICE_NOT_FOUND; ++ } ++ ++ wmb(); ++ *value=readl(PCI_CONFIG_IO_READ_DATA); ++ spin_unlock_irqrestore(&hipox_lock, flags); ++ ++ /* Read the result from the config io read data reg */ ++ switch (size) { ++ case 1: ++ // printk(KERN_DEBUG "PCI: readb( 0x%lx )\n", PCI_CONFIG_IO_READ_DATA ); ++ *value>>=(where&3); ++ *value&=0x000000ff; ++ break; ++ case 2: ++ // printk(KERN_DEBUG "PCI: readw( 0x%lx )\n", PCI_CONFIG_IO_READ_DATA ); ++ *value>>=(where&2); ++ *value&=0x0000ffff; ++ break; ++ case 4: ++ // printk(KERN_DEBUG "PCI: readl( 0x%lx )\n", PCI_CONFIG_IO_READ_DATA ); ++ break; ++ } ++ // printk(KERN_DEBUG "PCI: $Ghipox_read_config_%s( 0x%lx ) == 0x%lx\n", ++ // size == 1 ? "byte" : size == 2 ? "short" : "word", ++ // (unsigned long) addr, ++ // (unsigned long) *value); ++ ++ return PCIBIOS_SUCCESSFUL; ++} ++ ++static int hipox_write_config(struct pci_bus *bus, unsigned int devfn, int where, ++ int size, u32 value) ++{ ++ unsigned long flags; ++ unsigned long byteEnables = ~(( 0xffffffff >> (32 - size) ) << (where&3)); ++ unsigned long addr = ( 0x00000800 << (PCI_SLOT(devfn)-1) ) | ++ ( PCI_FUNC(devfn) << 8 ) | ++ ( where & 0xfc ); ++ value <<= 8*(where & 0x00000003); ++ ++ // printk(KERN_DEBUG "$GPCI: %s::%u hipox_write_config_%s( 0x%lx, 0x%lx & 0x%lx)\n", ++ // bus->name, ++ // bus->number, ++ // size == 1 ? "byte" : size == 2 ? "short" : "word", ++ // (unsigned long) addr, ++ // (unsigned long) value, ++ // (unsigned long) byteEnables ); ++ ++ if ( PCI_SLOT(devfn) > 15 ) ++ { ++ /* only 16 devices supported */ ++ return PCIBIOS_DEVICE_NOT_FOUND; ++ } ++ ++ ++ spin_lock_irqsave(&hipox_lock, flags); ++ CheckAndClearBusError(); ++ ++ /* Setup the config io read address (rounded down to word boundry) */ ++ // printk(KERN_DEBUG "PCI: writel( 0x%lx, 0x%lx)\n", addr, PCI_CONFIG_IO_CYCLE_ADDR ); ++ writel( addr, PCI_CONFIG_IO_CYCLE_ADDR ); ++ wmb(); ++ ++ /* issue the config io read command to the config io cmd reg */ ++ // printk(KERN_DEBUG "PCI: writel( 0x%lx, 0x%lx )\n", ++ // ( (byteEnables & 0xf) << PCI_CONFIG_IO_BYTE_ENABLES_START) | ++ // ( PCI_BUS_CMD_CONFIGURATION_WRITE << PCI_CONFIG_IO_CMD_START ), ++ // PCI_CONFIG_IO_BYTE_CMD ); ++ ++ writel( ( (byteEnables & 0xf) << PCI_CONFIG_IO_BYTE_ENABLES_START) | ++ ( PCI_BUS_CMD_CONFIGURATION_WRITE << PCI_CONFIG_IO_CMD_START ), ++ PCI_CONFIG_IO_BYTE_CMD ); ++ wmb(); ++ ++ /* write the value... */ ++ // printk(KERN_DEBUG "PCI: writel( 0x%lx, 0x%lx )\n", value, PCI_CONFIG_IO_WRITE_DATA ); ++ writel( value, PCI_CONFIG_IO_WRITE_DATA ); ++ wmb(); ++ ++ if ( CheckAndClearBusError() ) ++ { ++ printk(KERN_DEBUG "PCI: failed to write config\n"); ++ return PCIBIOS_DEVICE_NOT_FOUND; ++ } ++ ++ spin_unlock_irqrestore(&hipox_lock, flags); ++ return PCIBIOS_SUCCESSFUL; ++} ++ ++ ++// #if PCI_BUS_NONMEM_START & 0x000fffff ++// #error PCI_BUS_NONMEM_START must be megabyte aligned ++// #endif ++// #if PCI_BUS_PREMEM_START & 0x000fffff ++// #error PCI_BUS_PREMEM_START must be megabyte aligned ++// #endif ++// ++ ++static struct resource io_mem = { ++ .name = "PCI I/O Space", ++ .start = 0x00001000, ++ .end = 0xffff0000, ++ .flags = IORESOURCE_IO, ++}; ++ ++static struct resource non_mem = { ++ .name = "PCI non-prefetchable", ++ .start = PCI_BASE_PA + PCI_BUS_NONMEM_START, ++ .end = PCI_BASE_PA + PCI_BUS_NONMEM_START + PCI_BUS_NONMEM_SIZE - 1, ++ .flags = IORESOURCE_MEM, ++}; ++ ++static struct resource pre_mem = { ++ .name = "PCI prefetchable", ++ .start = PCI_BASE_PA + PCI_BUS_PREMEM_START, ++ .end = PCI_BASE_PA + PCI_BUS_PREMEM_START + PCI_BUS_PREMEM_SIZE - 1, ++ .flags = IORESOURCE_MEM | IORESOURCE_PREFETCH, ++}; ++ ++ ++/* ++ * This routine handles multiple bridges. ++ */ ++static u8 __init hipox_swizzle(struct pci_dev *dev, u8 *pinp) ++{ ++// printk(KERN_DEBUG "PCI: hipox_swizzle\n"); ++ return pci_std_swizzle(dev, pinp); ++} ++ ++ ++// static int irq_tab[4] __initdata = { ++// IRQ_AP_PCIINT0, IRQ_AP_PCIINT1, IRQ_AP_PCIINT2, IRQ_AP_PCIINT3 ++// }; ++ ++ ++/* ++ * map the specified device/slot/pin to an IRQ. This works out such ++ * that .. ++ */ ++static int __init hipox_map_irq(struct pci_dev *dev, u8 slot, u8 pin) ++{ ++ BUG_ON(pin < 1 || pin > 4); ++ ++// printk(KERN_DEBUG "PCI: hipox_map_irq %d,%d,%d = %d\n", dev->bus->number, dev->devfn, slot, PCI_A_INTERRUPT /*pci_irq_table[pin-1]*/ ); ++ return PCI_A_INTERRUPT; ++} ++ ++ ++static int __init hipox_pci_setup_resources(struct resource **resource) ++{ ++ /* ++ * bus->resource[0] is the IO resource for this bus ++ * bus->resource[1] is the mem resource for this bus ++ * bus->resource[2] is the prefetch mem resource for this bus ++ */ ++ ++ resource[0] = &io_mem; ++ resource[1] = &pre_mem; ++ resource[2] = &non_mem; ++ ++ // these regions apply to incomming transactions on PCI ++ hipox_pci_write_core_config( 0xffffffff , SYNOPSYS_PCI_MEMORY_BASE_ADDRESS ); ++ hipox_pci_write_core_config( 0xffffffff , SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS ); ++ hipox_pci_write_core_config( 0xffffffff , SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS ); ++ ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_MEMORY_BASE_ADDRESS $YWindow Size == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_MEMORY_BASE_ADDRESS ) ); ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS $YWindow Size == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS ) ); ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS $YWindow Size == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS ) ); ++ ++ hipox_pci_write_core_config( SDRAM_PA , SYNOPSYS_PCI_MEMORY_BASE_ADDRESS ); ++ hipox_pci_write_core_config( SDRAM_PA , SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS ); ++ hipox_pci_write_core_config( SDRAM_PA , SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS ); ++ ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_MEMORY_BASE_ADDRESS == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_MEMORY_BASE_ADDRESS ) ); ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_DUAL_CYCLE_BASE_ADDRESS ) ); ++// printk(KERN_DEBUG "PCI: SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS == 0x%08x\n", (u32) hipox_pci_read_core_config(SYNOPSYS_PCI_IO_MEM_BASE_ADDRESS ) ); ++ return 1; ++} ++ ++ ++int __init hipox_pci_setup(int nr, struct pci_sys_data *sys) ++{ ++ int ret = 0; ++ ++// printk(KERN_DEBUG "PCI: hipox_pci_setup nr == %u\n", nr); ++ if (nr == 0) { ++ /* the PCI core has been setup so that the top nybble is forced to 0, so ++ we need to offset by whatever is in the top nybble or the devices won't ++ recognise their memory accesses */ ++ sys->mem_offset = PCI_BASE_PA & 0xf0000000 ; ++ ++ // ioremap is not called on IO ports. this should shift the physical ++ // address to the statically mapped virtual one after the BARS have been ++ // setup. ++ sys->io_offset = 0; ++ ++ spin_lock_init(&hipox_lock); ++ ret = hipox_pci_setup_resources(sys->resource); ++ } ++ ++ return ret; ++} ++ ++ ++static struct pci_ops hipox_pci_ops = { ++ .read = hipox_read_config, ++ .write = hipox_write_config, ++}; ++ ++ ++struct pci_bus *hipox_pci_scan_bus(int nr, struct pci_sys_data *sys) ++{ ++// printk(KERN_DEBUG "PCI: hipox_pci_scan_bus\n"); ++ return pci_scan_bus(sys->busnr, &hipox_pci_ops, sys); ++} ++ ++void __init hipox_pci_preinit(void) ++{ ++ unsigned int temp; ++ unsigned long flags; ++// printk(KERN_DEBUG "PCI: hipox_pci_preinit\n"); ++ ++ // Configure GPIO lines which map PCI INTA for both minipci and planar as active low ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ *((volatile unsigned long*)GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE) |= ((1UL << PCI_GPIO_INTA_MINIPCI) | (1UL << PCI_GPIO_INTA_PLANAR)); ++ *((volatile unsigned long*)GPIO_A_LEVEL_INTERRUPT_ENABLE) |= ((1UL << PCI_GPIO_INTA_MINIPCI) | (1UL << PCI_GPIO_INTA_PLANAR)); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ /* ++ printk(KERN_DEBUG "\n\nPCI: GPIO ABse 0x%08x\n", GPIO_1_BASE ); ++ for ( temp=0;temp<0x40; temp += 4 ) ++ { ++ printk(KERN_DEBUG " GPIO ABse + 0x%02x == 0x%08x\n",temp, readl( GPIO_1_BASE+temp ) ); ++ } ++ */ ++ ++ // put pci into host mode ++ temp = ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO5 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO4 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO3 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO2 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO1 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO0 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_ENPU ) | ++ ( 0 << SYSCTL_PCI_CTRL1_ENCB ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SYSPCI_STATIC_REQ ) | ++ ( 1 << SYSCTL_PCI_CTRL1_SS_HOST_E ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SYSPCI_PAKING_ENABLE ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SYSPCI_PAKING_MASTE ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SS_CADBUS_E ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SS_MINIPCI_ ) | ++ ( 0 << SYSCTL_PCI_CTRL1_SS_INT_MASK_0 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_INT_STATUS_0 ) | ++ ( 0 << SYSCTL_PCI_CTRL1_APP_EQUIES_NOM_CLK ) | ++ ( 0 << SYSCTL_PCI_CTRL1_APP_CBUS_INT_N ) | ++ ( 0 << SYSCTL_PCI_CTRL1_APP_CSTSCHG_N ); ++ ++// printk(KERN_DEBUG "PCI: pci into host mode - writel( 0x%08x, 0x%08x )\n", (u32) temp, (u32) (SYS_CTRL_PCI_CTRL1) ); ++ writel( temp, SYS_CTRL_PCI_CTRL1 ); ++ ++ /* the interrupt lines map directly to the GPIO lines, so disable any ++ primary, secondary and tertiary functionality */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ ++ // Interrupt line the cardbus/mini-PCI slot ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_MINIPCI); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_MINIPCI); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_MINIPCI); ++ ++ // Interrupt line for VIA-SATA PCI device ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_PLANAR); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_PLANAR); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) &= ~(1UL << PCI_GPIO_INTA_PLANAR); ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_CLKOUT_0 ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_0); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_0); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_0); ++#endif // CONFIG_ARCH_HIPOX_PCI_CLKOUT_0 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_CLKOUT_1 ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_1); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_1); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_1); ++#endif // CONFIG_ARCH_HIPOX_PCI_CLKOUT_1 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_CLKOUT_2 ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_2); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_2); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_2); ++#endif // CONFIG_ARCH_HIPOX_PCI_CLKOUT_2 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_CLKOUT_3 ++ *((volatile unsigned long*)SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_3); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_SECSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_3); ++ *((volatile unsigned long*)SYS_CTRL_GPIO_TERTSEL_CTRL_0) |= (1UL << PCI_GPIO_CLKO_3); ++#endif // CONFIG_ARCH_HIPOX_PCI_CLKOUT_3 ++ ++// printk(KERN_DEBUG "PCI: set gnt and req functions for pci arbiters\n" ); ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_REQGNT_0 ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_REQ_N0); ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_GNT_N0); ++#endif // CONFIG_ARCH_HIPOX_PCI_REQGNT_0 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_REQGNT_1 ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_REQ_N1); ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_GNT_N1); ++#endif // CONFIG_ARCH_HIPOX_PCI_REQGNT_1 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_REQGNT_2 ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_REQ_N2); ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_GNT_N2); ++#endif // CONFIG_ARCH_HIPOX_PCI_REQGNT_2 ++ ++#ifdef CONFIG_ARCH_HIPOX_PCI_REQGNT_3 ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_REQ_N2); ++ *((volatile unsigned long*) SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ) |= (1UL << PCI_GNT_N2); ++#endif // CONFIG_ARCH_HIPOX_PCI_REQGNT_3 ++ ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ // no eeprom to setup core, so perform eeporm functions -------------------- ++ // setup the data to write to enable pci config ++// printk(KERN_DEBUG "PCI: enable core features\n" ); ++ hipox_pci_write_core_config( ++ PCI_COMMAND_IO | ++ PCI_COMMAND_MEMORY | ++ PCI_COMMAND_MASTER | ++ PCI_COMMAND_SPECIAL | ++ PCI_COMMAND_INVALIDATE | ++ PCI_COMMAND_VGA_PALETTE | ++ PCI_COMMAND_PARITY | ++ PCI_COMMAND_WAIT | ++ PCI_COMMAND_SERR | ++ PCI_COMMAND_FAST_BACK /* | ++ PCI_COMMAND_INTX_DISABLE, */, ++ PCI_COMMAND ); ++ ++// printk(KERN_DEBUG "PCI: PCI_COMMAND == 0x%08x\n", (u32) hipox_pci_read_core_config(PCI_COMMAND) ); ++} ++ ++void __init hipox_pci_postinit(void) ++{ ++// printk(KERN_DEBUG "PCI: hipox_pci_postinit\n"); ++} ++ ++static struct hw_pci hipox_pci __initdata = { ++ .swizzle = hipox_swizzle, ++ .map_irq = hipox_map_irq, ++ .setup = hipox_pci_setup, ++ .nr_controllers = 1, ++ .scan = hipox_pci_scan_bus, ++ .preinit = hipox_pci_preinit, ++ .postinit = hipox_pci_postinit, ++}; ++ ++static int __init hipox_pci_init(void) ++{ ++ pci_common_init(&hipox_pci); ++ return 0; ++} ++ ++static void __exit hipox_pci_exit(void) ++{ ++ // if ( resource[0] ) { ++ // int errVal = release_resource(resource[0]; ++ // if ( errVal ) { ++ // printk(KERN_ERR "PCI: unable to release csrRegister space %d", errVal ); ++ // } ++ // } ++ ++ // Put the PCI core into reset, but don't stop the clock as the PCI arbiter ++ // still requires it in order to be able to grant the static bus access to ++ // the PCI I/Os ++ writel(1UL << SYS_CTRL_RSTEN_PCI_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ ++ return; ++} ++ ++subsys_initcall(hipox_pci_init); ++module_exit(hipox_pci_exit); ++ ++#endif +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/power_button.c linux-2.6.24-oxe810/arch/arm/mach-hipox/power_button.c +--- linux-2.6.24/arch/arm/mach-hipox/power_button.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/power_button.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,270 @@ ++/* ++ * linux/arch/arm/mach-hipox/power_button.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/init.h> ++#include <linux/interrupt.h> ++#include <linux/module.h> ++#include <linux/timer.h> ++#include <linux/kobject.h> ++#include <linux/workqueue.h> ++#include <asm/hardware.h> ++#include <asm/io.h> ++ ++MODULE_LICENSE("GPL v2"); ++ ++// Global variable to hold LED inversion state ++extern int hipox_global_invert_leds; ++ ++// Make a module parameter to set whether LED are inverted ++static int invert_leds = 0; ++module_param(invert_leds, bool, S_IRUGO|S_IWUSR); ++ ++#if (CONFIG_HIPOX_POWER_BUTTON_GPIO < 32) ++#define SWITCH_NUM CONFIG_HIPOX_POWER_BUTTON_GPIO ++#define IRQ_NUM GPIO_1_INTERRUPT ++#define INT_STATUS_REG GPIO_A_INTERRUPT_STATUS_REGISTER ++#define SWITCH_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define SWITCH_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define SWITCH_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define SWITCH_CLR_OE_REG GPIO_A_OUTPUT_ENABLE_CLEAR ++#define DEBOUNCE_REG GPIO_A_INPUT_DEBOUNCE_ENABLE ++#define LEVEL_INT_REG GPIO_A_LEVEL_INTERRUPT_ENABLE ++#define FALLING_INT_REG GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ++#define DATA_REG GPIO_A_DATA ++#else ++#define SWITCH_NUM ((CONFIG_HIPOX_POWER_BUTTON_GPIO) - 32) ++#define IRQ_NUM GPIO_2_INTERRUPT ++#define INT_STATUS_REG GPIO_B_INTERRUPT_STATUS_REGISTER ++#define SWITCH_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define SWITCH_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define SWITCH_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define SWITCH_CLR_OE_REG GPIO_B_OUTPUT_ENABLE_CLEAR ++#define DEBOUNCE_REG GPIO_B_INPUT_DEBOUNCE_ENABLE ++#define LEVEL_INT_REG GPIO_B_LEVEL_INTERRUPT_ENABLE ++#define FALLING_INT_REG GPIO_B_FALLING_EDGE_ACTIVE_LOW_ENABLE ++#define DATA_REG GPIO_B_DATA ++#endif ++ ++#define SWITCH_MASK (1UL << (SWITCH_NUM)) ++ ++#define TIMER_INTERVAL_JIFFIES ((HZ) >> 3) /* An eigth of a second */ ++#define TIMER_COUNT_LIMIT 24 /* In eigths of a second */ ++ ++extern spinlock_t hipox_gpio_spinlock; ++ ++static unsigned long count; ++static struct timer_list timer; ++ ++/** Have to use active low level interupt generation, as otherwise might miss ++ * interrupts that arrive concurrently with a PCI interrupt, as PCI interrupts ++ * are generated via GPIO pins and std PCI drivers will not know that there ++ * may be other pending GPIO interrupt sources waiting to be serviced and will ++ * simply return IRQ_HANDLED if they see themselves as having generated the ++ * interrupt, thus preventing later chained handlers from being called ++ */ ++static irqreturn_t int_handler(int irq, void* dev_id) ++{ ++ int status = IRQ_NONE; ++ unsigned int int_status = readl((volatile unsigned long *)INT_STATUS_REG); ++ ++ /* Is the interrupt for us? */ ++ if (int_status & SWITCH_MASK) { ++ /* Disable the power button GPIO line interrupt */ ++ spin_lock(&hipox_gpio_spinlock); ++ writel(readl(FALLING_INT_REG) & ~SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock(&hipox_gpio_spinlock); ++ ++ /* Zeroise button hold down counter */ ++ count = 0; ++ ++ /* Start hold down timer with a timeout of 1/8 second */ ++ mod_timer(&timer, jiffies + TIMER_INTERVAL_JIFFIES); ++ ++ /* Only mark interrupt as serviced if no other unmasked GPIO interrupts ++ are pending */ ++ if (!readl((volatile unsigned long *)INT_STATUS_REG)) { ++ status = IRQ_HANDLED; ++ } ++ } ++ ++ return status; ++} ++ ++/* ++ * Device driver object ++ */ ++typedef struct power_button_driver_s { ++ /** sysfs dir tree root for power button driver */ ++ struct kset kset; ++ struct kobject power_button; ++} power_button_driver_t; ++ ++static power_button_driver_t power_button_driver; ++ ++static void work_handler(struct work_struct * not_used) { ++ kobject_uevent(&power_button_driver.power_button, KOBJ_OFFLINE); ++} ++ ++DECLARE_WORK(power_button_hotplug_work, work_handler); ++ ++static void timer_handler(unsigned long data) ++{ ++ unsigned long flags; ++ ++ /* Is the power button still pressed? */ ++ if (!(readl(DATA_REG) & SWITCH_MASK)) { ++ /* Yes, so increment count of how many timer intervals have passed since ++ power button was pressed */ ++ if (++count == TIMER_COUNT_LIMIT) { ++ schedule_work(&power_button_hotplug_work); ++ } else { ++ /* Restart timer with a timeout of 1/8 second */ ++ mod_timer(&timer, jiffies + TIMER_INTERVAL_JIFFIES); ++ } ++ } else { ++ /* The h/w debounced power button has been released, so reenable the ++ active low interrupt detection to trap the user's next attempt to ++ power down */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(FALLING_INT_REG) | SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ } ++} ++ ++static struct kobj_type ktype_power_button = { ++ .release = 0, ++ .sysfs_ops = 0, ++ .default_attrs = 0, ++}; ++ ++static int power_button_hotplug_filter(struct kset* kset, struct kobject* kobj) { ++ return get_ktype(kobj) == &ktype_power_button; ++} ++ ++static const char* power_button_hotplug_name(struct kset* kset, struct kobject* kobj) { ++ return "hipox_power_button"; ++} ++ ++static struct kset_uevent_ops power_button_uevent_ops = { ++ .filter = power_button_hotplug_filter, ++ .name = power_button_hotplug_name, ++ .uevent = NULL, ++}; ++ ++static int power_button_prep_sysfs(void) ++{ ++ int err = 0; ++ ++ /* prep the sysfs interface for use */ ++ kobject_set_name(&power_button_driver.kset.kobj, "power-button"); ++ power_button_driver.kset.ktype = &ktype_power_button; ++ ++ err = subsystem_register(&power_button_driver.kset); ++ if (err) ++ return err; ++ ++ /* setup hotplugging */ ++ power_button_driver.kset.uevent_ops = &power_button_uevent_ops; ++ ++ /* setup the heirarchy, the name will be set on detection */ ++ kobject_init(&power_button_driver.power_button); ++ power_button_driver.power_button.kset = kset_get(&power_button_driver.kset); ++ power_button_driver.power_button.parent = &power_button_driver.kset.kobj; ++ ++ return 0; ++} ++ ++static int power_button_build_sysfs(void) { ++ kobject_set_name(&power_button_driver.power_button, "power-button-1"); ++ return kobject_add(&power_button_driver.power_button); ++} ++ ++static int __init power_button_init(void) ++{ ++ int err = 0; ++ unsigned long flags; ++ ++ /* Copy the LED inversion module parameter into the global variable */ ++ hipox_global_invert_leds = invert_leds; ++ ++ err = power_button_prep_sysfs(); ++ if (err) ++ return -EINVAL; ++ ++ err = power_button_build_sysfs(); ++ if (err) ++ return -EINVAL; ++ ++ /* Setup the timer that will time how long the user holds down the power ++ button */ ++ init_timer(&timer); ++ timer.data = 0; ++ timer.function = timer_handler; ++ ++ /* Install a shared interrupt handler on the appropriate GPIO bank's ++ interrupt line */ ++ if (request_irq(IRQ_NUM, int_handler, IRQF_SHARED, "Power Button", &power_button_driver)) { ++ printk(KERN_ERR "Power Button: cannot register IRQ %d\n", IRQ_NUM); ++ del_timer_sync(&timer); ++ return -EIO; ++ } ++ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ /* Disable primary, secondary and teriary GPIO functions on switch lines */ ++ writel(readl(SWITCH_PRISEL_REG) & ~SWITCH_MASK, SWITCH_PRISEL_REG); ++ writel(readl(SWITCH_SECSEL_REG) & ~SWITCH_MASK, SWITCH_SECSEL_REG); ++ writel(readl(SWITCH_TERSEL_REG) & ~SWITCH_MASK, SWITCH_TERSEL_REG); ++ ++ /* Enable GPIO input on switch line */ ++ writel(SWITCH_MASK, SWITCH_CLR_OE_REG); ++ ++ /* Set up the power button GPIO line for active low, debounced interrupt */ ++ writel(readl(DEBOUNCE_REG) | SWITCH_MASK, DEBOUNCE_REG); ++ writel(readl(LEVEL_INT_REG) | SWITCH_MASK, LEVEL_INT_REG); ++ writel(readl(FALLING_INT_REG) | SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ printk(KERN_INFO "Power button driver registered\n"); ++ return 0; ++} ++ ++static void __exit power_button_exit(void) ++{ ++ unsigned long flags; ++ ++ kobject_del(&power_button_driver.power_button); ++ subsystem_unregister(&power_button_driver.kset); ++ ++ /* Deactive the timer */ ++ del_timer_sync(&timer); ++ ++ /* Disable interrupt generation by the power button GPIO line */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(FALLING_INT_REG) & ~SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ /* Remove the handler for the shared interrupt line */ ++ free_irq(IRQ_NUM, &power_button_driver); ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(power_button_init); ++module_exit(power_button_exit); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/samba_reserve.c linux-2.6.24-oxe810/arch/arm/mach-hipox/samba_reserve.c +--- linux-2.6.24/arch/arm/mach-hipox/samba_reserve.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/samba_reserve.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,50 @@ ++/* ++ * linux/arch/arm/mach-hipox/samba_receive.c ++ * ++ * Copyright (C) 2008 Oxford Semiconductor Ltd ++ * ++ * 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/errno.h> ++#include <linux/file.h> ++#include <linux/fs.h> ++#include <linux/kernel.h> ++ ++typedef struct xfs_flock64 { ++ __s16 l_type; ++ __s16 l_whence; ++ __s64 l_start; ++ __s64 l_len; /* len == 0 means until end of file */ ++ __s32 l_sysid; ++ __u32 l_pid; ++ __s32 l_pad[4]; /* reserve area */ ++} xfs_flock64_t; ++ ++#define XFS_IOC_RESVSP64 _IOW ('X', 42, struct xfs_flock64) ++ ++asmlinkage long sys_samba_reserve( ++ int fd, ++ void __user *info) ++{ ++ struct file *file = fget(fd); ++ long ret = -EINVAL; ++ ++ /* Do I need any locking around the unlocked_ioctl() call? */ ++ ret = file->f_op->unlocked_ioctl(file, XFS_IOC_RESVSP64, (unsigned long)info); ++ ++ fput(file); ++ ++ return ret; ++} +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/thermAndFan.c linux-2.6.24-oxe810/arch/arm/mach-hipox/thermAndFan.c +--- linux-2.6.24/arch/arm/mach-hipox/thermAndFan.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/thermAndFan.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,738 @@ ++/* ++ * Device driver for the i2c thermostat found on the iBook G4, Albook G4 ++ * ++ * Copyright (C) 2003, 2004 Colin Leroy, Rasmus Rohde, Benjamin Herrenschmidt ++ * ++ * Documentation from ++ * http://www.analog.com/UploadedFiles/Data_Sheets/115254175ADT7467_pra.pdf ++ * http://www.analog.com/UploadedFiles/Data_Sheets/3686221171167ADT7460_b.pdf ++ * ++ */ ++ ++ ++#include <linux/types.h> ++#include <linux/module.h> ++#include <linux/errno.h> ++#include <linux/miscdevice.h> ++#include <linux/smp_lock.h> ++#include <linux/kernel.h> ++#include <linux/delay.h> ++#include <linux/sched.h> ++#include <linux/i2c.h> ++#include <linux/proc_fs.h> ++#include <linux/capability.h> ++#include <linux/slab.h> ++#include <linux/init.h> ++#include <linux/spinlock.h> ++#include <linux/smp_lock.h> ++#include <linux/wait.h> ++#include <linux/suspend.h> ++#include <linux/kthread.h> ++#include <linux/moduleparam.h> ++#include <linux/freezer.h> ++ ++#include <asm/io.h> ++#include <asm/system.h> ++#include <asm/sections.h> ++#include <asm/uaccess.h> ++#include <asm/bitops.h> ++ ++#include "asm/arch-hipox/taco.h" ++#include "thermistorCalibration.h" ++ ++//#define DEBUG 1 ++#undef DEBUG ++ ++/* Set this define to simulate different temperature values and test the ++ * working of the fan control module ++ */ ++//#define SIMULATE_TEMPERATURE 1 ++#undef SIMULATE_TEMPERATURE ++ ++/****************************************************************************** ++ * * ++ * delta t = dutyCycle.Period * ++ * * ++ * PWM in >----+ V' = Vcc - Vt * ++ * | -------- * ++ * _|_ Vcc * ++ * | | | * ++ * \| | Rt = delta t * ++ * | | ------------- * ++ * |\| -C.ln( V' ) * ++ * | | * ++ * | |\ delta t is discovered by the hardware which performs a * ++ * !_! \ varies the PWM duty cycle until one is found that just * ++ * | trips the Vt threshold. * ++ * | * ++ * |-----------> V in (Schmidt trigger @ Vt) * ++ * | * ++ * ___!___ * ++ * _______ C ( eg 100nF ) * ++ * | * ++ * | * ++ * | * ++ * ---+--- * ++ * * ++ * Steinhart Thermistor approximation: * ++ * * ++ * 1/T = A + B.ln(Rt) + C.ln(Rt)^3 * ++ * * ++ ******************************************************************************/ ++ ++#define MAX_FAN_RATIO_CHANGE 20 ++#define OXSEMI_FAN_SPEED_RATIO_MIN 0 ++#define OXSEMI_FAN_SPEED_RATIO_MAX 255 ++#define FAN_SPEED_RATIO_SET (PWM_DATA_2) ++#define MIN_TEMP_COUNT_CHANGE 2 ++ ++/* This is not absolute temperature but counter val - thermistorCalibration*/ ++static int hot_limit = 16; ++ ++#ifdef HIPOX_TACHO_Ox810 ++static int cold_limit = 104; ++#else /* HIPOX_TACHO_Ox810 */ ++static int cold_limit = 200; ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++static int min_fan_speed_ratio = 64; ++ ++#ifdef HIPOX_TACHO_Ox810 ++static int fan_pulse_per_rev = 1; ++static int output_flag = 0; ++static int current_temp = 0; ++static int current_speed = 0; ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++MODULE_AUTHOR( "Chris Ford" ); ++ ++#ifdef HIPOX_TACHO_Ox810 ++MODULE_DESCRIPTION( "Driver for Temperature sense and Fan control of ox810" ); ++#else /* HIPOX_TACHO_Ox810 */ ++MODULE_DESCRIPTION( "Driver for Fan and temp sense of ox800" ); ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++MODULE_LICENSE( "GPL" ); ++ ++module_param(hot_limit, int, 0644); ++MODULE_PARM_DESC(hot_limit, "Thermistor input for maximum fan drive"); ++ ++module_param(cold_limit, int, 0644); ++MODULE_PARM_DESC(cold_limit,"Thermistor input for minimum fan drive"); ++ ++module_param(min_fan_speed_ratio, int, 0644); ++MODULE_PARM_DESC(min_fan_speed_ratio,"Specify starting( minimum) fan drive (0-255) (default 64)"); ++ ++#ifdef HIPOX_TACHO_Ox810 ++module_param(fan_pulse_per_rev, int, 0644); ++MODULE_PARM_DESC(fan_pulse_per_rev,"Specify the number of pulses per revolution of fan - 1(default) or 2"); ++ ++module_param(output_flag, bool, 0644); ++MODULE_PARM_DESC(output_flag,"Flag to specify whether temperature and speed output to user is required"); ++ ++module_param(current_temp, int, S_IRUGO); ++MODULE_PARM_DESC(current_temp,"Read only for the current temperature in counts"); ++ ++module_param(current_speed, int, S_IRUGO); ++MODULE_PARM_DESC(current_speed,"Read only for the current speed in rpm"); ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ ++struct thermostat { ++ int temps; ++ int cached_temp; ++ int curr_speed; ++ int last_speed; ++ int set_speed; ++ int last_var; ++ struct semaphore sem; ++// struct cdev cdev; ++}; ++ ++static struct thermostat* thermostat = NULL; ++static struct task_struct* thread_therm = NULL; ++ ++ ++static int write_reg( int reg, u32 data ) ++{ ++ writel( data, reg ); ++ return 0; ++} ++ ++static int read_reg( int reg ) ++{ ++ int data = 0; ++ data = readl( reg ); ++ return data; ++} ++ ++/** GetTemperatureCounter is an internal function to the module that reads the ++ * temperature as a counter value and returns it to the caller. The counter ++ * value is used in all the internal calculations avoiding the necessity to ++ * convert to Kelvin for interpretation. For corresponding temperature values ++ * in Kelvin look at thermistoCalilbration.h ++ */ ++int GetTemperatureCounter(void) ++{ ++ u32 res; ++ ++/* printk(KERN_INFO "T&F?::GetTemperatureCounter ----\n"); ++ */ ++ /* Test to ensure we are ready. ++ */ ++ if ( !thermostat ) { ++ printk(KERN_INFO "T&F?::$RERROR - Temperature conv not started\n"); ++ return -1; ++ } ++ ++ while ( !( read_reg( TACHO_THERMISTOR_CONTROL ) & ++ (1 << TACHO_THERMISTOR_CONTROL_THERM_VALID) ) ) { ++ printk(KERN_INFO "T&F?::$rWarning - Temperature reading not stabalised\n"); ++ msleep(100); ++ } ++ ++ res = read_reg( TACHO_THERMISTOR_RC_COUNTER ) & TACHO_THERMISTOR_RC_COUNTER_MASK; ++ ++#ifdef DEBUG ++ printk(KERN_INFO "Therm&Fan - Temperature Counter - %d \n",res); ++#endif ++ ++ return res; ++} ++ ++/** This function converts the unit of the temperature from counts to ++ * temperature in Kelvin ++ */ ++int ConverttoKelvin(int tempCount) ++{ ++ u32 res, arrayIndex; ++ ++ /* Convert the Counter Value to Temperature in Kelvin */ ++ arrayIndex = tempCount/THERM_INTERPOLATION_STEP; ++ res = TvsCnt[arrayIndex]; ++ if ((THERM_ENTRIES_IN_CALIB_TABLE - 2) > arrayIndex) ++ res -= (tempCount % THERM_INTERPOLATION_STEP) * (TvsCnt[arrayIndex] - TvsCnt[arrayIndex + 1]) / THERM_INTERPOLATION_STEP; ++ else ++ res -= (tempCount % THERM_INTERPOLATION_STEP) * (TvsCnt[THERM_ENTRIES_IN_CALIB_TABLE - 2] - TvsCnt[THERM_ENTRIES_IN_CALIB_TABLE - 1]) / THERM_INTERPOLATION_STEP; ++ ++#ifdef DEBUG ++ printk(KERN_INFO "Get Temperature- Temperature in Kelvin = %d\n", res); ++#endif ++ return res; ++} ++ ++/** ++ * GetTemperature reads the temperature from the thermistor and converts it ++ * to the corresponding Kelvin equivalent ++ */ ++int GetTemperature(void) ++{ ++ u32 tempCount; ++ tempCount = GetTemperatureCounter(); ++ return ConverttoKelvin(tempCount); ++} ++ ++/** ++ * GetFanRPM will read the fan tacho register and convert the value to ++ * RPM. ++ * @return an int that represents the fan speed in RPM, or a ++ * negative value in the case of error. ++ */ ++int GetFanRPM(void) ++{ ++ u32 res; ++ u32 iCounterValue; ++ ++#ifdef HIPOX_TACHO_Ox810 ++ ++ if(thermostat->last_speed == OXSEMI_FAN_SPEED_RATIO_MIN) ++ { ++#ifdef DEBUG ++ printk(KERN_INFO "ThernAndFan::GetFanRPM - Fan Speed %d \n", OXSEMI_FAN_SPEED_RATIO_MIN); ++#endif ++ return OXSEMI_FAN_SPEED_RATIO_MIN; ++ } ++ ++ write_reg( TACHO_FAN_ONE_SHOT_CONTROL, (1 << TACHO_FAN_ONE_SHOT_CONTROL_START)); ++ ++ while ( !(read_reg( TACHO_FAN_SPEED_COUNTER ) & ++ (1 << TACHO_FAN_SPEED_COUNTER_COUNT_VALID) ) ) { ++/* printk(KERN_INFO "ThernAndFan::$rWarning - Fan Counter reading not stabalised\n"); ++ */ msleep(100); ++ } ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ iCounterValue = read_reg( TACHO_FAN_SPEED_COUNTER ) ++ & TACHO_FAN_SPEED_COUNTER_MASK; ++ ++#ifndef HIPOX_TACHO_Ox810 /* Code thats only for non ox810 versions */ ++ if(iCounterValue == TACHO_FAN_SPEED_COUNTER_MASK) ++ { ++ /* speed less than measurable */ ++#ifdef DEBUG ++ printk(KERN_INFO "ThernAndFan::GetFanRPM - RPM < 117 - returning 0\n"); ++#endif ++ return 0; ++ } ++#endif ++ ++ ++iCounterValue; ++ ++#ifdef HIPOX_TACHO_Ox810 ++ /* Fan Speed (rpm) = 60 * 2000 / (counter value +1) * pulses per rev */ ++ res = (60 * 2000 ) / (iCounterValue * fan_pulse_per_rev); ++#else /* HIPOX_TACHO_Ox810 */ ++ /* Fan Speed (rpm) = 60 * 2000 / (counter value +1) */ ++ res = 60 * 2000 / iCounterValue; ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++#ifdef SIMULATE_TEMPERATURE ++ printk(KERN_INFO "thermAndFan::GetFanRPM == %d\n", res); ++#endif /*SIMULATE_TEMPERATURE */ ++ ++ return res; ++} ++ ++#ifdef HIPOX_TACHO_Ox810 ++ ++static void read_sensors(struct thermostat *th) ++{ ++ static int state; ++#ifdef SIMULATE_TEMPERATURE ++ static int curTemp = 30; ++#endif /* SIMULATE_TEMPERATURE */ ++ ++ if ( !th ) { ++ printk(KERN_INFO "thermAndFan::read_sensors $RTH NOT ESTABLISHED YET\n"); ++ return; ++ } ++ switch(state){ ++ case 0: ++ th->temps = GetTemperatureCounter(); ++ ++ /* Set to speed measurement */ ++ write_reg( TACHO_FAN_SPEED_CONTROL, ++ (1 << (TACHO_FAN_SPEED_CONTROL_PWM_ENABLE_BASE ++ + TACHO_FAN_SPEED_CONTROL_PWM_USED)) ++ | (1 << TACHO_FAN_SPEED_CONTROL_FAN_COUNT_MODE)); ++ state = 1; ++ ++ if(output_flag) /* Set the temperature to user space here */ ++ { ++ current_temp = th->temps; ++ } ++ ++ #ifdef SIMULATE_TEMPERATURE ++ th->temps = curTemp; ++ curTemp += 5; ++ if(curTemp > cold_limit + 20) ++ curTemp = hot_limit - 20; ++ printk(KERN_INFO "thermAndFan::read_sensors Temp Set to - %d\n", curTemp); ++ #endif /* SIMULATE_TEMPERATURE */ ++ break; ++ ++ case 1: ++ default: ++ ++ th->curr_speed = GetFanRPM(); ++ ++ /* Set to Temperature measurement */ ++ write_reg( TACHO_THERMISTOR_CONTROL, ((1 << TACHO_THERMISTOR_CONTROL_THERM_ENABLE) ++ | (0 << TACHO_THERMISTOR_CONTROL_THERM_VALID)) ); ++ state = 0; ++ ++ if(output_flag) /* Set the speed to user space here */ ++ { ++ current_speed = th->curr_speed; ++ } ++ break; ++ } ++} ++ ++#else /* HIPOX_TACHO_Ox810 */ ++ ++static void read_sensors(struct thermostat *th) ++{ ++ static int state; ++ ++ if ( !th ) { ++ printk(KERN_INFO "thermAndFan::read_sensors $RTH NOT ESTABLISHED YET\n"); ++ return; ++ } ++ ++ switch (state) { ++ case 0: /* Get the temperature */ ++ th->temps = GetTemperatureCounter(); ++ write_reg( TACHO_CLOCK_DIVIDER, TACHO_CORE_TACHO_DIVIDER_VALUE ); ++ state = 1; ++ break; ++ ++ case 1: ++ /* Get the fan speed */ ++ th->curr_speed = GetFanRPM(); ++ /* free fall to default case needed */ ++/* break; ++ */ ++ default: ++ /* Stop the thermister measuring */ ++ write_reg( TACHO_THERMISTOR_CONTROL, 0 ); ++ write_reg( TACHO_CLOCK_DIVIDER, TACHO_CORE_THERM_DIVIDER_VALUE ); ++ /* Start the thermister measuring */ ++ write_reg( TACHO_THERMISTOR_CONTROL, (1 << TACHO_THERMISTOR_CONTROL_THERM_ENABLE) ); ++ state = 0; ++ break; ++ } ++} ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ ++#ifdef DEBUG ++/** ++ * DumpTachoRegisters is a debug function used to inspect hte tacho registers. ++ */ ++void DumpTachoRegisters(void) ++{ ++ ++ printk(KERN_INFO \ ++ "\n<Taco Registers> ---------------------------------\n" ++ " TACHO_FAN_SPEED_COUNTER == 0x%08x\n" ++ " TACHO_THERMISTOR_RC_COUNTER == 0x%08x\n" ++ " TACHO_THERMISTOR_CONTROL == 0x%08x\n" ++ " TACHO_CLOCK_DIVIDER == 0x%08x\n" ++ " PWM_CORE_CLK_DIVIDER_VALUE == 0x%08x\n" ++ " FAN_SPEED_RATIO_SET == 0x%08x\n" ++ "<\\Taco Registers> --------------------------------\n\n", ++ (u32) (read_reg( TACHO_FAN_SPEED_COUNTER) & TACHO_FAN_SPEED_COUNTER_MASK), ++ (u32) (read_reg( TACHO_THERMISTOR_RC_COUNTER) & TACHO_THERMISTOR_RC_COUNTER_MASK), ++ (u32) read_reg( TACHO_THERMISTOR_CONTROL ), ++ (u32) (read_reg( TACHO_CLOCK_DIVIDER) & TACHO_CLOCK_DIVIDER_MASK), ++ (u32) read_reg( PWM_CLOCK_DIVIDER ), ++ (u32) read_reg( FAN_SPEED_RATIO_SET ) ); ++} ++#else ++void DumpTachoRegisters(void) {} ++#endif ++ ++static void write_fan_speed(struct thermostat *th, int speed) ++{ ++/* printk(KERN_INFO "thermAndFan::write_fan_speed %u\n", speed); ++*/ ++ /* The fan speed can vary between the max and the min speed ratio or ++ * it can be min ratio value of 0 ++ */ ++ if (speed > OXSEMI_FAN_SPEED_RATIO_MAX) ++ speed = OXSEMI_FAN_SPEED_RATIO_MAX; ++ else if ((speed < min_fan_speed_ratio) && (speed > OXSEMI_FAN_SPEED_RATIO_MIN)) ++ speed = min_fan_speed_ratio; ++ else if (speed < OXSEMI_FAN_SPEED_RATIO_MIN) ++ speed = OXSEMI_FAN_SPEED_RATIO_MIN; ++ ++ if (th->last_speed == speed) ++ return; ++ ++ write_reg( FAN_SPEED_RATIO_SET, speed ); ++ ++#ifdef SIMULATE_TEMPERATURE ++ printk(KERN_INFO "Speed Ratio Written - %d\n", speed); ++#endif /* SIMULATE_TEMPERATURE */ ++ ++ th->last_speed = speed; ++} ++ ++#ifdef DEBUG ++static void display_stats(struct thermostat *th) ++{ ++ if ( 1 || th->temps != th->cached_temp) { ++ printk(KERN_INFO ++ "thermAndFan:: Temperature infos:\n" ++ " * thermostats: %d;\n" ++ " * pwm: %d;\n" ++ " * fan speed: %d RPM\n\n", ++ th->temps, ++ min_fan_speed_ratio, ++ GetFanRPM()); ++ th->cached_temp = th->temps; ++ } ++} ++#endif ++ ++/* ++ * Use fuzzy logic type approach to creating the new fan speed. ++ * if count < cold_limit fan should be off. ++ * if count > hot_limit fan should be full on. ++ * if count between limits set proportionally to base speed + proportional element. ++ */ ++static void update_fan_speed(struct thermostat *th) ++{ ++ int var = th->temps; ++ ++/* remember that var = 1/T ie smaller var higher temperature and faster fan speed needed */ ++ if (abs(var - th->last_var) >= MIN_TEMP_COUNT_CHANGE) { ++ int new_speed; ++ ++ if(var < cold_limit){ ++ ++ if (var < hot_limit) ++ { ++ th->last_var = var; ++ /* too hot for proportional control */ ++ new_speed = OXSEMI_FAN_SPEED_RATIO_MAX; ++ } ++ else ++ { ++ /* fan speed it the user selected starting value for the fan ++ * so scale operatation from nominal at cold limit to max at hot limit. ++ */ ++ new_speed = OXSEMI_FAN_SPEED_RATIO_MAX - ++ (OXSEMI_FAN_SPEED_RATIO_MAX - min_fan_speed_ratio) * (var - hot_limit)/(cold_limit - hot_limit); ++ ++ if (th->set_speed == 0 ) th->set_speed = min_fan_speed_ratio; ++ ++ if ((new_speed - th->set_speed) > MAX_FAN_RATIO_CHANGE) ++ new_speed = th->set_speed + MAX_FAN_RATIO_CHANGE; ++ else if ((new_speed - th->set_speed) < -MAX_FAN_RATIO_CHANGE) ++ new_speed = th->set_speed - MAX_FAN_RATIO_CHANGE; ++ else ++ th->last_var = var; ++ } ++ } ++ else { ++ ++ th->last_var = var; ++ /* var greater than low limit - too cold for fan. */ ++ new_speed = OXSEMI_FAN_SPEED_RATIO_MIN; ++ } ++ ++ write_fan_speed(th, new_speed); ++ th->set_speed = new_speed; ++ } ++} ++ ++static int monitor_task(void *arg) ++{ ++ struct thermostat* th = arg; ++ ++ while(!kthread_should_stop()) { ++ if (unlikely(freezing(current))) ++ refrigerator(); ++ ++ msleep_interruptible(2000); ++ ++#ifdef DEBUG ++ DumpTachoRegisters(); ++#endif ++ ++ read_sensors(th); ++ ++ update_fan_speed(th); ++ ++#ifdef DEBUG ++ /* be carefule with the stats displayed. The Fan Counter value depends ++ * on what value is written in the register during the read sensors ++ * call. If its in temperature read setting, the fan counter and hence ++ * the rpm will be WRONG ++ */ ++ display_stats(th); ++#endif ++ } ++ ++ return 0; ++} ++ ++static int ++oxsemi_therm_read(char *buf, char **start, off_t offset, ++ int len, int *eof, void *unused) ++{ ++ len = sprintf(buf, ++ "Thermostat And Fan state ---------\n" ++ " temps_counter == %d\n" ++ " speed_ratio_set == %d\n" ++ " measured-fan_speed == %d\n" ++ " last_temp_counter == %d\n\n", ++ thermostat->temps, ++ thermostat->last_speed, ++ thermostat->curr_speed, ++ thermostat->last_var ); ++ //*start = buf; ++ return len; ++} ++ ++static struct proc_dir_entry *proc_oxsemi_therm; ++ ++ ++static struct file_operations oxsemi_therm_fops = { ++ .owner = THIS_MODULE, ++ .open = nonseekable_open, ++}; ++ ++static struct miscdevice oxsemi_therm_miscdev = { ++ TEMP_MINOR, ++ "temp", ++ &oxsemi_therm_fops ++}; ++ ++static int __init oxsemi_therm_init(void) ++{ ++ struct thermostat* th; ++ int rc, ret; ++ ++ if (thermostat) ++ return 0; ++ ++ read_reg(SYS_CTRL_RSTEN_CTRL); ++ ++/* release fan/tacho from system reset */ ++ *((volatile unsigned long *) SYS_CTRL_RSTEN_CLR_CTRL) = (1UL << SYS_CTRL_RSTEN_MISC_BIT); ++ ++/* Pull Down the GPIO 29 from the software */ ++#ifdef HIPOX_TACHO_Ox810 ++ *((volatile unsigned long *) SYSCTRL_GPIO_PULLUP_CTRL_0) |= TEMP_TACHO_PULLUP_CTRL_VALUE; ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++/* printk(KERN_INFO "thermAndFan: mux out therm and fan pins onto GPIO)\n" ); ++ */ ++ *((volatile unsigned long *) SYS_CTRL_GPIO_PRIMSEL_CTRL_0) &= ~(1UL << SECONDARY_FUNCTION_ENABLE_FAN_PWM2); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PRIMARY_FUNCTION_ENABLE_FAN_TACHO); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_PRIMSEL_CTRL_0) |= (1UL << PRIMARY_FUNCTION_ENABLE_FAN_TEMP); ++ ++/* disable secondary use */ ++ *((volatile unsigned long *) SYS_CTRL_GPIO_SECSEL_CTRL_0) |= (1UL << SECONDARY_FUNCTION_ENABLE_FAN_PWM2); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_SECSEL_CTRL_0) &= ~(1UL << PRIMARY_FUNCTION_ENABLE_FAN_TACHO); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_SECSEL_CTRL_0) &= ~(1UL << PRIMARY_FUNCTION_ENABLE_FAN_TEMP); ++ ++/* disable tertiary use */ ++ *((volatile unsigned long *) SYS_CTRL_GPIO_TERTSEL_CTRL_0) &= ~(1UL << SECONDARY_FUNCTION_ENABLE_FAN_PWM2); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_TERTSEL_CTRL_0) &= ~(1UL << PRIMARY_FUNCTION_ENABLE_FAN_TACHO); ++ *((volatile unsigned long *) SYS_CTRL_GPIO_TERTSEL_CTRL_0) &= ~(1UL << PRIMARY_FUNCTION_ENABLE_FAN_TEMP); ++ ++ read_reg(SYS_CTRL_RSTEN_CTRL); ++ read_reg(SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ read_reg(SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ read_reg(SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ th = (struct thermostat *) ++ kmalloc(sizeof(struct thermostat), GFP_KERNEL); ++ ++ if (!th) ++ return -ENOMEM; ++ ++ memset(th, 0, sizeof(struct thermostat)); ++ init_MUTEX( &th->sem ); ++ ++ rc = read_reg(TACHO_CLOCK_DIVIDER); ++ if (rc < 0) { ++ printk(KERN_ERR "thermAndFan: Thermostat failed to read config "); ++ kfree(th); ++ return -ENODEV; ++ } ++ ++ /* Set the Tacho clock divider up */ ++/* printk(KERN_INFO "thermAndFan: Setting tacho core frequency divider to %d\n", TACHO_CORE_THERM_DIVIDER_VALUE ); ++ */ ++#ifdef HIPOX_TACHO_Ox810 ++ write_reg( TACHO_CLOCK_DIVIDER, TACHO_CORE_TACHO_DIVIDER_VALUE ); ++ ++ /* check tacho divider set correctly */ ++ rc = read_reg(TACHO_CLOCK_DIVIDER); ++ /* Comparing a 10 bit value to a 32 bit return value */ ++ if ((rc & TACHO_CORE_TACHO_DIVIDER_VALUE) != TACHO_CORE_TACHO_DIVIDER_VALUE) { ++ printk(KERN_ERR "thermAndFan: Set Tacho Divider Value Failed readback:%d\n", rc); ++ kfree(th); ++ return -ENODEV; ++ } ++ ++#else /* HIPOX_TACHO_Ox810 */ ++ write_reg( TACHO_CLOCK_DIVIDER, TACHO_CORE_THERM_DIVIDER_VALUE ); ++ ++/* check tacho divider set correctly */ ++ rc = read_reg(TACHO_CLOCK_DIVIDER); ++ /* Comparing a 10 bit value to a 32 bit return value */ ++ if ((rc & TACHO_CORE_THERM_DIVIDER_VALUE) != TACHO_CORE_THERM_DIVIDER_VALUE) { ++ printk(KERN_ERR "thermAndFan: Thermostat failed to set config tacho divider readback:%d\n", rc); ++ kfree(th); ++ return -ENODEV; ++ } ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++/* printk(KERN_INFO "thermAndFan: Setting PWM core frequency divider to %d\n", PWM_CORE_CLK_DIVIDER_VALUE ); ++ */ ++ write_reg( PWM_CLOCK_DIVIDER, PWM_CORE_CLK_DIVIDER_VALUE ); ++ ++#ifdef HIPOX_TACHO_Ox810 ++ printk(KERN_INFO "thermAndFan: initializing - ox810\n"); ++#else /* HIPOX_TACHO_Ox810 */ ++ printk(KERN_INFO "thermAndFan: initializing\n"); ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++#ifdef DEBUG ++ DumpTachoRegisters(); ++#endif ++ ++ thermostat = th; ++ ++ /* Start the thermister measuring */ ++ write_reg( TACHO_THERMISTOR_CONTROL, (1 << TACHO_THERMISTOR_CONTROL_THERM_ENABLE) ); ++ ++ /* Start Speed measuring */ ++#ifdef HIPOX_TACHO_Ox810 ++ write_reg( TACHO_FAN_SPEED_CONTROL, ++ (1 << (TACHO_FAN_SPEED_CONTROL_PWM_ENABLE_BASE ++ + TACHO_FAN_SPEED_CONTROL_PWM_USED)) ++ | (1 << TACHO_FAN_SPEED_CONTROL_FAN_COUNT_MODE)); ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ /* be sure to really write fan speed the first time */ ++ th->last_speed = -2; ++ th->last_var = -80; ++ ++ /* Set fan to initial speed */ ++ write_fan_speed(th, min_fan_speed_ratio); ++ ++ thread_therm = kthread_run(monitor_task, th, "kfand"); ++ ++ if (thread_therm == ERR_PTR(-ENOMEM)) { ++ printk(KERN_INFO "thermAndFan: Kthread creation failed\n"); ++ thread_therm = NULL; ++ return -ENOMEM; ++ } ++ ++ ret = misc_register(&oxsemi_therm_miscdev); ++ if (ret < 0) ++ return ret; ++ ++ proc_oxsemi_therm = create_proc_entry("therm-fan", 0, NULL); ++ if (proc_oxsemi_therm) { ++ proc_oxsemi_therm->read_proc = oxsemi_therm_read; ++ } else { ++ printk(KERN_ERR "therm-fan: unable to register /proc/therm\n"); ++ } ++ ++ return 0; ++} ++ ++ ++static void __exit oxsemi_therm_exit(void) ++{ ++ if ( thread_therm ) ++ { ++ kthread_stop(thread_therm); ++ } ++ ++ remove_proc_entry("therm-fan", NULL); ++ misc_deregister(&oxsemi_therm_miscdev); ++ ++ kfree(thermostat); ++ thermostat = NULL; ++/* return fan/tacho to system reset */ ++ *((volatile unsigned long *) SYS_CTRL_RSTEN_SET_CTRL) |= (1UL << SYS_CTRL_RSTEN_MISC_BIT); ++} ++ ++ ++module_init(oxsemi_therm_init); ++module_exit(oxsemi_therm_exit); ++ ++ ++/* End of File */ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/thermistorCalibration.h linux-2.6.24-oxe810/arch/arm/mach-hipox/thermistorCalibration.h +--- linux-2.6.24/arch/arm/mach-hipox/thermistorCalibration.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/thermistorCalibration.h 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,149 @@ ++#ifndef __THERMISTOR_LOOKUP_TABLE_10K3A_H ++#define __THERMISTOR_LOOKUP_TABLE_10K3A_H ++ ++/* Thermistor is a 10K3A*/ ++/* THERM_COEF_A == 0.001129241*/ ++/* THERM_COEF_B == 0.0002341077. */ ++/* THERM_COEF_C == 0.00000008775468. */ ++ ++/* Capacitor is 100 nF */ ++/* Stepped frequency increment is 128000 Hz */ ++/* Schmitdt trigger threshold assumed: 1 / 3.3 V */ ++ ++ ++/* Inverse C.ln(V') == 216 */ ++#define THERM_INTERPOLATION_STEP 8 ++#define THERM_ENTRIES_IN_CALIB_TABLE 128 ++ ++static const unsigned long TvsCnt[THERM_ENTRIES_IN_CALIB_TABLE] = { ++ 416, /* == 143.37 deg C: Count == 0, R == 216 Ohms */ ++ 340, /* == 67.07 deg C: Count == 8, R == 1948 Ohms */ ++ 323, /* == 49.59 deg C: Count == 16, R == 3679 Ohms */ ++ 313, /* == 39.76 deg C: Count == 24, R == 5410 Ohms */ ++ 306, /* == 33 deg C: Count == 32, R == 7141 Ohms */ ++ 301, /* == 27.9 deg C: Count == 40, R == 8873 Ohms */ ++ 297, /* == 23.82 deg C: Count == 48, R == 10604 Ohms */ ++ 293, /* == 20.43 deg C: Count == 56, R == 12335 Ohms */ ++ 291, /* == 17.55 deg C: Count == 64, R == 14066 Ohms */ ++ 288, /* == 15.04 deg C: Count == 72, R == 15798 Ohms */ ++ 286, /* == 12.82 deg C: Count == 80, R == 17529 Ohms */ ++ 284, /* == 10.84 deg C: Count == 88, R == 19260 Ohms */ ++ 282, /* == 9.04 deg C: Count == 96, R == 20991 Ohms */ ++ 280, /* == 7.41 deg C: Count == 104, R == 22722 Ohms */ ++ 279, /* == 5.91 deg C: Count == 112, R == 24454 Ohms */ ++ 278, /* == 4.53 deg C: Count == 120, R == 26185 Ohms */ ++ 276, /* == 3.25 deg C: Count == 128, R == 27916 Ohms */ ++ 275, /* == 2.05 deg C: Count == 136, R == 29647 Ohms */ ++ 274, /* == 0.93 deg C: Count == 144, R == 31379 Ohms */ ++ 273, /* == -0.12 deg C: Count == 152, R == 33110 Ohms */ ++ 272, /* == -1.12 deg C: Count == 160, R == 34841 Ohms */ ++ 271, /* == -2.06 deg C: Count == 168, R == 36572 Ohms */ ++ 270, /* == -2.95 deg C: Count == 176, R == 38304 Ohms */ ++ 269, /* == -3.8 deg C: Count == 184, R == 40035 Ohms */ ++ 268, /* == -4.6 deg C: Count == 192, R == 41766 Ohms */ ++ 268, /* == -5.37 deg C: Count == 200, R == 43497 Ohms */ ++ 267, /* == -6.11 deg C: Count == 208, R == 45229 Ohms */ ++ 266, /* == -6.81 deg C: Count == 216, R == 46960 Ohms */ ++ 266, /* == -7.49 deg C: Count == 224, R == 48691 Ohms */ ++ 265, /* == -8.14 deg C: Count == 232, R == 50422 Ohms */ ++ 264, /* == -8.77 deg C: Count == 240, R == 52154 Ohms */ ++ 264, /* == -9.37 deg C: Count == 248, R == 53885 Ohms */ ++ 263, /* == -9.95 deg C: Count == 256, R == 55616 Ohms */ ++ 262, /* == -10.52 deg C: Count == 264, R == 57347 Ohms */ ++ 262, /* == -11.06 deg C: Count == 272, R == 59078 Ohms */ ++ 261, /* == -11.59 deg C: Count == 280, R == 60810 Ohms */ ++ 261, /* == -12.1 deg C: Count == 288, R == 62541 Ohms */ ++ 260, /* == -12.59 deg C: Count == 296, R == 64272 Ohms */ ++ 260, /* == -13.07 deg C: Count == 304, R == 66003 Ohms */ ++ 259, /* == -13.53 deg C: Count == 312, R == 67735 Ohms */ ++ 259, /* == -13.99 deg C: Count == 320, R == 69466 Ohms */ ++ 259, /* == -14.43 deg C: Count == 328, R == 71197 Ohms */ ++ 258, /* == -14.86 deg C: Count == 336, R == 72928 Ohms */ ++ 258, /* == -15.27 deg C: Count == 344, R == 74660 Ohms */ ++ 257, /* == -15.68 deg C: Count == 352, R == 76391 Ohms */ ++ 257, /* == -16.08 deg C: Count == 360, R == 78122 Ohms */ ++ 257, /* == -16.46 deg C: Count == 368, R == 79853 Ohms */ ++ 256, /* == -16.84 deg C: Count == 376, R == 81585 Ohms */ ++ 256, /* == -17.21 deg C: Count == 384, R == 83316 Ohms */ ++ 255, /* == -17.57 deg C: Count == 392, R == 85047 Ohms */ ++ 255, /* == -17.92 deg C: Count == 400, R == 86778 Ohms */ ++ 255, /* == -18.26 deg C: Count == 408, R == 88510 Ohms */ ++ 254, /* == -18.6 deg C: Count == 416, R == 90241 Ohms */ ++ 254, /* == -18.93 deg C: Count == 424, R == 91972 Ohms */ ++ 254, /* == -19.25 deg C: Count == 432, R == 93703 Ohms */ ++ 253, /* == -19.57 deg C: Count == 440, R == 95434 Ohms */ ++ 253, /* == -19.88 deg C: Count == 448, R == 97166 Ohms */ ++ 253, /* == -20.18 deg C: Count == 456, R == 98897 Ohms */ ++ 253, /* == -20.48 deg C: Count == 464, R == 100628 Ohms */ ++ 252, /* == -20.77 deg C: Count == 472, R == 102359 Ohms */ ++ 252, /* == -21.06 deg C: Count == 480, R == 104091 Ohms */ ++ 252, /* == -21.34 deg C: Count == 488, R == 105822 Ohms */ ++ 251, /* == -21.62 deg C: Count == 496, R == 107553 Ohms */ ++ 251, /* == -21.89 deg C: Count == 504, R == 109284 Ohms */ ++ 251, /* == -22.16 deg C: Count == 512, R == 111016 Ohms */ ++ 251, /* == -22.42 deg C: Count == 520, R == 112747 Ohms */ ++ 250, /* == -22.68 deg C: Count == 528, R == 114478 Ohms */ ++ 250, /* == -22.93 deg C: Count == 536, R == 116209 Ohms */ ++ 250, /* == -23.18 deg C: Count == 544, R == 117941 Ohms */ ++ 250, /* == -23.43 deg C: Count == 552, R == 119672 Ohms */ ++ 249, /* == -23.67 deg C: Count == 560, R == 121403 Ohms */ ++ 249, /* == -23.91 deg C: Count == 568, R == 123134 Ohms */ ++ 249, /* == -24.14 deg C: Count == 576, R == 124866 Ohms */ ++ 249, /* == -24.37 deg C: Count == 584, R == 126597 Ohms */ ++ 248, /* == -24.6 deg C: Count == 592, R == 128328 Ohms */ ++ 248, /* == -24.82 deg C: Count == 600, R == 130059 Ohms */ ++ 248, /* == -25.04 deg C: Count == 608, R == 131790 Ohms */ ++ 248, /* == -25.26 deg C: Count == 616, R == 133522 Ohms */ ++ 248, /* == -25.47 deg C: Count == 624, R == 135253 Ohms */ ++ 247, /* == -25.68 deg C: Count == 632, R == 136984 Ohms */ ++ 247, /* == -25.89 deg C: Count == 640, R == 138715 Ohms */ ++ 247, /* == -26.1 deg C: Count == 648, R == 140447 Ohms */ ++ 247, /* == -26.3 deg C: Count == 656, R == 142178 Ohms */ ++ 247, /* == -26.5 deg C: Count == 664, R == 143909 Ohms */ ++ 246, /* == -26.69 deg C: Count == 672, R == 145640 Ohms */ ++ 246, /* == -26.89 deg C: Count == 680, R == 147372 Ohms */ ++ 246, /* == -27.08 deg C: Count == 688, R == 149103 Ohms */ ++ 246, /* == -27.27 deg C: Count == 696, R == 150834 Ohms */ ++ 246, /* == -27.46 deg C: Count == 704, R == 152565 Ohms */ ++ 245, /* == -27.64 deg C: Count == 712, R == 154297 Ohms */ ++ 245, /* == -27.82 deg C: Count == 720, R == 156028 Ohms */ ++ 245, /* == -28 deg C: Count == 728, R == 157759 Ohms */ ++ 245, /* == -28.18 deg C: Count == 736, R == 159490 Ohms */ ++ 245, /* == -28.36 deg C: Count == 744, R == 161222 Ohms */ ++ 244, /* == -28.53 deg C: Count == 752, R == 162953 Ohms */ ++ 244, /* == -28.7 deg C: Count == 760, R == 164684 Ohms */ ++ 244, /* == -28.87 deg C: Count == 768, R == 166415 Ohms */ ++ 244, /* == -29.04 deg C: Count == 776, R == 168146 Ohms */ ++ 244, /* == -29.21 deg C: Count == 784, R == 169878 Ohms */ ++ 244, /* == -29.37 deg C: Count == 792, R == 171609 Ohms */ ++ 243, /* == -29.53 deg C: Count == 800, R == 173340 Ohms */ ++ 243, /* == -29.69 deg C: Count == 808, R == 175071 Ohms */ ++ 243, /* == -29.85 deg C: Count == 816, R == 176803 Ohms */ ++ 243, /* == -30.01 deg C: Count == 824, R == 178534 Ohms */ ++ 243, /* == -30.16 deg C: Count == 832, R == 180265 Ohms */ ++ 243, /* == -30.32 deg C: Count == 840, R == 181996 Ohms */ ++ 243, /* == -30.47 deg C: Count == 848, R == 183728 Ohms */ ++ 242, /* == -30.62 deg C: Count == 856, R == 185459 Ohms */ ++ 242, /* == -30.77 deg C: Count == 864, R == 187190 Ohms */ ++ 242, /* == -30.92 deg C: Count == 872, R == 188921 Ohms */ ++ 242, /* == -31.06 deg C: Count == 880, R == 190653 Ohms */ ++ 242, /* == -31.21 deg C: Count == 888, R == 192384 Ohms */ ++ 242, /* == -31.35 deg C: Count == 896, R == 194115 Ohms */ ++ 242, /* == -31.49 deg C: Count == 904, R == 195846 Ohms */ ++ 241, /* == -31.63 deg C: Count == 912, R == 197578 Ohms */ ++ 241, /* == -31.77 deg C: Count == 920, R == 199309 Ohms */ ++ 241, /* == -31.91 deg C: Count == 928, R == 201040 Ohms */ ++ 241, /* == -32.04 deg C: Count == 936, R == 202771 Ohms */ ++ 241, /* == -32.18 deg C: Count == 944, R == 204502 Ohms */ ++ 241, /* == -32.31 deg C: Count == 952, R == 206234 Ohms */ ++ 241, /* == -32.44 deg C: Count == 960, R == 207965 Ohms */ ++ 240, /* == -32.58 deg C: Count == 968, R == 209696 Ohms */ ++ 240, /* == -32.71 deg C: Count == 976, R == 211427 Ohms */ ++ 240, /* == -32.83 deg C: Count == 984, R == 213159 Ohms */ ++ 240, /* == -32.96 deg C: Count == 992, R == 214890 Ohms */ ++ 240, /* == -33.09 deg C: Count == 1000, R == 216621 Ohms */ ++ 240, /* == -33.21 deg C: Count == 1008, R == 218352 Ohms */ ++ 240, /* == -33.34 deg C: Count == 1016, R == 220084 Ohms */ ++}; ++ ++#endif +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/time.c linux-2.6.24-oxe810/arch/arm/mach-hipox/time.c +--- linux-2.6.24/arch/arm/mach-hipox/time.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/time.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,159 @@ ++/* ++ * linux/arch/arm/mach-hipox/irq.c ++ * ++ * 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/init.h> ++#include <linux/interrupt.h> ++#include <linux/irq.h> ++ ++#include <asm/io.h> ++#include <asm/hardware.h> ++#include <asm/mach/time.h> ++ ++#ifdef CONFIG_HIPOX_AHB_MON ++#include <asm/arch/ahb_mon.h> ++#endif // CONFIG_HIPOX_AHB_MON ++ ++#ifdef CONFIG_HIPOX_DDR_MON ++static int client = 0; ++#endif // CONFIG_HIPOX_DDR_MON ++ ++static irqreturn_t HIPOX_timer_interrupt(int irq, void *dev_id) ++{ ++#ifdef CONFIG_HIPOX_DDR_MON ++ static const int NUM_MON_CLIENTS = 8; ++#endif // CONFIG_HIPOX_DDR_MON ++ ++ write_seqlock(&xtime_lock); ++ ++ // Clear the timer interrupt - any write will do ++ *((volatile unsigned long*)TIMER1_CLEAR) = 0; ++ ++ timer_tick(); ++ ++ write_sequnlock(&xtime_lock); ++ ++#ifdef CONFIG_HIPOX_DDR_MON ++ if (!(jiffies % CONFIG_HIPOX_MONITOR_SUBSAMPLE)) { ++ // Read the DDR core bus monitors ++ u32 diag_reg_contents = readl(DDR_DIAG_REG); ++ u32 holdoffs = (diag_reg_contents >> DDR_DIAG_HOLDOFFS_BIT) & ((1UL << DDR_DIAG_HOLDOFFS_NUM_BITS) - 1); ++ u32 writes = (diag_reg_contents >> DDR_DIAG_WRITES_BIT) & ((1UL << DDR_DIAG_WRITES_NUM_BITS) - 1); ++ u32 reads = (diag_reg_contents >> DDR_DIAG_READS_BIT) & ((1UL << DDR_DIAG_READS_NUM_BITS) - 1); ++ ++ printk(KERN_INFO "$WC %d: H=%u, W=%u, R=%u\n", client, holdoffs, writes, reads); ++ // Re-arm the DDR core bus monitors ++ writel(client << DDR_MON_CLIENT_BIT, DDR_MON_REG); ++ if (++client >= NUM_MON_CLIENTS) { ++ client = 0; ++ } ++ } ++#endif // CONFIG_HIPOX_DDR_MON ++ ++#ifdef CONFIG_HIPOX_AHB_MON ++ if (!(jiffies % CONFIG_HIPOX_MONITOR_SUBSAMPLE)) { ++ read_ahb_monitors(); ++ restart_ahb_monitors(); ++ } ++#endif // CONFIG_HIPOX_AHB_MON ++ ++ return IRQ_HANDLED; ++} ++ ++static struct irqaction hipox_timer_irq = { ++ .name = "Jiffy tick", ++ .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL, ++ .handler = HIPOX_timer_interrupt ++}; ++ ++static void /*__init*/ hipox_init_time(void) ++{ ++ // Connect the timer interrupt handler ++ hipox_timer_irq.handler = HIPOX_timer_interrupt; ++ setup_irq(TIMER_1_INTERRUPT, &hipox_timer_irq); ++ ++ // Stop both timers before programming them ++ *((volatile unsigned long*)TIMER1_CONTROL) = 0; ++ *((volatile unsigned long*)TIMER2_CONTROL) = 0; ++ ++ // Setup timer 1 load value ++ *((volatile unsigned long*)TIMER1_LOAD) = TIMER_1_LOAD_VALUE; ++ ++ // Setup timer 1 prescaler, periodic operation and start it ++ *((volatile unsigned long*)TIMER1_CONTROL) = ++ (TIMER_1_PRESCALE_ENUM << TIMER_PRESCALE_BIT) | ++ (TIMER_1_MODE << TIMER_MODE_BIT) | ++ (TIMER_ENABLE_ENABLE << TIMER_ENABLE_BIT); ++ ++ // Setup timer 2 prescaler, free-running operation and start it ++ // This will not be used to generate interrupt, just as a hi-res source of ++ // timing information ++ *((volatile unsigned long*)TIMER2_CONTROL) = ++ (TIMER_2_PRESCALE_ENUM << TIMER_PRESCALE_BIT) | ++ (TIMER_2_MODE << TIMER_MODE_BIT) | ++ (TIMER_ENABLE_ENABLE << TIMER_ENABLE_BIT); ++ ++#ifdef CONFIG_HIPOX_DDR_MON ++ // Arm the DDR core bus monitors, start with client zero ++ writel(client << DDR_MON_CLIENT_BIT, DDR_MON_REG); ++#endif // CONFIG_HIPOX_DDR_MON ++ ++#ifdef CONFIG_HIPOX_AHB_MON ++ // Monitor all accesses ++ init_ahb_monitors(AHB_MON_HWRITE_READS_AND_WRITES, 0, 0, 0, 0); ++#endif // CONFIG_HIPOX_AHB_MON ++} ++ ++/* ++ * Returns number of microseconds since last clock tick interrupt. ++ * Note that interrupts will be disabled when this is called ++ * Should take account of any pending timer tick interrupt ++ */ ++static unsigned long hipox_gettimeoffset(void) ++{ ++ // How long since last timer interrupt? ++ unsigned long ticks_since_last_intr = ++ (unsigned long)TIMER_1_LOAD_VALUE - *((volatile unsigned long*)TIMER1_VALUE); ++ ++ // Is there a timer interrupt pending ++ int timer_int_pending = ++ *((volatile unsigned long*)RPS_IRQ_RAW_STATUS) & (1UL << TIMER_1_INTERRUPT); ++ ++ if (timer_int_pending) { ++ // Sample time since last timer interrupt again. Theoretical race between ++ // interrupt occuring and ARM reading value before reload has taken ++ // effect, but in practice it's not going to happen because it takes ++ // multiple clock cycles for the ARM to read the timer value register ++ unsigned long ticks2 = (unsigned long)TIMER_1_LOAD_VALUE - *((volatile unsigned long*)TIMER1_VALUE); ++ ++ // If the timer interrupt which hasn't yet been serviced, and thus has ++ // not yet contributed to the tick count, occured before our initial ++ // read of the current timer value then we need to account for a whole ++ // timer interrupt period ++ if (ticks_since_last_intr <= ticks2) { ++ // Add on a whole timer interrupt period, as the tick count will have ++ // wrapped around since the previously seen timer interrupt (?) ++ ticks_since_last_intr += TIMER_1_LOAD_VALUE; ++ } ++ } ++ ++ return TICKS_TO_US(ticks_since_last_intr); ++} ++ ++struct sys_timer hipox_timer = { ++ .init = hipox_init_time, ++ .offset = hipox_gettimeoffset, ++}; +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/usb-test-mode.c linux-2.6.24-oxe810/arch/arm/mach-hipox/usb-test-mode.c +--- linux-2.6.24/arch/arm/mach-hipox/usb-test-mode.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/usb-test-mode.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,253 @@ ++/* ++ * arch/arm/mach-hipox/usb-test-mode.c ++ * ++ * Copyright (C) 2006 Oxford Semiconductor Ltd ++ * ++ * 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/types.h> ++#include <linux/module.h> ++#include <linux/errno.h> ++#include <linux/miscdevice.h> ++#include <linux/smp_lock.h> ++#include <linux/kernel.h> ++#include <linux/delay.h> ++#include <linux/sched.h> ++#include <linux/i2c.h> ++#include <linux/proc_fs.h> ++#include <linux/capability.h> ++#include <linux/slab.h> ++#include <linux/init.h> ++#include <linux/spinlock.h> ++#include <linux/smp_lock.h> ++#include <linux/wait.h> ++#include <linux/suspend.h> ++#include <linux/kthread.h> ++#include <linux/moduleparam.h> ++#include <linux/interrupt.h> ++ ++#include <asm/io.h> ++#include <asm/system.h> ++#include <asm/sections.h> ++#include <asm/uaccess.h> ++#include <asm/bitops.h> ++ ++#include <asm/hardware.h> ++ ++ ++/* usb test masks and offsets */ ++#define TEST_MASK 0xF ++#define TEST_OFFSET 16 ++ ++#define MODULE_VERS "0.1" ++#define MODULE_NAME "usb_test_mode" ++MODULE_AUTHOR( "John Larkworthy" ); ++MODULE_DESCRIPTION( "Driver to put usb ports in test modes" ); ++MODULE_LICENSE( "GPL" ); ++ ++ ++static struct proc_dir_entry *proc_dir_usb_test_read, *usb_test_dir; ++ ++ ++/* create proc filing system entries to accept configuration data */ ++static int usb_test_write_entries(const char *name, write_proc_t *w, int data) ++{ ++ struct proc_dir_entry * entry = create_proc_entry(name, 0222, usb_test_dir); ++ if (entry) { ++ entry->write_proc = w; ++ entry->data = (void *)data; ++ entry->owner = THIS_MODULE; ++ return 0; ++ } ++ else ++ { ++ return -ENOMEM; ++ } ++} ++ ++ ++ ++#if 0 ++static int ++oxsemi_usb_test_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) ++{ ++ //int i = (int __user *)arg; ++ ++ printk(KERN_INFO "usb test:: usb_test_ioctl\n"); ++ switch(cmd) { ++ case SET_TEST_MODE: ++ break; ++ // etc... ++ ++ default: ++ return -ENOIOCTLCMD; ++ } ++ ++ return 0; ++} ++#endif ++ ++static int ++oxsemi_usb_test_read(char *buf, char **start, off_t offset, ++ int count, int *eof, void *unused) ++{ ++ ++ int i; ++ int len = 0; ++ long unsigned *usbport; ++ ++ usbport = (long unsigned *) (USB_BASE+0x184); ++ ++ for (i=0; i < 3; i++) ++ { ++ len += sprintf(buf+len, "usb port %d [%p]:%08lx \n", i, (usbport+4*i) , *(usbport+i)); ++ } ++ *eof=1; ++ return len; ++} ++ ++static int ++oxsemi_usb_test_write(struct file *file, const char *buf, unsigned long count, void * data) ++{ ++ int len; ++ long int *usbport; ++ char local[10]; ++ int result; ++ int test_mode; ++ unsigned long flags; ++ ++ if (count > 9) ++ len= 9; ++ else ++ len=count; ++ ++ if (copy_from_user(&local, buf, len)) ++ return -EFAULT; ++ ++ /* extract value from buffer and store */ ++ result = sscanf(local, "%1d", &test_mode); ++ if (result != 1) ++ return -EINVAL; ++ ++ usbport = (long int *) (USB_BASE+0X184 + (4* (int) data)); ++ printk(KERN_ERR "usb-test-write : [%08lx] <- %08lx \n", ++ (long unsigned) usbport, ++ (long unsigned) ((test_mode & TEST_MASK) << TEST_OFFSET)); ++ /* lock system while this is updated */ ++ local_irq_save(flags); ++ *usbport = (*usbport & ~(TEST_MASK<<TEST_OFFSET)) | ((test_mode & TEST_MASK) << TEST_OFFSET); ++ local_irq_restore(flags); ++ printk(KERN_ERR "usb-test-writen: [%08lx]:%08lx \n", (long unsigned) usbport, (long unsigned) *usbport); ++ return len; ++} ++ ++ ++static int __init oxsemi_usb_test_init(void) ++{ ++ int rv; ++ int i; ++ char name[] = "usb-test/write0"; /* overwritten with new name below */ ++ ++ usb_test_dir = proc_mkdir(MODULE_NAME, NULL); ++ if (usb_test_dir == NULL) { ++ printk(KERN_ERR "usb-test: unable to register /proc/usb-test\n"); ++ rv= -ENOMEM; ++ goto out; ++ } ++ ++ usb_test_dir->owner= THIS_MODULE; ++ ++ proc_dir_usb_test_read = create_proc_entry("read", 0444, usb_test_dir); ++ if (proc_dir_usb_test_read) { ++ proc_dir_usb_test_read->read_proc = oxsemi_usb_test_read; ++ } else { ++ printk(KERN_ERR "usb-test: unable to register /proc/usb-test/read\n"); ++ rv = -ENOMEM; ++ goto no_read; ++ } ++ /* create port write file entries */ ++ for (i=0;i<3;i++) ++ { ++ sprintf(name,"write%d",i+1); ++ rv = usb_test_write_entries(name, &oxsemi_usb_test_write, i); ++ if (rv < 0) ++ { ++ while (i != 0) ++ { ++ i--; ++ /* remove any allocated entries */ ++ sprintf(name,"usb-test/write%d",i+1); ++ remove_proc_entry (name, usb_test_dir); ++ } ++ goto no_write; ++ } ++ } ++ printk(KERN_INFO "%s %s initialised\n", MODULE_NAME, MODULE_VERS); ++ ++ return 0; ++ no_write: ++ remove_proc_entry("usb-test/read", usb_test_dir); ++ no_read: ++ remove_proc_entry(MODULE_NAME, NULL); ++ out: ++ return rv; ++} ++ ++ ++static void __exit oxsemi_usb_test_exit(void) ++{ ++ char name[] = "usb-test/write0"; ++ int i; ++ ++ for (i = 0; i < 3; i++) ++ { ++ sprintf(name, "write%1d", (i+1)); ++ remove_proc_entry(name, usb_test_dir); ++ } ++ ++ remove_proc_entry("read", usb_test_dir); ++ remove_proc_entry(MODULE_NAME, NULL); ++ ++ printk(KERN_INFO "%s %s removed\n", MODULE_NAME, MODULE_VERS); ++ ++} ++ ++ ++module_init(oxsemi_usb_test_init); ++module_exit(oxsemi_usb_test_exit); ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ ++ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/user_recovery_button.c linux-2.6.24-oxe810/arch/arm/mach-hipox/user_recovery_button.c +--- linux-2.6.24/arch/arm/mach-hipox/user_recovery_button.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/user_recovery_button.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,260 @@ ++/* ++ * linux/arch/arm/mach-hipox/user_recovery_button.c ++ * ++ * Copyright (C) 2008 Oxford Semiconductor Ltd ++ * ++ * 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/init.h> ++#include <linux/interrupt.h> ++#include <linux/module.h> ++#include <linux/timer.h> ++#include <linux/kobject.h> ++#include <linux/workqueue.h> ++#include <asm/hardware.h> ++#include <asm/io.h> ++ ++MODULE_LICENSE("GPL v2"); ++ ++#if (CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO < 32) ++#define SWITCH_NUM CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO ++#define IRQ_NUM GPIO_1_INTERRUPT ++#define INT_STATUS_REG GPIO_A_INTERRUPT_STATUS_REGISTER ++#define SWITCH_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_0 ++#define SWITCH_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_0 ++#define SWITCH_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_0 ++#define SWITCH_CLR_OE_REG GPIO_A_OUTPUT_ENABLE_CLEAR ++#define DEBOUNCE_REG GPIO_A_INPUT_DEBOUNCE_ENABLE ++#define LEVEL_INT_REG GPIO_A_LEVEL_INTERRUPT_ENABLE ++#define FALLING_INT_REG GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE ++#define DATA_REG GPIO_A_DATA ++#else ++#define SWITCH_NUM ((CONFIG_HIPOX_USER_RECOVERY_BUTTON_GPIO) - 32) ++#define IRQ_NUM GPIO_2_INTERRUPT ++#define INT_STATUS_REG GPIO_B_INTERRUPT_STATUS_REGISTER ++#define SWITCH_PRISEL_REG SYS_CTRL_GPIO_PRIMSEL_CTRL_1 ++#define SWITCH_SECSEL_REG SYS_CTRL_GPIO_SECSEL_CTRL_1 ++#define SWITCH_TERSEL_REG SYS_CTRL_GPIO_TERTSEL_CTRL_1 ++#define SWITCH_CLR_OE_REG GPIO_B_OUTPUT_ENABLE_CLEAR ++#define DEBOUNCE_REG GPIO_B_INPUT_DEBOUNCE_ENABLE ++#define LEVEL_INT_REG GPIO_B_LEVEL_INTERRUPT_ENABLE ++#define FALLING_INT_REG GPIO_B_FALLING_EDGE_ACTIVE_LOW_ENABLE ++#define DATA_REG GPIO_B_DATA ++#endif ++ ++#define SWITCH_MASK (1UL << (SWITCH_NUM)) ++ ++#define TIMER_INTERVAL_JIFFIES ((HZ) >> 3) /* An eigth of a second */ ++#define TIMER_COUNT_LIMIT 32 /* In eigths of a second */ ++ ++extern spinlock_t hipox_gpio_spinlock; ++ ++static unsigned long count; ++static struct timer_list timer; ++ ++/** Have to use active low level interupt generation, as otherwise might miss ++ * interrupts that arrive concurrently with a PCI interrupt, as PCI interrupts ++ * are generated via GPIO pins and std PCI drivers will not know that there ++ * may be other pending GPIO interrupt sources waiting to be serviced and will ++ * simply return IRQ_HANDLED if they see themselves as having generated the ++ * interrupt, thus preventing later chained handlers from being called ++ */ ++static irqreturn_t int_handler(int irq, void* dev_id) ++{ ++ int status = IRQ_NONE; ++ unsigned int int_status = readl((volatile unsigned long *)INT_STATUS_REG); ++ ++ /* Is the interrupt for us? */ ++ if (int_status & SWITCH_MASK) { ++ /* Disable the user recovery button GPIO line interrupt */ ++ spin_lock(&hipox_gpio_spinlock); ++ writel(readl(FALLING_INT_REG) & ~SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock(&hipox_gpio_spinlock); ++ ++ /* Zeroise button hold down counter */ ++ count = 0; ++ ++ /* Start hold down timer with a timeout of 1/8 second */ ++ mod_timer(&timer, jiffies + TIMER_INTERVAL_JIFFIES); ++ ++ /* Only mark interrupt as serviced if no other unmasked GPIO interrupts ++ are pending */ ++ if (!readl((volatile unsigned long *)INT_STATUS_REG)) { ++ status = IRQ_HANDLED; ++ } ++ } ++ ++ return status; ++} ++ ++/* ++ * Device driver object ++ */ ++typedef struct recovery_button_driver_s { ++ /** sysfs dir tree root for recovery button driver */ ++ struct kset kset; ++ struct kobject recovery_button; ++} recovery_button_driver_t; ++ ++static recovery_button_driver_t recovery_button_driver; ++ ++static void work_handler(struct work_struct * not_used) { ++ kobject_uevent(&recovery_button_driver.recovery_button, KOBJ_OFFLINE); ++} ++ ++DECLARE_WORK(recovery_button_hotplug_work, work_handler); ++ ++static void timer_handler(unsigned long data) ++{ ++ unsigned long flags; ++ ++ /* Is the user recovery button still pressed? */ ++ if (!(readl(DATA_REG) & SWITCH_MASK)) { ++ /* Yes, so increment count of how many timer intervals have passed since ++ user recovery button was pressed */ ++ if (++count == TIMER_COUNT_LIMIT) { ++ schedule_work(&recovery_button_hotplug_work); ++ } else { ++ /* Restart timer with a timeout of 1/8 second */ ++ mod_timer(&timer, jiffies + TIMER_INTERVAL_JIFFIES); ++ } ++ } else { ++ /* The h/w debounced user recovery button has been released, so reenable the ++ active low interrupt detection to trap the user's next attempt to ++ recover */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(FALLING_INT_REG) | SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ } ++} ++ ++static struct kobj_type ktype_recovery_button = { ++ .release = 0, ++ .sysfs_ops = 0, ++ .default_attrs = 0, ++}; ++ ++static int recovery_button_hotplug_filter(struct kset* kset, struct kobject* kobj) { ++ return get_ktype(kobj) == &ktype_recovery_button; ++} ++ ++static const char* recovery_button_hotplug_name(struct kset* kset, struct kobject* kobj) { ++ return "hipox_user_recovery"; ++} ++ ++static struct kset_uevent_ops recovery_button_uevent_ops = { ++ .filter = recovery_button_hotplug_filter, ++ .name = recovery_button_hotplug_name, ++ .uevent = NULL, ++}; ++ ++static int recovery_button_prep_sysfs(void) ++{ ++ int err = 0; ++ ++ /* prep the sysfs interface for use */ ++ kobject_set_name(&recovery_button_driver.kset.kobj, "recovery-button"); ++ recovery_button_driver.kset.ktype = &ktype_recovery_button; ++ ++ err = subsystem_register(&recovery_button_driver.kset); ++ if (err) ++ return err; ++ ++ /* setup hotplugging */ ++ recovery_button_driver.kset.uevent_ops = &recovery_button_uevent_ops; ++ ++ /* setup the heirarchy, the name will be set on detection */ ++ kobject_init(&recovery_button_driver.recovery_button); ++ recovery_button_driver.recovery_button.kset = kset_get(&recovery_button_driver.kset); ++ recovery_button_driver.recovery_button.parent = &recovery_button_driver.kset.kobj; ++ ++ return 0; ++} ++ ++static int recovery_button_build_sysfs(void) { ++ kobject_set_name(&recovery_button_driver.recovery_button, "recovery-button-1"); ++ return kobject_add(&recovery_button_driver.recovery_button); ++} ++ ++static int __init recovery_button_init(void) ++{ ++ int err = 0; ++ unsigned long flags; ++ ++ err = recovery_button_prep_sysfs(); ++ if (err) ++ return -EINVAL; ++ ++ err = recovery_button_build_sysfs(); ++ if (err) ++ return -EINVAL; ++ ++ /* Setup the timer that will time how long the user holds down the recovery ++ button */ ++ init_timer(&timer); ++ timer.data = 0; ++ timer.function = timer_handler; ++ ++ /* Install a shared interrupt handler on the appropriate GPIO bank's ++ interrupt line */ ++ if (request_irq(IRQ_NUM, int_handler, IRQF_SHARED, "User Recovery Button", &recovery_button_driver)) { ++ printk(KERN_ERR "User Recovery Button: cannot register IRQ %d\n", IRQ_NUM); ++ del_timer_sync(&timer); ++ return -EIO; ++ } ++ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ /* Disable primary, secondary and teriary GPIO functions on switch lines */ ++ writel(readl(SWITCH_PRISEL_REG) & ~SWITCH_MASK, SWITCH_PRISEL_REG); ++ writel(readl(SWITCH_SECSEL_REG) & ~SWITCH_MASK, SWITCH_SECSEL_REG); ++ writel(readl(SWITCH_TERSEL_REG) & ~SWITCH_MASK, SWITCH_TERSEL_REG); ++ ++ /* Enable GPIO input on switch line */ ++ writel(SWITCH_MASK, SWITCH_CLR_OE_REG); ++ ++ /* Set up the user recovery button GPIO line for active low, debounced interrupt */ ++ writel(readl(DEBOUNCE_REG) | SWITCH_MASK, DEBOUNCE_REG); ++ writel(readl(LEVEL_INT_REG) | SWITCH_MASK, LEVEL_INT_REG); ++ writel(readl(FALLING_INT_REG) | SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ printk(KERN_INFO "Recovery button driver registered\n"); ++ return 0; ++} ++ ++static void __exit recovery_button_exit(void) ++{ ++ unsigned long flags; ++ ++ kobject_del(&recovery_button_driver.recovery_button); ++ subsystem_unregister(&recovery_button_driver.kset); ++ ++ /* Deactive the timer */ ++ del_timer_sync(&timer); ++ ++ /* Disable interrupt generation by the recovery button GPIO line */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(FALLING_INT_REG) & ~SWITCH_MASK, FALLING_INT_REG); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ /* Remove the handler for the shared interrupt line */ ++ free_irq(IRQ_NUM, &recovery_button_driver); ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(recovery_button_init); ++module_exit(recovery_button_exit); +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/wdc-fan.c linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-fan.c +--- linux-2.6.24/arch/arm/mach-hipox/wdc-fan.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-fan.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,336 @@ ++/* ++ * linux/arch/arm/mach-hipox/wdc-fan.c ++ * ++ * Copyright (C) 2006-2007 Western Digital ++ * ++ * 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/kernel.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/err.h> ++#include <linux/ctype.h> ++#include <linux/platform_device.h> ++#include <asm/hardware.h> ++ ++/* Human recognizable driver name. */ ++#define DRIVER_NAME "WDC_Fan" ++ ++/* GPIOs for the fan on the Galaxy 2NC platform. All are on GPIO_A */ ++#define FAN_MASK_LOW (1 << GPIO_29) ++#define FAN_MASK_HIGH (1 << GPIO_8) ++ ++#define FAN_MASK ( FAN_MASK_LOW | FAN_MASK_HIGH ) ++ ++ ++/* I/O register access (FIXME: why not use the standard linux macros?) */ ++#define ox_writel(data, addr) (*(volatile unsigned long*)addr = (data)) ++#define ox_readl(addr) (*(volatile unsigned long*)addr) ++#define writel(data, addr) (*(volatile u32*)addr = (data)) ++#define readl(addr) (*(volatile u32*)addr) ++#define CLEAR(addr, mask) writel(readl(addr) & ~mask, addr) ++ ++enum fan_speeds ++{ ++ FAN_OFF = 0, ++ FAN_SPEED_MAX = 100 ++}; ++ ++typedef struct s_fan_device_state ++{ ++ unsigned char speed; /* Range FAN_OFF .. FAN_SPEED_MAX */ ++} fan_device_state; ++ ++ ++/* ++ * Driver-global variables. ++ */ ++ ++/* Number of successful probes. */ ++/* TODO: protect this variable??!? */ ++static int fans_found; ++ ++/* This spinlock protects the GPIO setup code from ++ interrupts but is not SMP-correct. */ ++static spinlock_t hipox_gpio_spinlock; ++ ++/* Device instance state. ++ Only one fan is supported, so this can be a global variable. */ ++static fan_device_state fan_state; ++ ++ ++/* ++ * Device attribute getter/setters ++ */ ++static ssize_t fan_speed_show (struct device*, struct device_attribute*, ++ char *buf); ++ ++static ssize_t fan_speed_store(struct device*, struct device_attribute*, ++ const char *buf, size_t count); ++ ++/* Declare device attributes using the functions above. ++ Contrary to the macro's name, DEVICE_ATTR declares a dev_attr_... */ ++static DEVICE_ATTR(speed, 0644, fan_speed_show, fan_speed_store); ++ ++ ++static void set_fan_speed(unsigned char speed); ++ ++static int fan_probe (struct platform_device *pdev); ++static int fan_remove(struct platform_device *pdev); ++ ++ ++ ++/***************************************************************************/ ++/* FUNCTION: fan_probe */ ++/* */ ++/* PURPOSE: */ ++/* Look for fans and do initialize. */ ++/***************************************************************************/ ++int fan_probe(struct platform_device *pdev) ++{ ++ int rc = 0; ++ ++ do { ++ unsigned long lock_flags; ++ ++ printk(KERN_DEBUG "Fan probe\n"); ++ ++ memset(&fan_state, sizeof(fan_state), 0); ++ ++ /* Setup the fan-control GPIO lines properly. */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, lock_flags); ++ ++ do { ++ /* Enable desired GPIO drivers by disabling other functions. */ ++ CLEAR(SYS_CTRL_GPIO_PRIMSEL_CTRL_0, FAN_MASK); ++ CLEAR(SYS_CTRL_GPIO_SECSEL_CTRL_0, FAN_MASK); ++ CLEAR(SYS_CTRL_GPIO_TERTSEL_CTRL_0, FAN_MASK); ++ ++ /* Turn off the fan... then enable its outputs. */ ++ writel(FAN_MASK, GPIO_A_OUTPUT_CLEAR); ++ writel(FAN_MASK, GPIO_A_OUTPUT_ENABLE_SET); ++ ++ } while (0); ++ ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, lock_flags); ++ ++ ++ /* Create an entry in sysfs so user apps can control the fan. */ ++ rc = device_create_file(&pdev->dev, &dev_attr_speed); ++ if (rc < 0) break; ++ ++ fans_found++; ++ ++ set_fan_speed(FAN_OFF); ++ ++ } while(0); ++ ++ ++ /* Cleanup if any errors occured. */ ++ if(rc < 0) ++ { ++ fan_remove(pdev); ++ } ++ ++ return rc; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: fan_remove */ ++/* */ ++/* PURPOSE: */ ++/* Deactive the fan device(s) */ ++/***************************************************************************/ ++int fan_remove(struct platform_device *pdev) ++{ ++ printk(KERN_DEBUG "Fan remove\n"); ++ ++ /* Undo everything that might have been done by fan_probe() */ ++ ++ device_remove_file(&pdev->dev, &dev_attr_speed); ++ ++ writel(FAN_MASK, GPIO_A_OUTPUT_ENABLE_CLEAR); ++ ++ return 0; ++} ++ ++ ++/***************************************************************************/ ++/* */ ++/* sysfs attribute I/O - user-space control points */ ++/* */ ++/***************************************************************************/ ++ ++/* fan_speed_show() ++ * ++ * Called when the speed setting attribute is read; ++ * returns the current fan speed. ++ */ ++ssize_t fan_speed_show(struct device *dev, struct device_attribute *attr, ++ char *buf) ++{ ++ /* TODO: Check sizeof buf? Nobody else does*/ ++ ++ return sprintf(buf, "%u\n", fan_state.speed); ++} ++ ++/* fan_speed_store() ++ * ++ * Called when the speed setting attribute is written; ++ * sets a new fan speed. ++ */ ++ssize_t fan_speed_store(struct device *dev, struct device_attribute *attr, ++ const char *buf, size_t count) ++{ ++ char *end; ++ long newSpeed; ++ ++ newSpeed = simple_strtol(buf, &end, 10); ++ while (*end) ++ { ++ if (!isspace(*end++)) return -EINVAL; ++ } ++ ++ if (newSpeed < 0) newSpeed = 0; ++ if (newSpeed > FAN_SPEED_MAX) newSpeed = FAN_SPEED_MAX; ++ ++ set_fan_speed( (unsigned char)newSpeed ); ++ ++ return count; /* Entire string was consumed and validated. */ ++} ++ ++/* set_fan_speed() ++ * ++ * Sets the fan's speed by twiddling its power control (GPO) lines. ++ */ ++void set_fan_speed(unsigned char newSpeed) ++{ ++int oldSpeed = fan_state.speed; ++ ++ /* Round the requested fan speed to the nearest supported ++ value and set the fan's power lines appropriately. */ ++ ++ /* The 2NC platform has three fan settings: off, low, hi-speed. */ ++ ++ if (newSpeed < 10) ++ { ++ fan_state.speed = FAN_OFF; /* Turn off the fan. */ ++ writel(FAN_MASK_LOW | FAN_MASK_HIGH, GPIO_A_OUTPUT_CLEAR); ++ } ++ else if (newSpeed < 75) ++ { ++ fan_state.speed = 50; /* Set to low speed. */ ++ writel(FAN_MASK_HIGH, GPIO_A_OUTPUT_CLEAR); ++ writel(FAN_MASK_LOW, GPIO_A_OUTPUT_SET); ++ } ++ else ++ { ++ fan_state.speed = FAN_SPEED_MAX; /* Set to max (high) speed. */ ++ writel(FAN_MASK_LOW | FAN_MASK_HIGH, GPIO_A_OUTPUT_SET); ++ } ++ ++ if (oldSpeed != fan_state.speed) ++ { ++#if 0 ++ printk(KERN_DEBUG "WDC Fan speed set %u\n", fan_state.speed); ++#endif ++ } ++} ++ ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_driver */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds platform device driver */ ++/***************************************************************************/ ++static struct platform_driver fan_driver = ++{ ++ .probe = fan_probe, ++ .remove = fan_remove, ++ .driver = ++ { ++ .name = "wdc-fan", ++ }, ++}; ++ ++static struct platform_device *fan_device; ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_init */ ++/* */ ++/* PURPOSE: */ ++/* Perform module initialization */ ++/***************************************************************************/ ++static int __init wdc_fan_init(void) ++{ ++ int rc = 0; ++ ++ fans_found = 0; ++ spin_lock_init(&hipox_gpio_spinlock); ++ ++ rc = platform_driver_register(&fan_driver); ++ if (rc) goto quit; ++ ++ fan_device = platform_device_register_simple("wdc-fan", -1, NULL, 0); ++ if (IS_ERR(fan_device)) ++ { ++ rc = PTR_ERR(fan_device); ++ fan_device = NULL; ++ ++ platform_driver_unregister(&fan_driver); ++ goto quit; ++ } ++ ++ ++quit: ++ if (rc) ++ { ++ printk(KERN_ERR DRIVER_NAME " init failed, rc=%i\n", rc); ++ } ++ else ++ { ++ printk(KERN_INFO DRIVER_NAME " initialized\n"); ++ } ++ ++ return rc; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_exit */ ++/* */ ++/* PURPOSE: */ ++/* Perform module unloading and cleanup */ ++/***************************************************************************/ ++static void __exit wdc_fan_exit(void) ++{ ++ platform_device_unregister(fan_device); ++ platform_driver_unregister(&fan_driver); ++ ++ printk(KERN_INFO DRIVER_NAME " goodbye!\n"); ++} ++ ++ ++module_init(wdc_fan_init); ++module_exit(wdc_fan_exit); ++ ++MODULE_AUTHOR("James Lin"); ++MODULE_DESCRIPTION("Western Digital NetCenter/2NC Fan Control"); ++MODULE_LICENSE("GPL"); ++ ++/*EOF*/ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/wdc-leds.c linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-leds.c +--- linux-2.6.24/arch/arm/mach-hipox/wdc-leds.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-leds.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,1299 @@ ++/* ++ * linux/arch/arm/mach-hipox/wdc-leds.c ++ * ++ * Copyright (C) 2006 Western Digital ++ * ++ * 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/kernel.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/timer.h> ++#include <linux/interrupt.h> ++#include <linux/platform_device.h> ++#include <linux/leds.h> ++#include <asm/hardware.h> ++ ++#define DEBUG ++ ++#ifdef DEBUG ++ #define DUMP(A,B) printk(KERN_INFO A,B); ++#else ++ #define DUMP(A,B) ++#endif ++ ++/* Number of LEDs */ ++#define NUM_ACTIVITY_LEDS 4 ++#define NUM_FUEL_GAUGE_LEDS 6 ++ ++/* Timer Values and Pulse Width Modulation */ ++#define PWM_RESOLUTION 255 ++#define TIMER_LED_MODE TIMER_MODE_PERIODIC ++ ++#define PWM_CLOCK_DATA ( ++ ++#define LED100 (PWM_RESOLUTION) /* 100% duty cycle */ ++#define LED50 (PWM_RESOLUTION / 2) /* 50% duty cycle */ ++#define LED25 (PWM_RESOLUTION / 4) /* 25% duty cycle */ ++ ++#define STEP_RESOLUTION (16) /* change intensity in 16 steps */ ++ ++/* Setup Timer2 prescaler, operation mode, and start it */ ++#define PERIODIC_INTERRUPT \ ++ ( \ ++ (TIMER_PRESCALE_256 << TIMER_PRESCALE_BIT) | \ ++ (TIMER_LED_MODE << TIMER_MODE_BIT) | \ ++ (TIMER_ENABLE_ENABLE << TIMER_ENABLE_BIT) \ ++ ) ++ ++/* ++ * Target frame rate is 60Hz. Slower frame rates flicker badly. ++ * Since each frame has 16 divisions to perform the pulse width ++ * modulation that means we need the timer set to 960Hz (i.e. 60 * 16) ++ * ++ * With a system clock of 25Mhz and a load register value of 1627 prescaled 256 ++ * to achieve 60Hz: ++ * 25Mhz / 256 / 1627 = ~60 ++ */ ++#define FAST_TIMER_INT (1627) /* Timer2 count down */ ++#define SYS_CLOCK (25000000) /* System clock frequency */ ++#define PRESCALE_VALUE (256) /* Value set in prescaler */ ++#define PWM_PRESCALE 814 /* Value loaded on PWM clock register */ ++#define MAX_PWM 255 ++#define SLOW_TPS ((SYS_CLOCK/PRESCALE_VALUE) / FAST_TIMER_INT) ++ ++/* The GPIO assignent to LED Masks need to make sure that the ++ * LED_MASK_GPIO_A and LED_MASK_GPIO_B are set appropriately ++ * based on the GPIOs assigned ++ */ ++ ++/* GPIO bits dedicated to LEDs */ ++#define LED_MASK_ACT12 (1 << GPIO_6) /* Activity 12 o'clock */ ++#define LED_MASK_ACT3 (1 << GPIO_7) /* Activity 3 o'clock */ ++#define LED_MASK_ACT6 (1 << GPIO_5) /* Activity 6 o'clock */ ++#define LED_MASK_ACT9 (1 << GPIO_34) /* Activity 9 o'clock */ ++#define LED_MASK_FG12 (1 << GPIO_10) /* Fuel Gauge 10 o'clock */ ++#define LED_MASK_FG2 (1 << GPIO_9) /* Fuel Gauge 8 o'clock */ ++#define LED_MASK_FG4 (1 << GPIO_25) /* Fuel Gauge 6 o'clock */ ++#define LED_MASK_FG6 (1 << GPIO_26) /* Fuel Gauge 4 o'clock */ ++#define LED_MASK_FG8 (1 << GPIO_27) /* Fuel Gauge 2 o'clock */ ++#define LED_MASK_FG10 (1 << GPIO_33) /* Fuel Gauge 12 o'clock */ ++ ++/* ++ * Mask for all the LEDs in the Fuel Gauge. This is in frame buffer format ++ * (see LED frame buffer design assumption comments below, near the ++ * frame_buffer declaration). ++ */ ++#define LED_MASK_FUEL_GAUGE \ ++ ( \ ++ LED_MASK_FG12 | \ ++ LED_MASK_FG2 | \ ++ LED_MASK_FG4 | \ ++ LED_MASK_FG6 | \ ++ LED_MASK_FG8 | \ ++ LED_MASK_FG10 \ ++ ) ++ ++/* Mask for all the Activity LEDs */ ++#define LED_MASK_ACTIVITY \ ++ ( \ ++ LED_MASK_ACT12 | \ ++ LED_MASK_ACT3 | \ ++ LED_MASK_ACT6 | \ ++ LED_MASK_ACT9 \ ++ ) ++ ++/* The GPIO_A and GPIO_B Masks below need to be set based on the ++ * GPIO numbers that are assigned for the LED MASKS ++ */ ++ ++/* Mask for all the LEDs on GPIO_A */ ++#define LED_MASK_GPIO_A \ ++ ( \ ++ LED_MASK_ACT12 | \ ++ LED_MASK_ACT3 | \ ++ LED_MASK_ACT6 | \ ++ LED_MASK_FG12 | \ ++ LED_MASK_FG2 | \ ++ LED_MASK_FG4 | \ ++ LED_MASK_FG6 | \ ++ LED_MASK_FG8 \ ++ ) ++ ++/* Mask for all the LEDs on GPIO_B */ ++#define LED_MASK_GPIO_B \ ++ ( \ ++ LED_MASK_ACT9 | \ ++ LED_MASK_FG10 \ ++ ) ++ ++/* I/O register access (FIXME: why not use the standard linux macros?) */ ++#define ox_writel(data, addr) (*(volatile unsigned long*)addr = (data)) ++#define ox_readl(addr) (*(volatile unsigned long*)addr) ++#define writel(data, addr) (*(volatile u32*)addr = (data)) ++#define readl(addr) (*(volatile u32*)addr) ++#define CLEAR(addr, mask) writel(readl(addr) & ~mask, addr) ++ ++ ++/* Variables to hold the number of LED classes created */ ++static int leds_created; ++ ++/* Variables to save/restore timer register values */ ++static u32 timer_load; ++static u32 timer_control; ++ ++/* LED polarity */ ++static int negative_led_logic = 0; ++module_param(negative_led_logic, bool, 0); ++ ++/* ++ * States for the main LED behavior state machine. The order of these states ++ * is important. In particular, the TRANS states use this ordering so that ++ * incrementing the state variable walks through the ordering shown below. ++ * This allows most of the TRANS states to share common code. ++ */ ++enum { ++ FULLY_ON__ENTRY, /* FullyOn - Initialize */ ++ FULLY_ON__RE_ENTRY, /* FullyOn - Initialize (skipping POR) */ ++ FULLY_ON__POR_RAMP_UP, /* FullyOn - Ramp up full ring */ ++ FULLY_ON__POR_HOLD, /* FullyOn - Hold a while with full ring */ ++ FULLY_ON__RAMP_UP, /* FullyOn - Ramp up full ring (skipping POR) */ ++ FULLY_ON__ACTIVITY, /* FullyOn - Read/write activity */ ++ FULLY_ON__IDLE_HOLD, /* FullyOn - Hold a while for no R/W activity */ ++ FULLY_ON__RAMP_DOWN, /* FullyOn - Ramp down full ring */ ++ STANDBY__ENTRY, /* Standby - Initialize */ ++ STANDBY__DARK, /* Standby - Full ring off */ ++ STANDBY__RAMP_UP, /* Standby - Ramp up full ring */ ++ STANDBY__RAMP_DOWN, /* Standby - Ramp down full ring */ ++ POWER_OFF__ENTRY, /* PowerOff - Initialize */ ++ POWER_OFF__DARK, /* PowerOff - Full ring off */ ++ DEGRADED__ENTRY, /* Degraded - Initialize */ ++ DEGRADED__BLINK1, /* Degraded - Blink step1 */ ++ DEGRADED__BLINK2, /* Degraded - Blink step2 */ ++ OVERTEMP__ENTRY, /* OverTemp - Initialize */ ++ OVERTEMP__BLINK1, /* OverTemp - Blink step1 */ ++ OVERTEMP__BLINK2, /* OverTemp - Blink step2 */ ++ TRANS__ENTRY, /* Transition - Initialize */ ++ TRANS__1_UP, /* 1st cycle - up 12 & 6 - down 9 & 3 o'clock */ ++ TRANS__1_DN, /* 1st cycle - down 12 & 6 - up 9 & 3 o'clock */ ++ TRANS__2_UP, /* 2nd cycle - up 12 & 6 - down 9 & 3 o'clock */ ++ TRANS__2_DN, /* 2nd cycle - down 12 & 6 - up 9 & 3 o'clock */ ++ TRANS__3_UP, /* 3rd cycle - up 12 & 6 - down 9 & 3 o'clock */ ++ TRANS__3_DN, /* 3rd cycle - down 12 & 6 - up 9 & 3 o'clock */ ++ TRANS__4_UP, /* 4th cycle - up 12 & 6 - down 9 & 3 o'clock */ ++ TRANS__4_DN /* 4th cycle - down 12 & 6 - down 9 & 3 o'clock */ ++}; ++ ++ ++/* Pattern for the activity behavior */ ++const u16 activity_pattern[NUM_ACTIVITY_LEDS] = { ++ LED100, ++ LED25, ++ 0, ++ 0 ++}; ++ ++ ++/* Various LED state machine constants */ ++#define TRANS_STEP (1) ++#define SLEEP_HI (0) ++#define SLEEP_LO (-STEP_RESOLUTION) ++#define NUM_POWER_STEPS (STEP_RESOLUTION) ++#define NUM_BREATHE_STEPS (SLEEP_HI - SLEEP_LO) ++#define NUM_TRANS_STEPS ((SLEEP_HI - SLEEP_LO) / TRANS_STEP) ++#define BIT_MASK_FUEL_GAUGE ((1 << NUM_FUEL_GAUGE_LEDS) - 1) ++ ++/* ++ * Calculate various speeds of the LED state machine based on the system ++ * clock frequency, the hardware timer prescaler, and the hardware timer ++ * load register value. This results in a calculation of the ticks per ++ * second (TPS) of the timer interrupt used to perform the pulse width ++ * modulation and the slower TPS of the tasklet that performs the main ++ * state machine of the LED behavior. The remaining speeds are ++ * calculated from the slow TPS. ++ */ ++ #define RW_SPEED (SLOW_TPS / 4) /* want ~4Hz */ ++#define BLINK_SPEED (SLOW_TPS / 2) /* want ~2Hz */ ++#define HOLD_BREATH (SLOW_TPS * 4) /* want ~4sec */ ++#define HOLD_ON_ENTER (SLOW_TPS * 10) /* want ~10sec */ ++#define POWER_SPEED (SLOW_TPS / NUM_POWER_STEPS) ++#define BREATHE_SPEED (SLOW_TPS / NUM_BREATHE_STEPS) ++#define TRANS_SPEED (SLOW_TPS / NUM_TRANS_STEPS) ++ ++#if \ ++ (!SLOW_TPS) || \ ++ (!RW_SPEED) || \ ++ (!BLINK_SPEED) || \ ++ (!POWER_SPEED) || \ ++ (!BREATHE_SPEED) || \ ++ (!TRANS_SPEED) ++# error TPS calculation(s) resulted in zero! ++#endif ++ ++ ++/* Variables for main LED behavior state machine */ ++static int state; ++static int next_state; ++static int active_count; ++static int count; ++static u32 fuel_gauge_bits; /* see LED frame buffer design assumption */ ++static u8 need_to_display_current_fuel_gauge; ++static u8 inner_ring_rotate; ++static u8 ignore_activity; ++static s8 active_tail; ++static s8 ramp1; ++static s8 ramp2; ++static s8 activity_led[NUM_ACTIVITY_LEDS]; ++static u16 rebuild_percentage; /* 0=not rebuilding */ ++ ++ ++/* ++ * Declare tasklet for the LED behavior state machine. The interrupt will ++ * only handle the pulse width modulation which can be performed quickly. ++ * The slower LED behavior state machine does not need to execute at such ++ * a high frequency so it will be executed by a tasklet that is ++ * periodically scheduled by the interrupt. ++ */ ++void wdc_leds_behavior(unsigned long); ++DECLARE_TASKLET(wdc_leds_behavior_tasklet, wdc_leds_behavior, 0); ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_interrupt */ ++/* */ ++/* PURPOSE: */ ++/* Interrupt handler for the wdc-leds pulse width modulation */ ++/***************************************************************************/ ++static irqreturn_t wdc_leds_interrupt ++ (int irq, void *dev_id) { ++ ox_writel(0, TIMER2_CLEAR); ++ ++ ++ tasklet_schedule(&wdc_leds_behavior_tasklet); ++ ++ return IRQ_HANDLED; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: get_inner_ring_bits */ ++/* */ ++/* PURPOSE: */ ++/* Convert the bit map of inner ring LEDs into the GPIO bit map */ ++/***************************************************************************/ ++static u32 get_inner_ring_bits(u16 value) ++{ ++ u32 pattern = 0; ++ ++ // Convert the bit map to the GPIO bit pattern ++ if (value & (1 << 0)) ++ pattern |= LED_MASK_FG2; ++ if (value & (1 << 1)) ++ pattern |= LED_MASK_FG4; ++ if (value & (1 << 2)) ++ pattern |= LED_MASK_FG6; ++ if (value & (1 << 3)) ++ pattern |= LED_MASK_FG8; ++ if (value & (1 << 4)) ++ pattern |= LED_MASK_FG10; ++ if (value & (1 << 5)) ++ pattern |= LED_MASK_FG12; ++ ++ return pattern; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: get_percentage_pattern */ ++/* */ ++/* PURPOSE: */ ++/* Convert a percentage to a inner ring bit map. Note, we never display */ ++/* less than 1 LED for a percentage so that something is alway visible. */ ++/***************************************************************************/ ++static u16 get_percentage_pattern(u16 percentage) ++{ ++ if (percentage >= 50) { ++ if (percentage >= 67) { ++ if (percentage >= 83) { ++ if (percentage >= 97) { ++ return 0x3F; // 6 LEDs is >= 97% ++ } else { ++ return 0x1F; // 5 LEDs is >= 83% ++ } ++ } else { ++ return 0x0F; // 4 LEDs is >= 67% ++ } ++ } else { ++ return 0x07; // 3 LEDs is >= 50% ++ } ++ } else { ++ if (percentage >= 33) { ++ return 0x03; // 2 LEDs is >= 33% ++ } else { ++ return 0x01; // 1 LED is >= 0% ++ } ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: set_led */ ++/* */ ++/* PURPOSE: */ ++/* Set frame buffer for the requested brightness on the requested LED(s) */ ++/***************************************************************************/ ++static void set_led(u32 led_bits, s8 value) ++{ ++ u32 bit; ++ s8 count = 0; ++ ++ if (negative_led_logic) { ++ value = MAX_PWM - value; ++ } ++ ++ for (bit = 1; bit > 0; bit <<= 1, ++count) { ++ if (bit & led_bits) writel(value, ((u32 *)PWM_DATA_REGISTER_BASE + count )); ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: display_inner_ring */ ++/* */ ++/* PURPOSE: */ ++/* Set frame buffer for the requested inner ring bit map */ ++/***************************************************************************/ ++static void display_inner_ring(u32 inner_ring_bits) ++{ ++ set_led(~inner_ring_bits & LED_MASK_FUEL_GAUGE, 0); ++ set_led(inner_ring_bits, LED100); ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: display_current_fuel_gauge */ ++/* */ ++/* PURPOSE: */ ++/* Display the current Fuel Gauge if it is not already being displayed */ ++/***************************************************************************/ ++static void display_current_fuel_gauge(void) ++{ ++ if (need_to_display_current_fuel_gauge) { ++ display_inner_ring(fuel_gauge_bits); ++ need_to_display_current_fuel_gauge = 0; ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: handle_inner_ring */ ++/* */ ++/* PURPOSE: */ ++/* Perform the LED behavior for the inner ring */ ++/***************************************************************************/ ++static void handle_inner_ring(void) ++{ ++ /* If currently rebuilding then display the rebuild percentage as */ ++ /* a series of LEDs representing the percentage complete rotating */ ++ /* around the inner ring. Note, the percentage is rotated to */ ++ /* distinguish it from normal fuel gauge behavior. */ ++ if (rebuild_percentage) { ++ /* Convert the rebuild percentage into a bit map of LEDs */ ++ u32 rotated_pattern = get_percentage_pattern(rebuild_percentage); ++ /* Now rotate that pattern */ ++ rotated_pattern <<= inner_ring_rotate; ++ rotated_pattern |= (rotated_pattern >> NUM_FUEL_GAUGE_LEDS); ++ rotated_pattern &= BIT_MASK_FUEL_GAUGE; ++ /* Now display the rotated pattern on the inner ring */ ++ display_inner_ring(get_inner_ring_bits(rotated_pattern)); ++ if (++inner_ring_rotate >= NUM_FUEL_GAUGE_LEDS) { ++ inner_ring_rotate = 0; ++ } ++ ++ need_to_display_current_fuel_gauge = 1; ++ } ++ ++ /* Otherwise not rebuilding so just display normal fuel gauge */ ++ else { ++ display_current_fuel_gauge(); ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: get_next_state_from_fully_on */ ++/* */ ++/* PURPOSE: */ ++/* Movement to STANDBY or POWER_OFF requires TRANSITION behavior; */ ++/* Otherwise just jump to next_state */ ++/***************************************************************************/ ++static int get_next_state_from_fully_on(void) ++{ ++ switch (next_state) { ++ case STANDBY__ENTRY: ++ case POWER_OFF__ENTRY: ++ return TRANS__ENTRY; ++ default: ++ return next_state; ++ } ++} ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_behavior_init */ ++/* */ ++/* PURPOSE: */ ++/* Initialization for LED behavior main state machine */ ++/***************************************************************************/ ++void wdc_leds_behavior_init(void) ++{ ++ /* State machine variables */ ++ state = FULLY_ON__ENTRY; ++ next_state = FULLY_ON__ENTRY; ++ /* Outer ring variables */ ++ active_count = 0; ++ count = 0; ++ ignore_activity = 0; ++ active_tail = NUM_ACTIVITY_LEDS - 1; ++ ramp1 = 0; ++ ramp2 = 0; ++ activity_led[0] = 0; ++ activity_led[1] = 0; ++ activity_led[2] = 0; ++ activity_led[3] = 0; ++ /* Inner ring variables */ ++ inner_ring_rotate = 0; ++ rebuild_percentage = 0; ++ fuel_gauge_bits = 0; ++ need_to_display_current_fuel_gauge = 1; ++} ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_behavior */ ++/* */ ++/* PURPOSE: */ ++/* LED behavior main state machine */ ++/***************************************************************************/ ++void wdc_leds_behavior(unsigned long unused) ++{ ++ static u8 been_there_done_that = 0; ++ s8 j, k; ++ switch (state) { ++ case FULLY_ON__ENTRY: ++ case FULLY_ON__RE_ENTRY: ++ inner_ring_rotate = 0; ++ need_to_display_current_fuel_gauge = 1; ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ ramp1 = -STEP_RESOLUTION; ++ ramp2 = -STEP_RESOLUTION; ++ if (state == FULLY_ON__RE_ENTRY) { ++ /* Don't go through the POR hold period for a re-entry */ ++ count = 0; ++ state = FULLY_ON__RAMP_UP; ++ break; ++ } ++ count = 0; ++ state = FULLY_ON__POR_RAMP_UP; ++ /* Fall through */ ++ case FULLY_ON__POR_RAMP_UP: ++ if (--count > 0) ++ break; ++ count = POWER_SPEED; ++ ++ramp2; ++ if (++ramp1 < 0) ++ break; ++ count = HOLD_ON_ENTER; ++ state = FULLY_ON__POR_HOLD; ++ break; ++ case FULLY_ON__POR_HOLD: ++ display_current_fuel_gauge(); ++ if (--count > 0) ++ break; ++ active_count = 0; ++ count = 0; ++ state = FULLY_ON__RAMP_UP; ++ break; ++ case FULLY_ON__RAMP_UP: ++ if (next_state != FULLY_ON__ENTRY) { ++ state = get_next_state_from_fully_on(); ++ break; ++ } ++ ++ display_current_fuel_gauge(); ++ if (--count > 0) ++ break; ++ count = POWER_SPEED; ++ ++ramp2; ++ if (++ramp1 >= 0) { ++ ramp1 = 0; ++ ramp2 = 0; ++ } ++ if (active_count == 0) { ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ break; ++ } ++ ++ activity_led[0] = 0; ++ activity_led[1] = 0; ++ activity_led[2] = 0; ++ activity_led[3] = 0; ++ count = 0; ++ ramp1 = 0; ++ ramp2 = 0; ++ state = FULLY_ON__ACTIVITY; ++ /* Fall through */ ++ case FULLY_ON__ACTIVITY: ++ if (next_state != FULLY_ON__ENTRY) { ++ state = get_next_state_from_fully_on(); ++ break; ++ } ++ ++ if (--count > 0) ++ break; ++ count = RW_SPEED; ++ handle_inner_ring(); ++ if (active_count) { ++ j = active_tail = ++ ((active_tail > ++ 0) ? (active_tail - 1) : (NUM_ACTIVITY_LEDS - 1) ++ ); ++ k = NUM_ACTIVITY_LEDS; ++ while (k--) { ++ activity_led[j] = activity_pattern[k]; ++ j = ((j > 0) ? (j - 1) : (NUM_ACTIVITY_LEDS - 1)); ++ } ++ ramp1 = 0; ++ ramp2 = 0; ++ } ++ if (active_count == 0) { ++ count = RW_SPEED; ++ state = FULLY_ON__IDLE_HOLD; ++ } ++ active_count = 0; ++ break; ++ case FULLY_ON__IDLE_HOLD: ++ if (--count > 0) ++ break; ++ count = 0; ++ state = FULLY_ON__RAMP_DOWN; ++ break; ++ case FULLY_ON__RAMP_DOWN: ++ if (--count > 0) ++ break; ++ count = POWER_SPEED; ++ --ramp2; ++ if ((--ramp1 <= -STEP_RESOLUTION) || active_count) { ++ display_current_fuel_gauge(); ++ ramp1 = -STEP_RESOLUTION; ++ ramp2 = -STEP_RESOLUTION; ++ state = FULLY_ON__RAMP_UP; ++ } ++ break; ++ case STANDBY__ENTRY: ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ ramp1 = -STEP_RESOLUTION; ++ ramp2 = -STEP_RESOLUTION; ++ count = HOLD_BREATH; ++ state = STANDBY__DARK; ++ display_current_fuel_gauge(); ++ /* Fall through */ ++ case STANDBY__DARK: ++ if (next_state != STANDBY__ENTRY) { ++ state = next_state; ++ break; ++ } ++ ++ if (--count > 0) ++ break; ++ state = STANDBY__RAMP_UP; ++ break; ++ case STANDBY__RAMP_UP: ++ ramp2++; ++ ramp1++; ++ if (ramp1 < SLEEP_HI) ++ break; ++ state = STANDBY__RAMP_DOWN; ++ break; ++ case STANDBY__RAMP_DOWN: ++ ramp2--; ++ if (ramp1-- > -STEP_RESOLUTION) ++ break; ++ state = STANDBY__ENTRY; ++ break; ++ case POWER_OFF__ENTRY: ++ display_inner_ring(0x00); ++ activity_led[0] = 0; ++ activity_led[1] = 0; ++ activity_led[2] = 0; ++ activity_led[3] = 0; ++ ramp1 = 0; ++ ramp2 = 0; ++ state = POWER_OFF__DARK; ++ /* Fall through */ ++ case POWER_OFF__DARK: ++ if (next_state != POWER_OFF__ENTRY) { ++ state = next_state; ++ break; ++ } ++ break; ++ case DEGRADED__ENTRY: ++ display_inner_ring(get_inner_ring_bits(BIT_MASK_FUEL_GAUGE)); ++ ramp1 = 0; ++ ramp2 = 0; ++ activity_led[0] = 0; ++ activity_led[1] = 0; ++ activity_led[2] = 0; ++ activity_led[3] = 0; ++ count = BLINK_SPEED; ++ state = DEGRADED__BLINK1; ++ /* Fall through */ ++ case DEGRADED__BLINK1: ++ if (next_state != DEGRADED__ENTRY) { ++ display_inner_ring(0); ++ state = TRANS__ENTRY; ++ break; ++ } ++ ++ if (--count > 0) ++ break; ++ display_inner_ring(0); ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ count = BLINK_SPEED; ++ state = DEGRADED__BLINK2; ++ break; ++ case DEGRADED__BLINK2: ++ if (--count > 0) ++ break; ++ state = DEGRADED__ENTRY; ++ break; ++ case OVERTEMP__ENTRY: ++ display_inner_ring(0); ++ ramp1 = 0; ++ ramp2 = 0; ++ activity_led[0] = 0; ++ activity_led[1] = 0; ++ activity_led[2] = 0; ++ activity_led[3] = 0; ++ count = BLINK_SPEED; ++ state = OVERTEMP__BLINK1; ++ /* Fall through */ ++ case OVERTEMP__BLINK1: ++ if (next_state != OVERTEMP__ENTRY) { ++ display_inner_ring(0); ++ state = TRANS__ENTRY; ++ break; ++ } ++ ++ if (--count > 0) ++ break; ++ display_inner_ring(get_inner_ring_bits(BIT_MASK_FUEL_GAUGE)); ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ count = BLINK_SPEED; ++ state = OVERTEMP__BLINK2; ++ break; ++ case OVERTEMP__BLINK2: ++ if (--count > 0) ++ break; ++ state = OVERTEMP__ENTRY; ++ break; ++ case TRANS__ENTRY: ++ activity_led[0] = LED100; ++ activity_led[1] = LED100; ++ activity_led[2] = LED100; ++ activity_led[3] = LED100; ++ ramp1 = SLEEP_LO; ++ ramp2 = SLEEP_HI; ++ state = TRANS__1_UP; ++ /* Fall through */ ++ case TRANS__1_UP: ++ case TRANS__2_UP: ++ case TRANS__3_UP: ++ case TRANS__4_UP: ++ ramp2 -= TRANS_STEP; ++ ramp1 += TRANS_STEP; ++ if ((ramp1 - TRANS_STEP) < SLEEP_HI) ++ break; ++ state++; ++ break; ++ case TRANS__4_DN: ++ if (ramp1 <= -STEP_RESOLUTION) { ++ if (next_state == TRANS__ENTRY) { ++ /* ++ * If no one told us where to go then just go to FullyOn, but ++ * don't go through the POR hold period because that makes ++ * the next transition display for the next button press wait ++ * too long. ++ * ++ * Note, that next_state needs to be set to FULLY_ON__ENTRY ++ * because it is used for the test whether or not to leave ++ * the FullyOn state even though we are entering FullyOn ++ * through the re-entry path. ++ */ ++ next_state = FULLY_ON__ENTRY; ++ state = FULLY_ON__RE_ENTRY; ++ } else { ++ state = next_state; ++ } ++ break; ++ } ++ ramp2 -= TRANS_STEP; ++ /* Fall through */ ++ case TRANS__1_DN: ++ case TRANS__2_DN: ++ case TRANS__3_DN: ++ ramp2 += TRANS_STEP; ++ ramp1 -= TRANS_STEP; ++ if ((ramp1 + TRANS_STEP) > -STEP_RESOLUTION) ++ break; ++ ramp1 = SLEEP_LO; ++ ramp2 = SLEEP_HI; ++ state++; ++ break; ++ default: ++ if (!been_there_done_that) { ++ printk(KERN_ERR "Invalid LED behavior state\n"); ++ been_there_done_that = 1; ++ return; ++ } ++ } ++ ++ /* Set the activity brightness according to value and ramp */ ++ set_led(LED_MASK_ACT12, activity_led[0] + ramp1); ++ set_led(LED_MASK_ACT9, activity_led[1] + ramp2); ++ set_led(LED_MASK_ACT6, activity_led[2] + ramp1); ++ set_led(LED_MASK_ACT3, activity_led[3] + ramp2); ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_power */ ++/* */ ++/* PURPOSE: */ ++/* Set the "power" LED to the requested behavior */ ++/***************************************************************************/ ++static void wdc_leds_set_power ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ if (value >= 255) { ++ next_state = FULLY_ON__ENTRY; ++ } else if (value > 0) { ++ next_state = STANDBY__ENTRY; ++ } else { ++ next_state = POWER_OFF__ENTRY; ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_activity */ ++/* */ ++/* PURPOSE: */ ++/* Trigger activity display behavior */ ++/***************************************************************************/ ++static void wdc_leds_set_activity ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ if (!ignore_activity && (value > 0)) { ++ active_count++; ++ } ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_ignore_activity */ ++/* */ ++/* PURPOSE: */ ++/* Set the "ignore activity" setting */ ++/***************************************************************************/ ++static void wdc_leds_set_ignore_activity ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ ignore_activity = value; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_transition */ ++/* */ ++/* PURPOSE: */ ++/* Trigger "transition" display behavior */ ++/***************************************************************************/ ++static void wdc_leds_set_transition ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ next_state = ((value > 0) ? TRANS__ENTRY : FULLY_ON__ENTRY); ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_fuel_gauge */ ++/* */ ++/* PURPOSE: */ ++/* Set the fuel gauge to the requested value (treated as a percentage) */ ++/***************************************************************************/ ++static void wdc_leds_set_fuel_gauge ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ fuel_gauge_bits = get_inner_ring_bits(get_percentage_pattern(value)); ++ need_to_display_current_fuel_gauge = 1; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_fg_bitmap */ ++/* */ ++/* PURPOSE: */ ++/* Set the fuel gauge to the requested value (treated as a bitmap) */ ++/***************************************************************************/ ++static void wdc_leds_set_fg_bitmap ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ fuel_gauge_bits = get_inner_ring_bits((u16) value); ++ need_to_display_current_fuel_gauge = 1; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_rebuilding */ ++/* */ ++/* PURPOSE: */ ++/* Set the rebuilding behavior (value = % complete, 0 = not rebuilding) */ ++/***************************************************************************/ ++static void wdc_leds_set_rebuilding ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ rebuild_percentage = value; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_degraded */ ++/* */ ++/* PURPOSE: */ ++/* Set the degraded mode display behavior */ ++/***************************************************************************/ ++static void wdc_leds_set_degraded ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ next_state = ((value > 0) ? DEGRADED__ENTRY : FULLY_ON__ENTRY); ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_set_over_temp */ ++/* */ ++/* PURPOSE: */ ++/* Set the over temperature mode display behavior */ ++/***************************************************************************/ ++static void wdc_leds_set_over_temp ++ (struct led_classdev *led_cdev, enum led_brightness value) { ++ next_state = ((value > 0) ? OVERTEMP__ENTRY : FULLY_ON__ENTRY); ++} ++ ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_power */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "power" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_power = { ++ .name = "wdc-leds:power",.brightness_set = wdc_leds_set_power, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_activity */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "activity" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_activity = { ++ .name = "wdc-leds:activity",.brightness_set = ++ wdc_leds_set_activity,.default_trigger = "sata-disk" ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_ignore_activity */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "ignore-activity" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_ignore_activity = { ++ .name = "wdc-leds:ignore-act",.brightness_set = ++ wdc_leds_set_ignore_activity, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_transition */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "transition" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_transition = { ++ .name = "wdc-leds:transition",.brightness_set = ++ wdc_leds_set_transition, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_fuel_gauge */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "fuel-gauge" LEDs (brightness = % full) */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_fuel_gauge = { ++ .name = "wdc-leds:fuel-gauge",.brightness_set = ++ wdc_leds_set_fuel_gauge, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_fg_bitmap */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "fuel-gauge" LEDs (brightness = bitmap) */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_fg_bitmap = { ++ .name = "wdc-leds:fg-bitmap",.brightness_set = wdc_leds_set_fg_bitmap, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_rebuilding */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds RAID1 "rebuilding" mode pseudo-LED */ ++/* (brightness = % complete) */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_rebuilding = { ++ .name = "wdc-leds:rebuilding",.brightness_set = ++ wdc_leds_set_rebuilding, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_degraded */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "degraded" mode pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_degraded = { ++ .name = "wdc-leds:degraded",.brightness_set = wdc_leds_set_degraded, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_over_temp */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds "over-temp" pseudo-LED */ ++/***************************************************************************/ ++static struct led_classdev wdc_leds_over_temp = { ++ .name = "wdc-leds:over-temp",.brightness_set = wdc_leds_set_over_temp, ++}; ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_classes[] */ ++/* */ ++/* PURPOSE: */ ++/* Array of LED classes to create/destroy */ ++/***************************************************************************/ ++static struct led_classdev *wdc_led_classes[] = { ++ &wdc_leds_power, ++ &wdc_leds_activity, ++ &wdc_leds_ignore_activity, ++ &wdc_leds_transition, ++ &wdc_leds_fuel_gauge, ++ &wdc_leds_fg_bitmap, ++ &wdc_leds_rebuilding, ++ &wdc_leds_degraded, ++ &wdc_leds_over_temp ++}; ++ ++#ifdef DEBUG ++static ssize_t show_registers (struct device *dev, struct device_attribute *attr, char *buf) ++{ ++ char * out = buf; ++ u32 clock_data = readl(PWM_CLOCK_REGISTER); ++ u32 data_ptr = PWM_CLOCK_REGISTER; ++ u8 no_pwms = (clock_data >> 16); ++ u8 i; ++ /* report hardware status here */ ++ out += sprintf(buf,"PWM drive registers\n"); ++ out += sprintf(out, "clock register:0x%08x @ 0x%08x\n", clock_data, data_ptr); ++ ++ for (i = 0; i < no_pwms; ++i) ++ { ++ data_ptr=(u32)((u32 *)PWM_BASE+i); ++ out+= sprintf(out,"%d:%d @ 0x%08x\n", i, (u8)readl(data_ptr),data_ptr); ++ } ++ ++ return out - buf; ++} ++ ++/* create a register 'file' to enbale reading back the pwm drive register status */ ++static DEVICE_ATTR (registers, S_IRUGO, show_registers, NULL); ++ ++static int create_debug_files(struct platform_device *pdev) ++{ ++ struct device *dev = &pdev->dev; ++ return device_create_file(dev, &dev_attr_registers); ++} ++ ++static void remove_debug_files(struct platform_device *pdev) ++{ ++ struct device *dev = &pdev->dev; ++ device_remove_file(dev, &dev_attr_registers); ++} ++#endif ++ ++ ++#ifdef CONFIG_PM ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_suspend */ ++/* */ ++/* PURPOSE: */ ++/* Suspend all LED class devices created by this driver */ ++/***************************************************************************/ ++static int wdc_leds_suspend(struct platform_device *pdev, ++ pm_message_t state) ++{ ++ int n = leds_created; ++ while (n > 0) { ++ if (--n < ARRAY_SIZE(wdc_led_classes)) { ++ led_classdev_suspend(wdc_led_classes[n]); ++ } ++ } ++ ++return 0} ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_resume */ ++/* */ ++/* PURPOSE: */ ++/* Wake up all LED class devices created by this driver */ ++/***************************************************************************/ ++static int wdc_leds_resume(struct platform_device *pdev, ++ pm_message_t state) ++{ ++ int n = leds_created; ++ while (n > 0) { ++ if (--n < ARRAY_SIZE(wdc_led_classes)) { ++ led_classdev_resume(wdc_led_classes[n]); ++ } ++ } ++ ++return 0} ++#endif /* CONFIG_PM */ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_probe */ ++/* */ ++/* PURPOSE: */ ++/* Perform any necessary probing and initial setup for wdc-leds device */ ++/***************************************************************************/ ++static int wdc_leds_probe(struct platform_device *pdev) ++{ ++ int rc; ++ int timer_changed = 0; ++ int interrupt_allocated = 0; ++ leds_created = 0; ++ do { ++ /* Enable LED output drivers and disable other uses */ ++ CLEAR(SYS_CTRL_GPIO_PRIMSEL_CTRL_0, LED_MASK_GPIO_A); ++ CLEAR(SYS_CTRL_GPIO_SECSEL_CTRL_0, LED_MASK_GPIO_A); ++ CLEAR(SYS_CTRL_GPIO_TERTSEL_CTRL_0, LED_MASK_GPIO_A); ++ ++ CLEAR(SYS_CTRL_GPIO_PRIMSEL_CTRL_1, LED_MASK_GPIO_B); ++ CLEAR(SYS_CTRL_GPIO_SECSEL_CTRL_1, LED_MASK_GPIO_B); ++ CLEAR(SYS_CTRL_GPIO_TERTSEL_CTRL_1, LED_MASK_GPIO_B); ++ /* Turn off all the LEDs */ ++ if (negative_led_logic) { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_SET); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_SET); ++ } else { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_CLEAR); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_CLEAR); ++ } ++ ++ /* bring PWM module out of reset and enable clock */ ++ writel((1<<SYS_CTRL_RSTEN_MISC_BIT), SYS_CTRL_RSTEN_CLR_CTRL); ++ //writel(PWM_CLOCK, SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* enable PWM clock */ ++ writel(PWM_PRESCALE, PWM_CLOCK_REGISTER); ++ ++ /* Initialize frame buffer to everything off */ ++ set_led(LED_MASK_FUEL_GAUGE | LED_MASK_ACTIVITY, 0); ++ /* Enable output to the LEDs */ ++ writel(LED_MASK_GPIO_A, SYS_CTRL_GPIO_PWMSEL_CTRL_0); ++ writel(LED_MASK_GPIO_B, SYS_CTRL_GPIO_PWMSEL_CTRL_1); ++ /* Initialize the LED behavior state machine */ ++ wdc_leds_behavior_init(); ++ /* Save Timer2 state for restoring later */ ++ timer_load = ox_readl(TIMER2_LOAD); ++ timer_control = ox_readl(TIMER2_CONTROL); ++ ox_writel(0, TIMER2_CONTROL); ++ timer_changed = 1; ++ /* Setup Timer2 for LED control */ ++ rc = request_irq ++ (TIMER_2_INTERRUPT, ++ wdc_leds_interrupt, 0, "led_pwm", 0); ++ if (rc < 0) { ++ printk(KERN_ERR "failed to get IRQ\n"); ++ break; ++ } ++ ++ interrupt_allocated = 1; ++ ox_writel(FAST_TIMER_INT, TIMER2_LOAD); ++ ox_writel(PERIODIC_INTERRUPT, TIMER2_CONTROL); ++ /* Register each LED class device */ ++ while (leds_created < ARRAY_SIZE(wdc_led_classes)) { ++ rc = led_classdev_register(&pdev->dev, ++ wdc_led_classes[leds_created]); ++ if (rc < 0) { ++ printk(KERN_ERR "failed to register led class \"%s\"\n", ++ wdc_led_classes[leds_created]->name); ++ break; ++ } ++ ++ ++leds_created; ++ } ++ } ++ while (0); ++ /* If we failed then perform any needed clean up */ ++ if (rc < 0) { ++ /* Unregister any classes we registered */ ++ while (leds_created > 0) { ++ if (--leds_created < ARRAY_SIZE(wdc_led_classes)) { ++ led_classdev_unregister(wdc_led_classes[leds_created]); ++ } ++ } ++ ++ /* Free the interrupt if we allocated one */ ++ if (interrupt_allocated) { ++ free_irq(TIMER_2_INTERRUPT, 0); ++ } ++ ++ /* Restore Timer2 if we changed it */ ++ if (timer_changed) { ++ ox_writel(timer_load, TIMER2_LOAD); ++ ox_writel(timer_control, TIMER2_CONTROL); ++ } ++ } ++#ifdef DEBUG ++ create_debug_files(pdev); ++#endif ++ return rc; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_remove */ ++/* */ ++/* PURPOSE: */ ++/* Perform steps to remove the wdc-leds device */ ++/***************************************************************************/ ++static int wdc_leds_remove(struct platform_device *pdev) ++{ ++ while (leds_created > 0) { ++ if (--leds_created < ARRAY_SIZE(wdc_led_classes)) { ++ led_classdev_unregister(wdc_led_classes[leds_created]); ++ } ++ } ++ ++ ox_writel(0, TIMER2_CONTROL); ++ free_irq(TIMER_2_INTERRUPT, 0); ++ ox_writel(timer_load, TIMER2_LOAD); ++ ox_writel(timer_control, TIMER2_CONTROL); ++ /* Turn off all the LEDs */ ++ if (negative_led_logic) { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_SET); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_SET); ++ } else { ++ writel(LED_MASK_GPIO_A, GPIO_A_OUTPUT_CLEAR); ++ writel(LED_MASK_GPIO_B, GPIO_B_OUTPUT_CLEAR); ++ } ++ /* put PWM module back into reset and disable clock */ ++ writel((1<<SYS_CTRL_RSTEN_MISC_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ // writel(PWM_CLOCK, SYS_CTRL_CKEN_CLR_CTRL); ++#ifdef DEBUG ++ remove_debug_files(pdev); ++#endif ++ return 0; ++} ++ ++ ++/***************************************************************************/ ++/* DATA STRUCTURE: wdc_leds_driver */ ++/* */ ++/* PURPOSE: */ ++/* Describe the wdc-leds platform device driver */ ++/***************************************************************************/ ++static struct platform_driver wdc_leds_driver = { ++ .probe = wdc_leds_probe,.remove = wdc_leds_remove, ++#ifdef CONFIG_PM ++ .suspend = wdc_leds_suspend,.resume = wdc_leds_resume, ++#endif /* CONFIG_PM */ ++ .driver = { ++ .name = "wdc-leds",}, ++}; ++ ++/* Pointer to device returned by platform_device_register_simple */ ++static struct platform_device *wdc_leds; ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_init */ ++/* */ ++/* PURPOSE: */ ++/* Perform module initialization */ ++/***************************************************************************/ ++static int __init wdc_leds_init(void) ++{ ++ int ret; ++ printk ++ (KERN_INFO "wdc-leds: SLOW_TPS=%d\n", ++ SLOW_TPS); ++ ret = platform_driver_register(&wdc_leds_driver); ++ if (!ret) { ++ wdc_leds = ++ platform_device_register_simple("wdc-leds", -1, NULL, 0); ++ } ++ ++ return ret; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_leds_exit */ ++/* */ ++/* PURPOSE: */ ++/* Perform module unloading and cleanup */ ++/***************************************************************************/ ++static void __exit wdc_leds_exit(void) ++{ ++ if (wdc_leds) { ++ platform_device_unregister(wdc_leds); ++ } ++ platform_driver_unregister(&wdc_leds_driver); ++} ++ ++ ++module_init(wdc_leds_init); ++module_exit(wdc_leds_exit); ++MODULE_AUTHOR("Michael Webster"); ++MODULE_DESCRIPTION("WDC 2NC LEDs"); ++MODULE_LICENSE("GPL"); ++/******************************* End of File *********************************/ +diff -Nurd linux-2.6.24/arch/arm/mach-hipox/wdc-ledtrig-sata.c linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-ledtrig-sata.c +--- linux-2.6.24/arch/arm/mach-hipox/wdc-ledtrig-sata.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-hipox/wdc-ledtrig-sata.c 2008-06-11 17:47:55.000000000 +0200 +@@ -0,0 +1,78 @@ ++/* ++ * linux/arch/arm/mach-hipox/wdc-ledtrig-sata.c ++ * ++ * Copyright (C) 2006 Western Digital ++ * ++ * 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/kernel.h> ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/leds.h> ++ ++ ++DEFINE_LED_TRIGGER(wdc_ledtrig_sata); ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_ledtrig_sata_activity */ ++/* */ ++/* PURPOSE: */ ++/* Entry point to trip the trigger (called from within SATA driver) */ ++/***************************************************************************/ ++void wdc_ledtrig_sata_activity(void) ++{ ++ led_trigger_event(wdc_ledtrig_sata, LED_FULL); ++} ++EXPORT_SYMBOL(wdc_ledtrig_sata_activity); ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_ledtrig_sata_init */ ++/* */ ++/* PURPOSE: */ ++/* Perform module initialization */ ++/***************************************************************************/ ++static int __init wdc_ledtrig_sata_init(void) ++{ ++ printk("<1>Hello, LED trigger\n"); ++ ++ led_trigger_register_simple("sata-disk", &wdc_ledtrig_sata); ++ return 0; ++} ++ ++ ++/***************************************************************************/ ++/* FUNCTION: wdc_ledtrig_sata_exit */ ++/* */ ++/* PURPOSE: */ ++/* Perform module unloading and cleanup */ ++/***************************************************************************/ ++static void __exit wdc_ledtrig_sata_exit(void) ++{ ++ led_trigger_unregister_simple(wdc_ledtrig_sata); ++ ++ printk("<1>Goodbye LED trigger\n"); ++} ++ ++ ++module_init(wdc_ledtrig_sata_init); ++module_exit(wdc_ledtrig_sata_exit); ++ ++MODULE_AUTHOR("Michael Webster"); ++MODULE_DESCRIPTION("WDC 2NC LED trigger"); ++MODULE_LICENSE("GPL"); ++ ++/******************************* End of File *********************************/ +diff -Nurd linux-2.6.24/arch/arm/mach-pxa/clock.c linux-2.6.24-oxe810/arch/arm/mach-pxa/clock.c +--- linux-2.6.24/arch/arm/mach-pxa/clock.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mach-pxa/clock.c 2008-06-11 17:47:55.000000000 +0200 +@@ -23,18 +23,27 @@ + static DEFINE_MUTEX(clocks_mutex); + static DEFINE_SPINLOCK(clocks_lock); + ++static struct clk *clk_lookup(struct device *dev, const char *id) ++{ ++ struct clk *p; ++ ++ list_for_each_entry(p, &clocks, node) ++ if (strcmp(id, p->name) == 0 && p->dev == dev) ++ return p; ++ ++ return NULL; ++} ++ + struct clk *clk_get(struct device *dev, const char *id) + { + struct clk *p, *clk = ERR_PTR(-ENOENT); + + mutex_lock(&clocks_mutex); +- list_for_each_entry(p, &clocks, node) { +- if (strcmp(id, p->name) == 0 && +- (p->dev == NULL || p->dev == dev)) { +- clk = p; +- break; +- } +- } ++ p = clk_lookup(dev, id); ++ if (!p) ++ p = clk_lookup(NULL, id); ++ if (p) ++ clk = p; + mutex_unlock(&clocks_mutex); + + return clk; +diff -Nurd linux-2.6.24/arch/arm/mm/Kconfig linux-2.6.24-oxe810/arch/arm/mm/Kconfig +--- linux-2.6.24/arch/arm/mm/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mm/Kconfig 2008-06-11 17:47:57.000000000 +0200 +@@ -171,8 +171,8 @@ + # ARM926T + config CPU_ARM926T + bool "Support ARM926T processor" +- depends on ARCH_INTEGRATOR || ARCH_VERSATILE_PB || MACH_VERSATILE_AB || ARCH_OMAP730 || ARCH_OMAP16XX || MACH_REALVIEW_EB || ARCH_PNX4008 || ARCH_NETX || CPU_S3C2412 || ARCH_AT91SAM9260 || ARCH_AT91SAM9261 || ARCH_AT91SAM9263 || ARCH_AT91SAM9RL || ARCH_NS9XXX || ARCH_DAVINCI +- default y if ARCH_VERSATILE_PB || MACH_VERSATILE_AB || ARCH_OMAP730 || ARCH_OMAP16XX || ARCH_PNX4008 || ARCH_NETX || CPU_S3C2412 || ARCH_AT91SAM9260 || ARCH_AT91SAM9261 || ARCH_AT91SAM9263 || ARCH_AT91SAM9RL || ARCH_NS9XXX || ARCH_DAVINCI ++ depends on ARCH_INTEGRATOR || ARCH_VERSATILE_PB || MACH_VERSATILE_AB || ARCH_OMAP730 || ARCH_OMAP16XX || MACH_REALVIEW_EB || ARCH_PNX4008 || ARCH_NETX || CPU_S3C2412 || ARCH_AT91SAM9260 || ARCH_AT91SAM9261 || ARCH_AT91SAM9263 || ARCH_AT91SAM9RL || ARCH_NS9XXX || ARCH_DAVINCI || ARCH_HIPOX ++ default y if ARCH_VERSATILE_PB || MACH_VERSATILE_AB || ARCH_OMAP730 || ARCH_OMAP16XX || ARCH_PNX4008 || ARCH_NETX || CPU_S3C2412 || ARCH_AT91SAM9260 || ARCH_AT91SAM9261 || ARCH_AT91SAM9263 || ARCH_AT91SAM9RL || ARCH_NS9XXX || ARCH_DAVINCI || ARCH_HIPOX + select CPU_32v5 + select CPU_ABRT_EV5TJ + select CPU_CACHE_VIVT +diff -Nurd linux-2.6.24/arch/arm/mm/init.c linux-2.6.24-oxe810/arch/arm/mm/init.c +--- linux-2.6.24/arch/arm/mm/init.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mm/init.c 2008-06-11 17:47:57.000000000 +0200 +@@ -173,9 +173,19 @@ + #ifdef CONFIG_MMU + struct map_desc map; + ++#ifdef CONFIG_HIPOX_MAP_SRAM ++ /* ++ * Assume only a single bank and stop the overwrite of the first section ++ * descriptor ++ */ ++ map.pfn = __phys_to_pfn(bank->start + 1024*1024); ++ map.virtual = __phys_to_virt(bank->start) + 1024*1024; ++ map.length = bank->size - 1024*1024; ++#else // CONFIG_HIPOX_MAP_SRAM + map.pfn = __phys_to_pfn(bank->start); + map.virtual = __phys_to_virt(bank->start); + map.length = bank->size; ++#endif // CONFIG_HIPOX_MAP_SRAM + map.type = MT_MEMORY; + + create_mapping(&map); +diff -Nurd linux-2.6.24/arch/arm/mm/mmu.c linux-2.6.24-oxe810/arch/arm/mm/mmu.c +--- linux-2.6.24/arch/arm/mm/mmu.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mm/mmu.c 2008-06-11 17:47:57.000000000 +0200 +@@ -617,6 +617,15 @@ + reserve_bootmem_node(pgdat, __pa(swapper_pg_dir), + PTRS_PER_PGD * sizeof(pgd_t)); + ++#ifdef CONFIG_HIPOX_MAP_SRAM ++ /* ++ * Reserve the page table describing the first MB of address space in 4KB ++ * pages so we can map SRAM over part of it. This didn't work for some reason ++ * so instead reserve first 0x4000 as some other archs do ++ */ ++ res_size = __pa(swapper_pg_dir) - PHYS_OFFSET; ++#endif // CONFIG_HIPOX_MAP_SRAM ++ + /* + * Hmm... This should go elsewhere, but we really really need to + * stop things allocating the low memory; ideally we need a better +diff -Nurd linux-2.6.24/arch/arm/mm/proc-arm926.S linux-2.6.24-oxe810/arch/arm/mm/proc-arm926.S +--- linux-2.6.24/arch/arm/mm/proc-arm926.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/arm/mm/proc-arm926.S 2008-06-11 17:47:57.000000000 +0200 +@@ -245,6 +245,7 @@ + * + * (same as v4wb) + */ ++.section ".text.arm926_dma_clean_range" + ENTRY(arm926_dma_inv_range) + #ifndef CONFIG_CPU_DCACHE_WRITETHROUGH + tst r0, #CACHE_DLINESIZE - 1 +@@ -259,6 +260,7 @@ + blo 1b + mcr p15, 0, r0, c7, c10, 4 @ drain WB + mov pc, lr ++.section ".text.other" + + /* + * dma_clean_range(start, end) +@@ -270,6 +272,7 @@ + * + * (same as v4wb) + */ ++.section ".text.arm926_dma_clean_range" + ENTRY(arm926_dma_clean_range) + #ifndef CONFIG_CPU_DCACHE_WRITETHROUGH + bic r0, r0, #CACHE_DLINESIZE - 1 +@@ -280,6 +283,7 @@ + #endif + mcr p15, 0, r0, c7, c10, 4 @ drain WB + mov pc, lr ++.section ".text.other" + + /* + * dma_flush_range(start, end) +@@ -289,6 +293,7 @@ + * - start - virtual start address + * - end - virtual end address + */ ++.section ".text.arm926_dma_flush_range" + ENTRY(arm926_dma_flush_range) + bic r0, r0, #CACHE_DLINESIZE - 1 + 1: +@@ -302,6 +307,7 @@ + blo 1b + mcr p15, 0, r0, c7, c10, 4 @ drain WB + mov pc, lr ++.section ".text.other" + + ENTRY(arm926_cache_fns) + .long arm926_flush_kern_cache_all +diff -Nurd linux-2.6.24/arch/mips/kernel/i8259.c linux-2.6.24-oxe810/arch/mips/kernel/i8259.c +--- linux-2.6.24/arch/mips/kernel/i8259.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/mips/kernel/i8259.c 2008-06-11 17:48:37.000000000 +0200 +@@ -338,8 +338,10 @@ + + init_8259A(0); + +- for (i = I8259A_IRQ_BASE; i < I8259A_IRQ_BASE + 16; i++) ++ for (i = I8259A_IRQ_BASE; i < I8259A_IRQ_BASE + 16; i++) { + set_irq_chip_and_handler(i, &i8259A_chip, handle_level_irq); ++ set_irq_probe(i); ++ } + + setup_irq(I8259A_IRQ_BASE + PIC_CASCADE_IR, &irq2); + } +diff -Nurd linux-2.6.24/arch/mips/kernel/irq.c linux-2.6.24-oxe810/arch/mips/kernel/irq.c +--- linux-2.6.24/arch/mips/kernel/irq.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/mips/kernel/irq.c 2008-06-11 17:48:37.000000000 +0200 +@@ -145,6 +145,11 @@ + + void __init init_IRQ(void) + { ++ int i; ++ ++ for (i = 0; i < NR_IRQS; i++) ++ set_irq_noprobe(i); ++ + arch_init_irq(); + + #ifdef CONFIG_KGDB +diff -Nurd linux-2.6.24/arch/powerpc/platforms/chrp/pci.c linux-2.6.24-oxe810/arch/powerpc/platforms/chrp/pci.c +--- linux-2.6.24/arch/powerpc/platforms/chrp/pci.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/powerpc/platforms/chrp/pci.c 2008-06-11 17:47:35.000000000 +0200 +@@ -354,7 +354,7 @@ + * mode as well. The same fixup must be done to the class-code property in + * the IDE node /pci@80000000/ide@C,1 + */ +-static void __devinit chrp_pci_fixup_vt8231_ata(struct pci_dev *viaide) ++static void chrp_pci_fixup_vt8231_ata(struct pci_dev *viaide) + { + u8 progif; + struct pci_dev *viaisa; +@@ -375,4 +375,4 @@ + + pci_dev_put(viaisa); + } +-DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, chrp_pci_fixup_vt8231_ata); ++DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, chrp_pci_fixup_vt8231_ata); +diff -Nurd linux-2.6.24/arch/powerpc/platforms/powermac/feature.c linux-2.6.24-oxe810/arch/powerpc/platforms/powermac/feature.c +--- linux-2.6.24/arch/powerpc/platforms/powermac/feature.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/powerpc/platforms/powermac/feature.c 2008-06-11 17:47:38.000000000 +0200 +@@ -2565,6 +2565,8 @@ + + /* Locate core99 Uni-N */ + uninorth_node = of_find_node_by_name(NULL, "uni-n"); ++ uninorth_maj = 1; ++ + /* Locate G5 u3 */ + if (uninorth_node == NULL) { + uninorth_node = of_find_node_by_name(NULL, "u3"); +@@ -2575,8 +2577,10 @@ + uninorth_node = of_find_node_by_name(NULL, "u4"); + uninorth_maj = 4; + } +- if (uninorth_node == NULL) ++ if (uninorth_node == NULL) { ++ uninorth_maj = 0; + return; ++ } + + addrp = of_get_property(uninorth_node, "reg", NULL); + if (addrp == NULL) +@@ -3029,3 +3033,8 @@ + pmac_agp_resume(pmac_agp_bridge); + } + EXPORT_SYMBOL(pmac_resume_agp_for_card); ++ ++int pmac_get_uninorth_variant(void) ++{ ++ return uninorth_maj; ++} +diff -Nurd linux-2.6.24/arch/s390/lib/uaccess_pt.c linux-2.6.24-oxe810/arch/s390/lib/uaccess_pt.c +--- linux-2.6.24/arch/s390/lib/uaccess_pt.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/s390/lib/uaccess_pt.c 2008-06-11 17:48:25.000000000 +0200 +@@ -406,6 +406,8 @@ + { + int ret; + ++ if (!current->mm) ++ return -EFAULT; + spin_lock(¤t->mm->page_table_lock); + uaddr = (int __user *) __dat_user_addr((unsigned long) uaddr); + if (!uaddr) { +diff -Nurd linux-2.6.24/arch/s390/lib/uaccess_std.c linux-2.6.24-oxe810/arch/s390/lib/uaccess_std.c +--- linux-2.6.24/arch/s390/lib/uaccess_std.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/s390/lib/uaccess_std.c 2008-06-11 17:48:25.000000000 +0200 +@@ -293,10 +293,10 @@ + + asm volatile( + " sacf 256\n" +- " cs %1,%4,0(%5)\n" +- "0: lr %0,%1\n" +- "1: sacf 0\n" +- EX_TABLE(0b,1b) ++ "0: cs %1,%4,0(%5)\n" ++ "1: lr %0,%1\n" ++ "2: sacf 0\n" ++ EX_TABLE(0b,2b) EX_TABLE(1b,2b) + : "=d" (ret), "+d" (oldval), "=m" (*uaddr) + : "0" (-EFAULT), "d" (newval), "a" (uaddr), "m" (*uaddr) + : "cc", "memory" ); +diff -Nurd linux-2.6.24/arch/sparc/kernel/Makefile linux-2.6.24-oxe810/arch/sparc/kernel/Makefile +--- linux-2.6.24/arch/sparc/kernel/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc/kernel/Makefile 2008-06-11 17:48:46.000000000 +0200 +@@ -1,4 +1,4 @@ +-# $Id: Makefile,v 1.62 2000/12/15 00:41:17 davem Exp $ ++# + # Makefile for the linux kernel. + # + +@@ -12,7 +12,8 @@ + sys_sparc.o sunos_asm.o systbls.o \ + time.o windows.o cpu.o devices.o sclow.o \ + tadpole.o tick14.o ptrace.o sys_solaris.o \ +- unaligned.o muldiv.o semaphore.o prom.o of_device.o devres.o ++ unaligned.o una_asm.o muldiv.o semaphore.o \ ++ prom.o of_device.o devres.o + + devres-y = ../../../kernel/irq/devres.o + +diff -Nurd linux-2.6.24/arch/sparc/kernel/una_asm.S linux-2.6.24-oxe810/arch/sparc/kernel/una_asm.S +--- linux-2.6.24/arch/sparc/kernel/una_asm.S 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc/kernel/una_asm.S 2008-06-11 17:48:46.000000000 +0200 +@@ -0,0 +1,153 @@ ++/* una_asm.S: Kernel unaligned trap assembler helpers. ++ * ++ * Copyright (C) 1996,2005,2008 David S. Miller (davem@davemloft.net) ++ * Copyright (C) 1996,1997 Jakub Jelinek (jj@sunsite.mff.cuni.cz) ++ */ ++ ++#include <linux/errno.h> ++ ++ .text ++ ++retl_efault: ++ retl ++ mov -EFAULT, %o0 ++ ++ /* int __do_int_store(unsigned long *dst_addr, int size, ++ * unsigned long *src_val) ++ * ++ * %o0 = dest_addr ++ * %o1 = size ++ * %o2 = src_val ++ * ++ * Return '0' on success, -EFAULT on failure. ++ */ ++ .globl __do_int_store ++__do_int_store: ++ ld [%o2], %g1 ++ cmp %1, 2 ++ be 2f ++ cmp %1, 4 ++ be 1f ++ srl %g1, 24, %g2 ++ srl %g1, 16, %g7 ++4: stb %g2, [%o0] ++ srl %g1, 8, %g2 ++5: stb %g7, [%o0 + 1] ++ ld [%o2 + 4], %g7 ++6: stb %g2, [%o0 + 2] ++ srl %g7, 24, %g2 ++7: stb %g1, [%o0 + 3] ++ srl %g7, 16, %g1 ++8: stb %g2, [%o0 + 4] ++ srl %g7, 8, %g2 ++9: stb %g1, [%o0 + 5] ++10: stb %g2, [%o0 + 6] ++ b 0f ++11: stb %g7, [%o0 + 7] ++1: srl %g1, 16, %g7 ++12: stb %g2, [%o0] ++ srl %g1, 8, %g2 ++13: stb %g7, [%o0 + 1] ++14: stb %g2, [%o0 + 2] ++ b 0f ++15: stb %g1, [%o0 + 3] ++2: srl %g1, 8, %g2 ++16: stb %g2, [%o0] ++17: stb %g1, [%o0 + 1] ++0: retl ++ mov 0, %o0 ++ ++ .section __ex_table,#alloc ++ .word 4b, retl_efault ++ .word 5b, retl_efault ++ .word 6b, retl_efault ++ .word 7b, retl_efault ++ .word 8b, retl_efault ++ .word 9b, retl_efault ++ .word 10b, retl_efault ++ .word 11b, retl_efault ++ .word 12b, retl_efault ++ .word 13b, retl_efault ++ .word 14b, retl_efault ++ .word 15b, retl_efault ++ .word 16b, retl_efault ++ .word 17b, retl_efault ++ .previous ++ ++ /* int do_int_load(unsigned long *dest_reg, int size, ++ * unsigned long *saddr, int is_signed) ++ * ++ * %o0 = dest_reg ++ * %o1 = size ++ * %o2 = saddr ++ * %o3 = is_signed ++ * ++ * Return '0' on success, -EFAULT on failure. ++ */ ++ .globl do_int_load ++do_int_load: ++ cmp %o1, 8 ++ be 9f ++ cmp %o1, 4 ++ be 6f ++4: ldub [%o2], %g1 ++5: ldub [%o2 + 1], %g2 ++ sll %g1, 8, %g1 ++ tst %o3 ++ be 3f ++ or %g1, %g2, %g1 ++ sll %g1, 16, %g1 ++ sra %g1, 16, %g1 ++3: b 0f ++ st %g1, [%o0] ++6: ldub [%o2 + 1], %g2 ++ sll %g1, 24, %g1 ++7: ldub [%o2 + 2], %g7 ++ sll %g2, 16, %g2 ++8: ldub [%o2 + 3], %g3 ++ sll %g7, 8, %g7 ++ or %g3, %g2, %g3 ++ or %g7, %g3, %g7 ++ or %g1, %g7, %g1 ++ b 0f ++ st %g1, [%o0] ++9: ldub [%o2], %g1 ++10: ldub [%o2 + 1], %g2 ++ sll %g1, 24, %g1 ++11: ldub [%o2 + 2], %g7 ++ sll %g2, 16, %g2 ++12: ldub [%o2 + 3], %g3 ++ sll %g7, 8, %g7 ++ or %g1, %g2, %g1 ++ or %g7, %g3, %g7 ++ or %g1, %g7, %g7 ++13: ldub [%o2 + 4], %g1 ++ st %g7, [%o0] ++14: ldub [%o2 + 5], %g2 ++ sll %g1, 24, %g1 ++15: ldub [%o2 + 6], %g7 ++ sll %g2, 16, %g2 ++16: ldub [%o2 + 7], %g3 ++ sll %g7, 8, %g7 ++ or %g1, %g2, %g1 ++ or %g7, %g3, %g7 ++ or %g1, %g7, %g7 ++ st %g7, [%o0 + 4] ++0: retl ++ mov 0, %o0 ++ ++ .section __ex_table,#alloc ++ .word 4b, retl_efault ++ .word 5b, retl_efault ++ .word 6b, retl_efault ++ .word 7b, retl_efault ++ .word 8b, retl_efault ++ .word 9b, retl_efault ++ .word 10b, retl_efault ++ .word 11b, retl_efault ++ .word 12b, retl_efault ++ .word 13b, retl_efault ++ .word 14b, retl_efault ++ .word 15b, retl_efault ++ .word 16b, retl_efault ++ .previous +diff -Nurd linux-2.6.24/arch/sparc/kernel/unaligned.c linux-2.6.24-oxe810/arch/sparc/kernel/unaligned.c +--- linux-2.6.24/arch/sparc/kernel/unaligned.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc/kernel/unaligned.c 2008-06-11 17:48:46.000000000 +0200 +@@ -175,157 +175,31 @@ + panic(str); + } + +-#define do_integer_load(dest_reg, size, saddr, is_signed, errh) ({ \ +-__asm__ __volatile__ ( \ +- "cmp %1, 8\n\t" \ +- "be 9f\n\t" \ +- " cmp %1, 4\n\t" \ +- "be 6f\n" \ +-"4:\t" " ldub [%2], %%l1\n" \ +-"5:\t" "ldub [%2 + 1], %%l2\n\t" \ +- "sll %%l1, 8, %%l1\n\t" \ +- "tst %3\n\t" \ +- "be 3f\n\t" \ +- " add %%l1, %%l2, %%l1\n\t" \ +- "sll %%l1, 16, %%l1\n\t" \ +- "sra %%l1, 16, %%l1\n" \ +-"3:\t" "b 0f\n\t" \ +- " st %%l1, [%0]\n" \ +-"6:\t" "ldub [%2 + 1], %%l2\n\t" \ +- "sll %%l1, 24, %%l1\n" \ +-"7:\t" "ldub [%2 + 2], %%g7\n\t" \ +- "sll %%l2, 16, %%l2\n" \ +-"8:\t" "ldub [%2 + 3], %%g1\n\t" \ +- "sll %%g7, 8, %%g7\n\t" \ +- "or %%l1, %%l2, %%l1\n\t" \ +- "or %%g7, %%g1, %%g7\n\t" \ +- "or %%l1, %%g7, %%l1\n\t" \ +- "b 0f\n\t" \ +- " st %%l1, [%0]\n" \ +-"9:\t" "ldub [%2], %%l1\n" \ +-"10:\t" "ldub [%2 + 1], %%l2\n\t" \ +- "sll %%l1, 24, %%l1\n" \ +-"11:\t" "ldub [%2 + 2], %%g7\n\t" \ +- "sll %%l2, 16, %%l2\n" \ +-"12:\t" "ldub [%2 + 3], %%g1\n\t" \ +- "sll %%g7, 8, %%g7\n\t" \ +- "or %%l1, %%l2, %%l1\n\t" \ +- "or %%g7, %%g1, %%g7\n\t" \ +- "or %%l1, %%g7, %%g7\n" \ +-"13:\t" "ldub [%2 + 4], %%l1\n\t" \ +- "st %%g7, [%0]\n" \ +-"14:\t" "ldub [%2 + 5], %%l2\n\t" \ +- "sll %%l1, 24, %%l1\n" \ +-"15:\t" "ldub [%2 + 6], %%g7\n\t" \ +- "sll %%l2, 16, %%l2\n" \ +-"16:\t" "ldub [%2 + 7], %%g1\n\t" \ +- "sll %%g7, 8, %%g7\n\t" \ +- "or %%l1, %%l2, %%l1\n\t" \ +- "or %%g7, %%g1, %%g7\n\t" \ +- "or %%l1, %%g7, %%g7\n\t" \ +- "st %%g7, [%0 + 4]\n" \ +-"0:\n\n\t" \ +- ".section __ex_table,#alloc\n\t" \ +- ".word 4b, " #errh "\n\t" \ +- ".word 5b, " #errh "\n\t" \ +- ".word 6b, " #errh "\n\t" \ +- ".word 7b, " #errh "\n\t" \ +- ".word 8b, " #errh "\n\t" \ +- ".word 9b, " #errh "\n\t" \ +- ".word 10b, " #errh "\n\t" \ +- ".word 11b, " #errh "\n\t" \ +- ".word 12b, " #errh "\n\t" \ +- ".word 13b, " #errh "\n\t" \ +- ".word 14b, " #errh "\n\t" \ +- ".word 15b, " #errh "\n\t" \ +- ".word 16b, " #errh "\n\n\t" \ +- ".previous\n\t" \ +- : : "r" (dest_reg), "r" (size), "r" (saddr), "r" (is_signed) \ +- : "l1", "l2", "g7", "g1", "cc"); \ +-}) +- +-#define store_common(dst_addr, size, src_val, errh) ({ \ +-__asm__ __volatile__ ( \ +- "ld [%2], %%l1\n" \ +- "cmp %1, 2\n\t" \ +- "be 2f\n\t" \ +- " cmp %1, 4\n\t" \ +- "be 1f\n\t" \ +- " srl %%l1, 24, %%l2\n\t" \ +- "srl %%l1, 16, %%g7\n" \ +-"4:\t" "stb %%l2, [%0]\n\t" \ +- "srl %%l1, 8, %%l2\n" \ +-"5:\t" "stb %%g7, [%0 + 1]\n\t" \ +- "ld [%2 + 4], %%g7\n" \ +-"6:\t" "stb %%l2, [%0 + 2]\n\t" \ +- "srl %%g7, 24, %%l2\n" \ +-"7:\t" "stb %%l1, [%0 + 3]\n\t" \ +- "srl %%g7, 16, %%l1\n" \ +-"8:\t" "stb %%l2, [%0 + 4]\n\t" \ +- "srl %%g7, 8, %%l2\n" \ +-"9:\t" "stb %%l1, [%0 + 5]\n" \ +-"10:\t" "stb %%l2, [%0 + 6]\n\t" \ +- "b 0f\n" \ +-"11:\t" " stb %%g7, [%0 + 7]\n" \ +-"1:\t" "srl %%l1, 16, %%g7\n" \ +-"12:\t" "stb %%l2, [%0]\n\t" \ +- "srl %%l1, 8, %%l2\n" \ +-"13:\t" "stb %%g7, [%0 + 1]\n" \ +-"14:\t" "stb %%l2, [%0 + 2]\n\t" \ +- "b 0f\n" \ +-"15:\t" " stb %%l1, [%0 + 3]\n" \ +-"2:\t" "srl %%l1, 8, %%l2\n" \ +-"16:\t" "stb %%l2, [%0]\n" \ +-"17:\t" "stb %%l1, [%0 + 1]\n" \ +-"0:\n\n\t" \ +- ".section __ex_table,#alloc\n\t" \ +- ".word 4b, " #errh "\n\t" \ +- ".word 5b, " #errh "\n\t" \ +- ".word 6b, " #errh "\n\t" \ +- ".word 7b, " #errh "\n\t" \ +- ".word 8b, " #errh "\n\t" \ +- ".word 9b, " #errh "\n\t" \ +- ".word 10b, " #errh "\n\t" \ +- ".word 11b, " #errh "\n\t" \ +- ".word 12b, " #errh "\n\t" \ +- ".word 13b, " #errh "\n\t" \ +- ".word 14b, " #errh "\n\t" \ +- ".word 15b, " #errh "\n\t" \ +- ".word 16b, " #errh "\n\t" \ +- ".word 17b, " #errh "\n\n\t" \ +- ".previous\n\t" \ +- : : "r" (dst_addr), "r" (size), "r" (src_val) \ +- : "l1", "l2", "g7", "g1", "cc"); \ +-}) ++/* una_asm.S */ ++extern int do_int_load(unsigned long *dest_reg, int size, ++ unsigned long *saddr, int is_signed); ++extern int __do_int_store(unsigned long *dst_addr, int size, ++ unsigned long *src_val); + +-#define do_integer_store(reg_num, size, dst_addr, regs, errh) ({ \ +- unsigned long *src_val; \ +- static unsigned long zero[2] = { 0, }; \ +- \ +- if (reg_num) src_val = fetch_reg_addr(reg_num, regs); \ +- else { \ +- src_val = &zero[0]; \ +- if (size == 8) \ +- zero[1] = fetch_reg(1, regs); \ +- } \ +- store_common(dst_addr, size, src_val, errh); \ +-}) ++static int do_int_store(int reg_num, int size, unsigned long *dst_addr, ++ struct pt_regs *regs) ++{ ++ unsigned long zero[2] = { 0, 0 }; ++ unsigned long *src_val; ++ ++ if (reg_num) ++ src_val = fetch_reg_addr(reg_num, regs); ++ else { ++ src_val = &zero[0]; ++ if (size == 8) ++ zero[1] = fetch_reg(1, regs); ++ } ++ return __do_int_store(dst_addr, size, src_val); ++} + + extern void smp_capture(void); + extern void smp_release(void); + +-#define do_atomic(srcdest_reg, mem, errh) ({ \ +- unsigned long flags, tmp; \ +- \ +- smp_capture(); \ +- local_irq_save(flags); \ +- tmp = *srcdest_reg; \ +- do_integer_load(srcdest_reg, 4, mem, 0, errh); \ +- store_common(mem, 4, &tmp, errh); \ +- local_irq_restore(flags); \ +- smp_release(); \ +-}) +- + static inline void advance(struct pt_regs *regs) + { + regs->pc = regs->npc; +@@ -342,9 +216,7 @@ + return !floating_point_load_or_store_p(insn); + } + +-void kernel_mna_trap_fault(struct pt_regs *regs, unsigned int insn) __asm__ ("kernel_mna_trap_fault"); +- +-void kernel_mna_trap_fault(struct pt_regs *regs, unsigned int insn) ++static void kernel_mna_trap_fault(struct pt_regs *regs, unsigned int insn) + { + unsigned long g2 = regs->u_regs [UREG_G2]; + unsigned long fixup = search_extables_range(regs->pc, &g2); +@@ -379,48 +251,34 @@ + printk("Unsupported unaligned load/store trap for kernel at <%08lx>.\n", + regs->pc); + unaligned_panic("Wheee. Kernel does fpu/atomic unaligned load/store."); +- +- __asm__ __volatile__ ("\n" +-"kernel_unaligned_trap_fault:\n\t" +- "mov %0, %%o0\n\t" +- "call kernel_mna_trap_fault\n\t" +- " mov %1, %%o1\n\t" +- : +- : "r" (regs), "r" (insn) +- : "o0", "o1", "o2", "o3", "o4", "o5", "o7", +- "g1", "g2", "g3", "g4", "g5", "g7", "cc"); + } else { + unsigned long addr = compute_effective_address(regs, insn); ++ int err; + + #ifdef DEBUG_MNA + printk("KMNA: pc=%08lx [dir=%s addr=%08lx size=%d] retpc[%08lx]\n", + regs->pc, dirstrings[dir], addr, size, regs->u_regs[UREG_RETPC]); + #endif +- switch(dir) { ++ switch (dir) { + case load: +- do_integer_load(fetch_reg_addr(((insn>>25)&0x1f), regs), +- size, (unsigned long *) addr, +- decode_signedness(insn), +- kernel_unaligned_trap_fault); ++ err = do_int_load(fetch_reg_addr(((insn>>25)&0x1f), ++ regs), ++ size, (unsigned long *) addr, ++ decode_signedness(insn)); + break; + + case store: +- do_integer_store(((insn>>25)&0x1f), size, +- (unsigned long *) addr, regs, +- kernel_unaligned_trap_fault); +- break; +-#if 0 /* unsupported */ +- case both: +- do_atomic(fetch_reg_addr(((insn>>25)&0x1f), regs), +- (unsigned long *) addr, +- kernel_unaligned_trap_fault); ++ err = do_int_store(((insn>>25)&0x1f), size, ++ (unsigned long *) addr, regs); + break; +-#endif + default: + panic("Impossible kernel unaligned trap."); + /* Not reached... */ + } +- advance(regs); ++ if (err) ++ kernel_mna_trap_fault(regs, insn); ++ else ++ advance(regs); + } + } + +@@ -459,9 +317,7 @@ + return 0; + } + +-void user_mna_trap_fault(struct pt_regs *regs, unsigned int insn) __asm__ ("user_mna_trap_fault"); +- +-void user_mna_trap_fault(struct pt_regs *regs, unsigned int insn) ++static void user_mna_trap_fault(struct pt_regs *regs, unsigned int insn) + { + siginfo_t info; + +@@ -485,7 +341,7 @@ + if(!ok_for_user(regs, insn, dir)) { + goto kill_user; + } else { +- int size = decode_access_size(insn); ++ int err, size = decode_access_size(insn); + unsigned long addr; + + if(floating_point_load_or_store_p(insn)) { +@@ -496,48 +352,34 @@ + addr = compute_effective_address(regs, insn); + switch(dir) { + case load: +- do_integer_load(fetch_reg_addr(((insn>>25)&0x1f), regs), +- size, (unsigned long *) addr, +- decode_signedness(insn), +- user_unaligned_trap_fault); ++ err = do_int_load(fetch_reg_addr(((insn>>25)&0x1f), ++ regs), ++ size, (unsigned long *) addr, ++ decode_signedness(insn)); + break; + + case store: +- do_integer_store(((insn>>25)&0x1f), size, +- (unsigned long *) addr, regs, +- user_unaligned_trap_fault); ++ err = do_int_store(((insn>>25)&0x1f), size, ++ (unsigned long *) addr, regs); + break; + + case both: +-#if 0 /* unsupported */ +- do_atomic(fetch_reg_addr(((insn>>25)&0x1f), regs), +- (unsigned long *) addr, +- user_unaligned_trap_fault); +-#else + /* + * This was supported in 2.4. However, we question + * the value of SWAP instruction across word boundaries. + */ + printk("Unaligned SWAP unsupported.\n"); +- goto kill_user; +-#endif ++ err = -EFAULT; + break; + + default: + unaligned_panic("Impossible user unaligned trap."); +- +- __asm__ __volatile__ ("\n" +-"user_unaligned_trap_fault:\n\t" +- "mov %0, %%o0\n\t" +- "call user_mna_trap_fault\n\t" +- " mov %1, %%o1\n\t" +- : +- : "r" (regs), "r" (insn) +- : "o0", "o1", "o2", "o3", "o4", "o5", "o7", +- "g1", "g2", "g3", "g4", "g5", "g7", "cc"); + goto out; + } +- advance(regs); ++ if (err) ++ goto kill_user; ++ else ++ advance(regs); + goto out; + } + +diff -Nurd linux-2.6.24/arch/sparc/lib/rwsem.S linux-2.6.24-oxe810/arch/sparc/lib/rwsem.S +--- linux-2.6.24/arch/sparc/lib/rwsem.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc/lib/rwsem.S 2008-06-11 17:48:47.000000000 +0200 +@@ -7,7 +7,7 @@ + #include <asm/ptrace.h> + #include <asm/psr.h> + +- .section .sched.text ++ .section .sched.text, "ax" + .align 4 + + .globl ___down_read +diff -Nurd linux-2.6.24/arch/sparc64/lib/rwsem.S linux-2.6.24-oxe810/arch/sparc64/lib/rwsem.S +--- linux-2.6.24/arch/sparc64/lib/rwsem.S 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc64/lib/rwsem.S 2008-06-11 17:48:11.000000000 +0200 +@@ -6,7 +6,7 @@ + + #include <asm/rwsem-const.h> + +- .section .sched.text ++ .section .sched.text, "ax" + + .globl __down_read + __down_read: +diff -Nurd linux-2.6.24/arch/sparc64/mm/fault.c linux-2.6.24-oxe810/arch/sparc64/mm/fault.c +--- linux-2.6.24/arch/sparc64/mm/fault.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/sparc64/mm/fault.c 2008-06-11 17:48:12.000000000 +0200 +@@ -244,16 +244,8 @@ + if (regs->tstate & TSTATE_PRIV) { + const struct exception_table_entry *entry; + +- if (asi == ASI_P && (insn & 0xc0800000) == 0xc0800000) { +- if (insn & 0x2000) +- asi = (regs->tstate >> 24); +- else +- asi = (insn >> 5); +- } +- +- /* Look in asi.h: All _S asis have LS bit set */ +- if ((asi & 0x1) && +- (entry = search_exception_tables(regs->tpc))) { ++ entry = search_exception_tables(regs->tpc); ++ if (entry) { + regs->tpc = entry->fixup; + regs->tnpc = regs->tpc + 4; + return; +@@ -294,7 +286,7 @@ + unsigned long tpc = regs->tpc; + + /* Sanity check the PC. */ +- if ((tpc >= KERNBASE && tpc < (unsigned long) _etext) || ++ if ((tpc >= KERNBASE && tpc < (unsigned long) __init_end) || + (tpc >= MODULES_VADDR && tpc < MODULES_END)) { + /* Valid, no problems... */ + } else { +diff -Nurd linux-2.6.24/arch/x86/ia32/ia32_signal.c linux-2.6.24-oxe810/arch/x86/ia32/ia32_signal.c +--- linux-2.6.24/arch/x86/ia32/ia32_signal.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/ia32/ia32_signal.c 2008-06-11 17:48:21.000000000 +0200 +@@ -494,7 +494,7 @@ + regs->ss = __USER32_DS; + + set_fs(USER_DS); +- regs->eflags &= ~TF_MASK; ++ regs->eflags &= ~(TF_MASK | X86_EFLAGS_DF); + if (test_thread_flag(TIF_SINGLESTEP)) + ptrace_notify(SIGTRAP); + +@@ -600,7 +600,7 @@ + regs->ss = __USER32_DS; + + set_fs(USER_DS); +- regs->eflags &= ~TF_MASK; ++ regs->eflags &= ~(TF_MASK | X86_EFLAGS_DF); + if (test_thread_flag(TIF_SINGLESTEP)) + ptrace_notify(SIGTRAP); + +diff -Nurd linux-2.6.24/arch/x86/kernel/Makefile_32 linux-2.6.24-oxe810/arch/x86/kernel/Makefile_32 +--- linux-2.6.24/arch/x86/kernel/Makefile_32 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/Makefile_32 2008-06-11 17:48:20.000000000 +0200 +@@ -19,7 +19,8 @@ + obj-$(CONFIG_X86_CPUID) += cpuid.o + obj-$(CONFIG_MICROCODE) += microcode.o + obj-$(CONFIG_PCI) += early-quirks.o +-obj-$(CONFIG_APM) += apm_32.o ++apm-y := apm_32.o ++obj-$(CONFIG_APM) += apm.o + obj-$(CONFIG_X86_SMP) += smp_32.o smpboot_32.o tsc_sync.o + obj-$(CONFIG_SMP) += smpcommon_32.o + obj-$(CONFIG_X86_TRAMPOLINE) += trampoline_32.o +diff -Nurd linux-2.6.24/arch/x86/kernel/apic_32.c linux-2.6.24-oxe810/arch/x86/kernel/apic_32.c +--- linux-2.6.24/arch/x86/kernel/apic_32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/apic_32.c 2008-06-11 17:48:20.000000000 +0200 +@@ -154,7 +154,7 @@ + /** + * enable_NMI_through_LVT0 - enable NMI through local vector table 0 + */ +-void enable_NMI_through_LVT0 (void * dummy) ++void __cpuinit enable_NMI_through_LVT0(void) + { + unsigned int v = APIC_DM_NMI; + +diff -Nurd linux-2.6.24/arch/x86/kernel/apic_64.c linux-2.6.24-oxe810/arch/x86/kernel/apic_64.c +--- linux-2.6.24/arch/x86/kernel/apic_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/apic_64.c 2008-06-11 17:48:20.000000000 +0200 +@@ -151,7 +151,7 @@ + return send_status; + } + +-void enable_NMI_through_LVT0 (void * dummy) ++void enable_NMI_through_LVT0(void) + { + unsigned int v; + +diff -Nurd linux-2.6.24/arch/x86/kernel/io_apic_32.c linux-2.6.24-oxe810/arch/x86/kernel/io_apic_32.c +--- linux-2.6.24/arch/x86/kernel/io_apic_32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/io_apic_32.c 2008-06-11 17:48:20.000000000 +0200 +@@ -2080,7 +2080,7 @@ + .eoi = ack_apic, + }; + +-static void setup_nmi (void) ++static void __init setup_nmi(void) + { + /* + * Dirty trick to enable the NMI watchdog ... +@@ -2093,7 +2093,7 @@ + */ + apic_printk(APIC_VERBOSE, KERN_INFO "activating NMI Watchdog ..."); + +- on_each_cpu(enable_NMI_through_LVT0, NULL, 1, 1); ++ enable_NMI_through_LVT0(); + + apic_printk(APIC_VERBOSE, " done.\n"); + } +diff -Nurd linux-2.6.24/arch/x86/kernel/io_apic_64.c linux-2.6.24-oxe810/arch/x86/kernel/io_apic_64.c +--- linux-2.6.24/arch/x86/kernel/io_apic_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/io_apic_64.c 2008-06-11 17:48:20.000000000 +0200 +@@ -1565,7 +1565,7 @@ + .end = end_lapic_irq, + }; + +-static void setup_nmi (void) ++static void __init setup_nmi(void) + { + /* + * Dirty trick to enable the NMI watchdog ... +@@ -1578,7 +1578,7 @@ + */ + printk(KERN_INFO "activating NMI Watchdog ..."); + +- enable_NMI_through_LVT0(NULL); ++ enable_NMI_through_LVT0(); + + printk(" done.\n"); + } +@@ -1654,7 +1654,7 @@ + * + * FIXME: really need to revamp this for modern platforms only. + */ +-static inline void check_timer(void) ++static inline void __init check_timer(void) + { + struct irq_cfg *cfg = irq_cfg + 0; + int apic1, pin1, apic2, pin2; +diff -Nurd linux-2.6.24/arch/x86/kernel/process_64.c linux-2.6.24-oxe810/arch/x86/kernel/process_64.c +--- linux-2.6.24/arch/x86/kernel/process_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/process_64.c 2008-06-11 17:48:20.000000000 +0200 +@@ -212,14 +212,13 @@ + current_thread_info()->status |= TS_POLLING; + /* endless idle loop with no priority at all */ + while (1) { ++ tick_nohz_stop_sched_tick(); + while (!need_resched()) { + void (*idle)(void); + + if (__get_cpu_var(cpu_idle_state)) + __get_cpu_var(cpu_idle_state) = 0; + +- tick_nohz_stop_sched_tick(); +- + rmb(); + idle = pm_idle; + if (!idle) +diff -Nurd linux-2.6.24/arch/x86/kernel/signal_32.c linux-2.6.24-oxe810/arch/x86/kernel/signal_32.c +--- linux-2.6.24/arch/x86/kernel/signal_32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/signal_32.c 2008-06-11 17:48:20.000000000 +0200 +@@ -396,7 +396,7 @@ + * The tracer may want to single-step inside the + * handler too. + */ +- regs->eflags &= ~TF_MASK; ++ regs->eflags &= ~(TF_MASK | X86_EFLAGS_DF); + if (test_thread_flag(TIF_SINGLESTEP)) + ptrace_notify(SIGTRAP); + +@@ -489,7 +489,7 @@ + * The tracer may want to single-step inside the + * handler too. + */ +- regs->eflags &= ~TF_MASK; ++ regs->eflags &= ~(TF_MASK | X86_EFLAGS_DF); + if (test_thread_flag(TIF_SINGLESTEP)) + ptrace_notify(SIGTRAP); + +diff -Nurd linux-2.6.24/arch/x86/kernel/signal_64.c linux-2.6.24-oxe810/arch/x86/kernel/signal_64.c +--- linux-2.6.24/arch/x86/kernel/signal_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/signal_64.c 2008-06-11 17:48:20.000000000 +0200 +@@ -295,7 +295,7 @@ + see include/asm-x86_64/uaccess.h for details. */ + set_fs(USER_DS); + +- regs->eflags &= ~TF_MASK; ++ regs->eflags &= ~(TF_MASK | X86_EFLAGS_DF); + if (test_thread_flag(TIF_SINGLESTEP)) + ptrace_notify(SIGTRAP); + #ifdef DEBUG_SIG +diff -Nurd linux-2.6.24/arch/x86/kernel/smpboot_32.c linux-2.6.24-oxe810/arch/x86/kernel/smpboot_32.c +--- linux-2.6.24/arch/x86/kernel/smpboot_32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/smpboot_32.c 2008-06-11 17:48:20.000000000 +0200 +@@ -405,7 +405,7 @@ + setup_secondary_clock(); + if (nmi_watchdog == NMI_IO_APIC) { + disable_8259A_irq(0); +- enable_NMI_through_LVT0(NULL); ++ enable_NMI_through_LVT0(); + enable_8259A_irq(0); + } + /* +diff -Nurd linux-2.6.24/arch/x86/kernel/smpboot_64.c linux-2.6.24-oxe810/arch/x86/kernel/smpboot_64.c +--- linux-2.6.24/arch/x86/kernel/smpboot_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/kernel/smpboot_64.c 2008-06-11 17:48:20.000000000 +0200 +@@ -338,7 +338,7 @@ + + if (nmi_watchdog == NMI_IO_APIC) { + disable_8259A_irq(0); +- enable_NMI_through_LVT0(NULL); ++ enable_NMI_through_LVT0(); + enable_8259A_irq(0); + } + +diff -Nurd linux-2.6.24/arch/x86/mm/pageattr_64.c linux-2.6.24-oxe810/arch/x86/mm/pageattr_64.c +--- linux-2.6.24/arch/x86/mm/pageattr_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/mm/pageattr_64.c 2008-06-11 17:48:22.000000000 +0200 +@@ -207,7 +207,7 @@ + if (__pa(address) < KERNEL_TEXT_SIZE) { + unsigned long addr2; + pgprot_t prot2; +- addr2 = __START_KERNEL_map + __pa(address); ++ addr2 = __START_KERNEL_map + __pa(address) - phys_base; + /* Make sure the kernel mappings stay executable */ + prot2 = pte_pgprot(pte_mkexec(pfn_pte(0, prot))); + err = __change_page_attr(addr2, pfn, prot2, +diff -Nurd linux-2.6.24/arch/x86/pci/mmconfig-shared.c linux-2.6.24-oxe810/arch/x86/pci/mmconfig-shared.c +--- linux-2.6.24/arch/x86/pci/mmconfig-shared.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/pci/mmconfig-shared.c 2008-06-11 17:48:22.000000000 +0200 +@@ -22,42 +22,9 @@ + #define MMCONFIG_APER_MIN (2 * 1024*1024) + #define MMCONFIG_APER_MAX (256 * 1024*1024) + +-DECLARE_BITMAP(pci_mmcfg_fallback_slots, 32*PCI_MMCFG_MAX_CHECK_BUS); +- + /* Indicate if the mmcfg resources have been placed into the resource table. */ + static int __initdata pci_mmcfg_resources_inserted; + +-/* K8 systems have some devices (typically in the builtin northbridge) +- that are only accessible using type1 +- Normally this can be expressed in the MCFG by not listing them +- and assigning suitable _SEGs, but this isn't implemented in some BIOS. +- Instead try to discover all devices on bus 0 that are unreachable using MM +- and fallback for them. */ +-static void __init unreachable_devices(void) +-{ +- int i, bus; +- /* Use the max bus number from ACPI here? */ +- for (bus = 0; bus < PCI_MMCFG_MAX_CHECK_BUS; bus++) { +- for (i = 0; i < 32; i++) { +- unsigned int devfn = PCI_DEVFN(i, 0); +- u32 val1, val2; +- +- pci_conf1_read(0, bus, devfn, 0, 4, &val1); +- if (val1 == 0xffffffff) +- continue; +- +- if (pci_mmcfg_arch_reachable(0, bus, devfn)) { +- raw_pci_ops->read(0, bus, devfn, 0, 4, &val2); +- if (val1 == val2) +- continue; +- } +- set_bit(i + 32 * bus, pci_mmcfg_fallback_slots); +- printk(KERN_NOTICE "PCI: No mmconfig possible on device" +- " %02x:%02x\n", bus, i); +- } +- } +-} +- + static const char __init *pci_mmcfg_e7520(void) + { + u32 win; +@@ -270,8 +237,6 @@ + return; + + if (pci_mmcfg_arch_init()) { +- if (type == 1) +- unreachable_devices(); + if (known_bridge) + pci_mmcfg_insert_resources(IORESOURCE_BUSY); + pci_probe = (pci_probe & ~PCI_PROBE_MASK) | PCI_PROBE_MMCONF; +diff -Nurd linux-2.6.24/arch/x86/pci/mmconfig_32.c linux-2.6.24-oxe810/arch/x86/pci/mmconfig_32.c +--- linux-2.6.24/arch/x86/pci/mmconfig_32.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/pci/mmconfig_32.c 2008-06-11 17:48:22.000000000 +0200 +@@ -30,10 +30,6 @@ + struct acpi_mcfg_allocation *cfg; + int cfg_num; + +- if (seg == 0 && bus < PCI_MMCFG_MAX_CHECK_BUS && +- test_bit(PCI_SLOT(devfn) + 32*bus, pci_mmcfg_fallback_slots)) +- return 0; +- + for (cfg_num = 0; cfg_num < pci_mmcfg_config_num; cfg_num++) { + cfg = &pci_mmcfg_config[cfg_num]; + if (cfg->pci_segment == seg && +@@ -68,13 +64,16 @@ + u32 base; + + if ((bus > 255) || (devfn > 255) || (reg > 4095)) { +- *value = -1; ++err: *value = -1; + return -EINVAL; + } + ++ if (reg < 256) ++ return pci_conf1_read(seg,bus,devfn,reg,len,value); ++ + base = get_base_addr(seg, bus, devfn); + if (!base) +- return pci_conf1_read(seg,bus,devfn,reg,len,value); ++ goto err; + + spin_lock_irqsave(&pci_config_lock, flags); + +@@ -105,9 +104,12 @@ + if ((bus > 255) || (devfn > 255) || (reg > 4095)) + return -EINVAL; + ++ if (reg < 256) ++ return pci_conf1_write(seg,bus,devfn,reg,len,value); ++ + base = get_base_addr(seg, bus, devfn); + if (!base) +- return pci_conf1_write(seg,bus,devfn,reg,len,value); ++ return -EINVAL; + + spin_lock_irqsave(&pci_config_lock, flags); + +@@ -134,12 +136,6 @@ + .write = pci_mmcfg_write, + }; + +-int __init pci_mmcfg_arch_reachable(unsigned int seg, unsigned int bus, +- unsigned int devfn) +-{ +- return get_base_addr(seg, bus, devfn) != 0; +-} +- + int __init pci_mmcfg_arch_init(void) + { + printk(KERN_INFO "PCI: Using MMCONFIG\n"); +diff -Nurd linux-2.6.24/arch/x86/pci/mmconfig_64.c linux-2.6.24-oxe810/arch/x86/pci/mmconfig_64.c +--- linux-2.6.24/arch/x86/pci/mmconfig_64.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/pci/mmconfig_64.c 2008-06-11 17:48:22.000000000 +0200 +@@ -40,9 +40,7 @@ + static char __iomem *pci_dev_base(unsigned int seg, unsigned int bus, unsigned int devfn) + { + char __iomem *addr; +- if (seg == 0 && bus < PCI_MMCFG_MAX_CHECK_BUS && +- test_bit(32*bus + PCI_SLOT(devfn), pci_mmcfg_fallback_slots)) +- return NULL; ++ + addr = get_virt(seg, bus); + if (!addr) + return NULL; +@@ -56,13 +54,16 @@ + + /* Why do we have this when nobody checks it. How about a BUG()!? -AK */ + if (unlikely((bus > 255) || (devfn > 255) || (reg > 4095))) { +- *value = -1; ++err: *value = -1; + return -EINVAL; + } + ++ if (reg < 256) ++ return pci_conf1_read(seg,bus,devfn,reg,len,value); ++ + addr = pci_dev_base(seg, bus, devfn); + if (!addr) +- return pci_conf1_read(seg,bus,devfn,reg,len,value); ++ goto err; + + switch (len) { + case 1: +@@ -88,9 +89,12 @@ + if (unlikely((bus > 255) || (devfn > 255) || (reg > 4095))) + return -EINVAL; + ++ if (reg < 256) ++ return pci_conf1_write(seg,bus,devfn,reg,len,value); ++ + addr = pci_dev_base(seg, bus, devfn); + if (!addr) +- return pci_conf1_write(seg,bus,devfn,reg,len,value); ++ return -EINVAL; + + switch (len) { + case 1: +@@ -126,12 +130,6 @@ + return addr; + } + +-int __init pci_mmcfg_arch_reachable(unsigned int seg, unsigned int bus, +- unsigned int devfn) +-{ +- return pci_dev_base(seg, bus, devfn) != NULL; +-} +- + int __init pci_mmcfg_arch_init(void) + { + int i; +diff -Nurd linux-2.6.24/arch/x86/pci/pci.h linux-2.6.24-oxe810/arch/x86/pci/pci.h +--- linux-2.6.24/arch/x86/pci/pci.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/arch/x86/pci/pci.h 2008-06-11 17:48:22.000000000 +0200 +@@ -98,13 +98,6 @@ + + /* pci-mmconfig.c */ + +-/* Verify the first 16 busses. We assume that systems with more busses +- get MCFG right. */ +-#define PCI_MMCFG_MAX_CHECK_BUS 16 +-extern DECLARE_BITMAP(pci_mmcfg_fallback_slots, 32*PCI_MMCFG_MAX_CHECK_BUS); +- +-extern int __init pci_mmcfg_arch_reachable(unsigned int seg, unsigned int bus, +- unsigned int devfn); + extern int __init pci_mmcfg_arch_init(void); + + /* +diff -Nurd linux-2.6.24/block/ll_rw_blk.c linux-2.6.24-oxe810/block/ll_rw_blk.c +--- linux-2.6.24/block/ll_rw_blk.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/block/ll_rw_blk.c 2008-06-11 17:46:40.000000000 +0200 +@@ -1424,6 +1424,13 @@ + else + max_sectors = q->max_sectors; + ++ /* ++ * If the RAID modes of the bio associated with the request differs ++ * from the merge candidate bio, it can't be merged ++ */ ++ if (req->bio->bi_raid != bio->bi_raid) ++ return 0; ++ + if (req->nr_sectors + bio_sectors(bio) > max_sectors) { + req->cmd_flags |= REQ_NOMERGE; + if (req == q->last_merge) +@@ -1462,6 +1469,12 @@ + else + max_sectors = q->max_sectors; + ++ /* ++ * If the RAID modes of the bio associated with the request differs ++ * from the merge candidate bio, it can't be merged ++ */ ++ if (req->bio->bi_raid != bio->bi_raid) ++ return 0; + + if (req->nr_sectors + bio_sectors(bio) > max_sectors) { + req->cmd_flags |= REQ_NOMERGE; +@@ -1502,6 +1515,17 @@ + */ + if (req->special || next->special) + return 0; ++ ++ /* ++ * If the RAID modes of the bio associated with the two requests differ ++ * then they cannot be merged. ++ * ++ BUG_ON(!req); ++ BUG_ON(!req->bio); ++ BUG_ON(!next); ++ BUG_ON(!next->bio); ++ if (req->bio->bi_raid != next->bio->bi_raid) ++ return 0;*/ + + /* + * Will it become too large? +@@ -2965,7 +2989,7 @@ + + static int __make_request(struct request_queue *q, struct bio *bio) + { +- struct request *req; ++ struct request *req = 0; + int el_ret, nr_sectors, barrier, err; + const unsigned short prio = bio_prio(bio); + const int sync = bio_sync(bio); +@@ -2992,6 +3016,15 @@ + goto get_rq; + + el_ret = elv_merge(q, &req, bio); ++ ++ /* if the bio raid modes differ, force a no-merge */ ++ if ((!ELEVATOR_NO_MERGE) && ++ (req) && ++ (req->bio) && ++ (bio->bi_raid != req->bio->bi_raid )) { ++ el_ret = ELEVATOR_NO_MERGE; ++ } ++ + switch (el_ret) { + case ELEVATOR_BACK_MERGE: + BUG_ON(!rq_mergeable(req)); +diff -Nurd linux-2.6.24/crypto/async_tx/async_xor.c linux-2.6.24-oxe810/crypto/async_tx/async_xor.c +--- linux-2.6.24/crypto/async_tx/async_xor.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/crypto/async_tx/async_xor.c 2008-06-11 17:43:37.000000000 +0200 +@@ -264,7 +264,7 @@ + + BUG_ON(src_cnt <= 1); + +- if (tx) { ++ if (tx && src_cnt <= device->max_xor) { + dma_addr_t dma_addr; + enum dma_data_direction dir; + +diff -Nurd linux-2.6.24/crypto/xcbc.c linux-2.6.24-oxe810/crypto/xcbc.c +--- linux-2.6.24/crypto/xcbc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/crypto/xcbc.c 2008-06-11 17:43:39.000000000 +0200 +@@ -124,6 +124,11 @@ + unsigned int offset = sg[i].offset; + unsigned int slen = sg[i].length; + ++ if (unlikely(slen > nbytes)) ++ slen = nbytes; ++ ++ nbytes -= slen; ++ + while (slen > 0) { + unsigned int len = min(slen, ((unsigned int)(PAGE_SIZE)) - offset); + char *p = crypto_kmap(pg, 0) + offset; +@@ -177,7 +182,6 @@ + offset = 0; + pg++; + } +- nbytes-=sg[i].length; + i++; + } while (nbytes>0); + +diff -Nurd linux-2.6.24/crypto/xts.c linux-2.6.24-oxe810/crypto/xts.c +--- linux-2.6.24/crypto/xts.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/crypto/xts.c 2008-06-11 17:43:39.000000000 +0200 +@@ -77,16 +77,16 @@ + } + + struct sinfo { +- be128 t; ++ be128 *t; + struct crypto_tfm *tfm; + void (*fn)(struct crypto_tfm *, u8 *, const u8 *); + }; + + static inline void xts_round(struct sinfo *s, void *dst, const void *src) + { +- be128_xor(dst, &s->t, src); /* PP <- T xor P */ ++ be128_xor(dst, s->t, src); /* PP <- T xor P */ + s->fn(s->tfm, dst, dst); /* CC <- E(Key1,PP) */ +- be128_xor(dst, dst, &s->t); /* C <- T xor CC */ ++ be128_xor(dst, dst, s->t); /* C <- T xor CC */ + } + + static int crypt(struct blkcipher_desc *d, +@@ -101,7 +101,6 @@ + .tfm = crypto_cipher_tfm(ctx->child), + .fn = fn + }; +- be128 *iv; + u8 *wsrc; + u8 *wdst; + +@@ -109,20 +108,20 @@ + if (!w->nbytes) + return err; + ++ s.t = (be128 *)w->iv; + avail = w->nbytes; + + wsrc = w->src.virt.addr; + wdst = w->dst.virt.addr; + + /* calculate first value of T */ +- iv = (be128 *)w->iv; +- tw(crypto_cipher_tfm(ctx->tweak), (void *)&s.t, w->iv); ++ tw(crypto_cipher_tfm(ctx->tweak), w->iv, w->iv); + + goto first; + + for (;;) { + do { +- gf128mul_x_ble(&s.t, &s.t); ++ gf128mul_x_ble(s.t, s.t); + + first: + xts_round(&s, wdst, wsrc); +diff -Nurd linux-2.6.24/drivers/acorn/char/defkeymap-l7200.c linux-2.6.24-oxe810/drivers/acorn/char/defkeymap-l7200.c +--- linux-2.6.24/drivers/acorn/char/defkeymap-l7200.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/acorn/char/defkeymap-l7200.c 2008-06-11 17:49:37.000000000 +0200 +@@ -347,40 +347,40 @@ + }; + + struct kbdiacruc accent_table[MAX_DIACR] = { +- {'`', 'A', '\300'}, {'`', 'a', '\340'}, +- {'\'', 'A', '\301'}, {'\'', 'a', '\341'}, +- {'^', 'A', '\302'}, {'^', 'a', '\342'}, +- {'~', 'A', '\303'}, {'~', 'a', '\343'}, +- {'"', 'A', '\304'}, {'"', 'a', '\344'}, +- {'O', 'A', '\305'}, {'o', 'a', '\345'}, +- {'0', 'A', '\305'}, {'0', 'a', '\345'}, +- {'A', 'A', '\305'}, {'a', 'a', '\345'}, +- {'A', 'E', '\306'}, {'a', 'e', '\346'}, +- {',', 'C', '\307'}, {',', 'c', '\347'}, +- {'`', 'E', '\310'}, {'`', 'e', '\350'}, +- {'\'', 'E', '\311'}, {'\'', 'e', '\351'}, +- {'^', 'E', '\312'}, {'^', 'e', '\352'}, +- {'"', 'E', '\313'}, {'"', 'e', '\353'}, +- {'`', 'I', '\314'}, {'`', 'i', '\354'}, +- {'\'', 'I', '\315'}, {'\'', 'i', '\355'}, +- {'^', 'I', '\316'}, {'^', 'i', '\356'}, +- {'"', 'I', '\317'}, {'"', 'i', '\357'}, +- {'-', 'D', '\320'}, {'-', 'd', '\360'}, +- {'~', 'N', '\321'}, {'~', 'n', '\361'}, +- {'`', 'O', '\322'}, {'`', 'o', '\362'}, +- {'\'', 'O', '\323'}, {'\'', 'o', '\363'}, +- {'^', 'O', '\324'}, {'^', 'o', '\364'}, +- {'~', 'O', '\325'}, {'~', 'o', '\365'}, +- {'"', 'O', '\326'}, {'"', 'o', '\366'}, +- {'/', 'O', '\330'}, {'/', 'o', '\370'}, +- {'`', 'U', '\331'}, {'`', 'u', '\371'}, +- {'\'', 'U', '\332'}, {'\'', 'u', '\372'}, +- {'^', 'U', '\333'}, {'^', 'u', '\373'}, +- {'"', 'U', '\334'}, {'"', 'u', '\374'}, +- {'\'', 'Y', '\335'}, {'\'', 'y', '\375'}, +- {'T', 'H', '\336'}, {'t', 'h', '\376'}, +- {'s', 's', '\337'}, {'"', 'y', '\377'}, +- {'s', 'z', '\337'}, {'i', 'j', '\377'}, ++ {'`', 'A', 0300}, {'`', 'a', 0340}, ++ {'\'', 'A', 0301}, {'\'', 'a', 0341}, ++ {'^', 'A', 0302}, {'^', 'a', 0342}, ++ {'~', 'A', 0303}, {'~', 'a', 0343}, ++ {'"', 'A', 0304}, {'"', 'a', 0344}, ++ {'O', 'A', 0305}, {'o', 'a', 0345}, ++ {'0', 'A', 0305}, {'0', 'a', 0345}, ++ {'A', 'A', 0305}, {'a', 'a', 0345}, ++ {'A', 'E', 0306}, {'a', 'e', 0346}, ++ {',', 'C', 0307}, {',', 'c', 0347}, ++ {'`', 'E', 0310}, {'`', 'e', 0350}, ++ {'\'', 'E', 0311}, {'\'', 'e', 0351}, ++ {'^', 'E', 0312}, {'^', 'e', 0352}, ++ {'"', 'E', 0313}, {'"', 'e', 0353}, ++ {'`', 'I', 0314}, {'`', 'i', 0354}, ++ {'\'', 'I', 0315}, {'\'', 'i', 0355}, ++ {'^', 'I', 0316}, {'^', 'i', 0356}, ++ {'"', 'I', 0317}, {'"', 'i', 0357}, ++ {'-', 'D', 0320}, {'-', 'd', 0360}, ++ {'~', 'N', 0321}, {'~', 'n', 0361}, ++ {'`', 'O', 0322}, {'`', 'o', 0362}, ++ {'\'', 'O', 0323}, {'\'', 'o', 0363}, ++ {'^', 'O', 0324}, {'^', 'o', 0364}, ++ {'~', 'O', 0325}, {'~', 'o', 0365}, ++ {'"', 'O', 0326}, {'"', 'o', 0366}, ++ {'/', 'O', 0330}, {'/', 'o', 0370}, ++ {'`', 'U', 0331}, {'`', 'u', 0371}, ++ {'\'', 'U', 0332}, {'\'', 'u', 0372}, ++ {'^', 'U', 0333}, {'^', 'u', 0373}, ++ {'"', 'U', 0334}, {'"', 'u', 0374}, ++ {'\'', 'Y', 0335}, {'\'', 'y', 0375}, ++ {'T', 'H', 0336}, {'t', 'h', 0376}, ++ {'s', 's', 0337}, {'"', 'y', 0377}, ++ {'s', 'z', 0337}, {'i', 'j', 0377}, + }; + + unsigned int accent_table_size = 68; +diff -Nurd linux-2.6.24/drivers/acpi/blacklist.c linux-2.6.24-oxe810/drivers/acpi/blacklist.c +--- linux-2.6.24/drivers/acpi/blacklist.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/acpi/blacklist.c 2008-06-11 17:49:40.000000000 +0200 +@@ -208,24 +208,24 @@ + * Disable OSI(Linux) warnings on all "Acer, inc." + * + * _OSI(Linux) disables the latest Windows BIOS code: ++ * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 3100"), + * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5050"), ++ * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5100"), + * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5580"), + * DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 3010"), + * _OSI(Linux) effect unknown: + * DMI_MATCH(DMI_PRODUCT_NAME, "Ferrari 5000"), + */ +- { +- .callback = dmi_disable_osi_linux, +- .ident = "Acer, inc.", +- .matches = { +- DMI_MATCH(DMI_SYS_VENDOR, "Acer, inc."), +- }, +- }, ++ /* ++ * note that dmi_check_system() uses strstr() ++ * to match sub-strings rather than !strcmp(), ++ * so "Acer" below matches "Acer, inc." above. ++ */ + /* + * Disable OSI(Linux) warnings on all "Acer" + * + * _OSI(Linux) effect unknown: +- * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5100"), ++ * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5315"), + * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 5610"), + * DMI_MATCH(DMI_PRODUCT_NAME, "Aspire 7720Z"), + * DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 5520"), +@@ -300,7 +300,7 @@ + DMI_MATCH(DMI_BIOS_VENDOR, "COMPAL"), + }, + }, +- { /* OSI(Linux) touches USB, breaks suspend to disk */ ++ { /* OSI(Linux) touches USB, unknown side-effect */ + .callback = dmi_disable_osi_linux, + .ident = "Dell Dimension 5150", + .matches = { +@@ -474,6 +474,11 @@ + * + * _OSI(Linux) confirmed to be a NOP: + * DMI_MATCH(DMI_PRODUCT_NAME, "P1-J150B"), ++ * with DMI_MATCH(DMI_BOARD_NAME, "ROCKY"), ++ * ++ * unknown: ++ * DMI_MATCH(DMI_PRODUCT_NAME, "S1-MDGDG"), ++ * with DMI_MATCH(DMI_BOARD_NAME, "ROCKY"), + */ + { + .callback = dmi_disable_osi_linux, +diff -Nurd linux-2.6.24/drivers/acpi/osl.c linux-2.6.24-oxe810/drivers/acpi/osl.c +--- linux-2.6.24/drivers/acpi/osl.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/acpi/osl.c 2008-06-11 17:49:40.000000000 +0200 +@@ -120,7 +120,7 @@ + */ + #define OSI_LINUX_ENABLE 0 + +-struct osi_linux { ++static struct osi_linux { + unsigned int enable:1; + unsigned int dmi:1; + unsigned int cmdline:1; +@@ -1213,24 +1213,24 @@ + * + * Returns 0 on success + */ +-int acpi_dmi_dump(void) ++static int acpi_dmi_dump(void) + { + + if (!dmi_available) + return -1; + + printk(KERN_NOTICE PREFIX "DMI System Vendor: %s\n", +- dmi_get_slot(DMI_SYS_VENDOR)); ++ dmi_get_system_info(DMI_SYS_VENDOR)); + printk(KERN_NOTICE PREFIX "DMI Product Name: %s\n", +- dmi_get_slot(DMI_PRODUCT_NAME)); ++ dmi_get_system_info(DMI_PRODUCT_NAME)); + printk(KERN_NOTICE PREFIX "DMI Product Version: %s\n", +- dmi_get_slot(DMI_PRODUCT_VERSION)); ++ dmi_get_system_info(DMI_PRODUCT_VERSION)); + printk(KERN_NOTICE PREFIX "DMI Board Name: %s\n", +- dmi_get_slot(DMI_BOARD_NAME)); ++ dmi_get_system_info(DMI_BOARD_NAME)); + printk(KERN_NOTICE PREFIX "DMI BIOS Vendor: %s\n", +- dmi_get_slot(DMI_BIOS_VENDOR)); ++ dmi_get_system_info(DMI_BIOS_VENDOR)); + printk(KERN_NOTICE PREFIX "DMI BIOS Date: %s\n", +- dmi_get_slot(DMI_BIOS_DATE)); ++ dmi_get_system_info(DMI_BIOS_DATE)); + + return 0; + } +diff -Nurd linux-2.6.24/drivers/ata/Kconfig linux-2.6.24-oxe810/drivers/ata/Kconfig +--- linux-2.6.24/drivers/ata/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/Kconfig 2008-06-11 17:50:32.000000000 +0200 +@@ -182,15 +182,49 @@ + firmware in the BIOS. This driver can sometimes handle + otherwise unsupported hardware. + ++config SATA_OX800 ++ bool "Oxford Semiconductor OX800 SATA support" ++ depends on ARCH_HIPOX && HIPOX_VERSION_0X800 ++ default n ++ help ++ This option enables support for the 924 based sata core ++ ++config SATA_OX810 ++ bool "Oxford Semiconductor OX810 SATA support" ++ depends on ARCH_HIPOX && HIPOX_VERSION_0X810 ++ default n ++ help ++ This option enables support for the 934 based sata core ++ + config SATA_FSL + tristate "Freescale 3.0Gbps SATA support" + depends on PPC_MPC837x + help + This option enables support for Freescale 3.0Gbps SATA controller. + It can be found on MPC837x and MPC8315. +- + If unsure, say N. + ++config SATA_HIPOX_SINGLE_SATA ++ bool "Force HIPOX family devices to only use one SATA port" ++ depends on SATA_OX800 || SATA_OX810 ++ default n ++ help ++ Prevents the ox800sata module from registering its second sata port, this ++ reduces startup time on systems where only one port is physically present ++ on the board/chip periphery. ++ ++config SATA_HIPOX_DISK_LIGHT ++ bool "Whether HIPOX family device should use a SATA disk activity light" ++ depends on SATA_OX800 || SATA_OX810 ++ default n ++ ++config SATA_HIPOX_DISK_LIGHT_GPIO_LINE ++ int "GPIO line of the disk light" ++ depends on SATA_HIPOX_DISK_LIGHT ++ default 29 ++ help ++ Selects the GPIO line of the disk activity light. ++ + config PATA_ALI + tristate "ALi PATA support (Experimental)" + depends on PCI && EXPERIMENTAL +diff -Nurd linux-2.6.24/drivers/ata/Makefile linux-2.6.24-oxe810/drivers/ata/Makefile +--- linux-2.6.24/drivers/ata/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/Makefile 2008-06-11 17:50:32.000000000 +0200 +@@ -18,6 +18,8 @@ + obj-$(CONFIG_SATA_INIC162X) += sata_inic162x.o + obj-$(CONFIG_PDC_ADMA) += pdc_adma.o + obj-$(CONFIG_SATA_FSL) += sata_fsl.o ++obj-$(CONFIG_SATA_OX800) += ox800sata.o ++obj-$(CONFIG_SATA_OX810) += ox810sata.o + + obj-$(CONFIG_PATA_ALI) += pata_ali.o + obj-$(CONFIG_PATA_AMD) += pata_amd.o +diff -Nurd linux-2.6.24/drivers/ata/libata-core.c linux-2.6.24-oxe810/drivers/ata/libata-core.c +--- linux-2.6.24/drivers/ata/libata-core.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/libata-core.c 2008-06-11 17:50:32.000000000 +0200 +@@ -140,6 +140,8 @@ + */ + void ata_tf_to_fis(const struct ata_taskfile *tf, u8 pmp, int is_cmd, u8 *fis) + { ++ ++ VPRINTK("\n"); + fis[0] = 0x27; /* Register - Host to Device FIS */ + fis[1] = pmp & 0xf; /* Port multiplier number*/ + if (is_cmd) +@@ -182,6 +184,8 @@ + + void ata_tf_from_fis(const u8 *fis, struct ata_taskfile *tf) + { ++ ++ VPRINTK("\n"); + tf->command = fis[2]; /* status */ + tf->feature = fis[3]; /* error */ + +@@ -245,6 +249,8 @@ + + int index, fua, lba48, write; + ++ ++ VPRINTK("\n"); + fua = (tf->flags & ATA_TFLAG_FUA) ? 4 : 0; + lba48 = (tf->flags & ATA_TFLAG_LBA48) ? 2 : 0; + write = (tf->flags & ATA_TFLAG_WRITE) ? 1 : 0; +@@ -288,6 +294,8 @@ + { + u64 block = 0; + ++ ++ VPRINTK("\n"); + if (tf->flags & ATA_TFLAG_LBA) { + if (tf->flags & ATA_TFLAG_LBA48) { + block |= (u64)tf->hob_lbah << 40; +@@ -336,6 +344,8 @@ + u64 block, u32 n_block, unsigned int tf_flags, + unsigned int tag) + { ++ ++ VPRINTK("\n"); + tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; + tf->flags |= tf_flags; + +@@ -454,6 +464,8 @@ + unsigned int mwdma_mask, + unsigned int udma_mask) + { ++ ++ VPRINTK("\n"); + return ((pio_mask << ATA_SHIFT_PIO) & ATA_MASK_PIO) | + ((mwdma_mask << ATA_SHIFT_MWDMA) & ATA_MASK_MWDMA) | + ((udma_mask << ATA_SHIFT_UDMA) & ATA_MASK_UDMA); +@@ -474,6 +486,7 @@ + unsigned int *mwdma_mask, + unsigned int *udma_mask) + { ++ VPRINTK("\n"); + if (pio_mask) + *pio_mask = (xfer_mask & ATA_MASK_PIO) >> ATA_SHIFT_PIO; + if (mwdma_mask) +@@ -510,6 +523,7 @@ + int highbit = fls(xfer_mask) - 1; + const struct ata_xfer_ent *ent; + ++ VPRINTK("\n"); + for (ent = ata_xfer_tbl; ent->shift >= 0; ent++) + if (highbit >= ent->shift && highbit < ent->shift + ent->bits) + return ent->base + highbit - ent->shift; +@@ -532,6 +546,7 @@ + { + const struct ata_xfer_ent *ent; + ++ VPRINTK("\n"); + for (ent = ata_xfer_tbl; ent->shift >= 0; ent++) + if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits) + return 1 << (ent->shift + xfer_mode - ent->base); +@@ -554,6 +569,7 @@ + { + const struct ata_xfer_ent *ent; + ++ VPRINTK("\n"); + for (ent = ata_xfer_tbl; ent->shift >= 0; ent++) + if (xfer_mode >= ent->base && xfer_mode < ent->base + ent->bits) + return ent->shift; +@@ -600,6 +616,7 @@ + }; + int highbit; + ++ VPRINTK("\n"); + highbit = fls(xfer_mask) - 1; + if (highbit >= 0 && highbit < ARRAY_SIZE(xfer_mode_str)) + return xfer_mode_str[highbit]; +@@ -613,6 +630,7 @@ + "3.0 Gbps", + }; + ++ VPRINTK("\n"); + if (spd == 0 || (spd - 1) >= ARRAY_SIZE(spd_str)) + return "<unknown>"; + return spd_str[spd - 1]; +@@ -620,6 +638,7 @@ + + void ata_dev_disable(struct ata_device *dev) + { ++ VPRINTK("\n"); + if (ata_dev_enabled(dev)) { + if (ata_msg_drv(dev->link->ap)) + ata_dev_printk(dev, KERN_WARNING, "disabled\n"); +@@ -638,6 +657,7 @@ + unsigned int err_mask; + int rc; + ++ VPRINTK("\n"); + /* + * disallow DIPM for drivers which haven't set + * ATA_FLAG_IPM. This is because when DIPM is enabled, +@@ -732,6 +752,7 @@ + int rc = 0; + struct ata_port *ap = dev->link->ap; + ++ VPRINTK("\n"); + /* set HIPM first, then DIPM */ + if (ap->ops->enable_pm) + rc = ap->ops->enable_pm(ap, policy); +@@ -764,6 +785,7 @@ + { + struct ata_port *ap = dev->link->ap; + ++ VPRINTK("\n"); + ata_dev_set_dipm(dev, MAX_PERFORMANCE); + if (ap->ops->disable_pm) + ap->ops->disable_pm(ap); +@@ -772,6 +794,7 @@ + + void ata_lpm_schedule(struct ata_port *ap, enum link_pm policy) + { ++ VPRINTK("\n"); + ap->pm_policy = policy; + ap->link.eh_info.action |= ATA_EHI_LPM; + ap->link.eh_info.flags |= ATA_EHI_NO_AUTOPSY; +@@ -786,6 +809,7 @@ + struct ata_device *dev; + int i; + ++ VPRINTK("\n"); + for (i = 0; i < host->n_ports; i++) { + ap = host->ports[i]; + ata_port_for_each_link(link, ap) { +@@ -799,6 +823,7 @@ + { + int i; + ++ VPRINTK("\n"); + for (i = 0; i < host->n_ports; i++) { + struct ata_port *ap = host->ports[i]; + ata_lpm_schedule(ap, ap->pm_policy); +@@ -828,6 +853,11 @@ + static unsigned int ata_devchk(struct ata_port *ap, unsigned int device) + { + struct ata_ioports *ioaddr = &ap->ioaddr; ++ VPRINTK("\n"); ++ if (ap->ops->dev_chk) { ++ return ap->ops->dev_chk(ap,device); ++ } else { ++ + u8 nsect, lbal; + + ap->ops->dev_select(ap, device); +@@ -848,6 +878,7 @@ + return 1; /* we found a device */ + + return 0; /* nothing found */ ++ } + } + + /** +@@ -938,6 +969,7 @@ + unsigned int class; + u8 err; + ++ VPRINTK("\n"); + ap->ops->dev_select(ap, dev->devno); + + memset(&tf, 0, sizeof(tf)); +@@ -998,6 +1030,7 @@ + { + unsigned int c; + ++ VPRINTK("\n"); + while (len > 0) { + c = id[ofs] >> 8; + *s = c; +@@ -1031,6 +1064,7 @@ + { + unsigned char *p; + ++ VPRINTK("\n"); + WARN_ON(!(len & 1)); + + ata_id_string(id, s, ofs, len - 1); +@@ -1043,6 +1077,7 @@ + + static u64 ata_id_n_sectors(const u16 *id) + { ++ VPRINTK("\n"); + if (ata_id_has_lba(id)) { + if (ata_id_has_lba48(id)) + return ata_id_u64(id, 100); +@@ -1060,6 +1095,7 @@ + { + u64 sectors = 0; + ++ VPRINTK("\n"); + sectors |= ((u64)(tf->hob_lbah & 0xff)) << 40; + sectors |= ((u64)(tf->hob_lbam & 0xff)) << 32; + sectors |= (tf->hob_lbal & 0xff) << 24; +@@ -1074,6 +1110,7 @@ + { + u64 sectors = 0; + ++ VPRINTK("\n"); + sectors |= (tf->device & 0x0f) << 24; + sectors |= (tf->lbah & 0xff) << 16; + sectors |= (tf->lbam & 0xff) << 8; +@@ -1100,6 +1137,7 @@ + struct ata_taskfile tf; + int lba48 = ata_id_has_lba48(dev->id); + ++ VPRINTK("\n"); + ata_tf_init(dev, &tf); + + /* always clear all address registers */ +@@ -1150,6 +1188,7 @@ + struct ata_taskfile tf; + int lba48 = ata_id_has_lba48(dev->id); + ++ VPRINTK("\n"); + new_sectors--; + + ata_tf_init(dev, &tf); +@@ -1208,6 +1247,7 @@ + u64 native_sectors; + int rc; + ++ VPRINTK("\n"); + /* do we need to do it? */ + if (dev->class != ATA_DEV_ATA || + !ata_id_has_lba(dev->id) || !ata_id_hpa_enabled(dev->id) || +@@ -1305,6 +1345,7 @@ + unsigned int mask; + u8 mode; + ++ VPRINTK("\n"); + /* Pack the DMA modes */ + mask = ((dev->id[63] >> 8) << ATA_SHIFT_MWDMA) & ATA_MASK_MWDMA; + if (dev->id[53] & 0x04) +@@ -1341,6 +1382,7 @@ + */ + void ata_noop_dev_select(struct ata_port *ap, unsigned int device) + { ++ VPRINTK("\n"); + } + + +@@ -1363,6 +1405,7 @@ + { + u8 tmp; + ++ VPRINTK("\n"); + if (device == 0) + tmp = ATA_DEVICE_OBS; + else +@@ -1394,6 +1437,7 @@ + void ata_dev_select(struct ata_port *ap, unsigned int device, + unsigned int wait, unsigned int can_sleep) + { ++ VPRINTK("\n"); + if (ata_msg_probe(ap)) + ata_port_printk(ap, KERN_INFO, "ata_dev_select: ENTER, " + "device %u, wait %u\n", device, wait); +@@ -1469,6 +1513,7 @@ + unsigned int pio_mask, mwdma_mask, udma_mask; + + /* Usual case. Word 53 indicates word 64 is valid */ ++ VPRINTK("\n"); + if (id[ATA_ID_FIELD_VALID] & (1 << 1)) { + pio_mask = id[ATA_ID_PIO_MODES] & 0x03; + pio_mask <<= 3; +@@ -1571,6 +1616,7 @@ + { + struct completion *waiting = qc->private_data; + ++ VPRINTK("\n"); + complete(waiting); + } + +@@ -1613,6 +1659,7 @@ + unsigned int err_mask; + int rc; + ++ VPRINTK("\n"); + spin_lock_irqsave(ap->lock, flags); + + /* no internal command while frozen */ +@@ -1729,7 +1776,11 @@ + *tf = qc->result_tf; + err_mask = qc->err_mask; + +- ata_qc_free(qc); ++ if (ap->ops->qc_free) { ++ ap->ops->qc_free(qc); ++ } else { ++ ata_qc_free(qc); ++ } + link->active_tag = preempted_tag; + link->sactive = preempted_sactive; + ap->qc_active = preempted_qc_active; +@@ -1783,6 +1834,7 @@ + struct scatterlist *psg = NULL, sg; + unsigned int n_elem = 0; + ++ VPRINTK("\n"); + if (dma_dir != DMA_NONE) { + WARN_ON(!buf); + sg_init_one(&sg, buf, buflen); +@@ -1812,6 +1864,7 @@ + { + struct ata_taskfile tf; + ++ VPRINTK("\n"); + ata_tf_init(dev, &tf); + + tf.command = cmd; +@@ -1831,6 +1884,7 @@ + + unsigned int ata_pio_need_iordy(const struct ata_device *adev) + { ++ VPRINTK("\n"); + /* Controller doesn't support IORDY. Probably a pointless check + as the caller should know this */ + if (adev->link->ap->flags & ATA_FLAG_NO_IORDY) +@@ -1854,6 +1908,7 @@ + + static u32 ata_pio_mask_no_iordy(const struct ata_device *adev) + { ++ VPRINTK("\n"); + /* If we have no drive specific rule, then PIO 2 is non IORDY */ + if (adev->id[ATA_ID_FIELD_VALID] & 2) { /* EIDE */ + u16 pio = adev->id[ATA_ID_EIDE_PIO]; +@@ -1900,12 +1955,15 @@ + int may_fallback = 1, tried_spinup = 0; + int rc; + ++ VPRINTK("\n"); + if (ata_msg_ctl(ap)) + ata_dev_printk(dev, KERN_DEBUG, "%s: ENTER\n", __FUNCTION__); + + ata_dev_select(ap, dev->devno, 1, 1); /* select device 0/1 */ + retry: + ata_tf_init(dev, &tf); ++ ++ tf.device |= ATA_LBA ; + + switch (class) { + case ATA_DEV_ATA: +@@ -2043,6 +2101,7 @@ + static inline u8 ata_dev_knobble(struct ata_device *dev) + { + struct ata_port *ap = dev->link->ap; ++ VPRINTK("\n"); + return ((ap->cbl == ATA_CBL_SATA) && (!ata_id_is_sata(dev->id))); + } + +@@ -2052,6 +2111,7 @@ + struct ata_port *ap = dev->link->ap; + int hdepth = 0, ddepth = ata_id_queue_depth(dev->id); + ++ VPRINTK("\n"); + if (!ata_id_has_ncq(dev->id)) { + desc[0] = '\0'; + return; +@@ -2096,6 +2156,7 @@ + char modelbuf[ATA_ID_PROD_LEN+1]; + int rc; + ++ VPRINTK("\n"); + if (!ata_dev_enabled(dev) && ata_msg_info(ap)) { + ata_dev_printk(dev, KERN_INFO, "%s: ENTER/EXIT -- nodev\n", + __FUNCTION__); +@@ -2334,7 +2395,7 @@ + } + + if (ap->ops->dev_config) +- ap->ops->dev_config(dev); ++ ap->ops->dev_config(ap, dev); + + if (ata_msg_probe(ap)) + ata_dev_printk(dev, KERN_DEBUG, "%s: EXIT, drv_stat = 0x%x\n", +@@ -2358,6 +2419,7 @@ + + int ata_cable_40wire(struct ata_port *ap) + { ++ VPRINTK("\n"); + return ATA_CBL_PATA40; + } + +@@ -2371,6 +2433,7 @@ + + int ata_cable_80wire(struct ata_port *ap) + { ++ VPRINTK("\n"); + return ATA_CBL_PATA80; + } + +@@ -2383,6 +2446,7 @@ + + int ata_cable_unknown(struct ata_port *ap) + { ++ VPRINTK("\n"); + return ATA_CBL_PATA_UNK; + } + +@@ -2395,6 +2459,7 @@ + + int ata_cable_sata(struct ata_port *ap) + { ++ VPRINTK("\n"); + return ATA_CBL_SATA; + } + +@@ -2420,6 +2485,7 @@ + int rc; + struct ata_device *dev; + ++ VPRINTK("\n"); + ata_port_probe(ap); + + ata_link_for_each_dev(dev, &ap->link) +@@ -2560,6 +2626,7 @@ + + void ata_port_probe(struct ata_port *ap) + { ++ VPRINTK("\n"); + ap->flags &= ~ATA_FLAG_DISABLED; + } + +@@ -2576,6 +2643,7 @@ + { + u32 sstatus, scontrol, tmp; + ++ VPRINTK("\n"); + if (sata_scr_read(link, SCR_STATUS, &sstatus)) + return; + sata_scr_read(link, SCR_CONTROL, &scontrol); +@@ -2604,6 +2672,7 @@ + { + struct ata_link *link = adev->link; + struct ata_device *pair = &link->device[1 - adev->devno]; ++ VPRINTK("\n"); + if (!ata_dev_enabled(pair)) + return NULL; + return pair; +@@ -2624,6 +2693,7 @@ + + void ata_port_disable(struct ata_port *ap) + { ++ VPRINTK("\n"); + ap->link.device[0].class = ATA_DEV_NONE; + ap->link.device[1].class = ATA_DEV_NONE; + ap->flags |= ATA_FLAG_DISABLED; +@@ -2648,6 +2718,7 @@ + u32 sstatus, spd, mask; + int rc, highbit; + ++ VPRINTK("\n"); + if (!sata_scr_valid(link)) + return -EOPNOTSUPP; + +@@ -2693,6 +2764,7 @@ + struct ata_link *host_link = &link->ap->link; + u32 limit, target, spd; + ++ VPRINTK("\n"); + limit = link->sata_spd_limit; + + /* Don't configure downstream link faster than upstream link. +@@ -2732,6 +2804,7 @@ + { + u32 scontrol; + ++ VPRINTK("\n"); + if (sata_scr_read(link, SCR_CONTROL, &scontrol)) + return 1; + +@@ -2756,6 +2829,7 @@ + u32 scontrol; + int rc; + ++ VPRINTK("\n"); + if ((rc = sata_scr_read(link, SCR_CONTROL, &scontrol))) + return rc; + +@@ -2822,6 +2896,7 @@ + + static void ata_timing_quantize(const struct ata_timing *t, struct ata_timing *q, int T, int UT) + { ++ VPRINTK("\n"); + q->setup = EZ(t->setup * 1000, T); + q->act8b = EZ(t->act8b * 1000, T); + q->rec8b = EZ(t->rec8b * 1000, T); +@@ -2835,6 +2910,7 @@ + void ata_timing_merge(const struct ata_timing *a, const struct ata_timing *b, + struct ata_timing *m, unsigned int what) + { ++ VPRINTK("\n"); + if (what & ATA_TIMING_SETUP ) m->setup = max(a->setup, b->setup); + if (what & ATA_TIMING_ACT8B ) m->act8b = max(a->act8b, b->act8b); + if (what & ATA_TIMING_REC8B ) m->rec8b = max(a->rec8b, b->rec8b); +@@ -2849,6 +2925,7 @@ + { + const struct ata_timing *t; + ++ VPRINTK("\n"); + for (t = ata_timing; t->mode != speed; t++) + if (t->mode == 0xFF) + return NULL; +@@ -2861,6 +2938,7 @@ + const struct ata_timing *s; + struct ata_timing p; + ++ VPRINTK("\n"); + /* + * Find the mode. + */ +@@ -2948,6 +3026,7 @@ + unsigned int pio_mask, mwdma_mask, udma_mask; + int quiet, highbit; + ++ VPRINTK("\n"); + quiet = !!(sel & ATA_DNXFER_QUIET); + sel &= ~ATA_DNXFER_QUIET; + +@@ -3021,6 +3100,7 @@ + unsigned int err_mask; + int rc; + ++ VPRINTK("\n"); + dev->flags &= ~ATA_DFLAG_PIO; + if (dev->xfer_shift == ATA_SHIFT_PIO) + dev->flags |= ATA_DFLAG_PIO; +@@ -3087,6 +3167,7 @@ + struct ata_device *dev; + int rc = 0, used_dma = 0, found = 0; + ++ VPRINTK("\n"); + /* step 1: calculate xfer_mask */ + ata_link_for_each_dev(dev, link) { + unsigned int pio_mask, dma_mask; +@@ -3191,6 +3272,7 @@ + { + struct ata_port *ap = link->ap; + ++ VPRINTK("\n"); + /* has private set_mode? */ + if (ap->ops->set_mode) + return ap->ops->set_mode(link, r_failed_dev); +@@ -3213,6 +3295,7 @@ + static inline void ata_tf_to_host(struct ata_port *ap, + const struct ata_taskfile *tf) + { ++ VPRINTK("\n"); + ap->ops->tf_load(ap, tf); + ap->ops->exec_command(ap, tf); + } +@@ -3238,6 +3321,7 @@ + unsigned long timer_start, timeout; + u8 status; + ++ VPRINTK("\n"); + status = ata_busy_wait(ap, ATA_BUSY, 300); + timer_start = jiffies; + timeout = timer_start + tmout_pat; +@@ -3291,6 +3375,7 @@ + { + unsigned long until = jiffies + ATA_TMOUT_FF_WAIT; + ++ VPRINTK("\n"); + if (time_before(until, deadline)) + deadline = until; + +@@ -3346,6 +3431,7 @@ + unsigned long start = jiffies; + int warned = 0; + ++ VPRINTK("\n"); + while (1) { + u8 status = ata_chk_status(ap); + unsigned long now = jiffies; +@@ -3377,6 +3463,7 @@ + unsigned int dev1 = devmask & (1 << 1); + int rc, ret = 0; + ++ VPRINTK("\n"); + /* if device 0 was found in ata_devchk, wait for its + * BSY bit to clear + */ +@@ -3432,19 +3519,36 @@ + static int ata_bus_softreset(struct ata_port *ap, unsigned int devmask, + unsigned long deadline) + { +- struct ata_ioports *ioaddr = &ap->ioaddr; ++ /* create a task file to control ctl register */ ++ struct ata_taskfile tf ; + + DPRINTK("ata%u: bus reset via SRST\n", ap->print_id); + ++ memset(&tf, 0, sizeof(tf)); ++#if 0 + /* software reset. causes dev0 to be selected */ +- iowrite8(ap->ctl, ioaddr->ctl_addr); ++ tf.ctl = ap->ctl; ++ ap->ops->tf_load(ap,&tf); + udelay(20); /* FIXME: flush */ +- iowrite8(ap->ctl | ATA_SRST, ioaddr->ctl_addr); ++ ++ tf.ctl = ap->ctl | ATA_SRST; ++ ap->ops->tf_load(ap,&tf); + udelay(20); /* FIXME: flush */ +- iowrite8(ap->ctl, ioaddr->ctl_addr); ++ ++ tf.ctl = ap->ctl; ++ ap->ops->tf_load(ap,&tf); + +- /* wait a while before checking status */ +- ata_wait_after_reset(ap, deadline); ++ /* spec mandates ">= 2ms" before checking status. ++ * We wait 150ms, because that was the magic delay used for ++ * ATAPI devices in Hale Landis's ATADRVR, for the period of time ++ * between when the ATA command register is written, and then ++ * status is checked. Because waiting for "a while" before ++ * checking status is fine, post SRST, we perform this magic ++ * delay here as well. ++ * ++ * Old drivers/ide uses the 2mS rule and then waits for ready ++ */ ++ msleep(150); + + /* Before we perform post reset processing we want to see if + * the bus shows 0xFF because the odd clown forgets the D7 +@@ -3452,7 +3556,7 @@ + */ + if (ata_chk_status(ap) == 0xFF) + return -ENODEV; +- ++#endif + return ata_bus_post_reset(ap, devmask, deadline); + } + +@@ -3479,7 +3583,6 @@ + void ata_bus_reset(struct ata_port *ap) + { + struct ata_device *device = ap->link.device; +- struct ata_ioports *ioaddr = &ap->ioaddr; + unsigned int slave_possible = ap->flags & ATA_FLAG_SLAVE_POSS; + u8 err; + unsigned int dev0, dev1 = 0, devmask = 0; +@@ -3530,8 +3633,11 @@ + goto err_out; + + if (ap->flags & (ATA_FLAG_SATA_RESET | ATA_FLAG_SRST)) { ++ /** @todo fix by using tf/tf_load as in ata_bus_softreset */ ++ #if 0 + /* set up device control for ATA_FLAG_SATA_RESET */ + iowrite8(ap->ctl, ioaddr->ctl_addr); ++ #endif + } + + DPRINTK("EXIT\n"); +@@ -3575,6 +3681,7 @@ + u32 last, cur; + int rc; + ++ VPRINTK("\n"); + t = jiffies + msecs_to_jiffies(params[2]); + if (time_before(t, deadline)) + deadline = t; +@@ -3633,6 +3740,7 @@ + u32 scontrol; + int rc; + ++ VPRINTK("\n"); + if ((rc = sata_scr_read(link, SCR_CONTROL, &scontrol))) + return rc; + +@@ -3673,6 +3781,7 @@ + const unsigned long *timing = sata_ehc_deb_timing(ehc); + int rc; + ++ VPRINTK("\n"); + /* handle link resume */ + if ((ehc->i.flags & ATA_EHI_RESUME_LINK) && + (link->flags & ATA_LFLAG_HRST_TO_RESUME)) +@@ -3939,9 +4048,12 @@ + return; + } + ++ /** @todo fix by using tf/tf_load as in ata_bus_softreset */ ++ #if 0 + /* set up device control */ + if (ap->ioaddr.ctl_addr) + iowrite8(ap->ctl, ap->ioaddr.ctl_addr); ++ #endif + + DPRINTK("EXIT\n"); + } +@@ -3969,6 +4081,7 @@ + unsigned char model[2][ATA_ID_PROD_LEN + 1]; + unsigned char serial[2][ATA_ID_SERNO_LEN + 1]; + ++ VPRINTK("\n"); + if (dev->class != new_class) { + ata_dev_printk(dev, KERN_INFO, "class mismatch %d != %d\n", + dev->class, new_class); +@@ -4015,6 +4128,7 @@ + u16 *id = (void *)dev->link->ap->sector_buf; + int rc; + ++ VPRINTK("\n"); + /* read ID data */ + rc = ata_dev_read_id(dev, &class, readid_flags, id); + if (rc) +@@ -4049,6 +4163,7 @@ + u64 n_sectors = dev->n_sectors; + int rc; + ++ VPRINTK("\n"); + if (!ata_dev_enabled(dev)) + return -ENODEV; + +@@ -4186,6 +4301,7 @@ + const char *p; + int len; + ++ VPRINTK("\n"); + /* + * check for trailing wildcard: *\0 + */ +@@ -4210,6 +4326,7 @@ + unsigned char model_rev[ATA_ID_FW_REV_LEN + 1]; + const struct ata_blacklist_entry *ad = ata_device_blacklist; + ++ VPRINTK("\n"); + ata_id_c_string(dev->id, model_num, ATA_ID_PROD, sizeof(model_num)); + ata_id_c_string(dev->id, model_rev, ATA_ID_FW_REV, sizeof(model_rev)); + +@@ -4227,6 +4344,7 @@ + + static int ata_dma_blacklisted(const struct ata_device *dev) + { ++ VPRINTK("\n"); + /* We don't support polling DMA. + * DMA blacklist those ATAPI devices with CDB-intr (and use PIO) + * if the LLDD handles only interrupts in the HSM_ST_LAST state. +@@ -4247,6 +4365,7 @@ + + static int ata_is_40wire(struct ata_device *dev) + { ++ VPRINTK("\n"); + if (dev->horkage & ATA_HORKAGE_IVB) + return ata_drive_40wire_relaxed(dev->id); + return ata_drive_40wire(dev->id); +@@ -4271,6 +4390,7 @@ + struct ata_host *host = ap->host; + unsigned long xfer_mask; + ++ VPRINTK("\n"); + /* controller modes available */ + xfer_mask = ata_pack_xfermask(ap->pio_mask, + ap->mwdma_mask, ap->udma_mask); +@@ -4525,6 +4645,7 @@ + struct scatterlist *sg; + unsigned int idx; + ++ VPRINTK("\n"); + WARN_ON(qc->__sg == NULL); + WARN_ON(qc->n_elem == 0 && qc->pad_len == 0); + +@@ -4579,6 +4700,7 @@ + struct scatterlist *sg; + unsigned int idx; + ++ VPRINTK("\n"); + WARN_ON(qc->__sg == NULL); + WARN_ON(qc->n_elem == 0 && qc->pad_len == 0); + +@@ -4640,6 +4762,7 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); + /* Don't allow DMA if it isn't multiple of 16 bytes. Quite a + * few ATAPI devices choke on such DMA requests. + */ +@@ -4669,6 +4792,7 @@ + */ + static int atapi_qc_may_overflow(struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + if (qc->tf.protocol != ATA_PROT_ATAPI && + qc->tf.protocol != ATA_PROT_ATAPI_DMA) + return 0; +@@ -4708,6 +4832,7 @@ + { + struct ata_link *link = qc->dev->link; + ++ VPRINTK("\n"); + if (qc->tf.protocol == ATA_PROT_NCQ) { + if (!ata_tag_valid(link->active_tag)) + return 0; +@@ -4730,6 +4855,7 @@ + */ + void ata_qc_prep(struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + if (!(qc->flags & ATA_QCFLAG_DMAMAP)) + return; + +@@ -4747,6 +4873,7 @@ + */ + void ata_dumb_qc_prep(struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + if (!(qc->flags & ATA_QCFLAG_DMAMAP)) + return; + +@@ -4770,6 +4897,7 @@ + + void ata_sg_init_one(struct ata_queued_cmd *qc, void *buf, unsigned int buflen) + { ++ VPRINTK("\n"); + qc->flags |= ATA_QCFLAG_SINGLE; + + qc->__sg = &qc->sgent; +@@ -4799,6 +4927,7 @@ + void ata_sg_init(struct ata_queued_cmd *qc, struct scatterlist *sg, + unsigned int n_elem) + { ++ VPRINTK("\n"); + qc->flags |= ATA_QCFLAG_SG; + qc->__sg = sg; + qc->n_elem = n_elem; +@@ -4827,6 +4956,7 @@ + dma_addr_t dma_address; + int trim_sg = 0; + ++ VPRINTK("\n"); + /* we must lengthen transfers to end on a 32-bit boundary */ + qc->pad_len = sg->length & 3; + if (qc->pad_len) { +@@ -5001,6 +5131,7 @@ + struct ata_port *ap = adev->link->ap; + unsigned int words = buflen >> 1; + ++ VPRINTK("\n"); + /* Transfer multiple of 2 bytes */ + if (write_data) + iowrite16_rep(ap->ioaddr.data_addr, buf, words); +@@ -5039,6 +5170,7 @@ + unsigned int buflen, int write_data) + { + unsigned long flags; ++ VPRINTK("\n"); + local_irq_save(flags); + ata_data_xfer(adev, buf, buflen, write_data); + local_irq_restore(flags); +@@ -5063,6 +5195,7 @@ + unsigned int offset; + unsigned char *buf; + ++ VPRINTK("\n"); + if (qc->curbytes == qc->nbytes - qc->sect_size) + ap->hsm_task_state = HSM_ST_LAST; + +@@ -5114,6 +5247,7 @@ + + static void ata_pio_sectors(struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + if (is_multi_taskfile(&qc->tf)) { + /* READ/WRITE MULTIPLE */ + unsigned int nsect; +@@ -5187,6 +5321,7 @@ + unsigned char *buf; + unsigned int offset, count; + ++ VPRINTK("\n"); + next_sg: + sg = qc->cursg; + if (unlikely(!sg)) { +@@ -5287,6 +5422,7 @@ + unsigned int ireason, bc_lo, bc_hi, bytes; + int i_write, do_write = (qc->tf.flags & ATA_TFLAG_WRITE) ? 1 : 0; + ++ VPRINTK("\n"); + /* Abuse qc->result_tf for temp storage of intermediate TF + * here to save some kernel stack usage. + * For normal completion, qc->result_tf is not relevant. For +@@ -5333,6 +5469,7 @@ + + static inline int ata_hsm_ok_in_wq(struct ata_port *ap, struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + if (qc->tf.flags & ATA_TFLAG_POLLING) + return 1; + +@@ -5365,6 +5502,7 @@ + struct ata_port *ap = qc->ap; + unsigned long flags; + ++ VPRINTK("\n"); + if (ap->ops->error_handler) { + if (in_wq) { + spin_lock_irqsave(ap->lock, flags); +@@ -5415,6 +5553,7 @@ + unsigned long flags = 0; + int poll_next; + ++ VPRINTK("\n"); + WARN_ON((qc->flags & ATA_QCFLAG_ACTIVE) == 0); + + /* Make sure ata_qc_issue_prot() does not throw things +@@ -5649,6 +5788,7 @@ + u8 status; + int poll_next; + ++ VPRINTK("\n"); + fsm_start: + WARN_ON(ap->hsm_task_state == HSM_ST_IDLE); + +@@ -5664,6 +5804,9 @@ + msleep(2); + status = ata_busy_wait(ap, ATA_BUSY, 10); + if (status & ATA_BUSY) { ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, ATA_SHORT_PAUSE); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, ATA_SHORT_PAUSE); + return; + } +@@ -5693,6 +5836,7 @@ + struct ata_queued_cmd *qc = NULL; + unsigned int i; + ++ VPRINTK("\n"); + /* no command while frozen */ + if (unlikely(ap->pflags & ATA_PFLAG_FROZEN)) + return NULL; +@@ -5723,7 +5867,14 @@ + struct ata_port *ap = dev->link->ap; + struct ata_queued_cmd *qc; + +- qc = ata_qc_new(ap); ++ VPRINTK("\n"); ++ /* if a specialised version is not available, call the default */ ++ if (ap->ops->qc_new) { ++ qc = ap->ops->qc_new(ap); ++ } else { ++ qc = ata_qc_new(ap); ++ } ++ + if (qc) { + qc->scsicmd = NULL; + qc->ap = ap; +@@ -5750,6 +5901,7 @@ + struct ata_port *ap = qc->ap; + unsigned int tag; + ++ VPRINTK("\n"); + WARN_ON(qc == NULL); /* ata_qc_from_tag _might_ return NULL */ + + qc->flags = 0; +@@ -5765,6 +5917,7 @@ + struct ata_port *ap = qc->ap; + struct ata_link *link = qc->dev->link; + ++ VPRINTK("\n"); + WARN_ON(qc == NULL); /* ata_qc_from_tag _might_ return NULL */ + WARN_ON(!(qc->flags & ATA_QCFLAG_ACTIVE)); + +@@ -5801,6 +5954,7 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); + qc->result_tf.flags = qc->tf.flags; + ap->ops->tf_read(ap, &qc->result_tf); + } +@@ -5820,6 +5974,7 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); + /* XXX: New EH and old EH use different mechanisms to + * synchronize EH with regular execution path. + * +@@ -5913,6 +6068,7 @@ + u32 done_mask; + int i; + ++ VPRINTK("\n"); + done_mask = ap->qc_active ^ qc_active; + + if (unlikely(done_mask & qc_active)) { +@@ -5942,6 +6098,7 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); + switch (qc->tf.protocol) { + case ATA_PROT_NCQ: + case ATA_PROT_DMA: +@@ -5979,6 +6136,7 @@ + struct ata_port *ap = qc->ap; + struct ata_link *link = qc->dev->link; + ++ VPRINTK("\n"); + /* Make sure only one non-NCQ command is outstanding. The + * check is skipped for old EH because it reuses active qc to + * request ATAPI sense. +@@ -6057,6 +6215,7 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); + /* Use polling pio if the LLD doesn't handle + * interrupt driven pio and atapi CDB interrupt. + */ +@@ -6084,18 +6243,24 @@ + /* start the command */ + switch (qc->tf.protocol) { + case ATA_PROT_NODATA: ++ VPRINTK("ATA_PROT_NODATA\n"); + if (qc->tf.flags & ATA_TFLAG_POLLING) + ata_qc_set_polling(qc); + + ata_tf_to_host(ap, &qc->tf); + ap->hsm_task_state = HSM_ST_LAST; + +- if (qc->tf.flags & ATA_TFLAG_POLLING) ++ if (qc->tf.flags & ATA_TFLAG_POLLING) { ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, 0); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, 0); ++ } + + break; + + case ATA_PROT_DMA: ++ VPRINTK("ATA_PROT_DMA\n"); + WARN_ON(qc->tf.flags & ATA_TFLAG_POLLING); + + ap->ops->tf_load(ap, &qc->tf); /* load tf registers */ +@@ -6105,6 +6270,7 @@ + break; + + case ATA_PROT_PIO: ++ VPRINTK("ATA_PROT_PIO\n"); + if (qc->tf.flags & ATA_TFLAG_POLLING) + ata_qc_set_polling(qc); + +@@ -6113,6 +6279,9 @@ + if (qc->tf.flags & ATA_TFLAG_WRITE) { + /* PIO data out protocol */ + ap->hsm_task_state = HSM_ST_FIRST; ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, 0); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, 0); + + /* always send first data block using +@@ -6122,8 +6291,12 @@ + /* PIO data in protocol */ + ap->hsm_task_state = HSM_ST; + +- if (qc->tf.flags & ATA_TFLAG_POLLING) ++ if (qc->tf.flags & ATA_TFLAG_POLLING) { ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, 0); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, 0); ++ } + + /* if polling, ata_pio_task() handles the rest. + * otherwise, interrupt handler takes over from here. +@@ -6134,6 +6307,7 @@ + + case ATA_PROT_ATAPI: + case ATA_PROT_ATAPI_NODATA: ++ VPRINTK("ATA_PROT_ATAPI / ATA_PROT_ATAPI_NODATA\n"); + if (qc->tf.flags & ATA_TFLAG_POLLING) + ata_qc_set_polling(qc); + +@@ -6143,11 +6317,16 @@ + + /* send cdb by polling if no cdb interrupt */ + if ((!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) || +- (qc->tf.flags & ATA_TFLAG_POLLING)) ++ (qc->tf.flags & ATA_TFLAG_POLLING)) { ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, 0); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, 0); ++ } + break; + + case ATA_PROT_ATAPI_DMA: ++ VPRINTK("ATA_PROT_ATAPI_DMA\n"); + WARN_ON(qc->tf.flags & ATA_TFLAG_POLLING); + + ap->ops->tf_load(ap, &qc->tf); /* load tf registers */ +@@ -6155,8 +6334,12 @@ + ap->hsm_task_state = HSM_ST_FIRST; + + /* send cdb by polling if no cdb interrupt */ +- if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) ++ if (!(qc->dev->flags & ATA_DFLAG_CDB_INTR)) { ++ if (ap->ops->pio_task) ++ ata_port_queue_task(ap, ap->ops->pio_task, qc, 0); ++ else + ata_port_queue_task(ap, ata_pio_task, qc, 0); ++ } + break; + + default: +@@ -6291,6 +6474,7 @@ + unsigned int handled = 0; + unsigned long flags; + ++ VPRINTK("\n"); + /* TODO: make _irqsave conditional on x86 PCI IDE legacy mode */ + spin_lock_irqsave(&host->lock, flags); + +@@ -6330,6 +6514,7 @@ + { + struct ata_port *ap = link->ap; + ++ VPRINTK("\n"); + return (ap->flags & ATA_FLAG_SATA) && ap->ops->scr_read; + } + +@@ -6351,6 +6536,7 @@ + */ + int sata_scr_read(struct ata_link *link, int reg, u32 *val) + { ++ VPRINTK("\n"); + if (ata_is_host_link(link)) { + struct ata_port *ap = link->ap; + +@@ -6380,6 +6566,7 @@ + */ + int sata_scr_write(struct ata_link *link, int reg, u32 val) + { ++ VPRINTK("\n"); + if (ata_is_host_link(link)) { + struct ata_port *ap = link->ap; + +@@ -6408,6 +6595,7 @@ + */ + int sata_scr_write_flush(struct ata_link *link, int reg, u32 val) + { ++ VPRINTK("\n"); + if (ata_is_host_link(link)) { + struct ata_port *ap = link->ap; + int rc; +@@ -6442,6 +6630,7 @@ + { + u32 sstatus; + ++ VPRINTK("\n"); + if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0 && + (sstatus & 0xf) == 0x3) + return 1; +@@ -6466,6 +6655,7 @@ + { + u32 sstatus; + ++ VPRINTK("\n"); + if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0 && + (sstatus & 0xf) != 0x3) + return 1; +@@ -6477,6 +6667,7 @@ + unsigned int err_mask; + u8 cmd; + ++ VPRINTK("\n"); + if (!ata_try_flush_cache(dev)) + return 0; + +@@ -6506,6 +6697,7 @@ + unsigned long flags; + int i, rc; + ++ VPRINTK("\n"); + for (i = 0; i < host->n_ports; i++) { + struct ata_port *ap = host->ports[i]; + struct ata_link *link; +@@ -6568,6 +6760,7 @@ + { + int rc; + ++ VPRINTK("\n"); + /* + * disable link pm on all ports before requesting + * any pm activity +@@ -6593,6 +6786,7 @@ + */ + void ata_host_resume(struct ata_host *host) + { ++ VPRINTK("\n"); + ata_host_request_pm(host, PMSG_ON, ATA_EH_SOFTRESET, + ATA_EHI_NO_AUTOPSY | ATA_EHI_QUIET, 0); + host->dev->power.power_state = PMSG_ON; +@@ -6619,6 +6813,7 @@ + struct device *dev = ap->dev; + int rc; + ++ VPRINTK("\n"); + ap->prd = dmam_alloc_coherent(dev, ATA_PRD_TBL_SZ, &ap->prd_dma, + GFP_KERNEL); + if (!ap->prd) +@@ -6648,6 +6843,7 @@ + struct ata_port *ap = link->ap; + unsigned long flags; + ++ VPRINTK("\n"); + /* SATA spd limit is bound to the first device */ + link->sata_spd_limit = link->hw_sata_spd_limit; + link->sata_spd = 0; +@@ -6683,6 +6879,7 @@ + { + int i; + ++ VPRINTK("\n"); + /* clear everything except for devices */ + memset(link, 0, offsetof(struct ata_link, device[0])); + +@@ -6719,6 +6916,7 @@ + u32 scontrol, spd; + int rc; + ++ VPRINTK("\n"); + rc = sata_scr_read(link, SCR_CONTROL, &scontrol); + if (rc) + return rc; +@@ -6797,6 +6995,7 @@ + struct ata_host *host = dev_get_drvdata(gendev); + int i; + ++ VPRINTK("\n"); + for (i = 0; i < host->n_ports; i++) { + struct ata_port *ap = host->ports[i]; + +@@ -6903,6 +7102,7 @@ + struct ata_host *host; + int i, j; + ++ VPRINTK("\n"); + host = ata_host_alloc(dev, n_ports); + if (!host) + return NULL; +@@ -6934,6 +7134,7 @@ + struct ata_host *host = dev_get_drvdata(gendev); + int i; + ++ VPRINTK("\n"); + WARN_ON(!(host->flags & ATA_HOST_STARTED)); + + for (i = 0; i < host->n_ports; i++) { +@@ -6969,6 +7170,8 @@ + void *start_dr = NULL; + int i, rc; + ++ VPRINTK("\n"); ++ + if (host->flags & ATA_HOST_STARTED) + return 0; + +@@ -7007,6 +7210,7 @@ + ata_eh_freeze_port(ap); + } + ++ + if (start_dr) + devres_add(host->dev, start_dr); + host->flags |= ATA_HOST_STARTED; +@@ -7038,6 +7242,7 @@ + void ata_host_init(struct ata_host *host, struct device *dev, + unsigned long flags, const struct ata_port_operations *ops) + { ++ VPRINTK("\n"); + spin_lock_init(&host->lock); + host->dev = dev; + host->flags = flags; +@@ -7064,6 +7269,7 @@ + { + int i, rc; + ++ VPRINTK("\n"); + /* host must have been started */ + if (!(host->flags & ATA_HOST_STARTED)) { + dev_printk(KERN_ERR, host->dev, +@@ -7203,6 +7409,7 @@ + { + int i, rc; + ++ VPRINTK("\n"); + rc = ata_host_start(host); + if (rc) + return rc; +@@ -7246,6 +7453,7 @@ + struct ata_link *link; + struct ata_device *dev; + ++ VPRINTK("\n"); + if (!ap->ops->error_handler) + goto skip_eh; + +@@ -7293,6 +7501,7 @@ + { + int i; + ++ VPRINTK("\n"); + for (i = 0; i < host->n_ports; i++) + ata_port_detach(host->ports[i]); + +@@ -7314,6 +7523,7 @@ + + void ata_std_ports(struct ata_ioports *ioaddr) + { ++ VPRINTK("\n"); + ioaddr->data_addr = ioaddr->cmd_addr + ATA_REG_DATA; + ioaddr->error_addr = ioaddr->cmd_addr + ATA_REG_ERR; + ioaddr->feature_addr = ioaddr->cmd_addr + ATA_REG_FEATURE; +@@ -7345,6 +7555,7 @@ + struct device *dev = &pdev->dev; + struct ata_host *host = dev_get_drvdata(dev); + ++ VPRINTK("\n"); + ata_host_detach(host); + } + +@@ -7353,6 +7564,7 @@ + { + unsigned long tmp = 0; + ++ VPRINTK("\n"); + switch (bits->width) { + case 1: { + u8 tmp8 = 0; +@@ -7385,6 +7597,7 @@ + #ifdef CONFIG_PM + void ata_pci_device_do_suspend(struct pci_dev *pdev, pm_message_t mesg) + { ++ VPRINTK("\n"); + pci_save_state(pdev); + pci_disable_device(pdev); + +@@ -7396,6 +7609,7 @@ + { + int rc; + ++ VPRINTK("\n"); + pci_set_power_state(pdev, PCI_D0); + pci_restore_state(pdev); + +@@ -7415,6 +7629,7 @@ + struct ata_host *host = dev_get_drvdata(&pdev->dev); + int rc = 0; + ++ VPRINTK("\n"); + rc = ata_host_suspend(host, mesg); + if (rc) + return rc; +@@ -7429,6 +7644,7 @@ + struct ata_host *host = dev_get_drvdata(&pdev->dev); + int rc; + ++ VPRINTK("\n"); + rc = ata_pci_device_do_resume(pdev); + if (rc == 0) + ata_host_resume(host); +@@ -7442,6 +7658,7 @@ + static int __init ata_init(void) + { + ata_probe_timeout *= HZ; ++ VPRINTK("\n"); + ata_wq = create_workqueue("ata"); + if (!ata_wq) + return -ENOMEM; +@@ -7458,6 +7675,7 @@ + + static void __exit ata_exit(void) + { ++ VPRINTK("\n"); + destroy_workqueue(ata_wq); + destroy_workqueue(ata_aux_wq); + } +@@ -7473,6 +7691,7 @@ + int rc; + unsigned long flags; + ++ VPRINTK("\n"); + spin_lock_irqsave(&ata_ratelimit_lock, flags); + + if (time_after(jiffies, ratelimit_time)) { +@@ -7516,6 +7735,7 @@ + unsigned long timeout; + u32 tmp; + ++ VPRINTK("\n"); + tmp = ioread32(reg); + + /* Calculate timeout _after_ the first read to make sure +@@ -7541,11 +7761,13 @@ + + static u8 ata_dummy_check_status(struct ata_port *ap) + { ++ VPRINTK("\n"); + return ATA_DRDY; + } + + static unsigned int ata_dummy_qc_issue(struct ata_queued_cmd *qc) + { ++ VPRINTK("\n"); + return AC_ERR_SYSTEM; + } + +diff -Nurd linux-2.6.24/drivers/ata/libata-eh.c linux-2.6.24-oxe810/drivers/ata/libata-eh.c +--- linux-2.6.24/drivers/ata/libata-eh.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/libata-eh.c 2008-06-11 17:50:32.000000000 +0200 +@@ -89,6 +89,8 @@ + static void __ata_ehi_pushv_desc(struct ata_eh_info *ehi, const char *fmt, + va_list args) + { ++ VPRINTK("\n"); ++ + ehi->desc_len += vscnprintf(ehi->desc + ehi->desc_len, + ATA_EH_DESC_LEN - ehi->desc_len, + fmt, args); +@@ -108,6 +110,8 @@ + { + va_list args; + ++ VPRINTK("\n"); ++ + va_start(args, fmt); + __ata_ehi_pushv_desc(ehi, fmt, args); + va_end(args); +@@ -128,6 +132,8 @@ + { + va_list args; + ++ VPRINTK("\n"); ++ + if (ehi->desc_len) + __ata_ehi_push_desc(ehi, ", "); + +@@ -147,6 +153,8 @@ + */ + void ata_ehi_clear_desc(struct ata_eh_info *ehi) + { ++ VPRINTK("\n"); ++ + ehi->desc[0] = '\0'; + ehi->desc_len = 0; + } +@@ -168,6 +176,8 @@ + { + va_list args; + ++ VPRINTK("\n"); ++ + WARN_ON(!(ap->pflags & ATA_PFLAG_INITIALIZING)); + + if (ap->link.eh_info.desc_len) +@@ -202,6 +212,8 @@ + char *type = ""; + unsigned long long start, len; + ++ VPRINTK("\n"); ++ + if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM) + type = "m"; + else if (pci_resource_flags(pdev, bar) & IORESOURCE_IO) +@@ -223,6 +235,8 @@ + { + struct ata_ering_entry *ent; + ++ VPRINTK("\n"); ++ + WARN_ON(!err_mask); + + ering->cursor++; +@@ -236,6 +250,8 @@ + + static void ata_ering_clear(struct ata_ering *ering) + { ++ VPRINTK("\n"); ++ + memset(ering, 0, sizeof(*ering)); + } + +@@ -246,6 +262,8 @@ + int idx, rc = 0; + struct ata_ering_entry *ent; + ++ VPRINTK("\n"); ++ + idx = ering->cursor; + do { + ent = &ering->ring[idx]; +@@ -264,6 +282,8 @@ + { + struct ata_eh_context *ehc = &dev->link->eh_context; + ++ VPRINTK("\n"); ++ + return ehc->i.action | ehc->i.dev_action[dev->devno]; + } + +@@ -272,6 +292,8 @@ + { + struct ata_device *tdev; + ++ VPRINTK("\n"); ++ + if (!dev) { + ehi->action &= ~action; + ata_link_for_each_dev(tdev, link) +@@ -537,8 +559,11 @@ + void ata_port_wait_eh(struct ata_port *ap) + { + unsigned long flags; ++ + DEFINE_WAIT(wait); + ++ VPRINTK("\n"); ++ + retry: + spin_lock_irqsave(ap->lock, flags); + +@@ -564,6 +589,8 @@ + unsigned int tag; + int nr = 0; + ++ VPRINTK("\n"); ++ + /* count only non-internal commands */ + for (tag = 0; tag < ATA_MAX_QUEUE - 1; tag++) + if (ata_qc_from_tag(ap, tag)) +@@ -578,6 +605,8 @@ + unsigned long flags; + int cnt; + ++ VPRINTK("\n"); ++ + spin_lock_irqsave(ap->lock, flags); + + cnt = ata_eh_nr_in_flight(ap); +@@ -627,6 +656,8 @@ + { + int cnt; + ++ VPRINTK("\n"); ++ + /* already scheduled? */ + if (ap->pflags & ATA_PFLAG_EH_PENDING) + return; +@@ -661,6 +692,8 @@ + { + struct ata_port *ap = qc->ap; + ++ VPRINTK("\n"); ++ + WARN_ON(!ap->ops->error_handler); + + qc->flags |= ATA_QCFLAG_FAILED; +@@ -686,6 +719,8 @@ + */ + void ata_port_schedule_eh(struct ata_port *ap) + { ++ VPRINTK("\n"); ++ + WARN_ON(!ap->ops->error_handler); + + if (ap->pflags & ATA_PFLAG_INITIALIZING) +@@ -701,6 +736,8 @@ + { + int tag, nr_aborted = 0; + ++ VPRINTK("\n"); ++ + WARN_ON(!ap->ops->error_handler); + + /* we're gonna abort all commands, no need for fast drain */ +@@ -736,6 +773,8 @@ + */ + int ata_link_abort(struct ata_link *link) + { ++ VPRINTK("\n"); ++ + return ata_do_link_abort(link->ap, link); + } + +@@ -753,6 +792,8 @@ + */ + int ata_port_abort(struct ata_port *ap) + { ++ VPRINTK("\n"); ++ + return ata_do_link_abort(ap, NULL); + } + +@@ -776,6 +817,8 @@ + */ + static void __ata_port_freeze(struct ata_port *ap) + { ++ VPRINTK("\n"); ++ + WARN_ON(!ap->ops->error_handler); + + if (ap->ops->freeze) +@@ -802,6 +845,8 @@ + { + int nr_aborted; + ++ VPRINTK("\n"); ++ + WARN_ON(!ap->ops->error_handler); + + nr_aborted = ata_port_abort(ap); +@@ -828,6 +873,8 @@ + u32 sntf; + int rc; + ++ VPRINTK("\n"); ++ + if (!(ap->flags & ATA_FLAG_AN)) + return 0; + +@@ -896,6 +943,8 @@ + { + unsigned long flags; + ++ VPRINTK("\n"); ++ + if (!ap->ops->error_handler) + return; + +@@ -917,6 +966,8 @@ + { + unsigned long flags; + ++ VPRINTK("\n"); ++ + if (!ap->ops->error_handler) + return; + +@@ -943,6 +994,8 @@ + struct scsi_cmnd *scmd = qc->scsicmd; + unsigned long flags; + ++ VPRINTK("\n"); ++ + spin_lock_irqsave(ap->lock, flags); + qc->scsidone = ata_eh_scsidone; + __ata_qc_complete(qc); +@@ -962,6 +1015,8 @@ + void ata_eh_qc_complete(struct ata_queued_cmd *qc) + { + struct scsi_cmnd *scmd = qc->scsicmd; ++ VPRINTK("\n"); ++ + scmd->retries = scmd->allowed; + __ata_eh_qc_complete(qc); + } +@@ -980,6 +1035,8 @@ + void ata_eh_qc_retry(struct ata_queued_cmd *qc) + { + struct scsi_cmnd *scmd = qc->scsicmd; ++ VPRINTK("\n"); ++ + if (!qc->err_mask && scmd->retries) + scmd->retries--; + __ata_eh_qc_complete(qc); +@@ -1000,6 +1057,8 @@ + struct ata_port *ap = link->ap; + unsigned long flags; + ++ VPRINTK("\n"); ++ + ata_dev_disable(dev); + + spin_lock_irqsave(ap->lock, flags); +@@ -1039,6 +1098,8 @@ + struct ata_eh_context *ehc = &link->eh_context; + unsigned long flags; + ++ VPRINTK("\n"); ++ + spin_lock_irqsave(ap->lock, flags); + + /* Reset is represented by combination of actions and EHI +@@ -1079,6 +1140,8 @@ + { + struct ata_eh_context *ehc = &link->eh_context; + ++ VPRINTK("\n"); ++ + /* if reset is complete, clear all reset actions & reset modifier */ + if (action & ATA_EH_RESET_MASK) { + action |= ATA_EH_RESET_MASK; +@@ -1104,6 +1167,8 @@ + */ + static const char *ata_err_string(unsigned int err_mask) + { ++ VPRINTK("\n"); ++ + if (err_mask & AC_ERR_HOST_BUS) + return "host bus error"; + if (err_mask & AC_ERR_ATA_BUS) +@@ -1184,6 +1249,8 @@ + u8 csum; + int i; + ++ VPRINTK("\n"); ++ + err_mask = ata_read_log_page(dev, ATA_LOG_SATA_NCQ, buf, 1); + if (err_mask) + return -EIO; +@@ -1289,6 +1356,8 @@ + unsigned int err_mask = 0, action = 0; + u32 hotplug_mask; + ++ VPRINTK("\n"); ++ + if (serror & SERR_PERSISTENT) { + err_mask |= AC_ERR_ATA_BUS; + action |= ATA_EH_HARDRESET; +@@ -1347,6 +1416,8 @@ + struct ata_taskfile tf; + int tag, rc; + ++ VPRINTK("\n"); ++ + /* if frozen, we can't do much */ + if (ap->pflags & ATA_PFLAG_FROZEN) + return; +@@ -1408,6 +1479,8 @@ + unsigned int tmp, action = 0; + u8 stat = tf->command, err = tf->feature; + ++ VPRINTK("\n"); ++ + if ((stat & (ATA_BUSY | ATA_DRQ | ATA_DRDY)) != ATA_DRDY) { + qc->err_mask |= AC_ERR_HSM; + return ATA_EH_SOFTRESET; +@@ -1453,6 +1526,8 @@ + + static int ata_eh_categorize_error(int is_io, unsigned int err_mask) + { ++ VPRINTK("\n"); ++ + if (err_mask & AC_ERR_ATA_BUS) + return 1; + +@@ -1480,6 +1555,8 @@ + struct speed_down_verdict_arg *arg = void_arg; + int cat = ata_eh_categorize_error(ent->is_io, ent->err_mask); + ++ VPRINTK("\n"); ++ + if (ent->timestamp < arg->since) + return -1; + +@@ -1525,6 +1602,8 @@ + struct speed_down_verdict_arg arg; + unsigned int verdict = 0; + ++ VPRINTK("\n"); ++ + /* scan past 10 mins of error history */ + memset(&arg, 0, sizeof(arg)); + arg.since = j64 - min(j64, j10mins); +@@ -1569,6 +1648,8 @@ + unsigned int verdict; + unsigned int action = 0; + ++ VPRINTK("\n"); ++ + /* don't bother if Cat-0 error */ + if (ata_eh_categorize_error(is_io, err_mask) == 0) + return 0; +@@ -1763,6 +1844,8 @@ + { + struct ata_link *link; + ++ VPRINTK("\n"); ++ + ata_port_for_each_link(link, ap) + ata_eh_link_autopsy(link); + +@@ -1790,6 +1873,8 @@ + char tries_buf[6]; + int tag, nr_failed = 0; + ++ VPRINTK("\n"); ++ + if (ehc->i.flags & ATA_EHI_QUIET) + return; + +@@ -1954,6 +2039,8 @@ + { + struct ata_link *link; + ++ VPRINTK("\n"); ++ + __ata_port_for_each_link(link, ap) + ata_eh_link_report(link); + } +@@ -1964,6 +2051,8 @@ + struct ata_device *dev; + int rc; + ++ VPRINTK("\n"); ++ + ata_link_for_each_dev(dev, link) + classes[dev->devno] = ATA_DEV_UNKNOWN; + +@@ -1993,6 +2082,8 @@ + int rc, int classify, + const unsigned int *classes) + { ++ VPRINTK("\n"); ++ + if (link->flags & ATA_LFLAG_NO_SRST) + return 0; + if (rc == -EAGAIN) +@@ -2026,6 +2117,8 @@ + u32 sstatus; + int rc; + ++ VPRINTK("\n"); ++ + /* about to reset */ + spin_lock_irqsave(ap->lock, flags); + ap->pflags |= ATA_PFLAG_RESETTING; +@@ -2334,6 +2427,8 @@ + struct ata_device *dev; + int cnt = 0; + ++ VPRINTK("\n"); ++ + ata_link_for_each_dev(dev, link) + if (ata_dev_enabled(dev)) + cnt++; +@@ -2345,6 +2440,8 @@ + struct ata_device *dev; + int cnt = 0; + ++ VPRINTK("\n"); ++ + ata_link_for_each_dev(dev, link) + if (dev->class == ATA_DEV_UNKNOWN) + cnt++; +@@ -2356,6 +2453,8 @@ + struct ata_eh_context *ehc = &link->eh_context; + struct ata_device *dev; + ++ VPRINTK("\n"); ++ + /* skip disabled links */ + if (link->flags & ATA_LFLAG_DISABLED) + return 1; +@@ -2379,6 +2478,8 @@ + { + struct ata_eh_context *ehc = &dev->link->eh_context; + ++ VPRINTK("\n"); ++ + ehc->tries[dev->devno]--; + + switch (err) { +@@ -2638,6 +2739,8 @@ + { + int tag; + ++ VPRINTK("\n"); ++ + /* retry or finish qcs */ + for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { + struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag); +@@ -2697,6 +2800,8 @@ + struct ata_device *dev; + int rc; + ++ VPRINTK("\n"); ++ + ata_eh_autopsy(ap); + ata_eh_report(ap); + +@@ -2725,6 +2830,8 @@ + unsigned long flags; + int rc = 0; + ++ VPRINTK("\n"); ++ + /* are we suspending? */ + spin_lock_irqsave(ap->lock, flags); + if (!(ap->pflags & ATA_PFLAG_PM_PENDING) || +@@ -2781,6 +2888,8 @@ + unsigned long flags; + int rc = 0; + ++ VPRINTK("\n"); ++ + /* are we resuming? */ + spin_lock_irqsave(ap->lock, flags); + if (!(ap->pflags & ATA_PFLAG_PM_PENDING) || +diff -Nurd linux-2.6.24/drivers/ata/libata-scsi.c linux-2.6.24-oxe810/drivers/ata/libata-scsi.c +--- linux-2.6.24/drivers/ata/libata-scsi.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/libata-scsi.c 2008-06-11 17:50:32.000000000 +0200 +@@ -1477,7 +1477,10 @@ + + qc->scsidone(cmd); + +- ata_qc_free(qc); ++ if (ap->ops->qc_free) ++ ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + } + + /** +@@ -1552,13 +1555,19 @@ + return 0; + + early_finish: +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + qc->scsidone(cmd); + DPRINTK("EXIT - early finish (good or error)\n"); + return 0; + + err_did: +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + cmd->result = (DID_ERROR << 16); + qc->scsidone(cmd); + err_mem: +@@ -1566,7 +1575,10 @@ + return 0; + + defer: +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + DPRINTK("EXIT - defer\n"); + if (rc == ATA_DEFER_LINK) + return SCSI_MLQUEUE_DEVICE_BUSY; +@@ -2314,7 +2326,10 @@ + } + + qc->scsidone(qc->scsicmd); +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + } + + /* is it pointless to prefer PIO for "safety reasons"? */ +@@ -2403,7 +2418,10 @@ + + qc->scsicmd->result = SAM_STAT_CHECK_CONDITION; + qc->scsidone(cmd); +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + return; + } + +@@ -2448,7 +2466,10 @@ + } + + qc->scsidone(cmd); +- ata_qc_free(qc); ++ if (qc->ap->ops->qc_free) ++ qc->ap->ops->qc_free(qc); ++ else ++ ata_qc_free(qc); + } + /** + * atapi_xlat - Initialize PACKET taskfile +@@ -2694,6 +2715,12 @@ + if (tf->protocol == ATA_PROT_DMA && dev->dma_mode == 0) + goto invalid_fld; + ++ /** @NOTE: OX800/OX810 driver needs polling for PIO and no data commands */ ++ if ((tf->protocol == ATA_PROT_PIO) || ++ (tf->protocol == ATA_PROT_NODATA)) { ++ tf->flags |= ATA_TFLAG_POLLING; ++ } ++ + /* + * 12 and 16 byte CDBs use different offsets to + * provide the various register values. +diff -Nurd linux-2.6.24/drivers/ata/ox800sata.c linux-2.6.24-oxe810/drivers/ata/ox800sata.c +--- linux-2.6.24/drivers/ata/ox800sata.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/ox800sata.c 2008-06-11 17:50:32.000000000 +0200 +@@ -0,0 +1,2184 @@ ++/************************************************************************** ++ * ++ * Copyright (c) 2004 Oxford Semiconductor Ltd. ++ * ++ * 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, 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. ++ * ++ * Module Name: ++ * ox800sata.c ++ * ++ * Abstract: ++ * A driver to interface the 924 based sata core present in the ox800 ++ * with libata and scsi ++ */ ++ ++#include <linux/types.h> ++#include <linux/sched.h> ++#include <linux/interrupt.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/list.h> ++#include <linux/device.h> ++#include <linux/string.h> ++#include <linux/sysdev.h> ++#include <linux/module.h> ++#include <linux/leds.h> ++ ++#include <scsi/scsi_host.h> ++#include <scsi/scsi_cmnd.h> ++#include <scsi/scsi_device.h> ++#include <asm/io.h> ++ ++#include <asm/arch/hardware.h> ++#include <asm/arch/dma.h> ++#include <asm/arch/memory.h> ++#include <asm/arch/sata.h> ++#include <linux/platform_device.h> ++ ++/*************************************************************************** ++* DEBUG CONTROL ++***************************************************************************/ ++//#define SATA_DEBUG ++//#define SATA_DUMP_REGS ++//#define SATA_TF_DUMP ++//#define CRAZY_DUMP_DEBUG ++ ++#if 0 ++ #ifdef writel ++ #undef writel ++ #endif ++ #define writel(v,a) {printk("[%p]<=%08x\n",a,v);*((volatile u32*)(a)) = v;} ++#endif ++ ++#if 0 ++ #ifdef readl ++ #undef readl ++ #endif ++ static inline u32 myreadl(u32 a) {u32 v =(*((volatile u32*)(a)));printk("[%p]=>%08x\n",a,v);return v;} ++ #define readl(a) (myreadl(a)) ++#endif ++ ++ ++#include <linux/libata.h> ++/*************************************************************************** ++* CONSTANTS ++***************************************************************************/ ++ ++#define DRIVER_AUTHOR "Oxford Semiconductor Ltd." ++#define DRIVER_DESC "924 SATA core controler" ++#define DRIVER_NAME "hipoxsata" ++ ++#define SATA_ABORT_WAIT_MS 5000 ++#define SATA_SRST_WAIT_MS 5000 ++ ++/************************************************************************** ++* PROTOTYPES ++**************************************************************************/ ++static int ox800sata_init_one(struct platform_device *); ++static int ox800sata_remove_one(struct platform_device *); ++ ++static void ox800sata_port_disable(struct ata_port *); ++static void ox800sata_dev_config(struct ata_device *); ++static void ox800sata_set_piomode(struct ata_port *, struct ata_device *); ++static void ox800sata_set_dmamode(struct ata_port *, struct ata_device *); ++static void ox800sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf); ++static void ox800sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf); ++static void ox800sata_exec_command(struct ata_port *ap, const struct ata_taskfile *tf); ++static u8 ox800sata_check_status(struct ata_port *ap); ++static u8 ox800sata_check_altstatus(struct ata_port *ap); ++static void ox800sata_dev_select(struct ata_port *ap, unsigned int device); ++static void ox800sata_phy_reset(struct ata_port *ap); ++static void ox800sata_bmdma_setup(struct ata_queued_cmd *qc); ++static void ox800sata_bmdma_start(struct ata_queued_cmd *qc); ++static u8 ox800sata_bmdma_status(struct ata_port *ap); ++static struct ata_queued_cmd* ox800sata_qc_new(struct ata_port *ap); ++static void ox800sata_qc_free(struct ata_queued_cmd *qc); ++static unsigned int ox800sata_qc_issue(struct ata_queued_cmd *qc); ++static void ox800sata_eng_timeout(struct ata_port *ap); ++static irqreturn_t ox800sata_irq_handler(int, void *); ++static void ox800sata_eng_timeout(struct ata_port *ap); ++static void ox800sata_irq_clear(struct ata_port *); ++static int ox800sata_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val); ++static int ox800sata_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val); ++static int ox800sata_port_start(struct ata_port *ap); ++static void ox800sata_port_stop(struct ata_port *ap); ++static void ox800sata_host_stop(struct ata_host *host_set); ++static unsigned int ox800sata_devchk(struct ata_port *ap,unsigned int device); ++static u32* ox800sata_get_io_base(struct ata_port* ap); ++static u32* ox800sata_get_bbp_base(void); ++static u8 ox800sata_irq_ack(struct ata_port *ap, unsigned int chk_drq); ++static u8 ox800sata_irq_on(struct ata_port *ap); ++static void ox800sata_bmdma_stop(struct ata_queued_cmd *qc); ++static void CrazyDumpDebug(struct ata_port *ap); ++static void ox800sata_spot_the_end(struct work_struct *work); ++static void ox800sata_timeout_cleanup( struct ata_port *ap ); ++static void ox800sata_reset_core( void ); ++static void ox800sata_pio_start(struct work_struct *work); ++static void ox800sata_pio_task(struct work_struct *work); ++static void ox800sata_post_reset_init(struct ata_port* ap); ++static u32 __ox800sata_scr_read(u32* core_addr, unsigned int sc_reg); ++static void __ox800sata_scr_write(u32* core_addr, unsigned int sc_reg, u32 val); ++ ++/************************************************************************** ++* STRUCTURES ++**************************************************************************/ ++typedef struct ++{ ++ struct platform_driver driver; ++ struct ata_port* ap[2]; ++ struct workqueue_struct* spot_the_end_q; ++} ox800sata_driver_t; ++ ++/** ++ * Struct to hold private (specific to this driver) data for each queued ++ * command, all queued commands will point to a per-port private data ++ * structure. This is a completely unresearched decision that will surely ++ * cause some untracable bug in the future. ++ */ ++typedef struct ++{ ++ hipox_dma_channel_t* DmaChannel; ++ hipox_dma_sg_entry_t* sg_entries; ++ struct spot_the_end_work_s { ++ struct work_struct worker; ++ struct ata_port* ap; ++ } spot_the_end_work; ++ int port_disabled; ++ u32 ErrorsWithNoCommamnd; ++ u32 int_status; ++ u32 in_cleanup; ++} ox800sata_private_data; ++ ++ox800sata_driver_t ox800sata_driver = ++{ ++ .driver = ++ { ++ .driver.name = DRIVER_NAME, ++ .driver.bus = &platform_bus_type, ++ .probe = ox800sata_init_one, ++ .remove = ox800sata_remove_one, ++ }, ++ .ap = {0,0}, ++}; ++ ++/** If we were writing this in C++ then we would be deriving a subclass of ++ata_port, these would be the overridden functions*/ ++static struct ata_port_operations ox800sata_port_ops = ++{ ++ .port_disable = ox800sata_port_disable, ++ .dev_config = ox800sata_dev_config, ++ .set_piomode = ox800sata_set_piomode, ++ .set_dmamode = ox800sata_set_dmamode, ++ .tf_load = ox800sata_tf_load, ++ .tf_read = ox800sata_tf_read, ++ .exec_command = ox800sata_exec_command, ++ .check_status = ox800sata_check_status, ++ .check_altstatus = ox800sata_check_altstatus, ++ .dev_select = ox800sata_dev_select, ++ .phy_reset = ox800sata_phy_reset, ++ .bmdma_setup = ox800sata_bmdma_setup, ++ .bmdma_start = ox800sata_bmdma_start, ++ .bmdma_stop = ox800sata_bmdma_stop, ++ .bmdma_status = ox800sata_bmdma_status, ++ .qc_new = ox800sata_qc_new, ++ .qc_free = ox800sata_qc_free, ++ .qc_prep = ata_qc_prep, ++ .qc_issue = ox800sata_qc_issue, ++ .eng_timeout = ox800sata_eng_timeout, ++ .irq_handler = ox800sata_irq_handler, ++ .irq_clear = ox800sata_irq_clear, ++ .scr_read = ox800sata_scr_read, ++ .scr_write = ox800sata_scr_write, ++ .port_start = ox800sata_port_start, ++ .port_stop = ox800sata_port_stop, ++ .host_stop = ox800sata_host_stop, ++ .dev_chk = ox800sata_devchk, ++ .irq_on = ox800sata_irq_on, ++ .irq_ack = ox800sata_irq_ack, ++ .pio_task = ox800sata_pio_start, ++}; ++ ++/** the scsi_host_template structure describes the basic capabilities of libata ++and our 921 core to the SCSI framework, it contains the addresses of functions ++in the libata library that handle top level comands from the SCSI library */ ++static struct scsi_host_template ox800sata_sht = ++{ ++ .module = THIS_MODULE, ++ .name = DRIVER_NAME, ++ .ioctl = ata_scsi_ioctl, ++ .queuecommand = ata_scsi_queuecmd, ++/* .eh_strategy_handler= ata_scsi_error,*/ ++ .can_queue = ATA_DEF_QUEUE, ++ .this_id = ATA_SHT_THIS_ID, ++/* .sg_tablesize = LIBATA_MAX_PRD,*/ ++ .sg_tablesize = CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES, ++ .max_sectors = 256, // Use the full 28-bit SATA value ++ .cmd_per_lun = ATA_SHT_CMD_PER_LUN, ++ .emulated = ATA_SHT_EMULATED, ++ .use_clustering = ATA_SHT_USE_CLUSTERING, ++ .proc_name = DRIVER_NAME, ++ .dma_boundary = ~0UL, // NAS has no DMA boundary restrictions ++ .slave_configure = ata_scsi_slave_config, ++ .bios_param = ata_std_bios_param, ++ .unchecked_isa_dma = 0, ++ ++}; ++ ++/** after PIO read operations, DRQ can remain set even when all the data has ++been read, when set, PretendDRQIsClear will mask out the DRQ bit in ++ox800sata_check_status operation */ ++static char PretendDRQIsClear; ++ ++/** ++ * used as a store for atomic test and set operations used to coordinate so ++ * that only one port is processing comnmands at any time */ ++static unsigned long ox800sata_command_active; ++ ++/** ++ * A record of which drives have accumulated raid faults. A set bit indicates ++ * a fault has occured on that drive */ ++static u32 ox800sata_accumulated_RAID_faults = 0; ++ ++/**************************************************************************/ ++MODULE_LICENSE("GPL"); ++MODULE_VERSION(1.0); ++MODULE_AUTHOR(DRIVER_AUTHOR); ++MODULE_DESCRIPTION(DRIVER_DESC); ++ ++/************************************************************************** ++* FUCTIONS ++* prefix all with "ox800sata_" ++**************************************************************************/ ++ ++/** ++ * Gets the base address of the ata core from the ata_port structure ++ * @param ap pointer to the appropriate ata_port structure ++ * @return the base address of the SATA core ++ */ ++static u32* ox800sata_get_io_base(struct ata_port* ap) ++{ ++ // return (u32* )SATA0_REGS_BASE; ++ ++ return (u32* )ap->host->iomap; ++} ++ ++/** ++ * Gets the base address of the core that contains the BBP registers ++ * @return the base address of the SATA core that contains the BBP registers ++ */ ++static u32* ox800sata_get_bbp_base(void) ++{ ++ return (u32* )SATA0_REGS_BASE;; ++} ++ ++/** ++ * Gets the base address of the sata link registers core from the ++ * ata_port structure ++ * @param ap pointer to the appropriate ata_port structure ++ * @return the base address of the SATA core ++ */ ++static u32* ox800sata_get_link_base(struct ata_port* ap) ++{ ++ u8* link_base = (u8* )ap->host->iomap + ++ ((u8* )SATA0_LINK_REGS_BASE - (u8* )SATA0_REGS_BASE); ++ ++ return (u32* )link_base; ++} ++ ++/** ++ * Turns on the cores clock and resets it ++ */ ++static void ox800sata_reset_core( void ){ ++ // Enable the clock to the SATA block ++ writel(1UL << SYS_CTRL_CKEN_SATA_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ wmb(); ++ ++ // reset both MAC and PHY ++ writel(1UL << SYS_CTRL_RSTEN_SATA_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_SATA_PHY_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ wmb(); ++ udelay(50); ++ ++ // un-reset both MAC and PHY ++ writel(1UL << SYS_CTRL_RSTEN_SATA_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_SATA_PHY_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ wmb(); ++ udelay(50); ++} ++ ++/** ++ * port capabilities for the ox800 sata ports. ++ */ ++static const struct ata_port_info ox800sata_port_info = { ++ .flags = ATA_FLAG_SATA | ATA_FLAG_SATA_RESET | ATA_FLAG_NO_LEGACY, ++ .pio_mask = 0x1f, /* pio modes 0..4*/ ++ .mwdma_mask = 0x07, /* mwdma0-2 */ ++ .udma_mask = 0x7f, /* udma0-5 */ ++ .port_ops = &ox800sata_port_ops, ++}; ++ ++/** ++ * The driver probe function. ++ * Registered with the amba bus driver as a parameter of ox800sata_driver.bus ++ * it will register the ata device with kernel first performing any ++ * initialisation required (if the correct device is present). ++ * @param pdev Pointer to the 921 device structure ++ * @param port where on the bus the port was found, ignored and probably wrong ++ * @return 0 if no errors ++ */ ++static int ox800sata_init_one(struct platform_device* pdev) ++{ ++ ++ u32 version; ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ unsigned long reg; ++#endif // CONFIG_SATA_HIPOX_DISK_LIGHT ++ struct ata_host *host; ++ const struct ata_port_info* port_info[] = { &ox800sata_port_info, NULL }; ++ ++ void __iomem* iomem; ++ struct resource* memres = platform_get_resource(pdev, IORESOURCE_MEM, 0 ); ++ int irq = platform_get_irq(pdev, 0); ++ ++ DPRINTK("\n"); ++ ++ /* check resourses for sanity */ ++ if ((memres == NULL) || (irq < 0)) { ++ return 0; ++ } ++ iomem = (void __iomem* ) memres->start; ++ ++ /* check we support this version of the core */ ++ version = readl(((u32* )iomem) + OX800SATA_VERSION) & 0xff; ++ switch (version) ++ { ++ case OX800SATA_CORE_VERSION: ++ printk(KERN_INFO"ox800sata: OX800 sata core.\n"); ++ break; ++ default: ++ printk(KERN_ERR"ox800sata: unknown sata core (version register = 0x%08x)\n",version); ++ return 0; ++ break; ++ } ++ ++ /* reset the core */ ++ ox800sata_reset_core(); ++ ++ /* initialise a work queue to spot the end of transfers */ ++ ox800sata_driver.spot_the_end_q = create_singlethread_workqueue("sata-endQ"); ++ if (!ox800sata_driver.spot_the_end_q) { ++ printk(KERN_ERR DRIVER_NAME " Couldn't create a work queue.\n"); ++ return -1; ++ } ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* setup path */ ++ reg = ~(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ reg = ~(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ reg = ~(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ /* enable output */ ++ writel(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_ENABLE); ++ ++ /* disk light off */ ++ writel(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_CLEAR); ++#endif /* CONFIG_SATA_HIPOX_DISK_LIGHT */ ++ ++ /* setup the probe_ent structure which is basically info about the ports ++ capabilities */ ++ ++ /* allocate memory and check */ ++ host = ata_host_alloc_pinfo(&(pdev->dev), port_info, OX800SATA_MAX_PORTS ); ++ if (!host) { ++ printk(KERN_ERR DRIVER_NAME " Couldn't create an ata host.\n"); ++ destroy_workqueue(ox800sata_driver.spot_the_end_q); ++ } ++ ++ /* set to base of ata core */ ++ host->iomap = iomem; ++ ++ /* call ata_device_add and begin probing for drives*/ ++ ata_host_activate(host, ++ irq, ++ ox800sata_irq_handler, ++ 0, ++ &ox800sata_sht ); ++ ++ return 0; ++} ++ ++/** ++ * Called when the amba bus tells this device to remove itself. ++ * @param pdev pointer to the device that needs to be shutdown ++ */ ++static int ox800sata_remove_one(struct platform_device* pdev) ++{ ++ struct ata_host *host_set = dev_get_drvdata( &(pdev->dev) ); ++ struct ata_port *ap; ++ unsigned int i; ++ ++ ++ for (i = 0; i < host_set->n_ports; i++) ++ { ++ ap = host_set->ports[i]; ++ scsi_remove_host( ap->scsi_host ); ++ } ++ ++ /** @TODO etc. */ ++ ++ // Disable the clock to the SATA block ++ writel(1UL << SYS_CTRL_CKEN_SATA_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ return 0; ++} ++ ++/** ++ * module initialisation ++ * @return success ++ */ ++static int __init ox800sata_init( void ) ++{ ++ int ret; ++ ++ printk(KERN_INFO"ox800sata init \n"); ++ ++ ret = platform_driver_register( &ox800sata_driver.driver ); ++ ++ return ret; ++} ++ ++/** ++ * module cleanup ++ */ ++static void __exit ox800sata_exit( void ) ++{ ++ platform_driver_unregister( &ox800sata_driver.driver ); ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(ox800sata_init); ++module_exit(ox800sata_exit); ++ ++/** ++ * Called from ata_bus_probe() and ata_bus_reset() error paths, as well as ++ * when unregistering from the SCSI module (rmmod, hot unplug). ++ * @param port The port to disable ++ */ ++static void ox800sata_port_disable(struct ata_port* port) ++{ ++ DPRINTK("\n"); ++} ++ ++/** ++ * Called after IDENTIFY [PACKET] DEVICE is issued to each device found. ++ * Typically used to apply device-specific fixups prior to issue of ++ * SET FEATURES - XFER MODE, and prior to operation. ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox800sata_dev_config(struct ata_device* pdev) ++{ ++ u32 reg; ++ u32 *ioaddr = ox800sata_get_io_base(pdev->ap); ++ ++ DPRINTK("\n"); ++ ++ /* if needed, set the bits to put the interface into 48-bit node */ ++ if (pdev->flags & ATA_DFLAG_LBA48) { ++ reg = readl( ioaddr + OX800SATA_DRIVE_CONTROL ); ++ ++ /* mask out the pair of bits associaed with each port */ ++ reg &= ~( 3 << (pdev->ap->port_no * 2) ); ++ ++ /* set the mode pair associated with each port */ ++ reg |= 2 << (pdev->ap->port_no * 2); ++ writel(reg ,ioaddr + OX800SATA_DRIVE_CONTROL); ++ } ++} ++ ++/** ++ * Hooks called prior to the issue of SET FEATURES - XFER MODE command. ++ * dev->pio_mode is guaranteed to be valid when ->set_piomode() is called ++ * ++ * If we're doing PIO, we need to disable the burst buffer port to stop it ++ * trying to do a DMA transfer of the data. ++ * ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox800sata_set_piomode(struct ata_port* port, struct ata_device* pdev) ++{ ++ u32 Register; ++ u32 *ioaddr = ox800sata_get_bbp_base(); ++ ++ DPRINTK("\n"); ++ ++ /* disable burst buffer DMA */ ++ Register = readl( ioaddr + OX800SATA_BURST_CONTROL ); ++ Register |= OX800SATA_BBC_DREQ_DIS ; ++ writel(Register ,ioaddr + OX800SATA_BURST_CONTROL); ++ PretendDRQIsClear = 0; ++} ++ ++/** ++ * Hooks called prior to the issue of SET FEATURES - XFER MODE command. ++ * dev->dma_mode is guaranteed to be valid when ->set_dmamode() is called. ++ * ++ * When doing a DMA transfer, we need to enable the burst buffer port as this ++ * may have been disabled by a previous command. ++ * ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox800sata_set_dmamode(struct ata_port* port, struct ata_device* pdev) ++{ ++ u32 Register; ++ u32 *ioaddr = ox800sata_get_bbp_base(); ++ ++ DPRINTK("\n"); ++ ++ /* enable burst buffer DMA */ ++ Register = readl( ioaddr + OX800SATA_BURST_CONTROL ); ++ Register &= ~OX800SATA_BBC_DREQ_DIS; ++ writel(Register ,ioaddr + OX800SATA_BURST_CONTROL); ++} ++ ++/** ++ * Output the taskfile for diagnostic reasons, it will always appear in the ++ * debug output as if it's a task file being written. ++ * @param tf The taskfile to output ++ */ ++static void tfdump(const struct ata_taskfile* tf) ++{ ++ if (tf->flags & ATA_TFLAG_LBA48) { ++#ifdef SATA_TF_DUMP ++ printk("Cmd %x Ft %x%x, LBA-48 %02x%02x%02x%02x%02x%02x, nsect %02x%02x, ctl %02x, dev %x\n", ++#else // SATA_TF_DUMP ++ DPRINTK("Cmd %x Ft %x%x, LBA-48 %02x%02x%02x%02x%02x%02x, nsect %02x%02x, ctl %02x, dev %x\n", ++#endif // SATA_TF_DUMP ++ tf->command, ++ ++ tf->hob_feature, ++ tf->feature, ++ ++ tf->hob_lbah, ++ tf->hob_lbam, ++ tf->hob_lbal, ++ tf->lbah, ++ tf->lbam, ++ tf->lbal, ++ ++ tf->hob_nsect, ++ tf->nsect, ++ tf->ctl, ++ tf->device ); ++ }else{ ++#ifdef SATA_TF_DUMP ++ printk("Cmd %x Ft %x, LBA-28 %01x%02x%02x%02x, nsect %02x, ctl %02x, dev %x\n", ++#else // SATA_TF_DUMP ++ DPRINTK("Cmd %x Ft %x, LBA-28 %01x%02x%02x%02x, nsect %02x, ctl %02x, dev %x\n", ++#endif // SATA_TF_DUMP ++ tf->command, ++ ++ tf->feature, ++ ++ tf->device & 0x0f, ++ tf->lbah, ++ tf->lbam, ++ tf->lbal, ++ ++ tf->nsect, ++ tf->ctl, ++ tf->device ); ++ } ++} ++ ++/** ++ * called to write a taskfile into the ORB registers ++ * @param ap hardware with the registers in ++ * @param tf taskfile to write to the registers ++ */ ++static void ox800sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf) ++{ ++ u32 count = 0; ++ u32 Orb1 = 0; ++ u32 Orb2 = 0; ++ u32 Orb3 = 0; ++ u32 Orb4 = 0; ++ u32 Command_Reg; ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR; ++ ++ do { ++ Command_Reg = readl(ioaddr + OX800SATA_SATA_COMMAND ); ++ if (!(Command_Reg & CMD_CORE_BUSY)) ++ break; ++ count++; ++ if ( in_atomic() ) { ++ mdelay(1); ++ } else { ++ msleep(1); ++ } ++ } while (count < 10); ++ ++ /* if the control register has changed, write it */ ++ if (tf->ctl != ap->last_ctl) ++ { ++ //DPRINTK("ap->last_ctl = %02x",ap->last_ctl); ++ Orb4 |= (tf->ctl) << 24; ++ ++ /* write value to register */ ++ writel(Orb4, ioaddr + OX800SATA_ORB4 ); ++ ++ ap->last_ctl = tf->ctl; ++ } ++ ++ /* check if the ctl register has interrupts disabled or enabled and ++ modify the interrupt enable registers on the ata core as required */ ++ if (tf->ctl & ATA_NIEN) ++ { ++ /* interrupts disabled */ ++ ox800sata_irq_clear(ap); ++ } ++ else ++ { ++ /* interrupts enabled */ ++ ox800sata_irq_on(ap); ++ } ++ ++ /* write 48 or 28 bit tf parameters */ ++ if (is_addr) ++ { ++ /* set LBA bit as it's an address */ ++ Orb1 |= (tf->device & ATA_LBA) << 24; ++ ++ if (tf->flags & ATA_TFLAG_LBA48) ++ { ++ //DPRINTK(KERN_INFO" 48 bit tf load \n"); ++ Orb1 |= ATA_LBA << 24; ++ ++ Orb2 |= (tf->hob_nsect) << 8 ; ++ ++ Orb3 |= (tf->hob_lbal) << 24; ++ ++ Orb4 |= (tf->hob_lbam) << 0 ; ++ Orb4 |= (tf->hob_lbah) << 8 ; ++ Orb4 |= (tf->hob_feature)<< 16; ++ } else { ++ Orb1 |= (tf->device & 0xf)<< 24; ++ } ++ ++ /* write 28-bit lba */ ++ //DPRINTK(KERN_INFO" 28 bit tf load\n"); ++ Orb1 |= (tf->lbal) << 0 ; ++ Orb1 |= (tf->lbam) << 8 ; ++ Orb1 |= (tf->lbah) << 16; ++ ++ Orb2 |= (tf->nsect) << 0 ; ++ Orb2 |= (tf->feature) << 16; ++ Orb2 |= (tf->command) << 24; ++ ++ Orb3 |= (tf->lbal) << 0 ; ++ Orb3 |= (tf->lbam) << 8 ; ++ Orb3 |= (tf->lbah) << 16; ++ ++ Orb4 |= (tf->ctl) << 24; ++ ++ /* write values to registers */ ++ writel(Orb1, ioaddr + OX800SATA_ORB1 ); ++ writel(Orb2, ioaddr + OX800SATA_ORB2 ); ++ writel(Orb3, ioaddr + OX800SATA_ORB3 ); ++ writel(Orb4, ioaddr + OX800SATA_ORB4 ); ++ } ++ ++ if (tf->flags & ATA_TFLAG_DEVICE) ++ { ++ Orb1 |= (tf->device) << 24; ++ ++ /* write value to register */ ++ writel(Orb1, ioaddr + OX800SATA_ORB1 ); ++ } ++ ++ tfdump(tf); ++ ++} ++ ++/** ++ * Called to read the hardware registers / DMA buffers, to ++ * obtain the current set of taskfile register values. ++ * @param ap hardware with the registers in ++ * @param tf taskfile to read the registers into ++ */ ++static void ox800sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf) ++{ ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ ++ /* read the orb registers */ ++ u32 Orb1 = readl( ioaddr + OX800SATA_ORB1 ); ++ u32 Orb2 = readl( ioaddr + OX800SATA_ORB2 ); ++ u32 Orb3 = readl( ioaddr + OX800SATA_ORB3 ); ++ u32 Orb4 = readl( ioaddr + OX800SATA_ORB4 ); ++ ++ DPRINTK("\n"); ++ ++ /* read common 28/48 bit tf parameters */ ++ tf->device = (Orb1 >> 24); ++ tf->nsect = (Orb2 >> 0); ++ tf->feature = (Orb2 >> 16); ++ tf->command = ox800sata_check_status(ap); ++ ++ /* read 48 or 28 bit tf parameters */ ++ if (tf->flags & ATA_TFLAG_LBA48) ++ { ++ //DPRINTK(KERN_INFO" 48 bit tf read \n"); ++ tf->hob_nsect = (Orb2 >> 8 ) ; ++ ++ tf->lbal = (Orb3 >> 0 ) ; ++ tf->lbam = (Orb3 >> 8 ) ; ++ tf->lbah = (Orb3 >> 16) ; ++ tf->hob_lbal = (Orb3 >> 24) ; ++ ++ tf->hob_lbam = (Orb4 >> 0 ) ; ++ tf->hob_lbah = (Orb4 >> 8 ) ; ++ /* feature ext and control are write only */ ++ ++ } ++ else ++ { ++ /* read 28-bit lba */ ++ //DPRINTK(KERN_INFO" 28 bit tf read\n"); ++ tf->lbal = (Orb1 >> 0 ) ; ++ tf->lbam = (Orb1 >> 8 ) ; ++ tf->lbah = (Orb1 >> 16) ; ++ } ++ ++ /* fixup NAS SATA core's non-std status reporting */ ++ if (PretendDRQIsClear) ++ { ++ tf->command &= ~ATA_DRQ; ++ } ++ ++ tfdump(tf); ++} ++ ++/** ++ * Causes an ATA command, previously loaded with ->tf_load(), to be ++ * initiated in hardware. The command is written into the registers again just ++ * to be sure. All the other registers that are in Orb2 are also written at the ++ * same time. The command is initiated in hardware by a poke to the COMMAND ++ * register. ++ * @param ap hardware with the registers in ++ * @param tf taskfile to write to the registers ++ */ ++static void ox800sata_exec_command(struct ata_port *ap, const struct ata_taskfile *tf) ++{ ++ u32 count =0; ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ u32 Orb2 ; ++ u32 Command_Reg; ++ ox800sata_private_data* private_data ; ++ ++ //DPRINTK(KERN_INFO"ox800sata_exec_command cmd %02x\n", tf->command); ++ do { ++ Command_Reg = readl(ioaddr + OX800SATA_SATA_COMMAND ); ++ if (!(Command_Reg & CMD_CORE_BUSY)) ++ break; ++ count++; ++ if ( in_atomic() ) { ++ mdelay(1); ++ } else { ++ msleep(1); ++ } ++ } while (count < 10); ++ ++ /* write all the things in Orb 2 */ ++ Orb2 = (tf->nsect) << 0 ; ++ if (tf->flags & ATA_TFLAG_LBA48) ++ { ++ Orb2 |= (tf->hob_nsect) << 8 ; ++ } ++ Orb2 |= (tf->feature) << 16; ++ Orb2 |= (tf->command) << 24; ++ writel( Orb2 , ioaddr + OX800SATA_ORB2 ); ++ wmb(); ++ ++ do { ++ Command_Reg = readl(ioaddr + OX800SATA_SATA_COMMAND ); ++ if (!(Command_Reg & CMD_CORE_BUSY)) ++ break; ++ count++; ++ if ( in_atomic() ) { ++ mdelay(1); ++ } else { ++ msleep(1); ++ } ++ } while (count < 10); ++ ++ /* if the drive has become disconnected, executing a command will be a ++ problem */ ++ private_data = (ox800sata_private_data*)ap->private_data; ++ ++ /* Command that the orb registers get written to drive */ ++ Command_Reg &= ~SATA_OPCODE_MASK; ++ Command_Reg |= CMD_WRITE_TO_ORB_REGS; ++ writel( Command_Reg , ioaddr + OX800SATA_SATA_COMMAND ); ++ wmb(); ++} ++ ++ ++/** ++ * Reads the Status ATA shadow register from hardware. Due to a fault with PIO ++ * transfers, it it sometimes necessary to mask out the DRQ bit ++ * @param ap hardware with the registers in ++ * @return The status register ++ */ ++static u8 ox800sata_check_status(struct ata_port *ap) ++{ ++ u32 Reg; ++ u8 result; ++ u8 state; ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ ++// VPRINTK(KERN_INFO"ox800sata_check_status "); ++ ++ /* read byte 3 of Orb2 register */ ++ result = readl(ioaddr + OX800SATA_ORB2 ) >> 24; ++ ++ /* set DRQ when core is in PIO transfer states */ ++ state = readl(ioaddr + OX800SATA_SATA_CONTROL) & OX800SATA_SATA_CONTROL_TRANS_MASK; ++ if ((state == OX800SATA_TRANS_PIOITRANS) || (state == OX800SATA_TRANS_PIOOTRANS)) { ++ result |= ATA_DRQ; ++ } ++ ++ if (PretendDRQIsClear) ++ { ++// VPRINTK("(ignoring DRQ) "); ++ result &= ~ATA_DRQ; ++ } ++ ++ /* use error informatian from raw interupt status */ ++ if (readl(ioaddr + OX800SATA_INT_STATUS) & OX800SATA_RAW_ERROR) { ++ result |= ATA_ERR; ++ } else { ++ result &= ~ATA_ERR; ++ } ++ ++ /* check for the drive going missing indicated by SCR status bits 0-3 = 0 */ ++ ox800sata_scr_read(ap, SCR_STATUS, &Reg); ++ if (!(Reg & 0x1)) { ++ result |= ATA_DF; ++ result |= ATA_ERR; ++ } ++ //VPRINTK("%02x\n",result); ++ ++ return result; ++} ++ ++/** ++ * Reads the alt status ATA shadow register from hardware. ++ * @param ap hardware with the registers in ++ * @return The alt status register ++ */ ++static u8 ox800sata_check_altstatus(struct ata_port *ap) ++{ ++ u8 result; ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ ++ //DPRINTK(KERN_INFO"ox800sata_check_altstatus base=%p\n",ioaddr); ++ ++ /* read byte 3 of Orb4 register */ ++ result = ( readl(ioaddr + OX800SATA_ORB4 ) >> 24 ) ; ++ ++ //DPRINTK(KERN_INFO"alternate status register %02x\n",result); ++ ++ return result; ++} ++ ++/** ++ * Use the method defined in the ATA specification to make either device 0, ++ * or device 1, active on the ATA channel. If we ever get port multipliers ++ * to work, this will be where they would switch. ++ * ++ * @param ap hardware with the registers in ++ * @param number of the device to talk to (0..) ++ */ ++static void ox800sata_dev_select(struct ata_port *ap, unsigned int device) ++{ ++ /* currently only one i/f, but this may not always be the case */ ++ const unsigned char interface_no = 0; ++ ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ DPRINTK(" i/f=%d dev=%d\n", interface_no, device); ++ ++ writel( ++ (interface_no << 4) | device , ++ ioaddr + OX800SATA_DEVICE_SELECT ); ++} ++ ++/** ++ * The very first step in the probe phase. Actions vary depending on the bus ++ * type, typically. After waking up the device and probing for device presence ++ * (PATA and SATA), typically a soft reset (SRST) will be performed. Drivers ++ * typically use the helper functions ata_bus_reset() or sata_phy_reset() for ++ * this hook. ++ * ++ * This should reset the SATA core and Phisical layer then jump back into the ++ * libata libraries for lots of other resetting ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox800sata_phy_reset(struct ata_port *ap) ++{ ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ ++ //DPRINTK(KERN_INFO"ox800sata_phy_reset base = %p\n", ioaddr); ++ ++ /* turn ata core on */ ++ writel( (1 << SYS_CTRL_CKEN_SATA_BIT), SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* stop all the interrupts in the ata core */ ++ writel( ~0, ioaddr + OX800SATA_INT_DISABLE); ++ writel( ~0, ioaddr + OX800SATA_INT_CLEAR); ++ ++ /* get libata to perform a soft reset */ ++ sata_phy_reset(ap); ++ ++} ++ ++/** ++ * When setting up an IDE BMDMA transaction, these hooks arm (->bmdma_setup) ++ * and fire (->bmdma_start) the hardware's DMA engine. ++ * ++ * @param qc the queued command to issue ++ */ ++static void ox800sata_bmdma_setup(struct ata_queued_cmd *qc) ++{ ++ ox800sata_private_data* PrivateData ; ++ hipox_dma_direction_t direction; ++ ++#ifdef SATA_DEBUG ++ printk(KERN_INFO"ox800sata_bmdma_setup: %s, %d element%s\n", (qc->dma_dir == DMA_FROM_DEVICE) ? "Read" : "Write", qc->n_elem, qc->n_elem ? "s" : ""); ++#else // SATA_DEBUG ++ DPRINTK(" %s, %d element%s\n", (qc->dma_dir == DMA_FROM_DEVICE) ? "Read" : "Write", qc->n_elem, qc->n_elem ? "s" : ""); ++#endif // SATA_DEBUG ++ ++ qc->private_data = qc->ap->private_data; ++ PrivateData = (ox800sata_private_data* )qc->private_data; ++ ++ // We check for DMA completion from ISR which cannot wait for all DMA channel ++ // housekeeping to complete, so need to wait here is case we try to reuse ++ // channel before that housekeeping has completed ++ while (hipox_dma_is_active(PrivateData->DmaChannel)) { ++ printk("DMA Setup Channel still active\n"); ++ } ++ ++ /* Do not use DMA callback */ ++ hipox_dma_set_callback(PrivateData->DmaChannel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ /* decide on DMA direction */ ++ direction = (qc->dma_dir == DMA_FROM_DEVICE) ? HIPOX_DMA_FROM_DEVICE : ++ HIPOX_DMA_TO_DEVICE; ++ ++/* Expect transfers to be multiples of 4KB */ ++//struct scatterlist* sle = qc->sg; ++//while (sg_dma_len(sle)) { ++// BUG_ON(sg_dma_len(sle) % 4096); ++// ++sle; ++//} ++ ++ /* now set-up the DMA transfer */ ++ if (qc->n_elem > 1) ++ { ++#ifdef SATA_DEBUG ++ u32 total=0; ++ int i=0; ++ struct scatterlist* sg = qc->__sg; ++ printk("Lengths: "); ++ do { ++ u32 len = sg_dma_len(sg++); ++ printk("%u ", len); ++ total += len; ++ } while (++i < qc->n_elem); ++ printk("\nTotal len = %u\n", total); ++#endif // SATA_DEBUG ++ /* try and setup scatter gather controller */ ++/* if (hipox_dma_device_set_sg(PrivateData->DmaChannel, ++ direction, ++ qc->__sg, ++ qc->n_elem, ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC )) { ++ printk(KERN_ERR"Failed to setup DMA with disk.\n"); ++ return; ++ }*/ ++ if (hipox_dma_device_set_prd( ++ PrivateData->DmaChannel, ++ direction, ++ qc->ap->prd, ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ PrivateData->sg_entries)) { ++ printk(KERN_ERR"Failed to setup DMA with disk.\n"); ++ return; ++ } ++ } ++ else ++ { ++#ifdef SATA_DEBUG ++ printk("Total len = %u\n", sg_dma_len(qc->__sg)); ++#endif // SATA_DEBUG ++ /* setup a single dma */ ++ hipox_dma_device_set( PrivateData->DmaChannel, ++ direction, ++ (unsigned char* )sg_dma_address(qc->__sg), ++ sg_dma_len(qc->__sg), ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ 1); /* paused */ ++ } ++} ++ ++/** ++ * When setting up an IDE BMDMA transaction, these hooks arm (->ignedmdma_setup) ++ * and fire (->bmdma_start) the hardware's DMA engine. ++ * ++ * @param qc the queued command to issue ++ */ ++static void ox800sata_bmdma_start(struct ata_queued_cmd *qc) ++{ ++ ox800sata_private_data* PrivateData ; ++ DPRINTK("\n"); ++ PrivateData = (ox800sata_private_data* )(qc->private_data); ++ ++ { ++ /* turn on the fifo */ ++ u32 Register; ++ u32 *ioaddr = ox800sata_get_bbp_base(); ++ Register = readl( ioaddr + OX800SATA_BURST_CONTROL ); ++ Register &= ~OX800SATA_BBC_FIFO_DIS; ++ writel(Register ,ioaddr + OX800SATA_BURST_CONTROL); ++ } ++ ++ /* if the drive has become disconnected, executing a command will be a ++ problem */ ++ { ++ /* start DMA transfer */ ++ hipox_dma_start( PrivateData->DmaChannel ); ++ qc->ap->ops->exec_command(qc->ap, &(qc->tf)); ++ } ++} ++ ++ ++/** ++ * ata_qc_new - Request an available ATA command, for queueing ++ * @ap: Port associated with device @dev ++ * @dev: Device from whom we request an available command structure ++ * ++ * LOCKING: ++ */ ++ ++static struct ata_queued_cmd* ox800sata_qc_new(struct ata_port *ap) ++{ ++ struct ata_queued_cmd *qc = NULL; ++ ++ /* first see if we're not doing a command */ ++ if (!test_and_set_bit(0, &ox800sata_command_active)) { ++ /* now set the standard bits for compatibility */ ++ set_bit(0, &ap->qc_allocated); ++ qc = ata_qc_from_tag(ap, 0); ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* disk light on */ ++ writel(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_SET); ++#endif // CONFIG_SATA_HIPOX_DISK_LIGHT ++#ifdef CONFIG_WDC_LEDS_TRIGGER_SATA_DISK ++ wdc_ledtrig_sata_activity(); ++#endif // CONFIG_WDC_LEDS_TRIGGER_SATA_DISK ++ } else ++ DPRINTK("Command active flag still set\n"); ++ ++ if (qc) ++ qc->tag = 0; ++ ++ return qc; ++} ++ ++ ++/** ++ * ++ */ ++static void ox800sata_qc_free(struct ata_queued_cmd *qc) ++{ ++ struct ata_port *ap = qc->ap; ++ unsigned int tag, do_clear = 0; ++ ++ DPRINTK("\n"); ++ ++ qc->flags = 0; ++ tag = qc->tag; ++ if (likely(ata_tag_valid(tag))) { ++ if (tag == ap->active_tag) ++ ap->active_tag = ATA_TAG_POISON; ++ qc->tag = ATA_TAG_POISON; ++ do_clear = 1; ++ } ++ ++ if (likely(do_clear)) { ++ clear_bit(tag, &ap->qc_allocated); ++ clear_bit(0, &ox800sata_command_active); ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* disk light off */ ++ writel(1 << CONFIG_OX800SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_CLEAR); ++#endif /* CONFIG_SATA_HIPOX_DISK_LIGHT */ ++ } ++} ++ ++/** ++ * qc_issue is used to make a command active, once the hardware and S/G tables ++ * have been prepared. IDE BMDMA drivers use the helper function ++ * ata_qc_issue_prot() for taskfile protocol-based dispatch. More advanced drivers ++ * roll their own ->qc_issue implementation, using this as the "issue new ATA ++ * command to hardware" hook. ++ * @param qc the queued command to issue ++ */ ++static unsigned int ox800sata_qc_issue(struct ata_queued_cmd *qc) ++{ ++ u32 Register; ++ int this_port_fail; ++ ox800sata_private_data* private_data = (ox800sata_private_data*)qc->ap->private_data ; ++ u32 *ioaddr = ox800sata_get_bbp_base(); ++ u32 reg; ++ u32 raid_reg = 0; /* default to no raid */ ++ ++ DPRINTK("\n"); ++ ++ /* get raid settings from the bio if they exist */ ++ if (qc->scsicmd && qc->scsicmd->request && qc->scsicmd->request->bio) { ++ struct bio* bio; ++ bio = qc->scsicmd->request->bio; ++ raid_reg = bio->bi_raid ; ++ if (raid_reg) DPRINTK(" raid reg 0x%08x\n",raid_reg); ++ } ++ ++ /* check cable is still connected */ ++ ox800sata_scr_read(qc->ap, SCR_STATUS, ®); ++ private_data->port_disabled |= (!(reg & 1)); ++ ++ this_port_fail = private_data->port_disabled; ++ ++ if (raid_reg) { ++ int port0fail, port1fail; ++ port0fail = (! (__ox800sata_scr_read((u32* )SATA0_LINK_REGS_BASE, 0x20 + (4 * SCR_STATUS) ) & 1 ) ); ++ port1fail = (! (__ox800sata_scr_read((u32* )SATA1_LINK_REGS_BASE, 0x20 + (4 * SCR_STATUS) ) & 1 ) ); ++ this_port_fail |= port1fail; ++ ++ ox800sata_accumulated_RAID_faults |= port0fail ? 1 : 0 ; ++ ox800sata_accumulated_RAID_faults |= port1fail ? 2 : 0 ; ++ } ++ ++ if (!this_port_fail ) { ++ writel(raid_reg ,ioaddr + OX800SATA_RAID_CONTROL); ++ ++ DPRINTK(" enabling burst buffer DMA\n"); ++ Register = readl( ioaddr + OX800SATA_BURST_CONTROL ); ++ Register &= ~OX800SATA_BBC_DREQ_DIS; ++ writel(Register ,ioaddr + OX800SATA_BURST_CONTROL); ++ ++ /* call the default, this should be changed to take advantage of orb ++ registers, etc... */ ++ return ata_qc_issue_prot(qc); ++ } else { ++ /* record the error */ ++ qc->err_mask |= AC_ERR_ATA_BUS; ++ ++ /* offline the SCSI device */ ++ printk(KERN_ERR"ata%u offline\n", qc->ap->print_id); ++ scsi_device_set_state(qc->scsicmd->device, SDEV_OFFLINE); ++ return 0; ++ } ++} ++ ++/** ++ * This is a high level error handling function, called from the error ++ * handling thread, when a command times out. ++ * ++ * @todo possibly remove this function and revert to only calling the default ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox800sata_eng_timeout(struct ata_port *ap) ++{ ++ struct ata_queued_cmd *qc; ++ ox800sata_private_data* pd = (ox800sata_private_data*)ap->private_data; ++ DPRINTK("\n"); ++ ++ /* set the in cleanup flag */ ++ pd->in_cleanup = 1; ++ ++ /* if we're a PIO command existing cleanup won't be called */ ++ qc = ata_qc_from_tag(ap, ap->active_tag); ++ if (qc->tf.protocol == ATA_PROT_PIO) { ++ /* reset the core */ ++ ox800sata_timeout_cleanup(ap); ++ } ++ ++ /* call strandard lib ata function */ ++ ata_eng_timeout( ap ); ++ ++ /* clear the in cleanup flag */ ++ pd->in_cleanup = 0; ++} ++ ++/** ++ * irq_handler is the interrupt handling routine registered with the system, ++ * by libata. ++ */ ++static irqreturn_t ox800sata_irq_handler(int irq, ++ void* dev_instance) ++{ ++ struct ata_port *ap = ((struct ata_host *)dev_instance)->ports[0]; ++ ox800sata_private_data *pd; ++ u32 *ioaddr; ++ u32 int_status; ++ ++ DPRINTK("irq = %d\n", irq); ++ ++ if (!ap || !ap->private_data) ++ BUG(); ++ ++ pd = (ox800sata_private_data*)ap->private_data; ++ ioaddr = ox800sata_get_io_base(ap); ++ ++ int_status = readl(ioaddr + OX800SATA_INT_STATUS); ++ while (int_status & OX800SATA_INT_MASKABLE) { ++ /* store interrupt status for the bottom end */ ++ pd->int_status |= int_status; ++ ++ /* Clear and mask pending interrupts */ ++ writel(int_status, ioaddr + OX800SATA_INT_CLEAR); ++ writel(int_status, ioaddr + OX800SATA_INT_DISABLE); ++ ++ int_status = readl(ioaddr + OX800SATA_INT_STATUS); ++ } ++ ++ // Wait a short while for the DMA to finish and if it doesn't start a thread ++ // to poll for the finish ++ pd->spot_the_end_work.ap = ap; ++ if (!hipox_dma_raw_isactive(pd->DmaChannel)) { ++ ox800sata_spot_the_end(&(pd->spot_the_end_work.worker)); ++ } else { ++ udelay(100); ++ if (!hipox_dma_raw_isactive(pd->DmaChannel)) { ++ ox800sata_spot_the_end(&(pd->spot_the_end_work.worker)); ++ } else { ++ /* Start a worker thread looking for the DMA channel to become idle */ ++ queue_work(ox800sata_driver.spot_the_end_q, &pd->spot_the_end_work.worker); ++ } ++ } ++ ++ return IRQ_HANDLED; ++} ++ ++/** ++ * Work for a work queue, this will check for errors then wait for the DMA to ++ * complete. On the DMA completing it will call ata_qc_complete ++ */ ++static void ox800sata_spot_the_end(struct work_struct *work) ++{ ++ struct spot_the_end_work_s* stew = ++ container_of(work, struct spot_the_end_work_s, worker); ++ struct ata_port* ap = stew->ap; ++ ox800sata_private_data* PrivateData = (ox800sata_private_data* )ap->private_data; ++ struct ata_queued_cmd* qc = ata_qc_from_tag(ap, ap->active_tag); ++ unsigned long flags = 0; ++ ++ /* If there's no command ending associated with this IRQ, ignore it. */ ++ if ((qc == NULL) || ++ !(PrivateData->int_status & OX800SATA_INT_END_OF_CMD)) { ++ DPRINTK(" qc=null\n"); ++ return; ++ } ++ ++ /* Look to see if the core is indicating an error condition after a RAID ++ * command */ ++ if (qc->scsicmd && ++ qc->scsicmd->request && ++ qc->scsicmd->request->bio && ++ qc->scsicmd->request->bio->bi_raid ) { ++ unsigned long Port0Irq = readl(((u32)(SATA0_REGS_BASE)) + OX800SATA_INT_STATUS); ++ unsigned long Port1Irq = readl(((u32)(SATA1_REGS_BASE)) + OX800SATA_INT_STATUS); ++ ++ if (test_bit(OX800SATA_INT_ERROR, &Port0Irq)) { ++ printk("disk 0 error in raid\n"); ++ ox800sata_accumulated_RAID_faults |= 1; ++ } ++ if (test_bit(OX800SATA_INT_ERROR, &Port1Irq)) { ++ printk("disk 1 error in raid\n"); ++ ox800sata_accumulated_RAID_faults |= 2; ++ } ++ } ++ ++ if (!in_irq()) { ++ /* wait for the DMA to finish */ ++ while (hipox_dma_is_active(PrivateData->DmaChannel)) { ++ schedule(); ++ } ++ } ++ ++ /* The command may have aborted, this is indicated by the interrupt bit ++ * being masked */ ++ if (PrivateData->in_cleanup) { ++ return; ++ } ++ ++ if (!(qc->flags & ATA_QCFLAG_ACTIVE)) { ++ printk(KERN_WARNING "**** QC already completed! ****\n"); ++ return; ++ } ++ ++ /* get the error status */ ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ ++ /* tell libata we're done */ ++ DPRINTK(" returning err_mask=0x%x\n", qc->err_mask); ++ local_irq_save(flags); ++ PrivateData->int_status = 0; ++ local_irq_restore(flags); ++ ata_qc_complete(qc); ++} ++ ++/** ++ * ox800sata_irq_clear is called during probe just before the interrupt handler is ++ * registered, to be sure hardware is quiet. It clears and masks interrupt bits ++ * in the SATA core. ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox800sata_irq_clear(struct ata_port* ap) ++{ ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ //DPRINTK(KERN_INFO"ox800sata_irq_clear\n"); ++ ++ writel( ~0, ioaddr + OX800SATA_INT_DISABLE ); ++ writel( ~0, ioaddr + OX800SATA_INT_CLEAR ); ++} ++ ++static u32 __ox800sata_scr_read(u32* core_addr, unsigned int sc_reg) ++{ ++ u32 result; ++ u32 patience; ++ ++ /* we've got 8 other registers in before the start of the standard ones */ ++ writel(sc_reg, core_addr + OX800SATA_LINK_RD_ADDR ); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (readl(core_addr + OX800SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ result = readl(core_addr + OX800SATA_LINK_DATA); ++ ++ //DPRINTK(KERN_INFO"ox800sata_scr_read: [0x%02x]->0x%08x\n", sc_reg, result); ++ return result; ++} ++ ++/** ++ * Read standard SATA phy registers. Currently only used if ++ * ->phy_reset hook called the sata_phy_reset() helper function. ++ * ++ * These registers are in another clock domain to the processor, access is via ++ * some bridging registers ++ * ++ * @param ap hardware with the registers in ++ * @param sc_reg the SATA PHY register ++ * @return the value in the register ++ */ ++static int ox800sata_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val) ++{ ++ u32* ioaddr = ox800sata_get_link_base(ap); ++ *val = __ox800sata_scr_read(ioaddr, 0x20 + (sc_reg*4) ); ++ return 0; ++} ++ ++static void __ox800sata_scr_write(u32* core_addr, unsigned int sc_reg, u32 val) ++{ ++ u32 patience; ++ ++ //DPRINTK(KERN_INFO"ox800sata_scr_write: [0x%02x]<-0x%08x\n", sc_reg, val); ++ writel(val, core_addr + OX800SATA_LINK_DATA ); ++ writel(sc_reg , core_addr + OX800SATA_LINK_WR_ADDR ); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (readl(core_addr + OX800SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++} ++/** ++ * Write standard SATA phy registers. Currently only used if ++ * phy_reset hook called the sata_phy_reset() helper function. ++ * ++ * These registers are in another clock domain to the processor, access is via ++ * some bridging registers ++ * ++ * @param ap hardware with the registers in ++ * @param sc_reg the SATA PHY register ++ * @param val the value to write into the register ++ */ ++static int ox800sata_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val) ++{ ++ u32 *ioaddr = ox800sata_get_link_base(ap); ++ __ox800sata_scr_write(ioaddr, 0x20 + (sc_reg * 4), val); ++ return 0; ++} ++ ++/** ++ * port_start() is called just after the data structures for each port are ++ * initialized. Typically this is used to alloc per-port DMA buffers, tables ++ * rings, enable DMA engines and similar tasks. ++ * ++ * @return 0 = success ++ * @param ap hardware with the registers in ++ */ ++static int ox800sata_port_start(struct ata_port *ap) ++{ ++ ox800sata_private_data* pd; ++ struct device* pdev = ap->host->dev; ++ ++ ap->prd = dma_alloc_coherent(pdev, ATA_PRD_TBL_SZ, &ap->prd_dma, GFP_DMA); ++ if (!ap->prd) { ++ return -ENOMEM; ++ } ++ ++ /* allocate port private data memory and attach to port */ ++ if (!ap->private_data) { ++ ap->private_data = kmalloc(sizeof(ox800sata_private_data), GFP_KERNEL); ++ } ++ ++ if (!ap->private_data) { ++ return -ENOMEM; ++ } ++ ++ pd = (ox800sata_private_data* )ap->private_data; ++ pd->DmaChannel = 0; ++ pd->sg_entries = 0; ++ ++ DPRINTK("ap = %p, pd = %p\n",ap,ap->private_data); ++ ++ // Allocate DMA SG entries ++ if (hipox_dma_alloc_sg_entries(&pd->sg_entries, CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES)) { ++ printk(KERN_WARNING "ox800sata_port_start() Failed to obtain DMA SG entries\n"); ++ return -ENOMEM; ++ } ++ ++ // Hold on to a DMA channel for the life of the SATA driver ++ pd->DmaChannel = hipox_dma_request(1); ++ if (!pd->DmaChannel) { ++ printk(KERN_WARNING "ox800sata_port_start() Failed to obtain DMA channel\n"); ++ return -ENOMEM; ++ } ++ ++ /* declare a work item to spot when a command finishes */ ++ INIT_WORK(&(pd->spot_the_end_work.worker), &ox800sata_spot_the_end); ++ ++ /* initialise to zero */ ++ pd->ErrorsWithNoCommamnd = 0; ++ pd->port_disabled = 0; ++ pd->int_status = 0; ++ pd->in_cleanup = 0; ++ ++ /* store the ata_port painter in the driver structure (BAD, should really ++ be in the device) */ ++ if (ox800sata_get_io_base(ap) == (u32*)SATA0_REGS_BASE) { ++ ox800sata_driver.ap[0] = ap; ++ } else if (ox800sata_get_io_base(ap) == (u32*)SATA1_REGS_BASE) { ++ ox800sata_driver.ap[1] = ap; ++ } ++ ++ // turn ata core on ++ writel((1 << SYS_CTRL_CKEN_SATA_BIT), SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* post reset init needs to be called for both ports as there's one reset ++ for both ports*/ ++ if (ox800sata_driver.ap[0]) { ++ ox800sata_post_reset_init(ox800sata_driver.ap[0]); ++ } ++ if (ox800sata_driver.ap[1]) { ++ ox800sata_post_reset_init(ox800sata_driver.ap[1]); ++ } ++ ++ return 0; ++} ++ ++static void ox800sata_post_reset_init(struct ata_port* ap) ++{ ++ u32 patience; ++ u32* link_addr = ox800sata_get_link_base(ap); ++ u32* ioaddr = ox800sata_get_io_base(ap); ++ uint dev; ++ ++ /* turn on phy error detection by removing the masks */ ++ writel(0x30003, link_addr + OX800SATA_LINK_DATA ); ++ wmb(); ++ writel(0x0C, link_addr + OX800SATA_LINK_WR_ADDR ); ++ wmb(); ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (readl(link_addr + OX800SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ /* Set FIS modes to flush rather than softtrans */ ++ writel(0xff, ioaddr + OX800SATA_REG_ACCESS); ++ ++ /* go through all the devices and configure them */ ++ for (dev = 0; dev < ATA_MAX_DEVICES; ++dev) { ++ if ( ap->device[dev].class == ATA_DEV_ATA ) ++ ox800sata_dev_config( &(ap->device[dev]) ); ++ } ++} ++ ++/** ++ * port_stop() is called after ->host_stop(). It's sole function is to ++ * release DMA/memory resources, now that they are no longer actively being ++ * used. ++ */ ++static void ox800sata_port_stop(struct ata_port *ap) ++{ ++ ox800sata_private_data* pd = (ox800sata_private_data* )ap->private_data; ++ ++ DPRINTK("\n"); ++ ++ if (pd->DmaChannel) { ++ hipox_dma_free(pd->DmaChannel); ++ pd->DmaChannel = 0; ++ } ++ ++ if (pd->sg_entries) { ++ hipox_dma_free_sg_entries(pd->sg_entries); ++ pd->sg_entries = 0; ++ } ++ ++ kfree(pd); ++} ++ ++/** ++ * host_stop() is called when the rmmod or hot unplug process begins. The ++ * hook must stop all hardware interrupts, DMA engines, etc. ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox800sata_host_stop(struct ata_host *host_set) ++{ ++ DPRINTK("\n"); ++} ++ ++/** ++ * PATA device presence detection ++ * @param ap ATA channel to examine ++ * @param device Device to examine (starting at zero) ++ * @return true if something found ++ * ++ * This technique was originally described in ++ * Hale Landis's ATADRVR (www.ata-atapi.com), and ++ * later found its way into the ATA/ATAPI spec. ++ * ++ * Write a pattern to the ATA shadow registers, ++ * and if a device is present, it will respond by ++ * correctly storing and echoing back the ++ * ATA shadow register contents. ++ * ++ * LOCKING: ++ * caller. ++ */ ++static unsigned int ox800sata_devchk(struct ata_port *ap,unsigned int device) ++{ ++ DPRINTK("\n"); ++ ++ return 0; /* nothing found */ ++} ++ ++static void ox800sata_pio_start(struct work_struct *work) ++{ ++ u32 burst_reg; ++ struct ata_port *ap = container_of(work, struct ata_port, port_task.work); ++ ox800sata_private_data* pd = (ox800sata_private_data*)ap->private_data; ++ struct ata_queued_cmd* qc = ap->port_task_data; ++ u32* ioaddr = ox800sata_get_io_base(ap); ++ unsigned long flags = 0; ++ ++ // We check for DMA completion from ISR which cannot wait for all DMA channel ++ // housekeeping to complete, so need to wait here is case we try to reuse ++ // channel before that housekeeping has completed ++ while (hipox_dma_is_active(pd->DmaChannel)) { ++ printk(KERN_WARNING "PIO start Channel still active\n"); ++ } ++ ++ if (qc->tf.protocol != ATA_PROT_NODATA) { ++ hipox_dma_direction_t direction = (qc->dma_dir == DMA_FROM_DEVICE) ? ++ HIPOX_DMA_FROM_DEVICE : ++ HIPOX_DMA_TO_DEVICE; ++ ++ /* Do not use DMA callback */ ++ hipox_dma_set_callback(pd->DmaChannel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ /* map memory for dma */ ++ dma_map_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ ++ /* setup a scatter gather dma */ ++ hipox_dma_device_set_sg(pd->DmaChannel, ++ direction, ++ qc->__sg, ++ qc->n_elem, ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC); ++ ++ hipox_dma_start(pd->DmaChannel); ++ ++ /* turn on the fifo */ ++ burst_reg = readl( ioaddr + OX800SATA_BURST_CONTROL ); ++ burst_reg &= ~OX800SATA_BBC_DREQ_DIS; ++ writel(burst_reg, ioaddr + OX800SATA_BURST_CONTROL); ++ ++ if (hipox_dma_is_active(pd->DmaChannel)) { ++ /* if the DMA is still busy, schedule a task to poll again in 1 ms */ ++ ata_port_queue_task(ap, ox800sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ ++ /* cleanup DMA */ ++ dma_unmap_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ } else { ++ /* if the core is still busy, reschedule */ ++ if (readl(ioaddr + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY) { ++ ata_port_queue_task(ap, ox800sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ } ++ ++ /* notify of completion */ ++ PretendDRQIsClear = 1; ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ spin_lock_irqsave(ap->lock, flags); ++ ap->ops->irq_on(ap); ++ ata_qc_complete(qc); ++ spin_unlock_irqrestore(ap->lock, flags); ++} ++ ++/** ++ * This is the top level of the PIO task. It is responsible for organising the ++ * transfer of data, collecting and reacting to status changes and notification ++ * of command completion. ++ * ++ */ ++static void ox800sata_pio_task(struct work_struct *work) ++{ ++ struct ata_port *ap = container_of(work, struct ata_port, port_task.work); ++ struct ata_queued_cmd *qc = ap->port_task_data; ++ unsigned long flags = 0; ++ ++ if (qc->tf.protocol != ATA_PROT_NODATA) { ++ ox800sata_private_data* pd = (ox800sata_private_data* )ap->private_data; ++ ++ if (hipox_dma_is_active(pd->DmaChannel)) { ++ /* if the DMA is still busy, re-schedule the task */ ++ /* try again in 1 ms */ ++ ata_port_queue_task(ap, ox800sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ ++ /* cleanup DMA */ ++ dma_unmap_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ } else { ++ u32* ioaddr = ox800sata_get_io_base(ap); ++ ++ /* if the core is still busy, reschedule */ ++ if (readl(ioaddr + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY) { ++ ata_port_queue_task(ap, ox800sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ } ++ ++ /* notify of completion */ ++ PretendDRQIsClear = 1; ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ spin_lock_irqsave(ap->lock, flags); ++ ap->ops->irq_on(ap); ++ ata_qc_complete(qc); ++ spin_unlock_irqrestore(ap->lock, flags); ++} ++ ++static void ox800sata_bmdma_stop(struct ata_queued_cmd *qc) ++{ ++ struct ata_port *ap = qc->ap; ++ ox800sata_private_data* private_data = (ox800sata_private_data*)ap->private_data; ++ ++ /* Check if DMA is in progress, if so abort */ ++ if (hipox_dma_is_active(private_data->DmaChannel)) { ++ /* ++ * Attempt to abort any current transfer: ++ * Abort DMA transfer at the DMA controller, ++ */ ++ printk(KERN_ERR "ox800sata_bmdma_stop - aborting DMA\n"); ++ ++ hipox_dma_abort(private_data->DmaChannel); ++ ++ /* perform core cleanups and resets */ ++ ox800sata_timeout_cleanup(ap); ++ } ++} ++ ++/** ++ * ++ */ ++static void ox800sata_timeout_cleanup( struct ata_port *ap ) { ++ u32* io_base = ox800sata_get_io_base(ap); ++ u32* bbp_base = ox800sata_get_bbp_base(); ++ int idle; ++ u32 reg; ++ int loops; ++ ++ /* Test SATA core idle state */ ++ CrazyDumpDebug(ap); ++ idle = !(readl(io_base + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY); ++ ++ ++ printk(KERN_ERR "ox800sata_timeout_cleanup() ata%u idle = %d\n", ap->print_id, idle); ++ ++ if (!idle) { ++ /* ++ * Assert SATA core and burst buffer port Force_EOT ++ */ ++ printk(KERN_INFO "ox800sata_timeout_cleanup - aborting SATA... (may take upto 5 seconds)\n"); ++ ++ reg = readl(io_base + OX800SATA_DEVICE_CONTROL); ++ reg |= OX800SATA_DEVICE_CONTROL_ABORT; ++ writel(reg, io_base + OX800SATA_DEVICE_CONTROL); ++ ++ reg = readl(bbp_base + OX800SATA_BURST_CONTROL); ++ reg |= OX800SATA_BBC_FORCE_EOT; ++ writel(reg, bbp_base + OX800SATA_BURST_CONTROL); ++ ++ /* Wait for SATA core to go idle */ ++ idle = 0; ++ loops = SATA_ABORT_WAIT_MS; ++ while(1) { ++ /* Test SATA core idle state */ ++ idle = !(readl(io_base + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY); ++ if (idle || (loops-- <= 0)) { ++ break; ++ } ++ /* Wait a millisecond before testing again */ ++ udelay(1000); ++ } ++ ++ /* Deassert SATA core abort - BBP Force_EOT is self-clearing` */ ++ reg = readl(io_base + OX800SATA_DEVICE_CONTROL); ++ reg &= ~OX800SATA_DEVICE_CONTROL_ABORT; ++ writel(reg, io_base + OX800SATA_DEVICE_CONTROL); ++ ++ DPRINTK("idle = %d, %d loops remaining\n", idle, loops); ++ ++ if (!idle) { ++ /* ++ * SATA core did not go idle, so attempt a core reset: ++ * Assert both SATA core internal reset and ORB4 srst ++ * Deassert both SATA core internal reset and ORB4 srst ++ */ ++#if 0 ++ printk(KERN_INFO "ox800sata_timeout_cleanup - internal SATA reset... (may take upto 5 seconds)\n"); ++ ++ reg = readl(io_base + OX800SATA_SATA_CONTROL); ++ reg |= OX800SATA_SCTL_RESET; ++ writel(reg, io_base + OX800SATA_SATA_CONTROL); ++ ++ reg = readl(io_base + OX800SATA_ORB4); ++ reg |= OX800SATA_ORB4_SRST; ++ writel(reg, io_base + OX800SATA_ORB4); ++ ++ /* Wait for SATA core to go idle */ ++ idle = 0; ++ loops = SATA_SRST_WAIT_MS; ++ while(1) { ++ /* Test SATA core idle state */ ++ idle = !(readl(io_base + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY); ++ if (idle || (loops-- <= 0)) { ++ break; ++ } ++ /* Wait a millisecond before testing again */ ++ udelay(1000); ++ } ++ ++ reg = readl(io_base + OX800SATA_ORB4); ++ reg &= ~OX800SATA_ORB4_SRST; ++ writel(reg, io_base + OX800SATA_ORB4); ++ ++ reg = readl(io_base + OX800SATA_SATA_CONTROL); ++ reg &= ~OX800SATA_SCTL_RESET; ++ writel(reg, io_base + OX800SATA_SATA_CONTROL); ++ udelay(1000); ++ ++ DPRINTK("idle = %d, %d loops remaining\n", idle, loops); ++#endif ++ idle = !(readl(io_base + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY); ++ if (!idle) { ++ /* ++ * SATA core did not go idle, so cause a SATA core reset from the RPS ++ * NB It may be required to reset both SATA cores if have a dual system ++ */ ++ printk(KERN_INFO "ox800sata_timeout_cleanup - RPS SATA core reset\n"); ++ ++ writel(1UL << SYS_CTRL_RSTEN_SATA_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ udelay(1000); ++ writel(1UL << SYS_CTRL_RSTEN_SATA_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ /* Read SATA core idle state */ ++ idle = !(readl(io_base + OX800SATA_SATA_COMMAND) & CMD_CORE_BUSY); ++ ++ printk(KERN_INFO"idle = %d\n", idle); ++ ++ /* Perform any SATA core re-initialisation after reset */ ++ /* post reset init needs to be called for both ports as there's one reset ++ for both ports*/ ++ if (ox800sata_driver.ap[0]) ++ ox800sata_post_reset_init(ox800sata_driver.ap[0]); ++ if (ox800sata_driver.ap[1]) ++ ox800sata_post_reset_init(ox800sata_driver.ap[1]); ++ } ++ } ++ } ++} ++ ++/** ++ * bmdma_status return a made up version of a BMDMA status register ++ * ++ * @param ap Hardware with the registers in ++ * @return the value ATA_DMA_INTR if the interrupt came from the DMA finishing ++ */ ++static u8 ox800sata_bmdma_status(struct ata_port *ap) ++{ ++ ox800sata_private_data* PrivateData ; ++ PrivateData = (ox800sata_private_data* )ap->private_data; ++ ++ { ++ u32 interrupt_status; ++ u32 *ioaddr = ox800sata_get_io_base(ap); ++ interrupt_status = readl(ioaddr + OX800SATA_INT_STATUS ); ++ DPRINTK(" irq bits are %08x \n",interrupt_status); ++ } ++/* if( hipox_dma_is_active( PrivateData->DmaChannel ) ) ++ { ++ CrazyDumpDebug(ap); ++ return 0; ++ } ++ else*/ ++ { ++ return ATA_DMA_INTR; ++ } ++} ++ ++/** ++ * turn on the interrupts from the ata drive ++ * wait for idle, clear any pending interrupts. ++ * ++ * @param ap Hardware with the registers in ++ */ ++static u8 ox800sata_irq_on(struct ata_port *ap) ++{ ++ u32* ioaddr = ox800sata_get_io_base(ap); ++ u8 tmp; ++ ++ //DPRINTK(KERN_INFO"ox800sata_irq_on\n"); ++ ++ /* enable End of command interrupt */ ++ writel(OX800SATA_INT_END_OF_CMD, ioaddr + OX800SATA_INT_CLEAR); ++ writel(OX800SATA_INT_END_OF_CMD, ioaddr + OX800SATA_INT_ENABLE); ++ tmp = ata_wait_idle(ap); ++ ++ return tmp; ++} ++ ++/** ++ * Acknowledges any pending interrupts, by clearing them, but not disabling ++ * them. ++ * ++ * @param ap Hardware with the registers in ++ */ ++static u8 ox800sata_irq_ack(struct ata_port *ap, unsigned int chk_drq) ++{ ++ u32* ioaddr = ox800sata_get_io_base(ap); ++ unsigned int bits = chk_drq ? ATA_BUSY | ATA_DRQ : ATA_BUSY; ++ u8 status; ++ ++ //DPRINTK(KERN_INFO"921ish_irq_ack\n"); ++ status = ata_busy_wait(ap, bits, 1000); ++ if (status & bits) ++ { ++ DPRINTK("abnormal status 0x%X\n", status); ++ } ++ ++ /* clear the end of command interrupt bit */ ++ writel(OX800SATA_INT_END_OF_CMD, ioaddr + OX800SATA_INT_CLEAR); ++ ++ return status; ++} ++ ++/** ++ * Outputs all the registers in the SATA core for diagnosis of faults. ++ * ++ * @param ap Hardware with the registers in ++ */ ++static void CrazyDumpDebug(struct ata_port *ap) ++{ ++#ifdef CRAZY_DUMP_DEBUG ++ u32 offset; ++ u32 result; ++ u32 patience; ++ u32* ioaddr; ++ ++ /* IRQ flags for calling port */ ++ { ++ ox800sata_private_data* PrivateData = (ox800sata_private_data* )ap->private_data; ++ printk("IRQ %08x\n",PrivateData->int_status); ++ } ++ ++ /* port 0 */ ++ ioaddr = (u32* )SATA0_REGS_BASE; ++ printk("Port 0 High level registers\n"); ++ for(offset = 0; offset < 32;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, readl(ioaddr + offset)); ++ } ++ ++ printk("Port 0 link layer registers\n"); ++ ioaddr = (u32* )SATA0_LINK_REGS_BASE; ++ for(offset = 0; offset < 15;++offset) ++ { ++ writel( (offset*4), ioaddr + OX800SATA_LINK_RD_ADDR ); ++ wmb(); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (readl(ioaddr + OX800SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ result = readl(ioaddr + OX800SATA_LINK_DATA); ++ printk("[%02x] %08x\n", offset*4, result); ++ } ++ ++ /* port 1 */ ++ ioaddr = (u32* )SATA1_REGS_BASE; ++ printk("Port 1 High level registers\n"); ++ for(offset = 0; offset < 32;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, readl(ioaddr + offset)); ++ } ++ ++ printk("Port 1 link layer registers\n"); ++ ioaddr = (u32* )SATA1_LINK_REGS_BASE; ++ for(offset = 0; offset < 15;++offset) ++ { ++ writel( (offset*4), ioaddr + OX800SATA_LINK_RD_ADDR ); ++ wmb(); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (readl(ioaddr + OX800SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ result = readl(ioaddr + OX800SATA_LINK_DATA); ++ printk("[%02x] %08x\n", offset*4, result); ++ } ++ ++ hipox_dma_dump_registers(); ++#endif ++} ++ ++/************************************************************************** ++* DEVICE CODE ++**************************************************************************/ ++ ++/** ++ * Describes the identity of the SATA core and the resources it requires ++ */ ++static struct resource ox800sata_port0_resources[] = { ++ { ++ .name = "sata_port_0_registers", ++ .start = SATA0_REGS_BASE, ++ .end = (SATA0_LINK_REGS_BASE + 64), ++ .flags = IORESOURCE_MEM, ++ }, ++ { ++ .name = "sata_irq", ++ .start = SATA_1_INTERRUPT, ++ .flags = IORESOURCE_IRQ, ++ } ++}; ++ ++static struct resource ox800sata_port1_resources[] = { ++ { ++ .name = "sata_port_1_registers", ++ .start = SATA1_REGS_BASE, ++ .end = (SATA1_LINK_REGS_BASE + 64), ++ .flags = IORESOURCE_MEM, ++ }, ++ { ++ .name = "sata_irq", ++ .start = SATA_2_INTERRUPT, ++ .flags = IORESOURCE_IRQ, ++ }, ++}; ++ ++static struct platform_device ox800sata_dev0 = ++{ ++ .name = DRIVER_NAME, ++ .id = 0, ++ .num_resources = 2, ++ .resource = ox800sata_port0_resources, ++ .dev.coherent_dma_mask = 0xffffffff, ++}; ++ ++static struct platform_device ox800sata_dev1 = ++{ ++ .name = DRIVER_NAME, ++ .id = 1, ++ .num_resources = 2, ++ .resource = ox800sata_port1_resources, ++ .dev.coherent_dma_mask = 0xffffffff, ++}; ++ ++/** ++ * module initialisation ++ * @return success is 0 ++ */ ++static int __init ox800sata_device_init( void ) ++{ ++ int ret; ++ ++ DPRINTK("\n"); ++ ++ { ++ // register the ata device for the driver to find ++ ret = platform_device_register( &ox800sata_dev0 ); ++ DPRINTK(" %i\n", ret); ++ } ++ ++#ifndef SATA_HIPOX_SINGLE_SATA ++ { ++ // register the ata device for the driver to find ++ ret = platform_device_register( &ox800sata_dev1 ); ++ DPRINTK(" %i\n", ret); ++ } ++#endif /* SATA_HIPOX_SINGLE_SATA */ ++ ++ return ret; ++} ++ ++/** ++ * module cleanup ++ */ ++static void __exit ox800sata_device_exit( void ) ++{ ++ platform_device_unregister( &ox800sata_dev0 ); ++ platform_device_unregister( &ox800sata_dev1 ); ++} ++ ++/** ++ * Returns accumulated RAID faults and then clears the accumulation ++ * @return accumulated RAID faults indicated by set bits ++ */ ++int hipoxsata_RAID_faults( void ) { ++ int temp = ox800sata_accumulated_RAID_faults; ++ ox800sata_accumulated_RAID_faults = 0; ++ return temp; ++} ++ ++/** ++ * Returns ox800 port number the request queue is serviced by. ++ * ++ * @param queue The queue under investigation. ++ * @return The ox800 sata port number servicing the queue or -1 if not found. ++ */ ++int hipoxsata_get_port_no(struct request_queue* q) ++{ ++ struct ata_port* ap = 0; ++ struct scsi_device* sdev = 0; ++ ++ /* check port 0 */ ++ ap = ox800sata_driver.ap[0]; ++ if (ap) ++ shost_for_each_device(sdev, ap->scsi_host) { ++ if (sdev->request_queue == q) { ++ DPRINTK("Queue %p on port 0\n", q); ++ return 0; ++ } ++ } ++ ++ /* check port 1 */ ++ ap = ox800sata_driver.ap[1]; ++ if (ap) ++ shost_for_each_device(sdev, ap->scsi_host) { ++ if (sdev->request_queue == q) { ++ DPRINTK("Queue %p on port 1\n", q); ++ return 1; ++ } ++ } ++ ++ /* not found */ ++ return -1; ++} ++ ++/** ++ * @return true if all the drives attached to the internal SATA ports use the ++ * same LBA size. ++ */ ++int hipoxsata_LBA_schemes_compatible( void ) ++{ ++ unsigned long flags0 ; ++ unsigned long flags1 ; ++ struct ata_port* ap ; ++ ++ /* check port 0 */ ++ ap = ox800sata_driver.ap[0]; ++ if (ap) ++ flags0 = ap->device[0].flags & ATA_DFLAG_LBA48 ; ++ else ++ return 0; ++ ++ /* check port 1 */ ++ ap = ox800sata_driver.ap[1]; ++ if (ap) ++ flags1 = ap->device[0].flags & ATA_DFLAG_LBA48 ; ++ else ++ return 0; ++ ++ /* compare */ ++ return (flags0 == flags1); ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(ox800sata_device_init); ++module_exit(ox800sata_device_exit); ++ ++EXPORT_SYMBOL( hipoxsata_RAID_faults ); ++EXPORT_SYMBOL( hipoxsata_get_port_no ); ++EXPORT_SYMBOL( hipoxsata_LBA_schemes_compatible ); +diff -Nurd linux-2.6.24/drivers/ata/ox810sata.c linux-2.6.24-oxe810/drivers/ata/ox810sata.c +--- linux-2.6.24/drivers/ata/ox810sata.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/ox810sata.c 2008-06-11 17:50:32.000000000 +0200 +@@ -0,0 +1,2423 @@ ++/************************************************************************** ++ * ++ * Copyright (c) 2007 Oxford Semiconductor Ltd. ++ * ++ * 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, 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. ++ * ++ * Module Name: ++ * ox810sata.c ++ * ++ * Abstract: ++ * A driver to interface the 934 based sata core present in the ox810 ++ * with libata and scsi ++ */ ++ ++#include <linux/types.h> ++#include <linux/sched.h> ++#include <linux/interrupt.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/list.h> ++#include <linux/device.h> ++#include <linux/string.h> ++#include <linux/sysdev.h> ++#include <linux/module.h> ++#include <linux/leds.h> ++ ++#include <scsi/scsi_host.h> ++#include <scsi/scsi_cmnd.h> ++#include <scsi/scsi_device.h> ++#include <asm/io.h> ++ ++#include <linux/platform_device.h> ++#include <asm/arch/hardware.h> ++#include <asm/arch/dma.h> ++#include <asm/arch/memory.h> ++#include <asm/arch/ox810sata.h> ++ ++#include <linux/proc_fs.h> ++ ++/*************************************************************************** ++* DEBUG CONTROL ++***************************************************************************/ ++//#define SATA_DEBUG ++//#define SATA_DUMP_REGS ++//#define SATA_TF_DUMP ++//#define DEBUG_EOT_FAILURE ++#define ERROR_INJECTION ++ ++#define CRAZY_DUMP_DEBUG ++#if 0 ++typedef struct { ++ u32 a; ++ u32 d; ++ u32 w; ++} regaccess; ++static u32 regindex = 0; ++static regaccess regarray[1024]; ++#endif ++ ++#if 0 ++ #ifdef writel ++ #undef writel ++ #endif ++ #define writel(v,a) {printk("[%p]<=%08x\n",a,v);*((volatile u32*)(a)) = v;} ++ //#define writel(vv,aa) {regarray[regindex].a=(aa); regarray[regindex].d=(vv); regarray[regindex].w=1; ++regindex; regindex &= 1023;*((volatile u32*)(aa)) = (vv);} ++#endif ++ ++#if 0 ++ #ifdef readl ++ #undef readl ++ #endif ++ static inline u32 myreadl(u32 a) {u32 v =(*((volatile u32*)(a)));printk("[%p]=>%08x\n",a,v);return v;} ++ //static inline u32 myreadl(u32 a) {u32 v =(*((volatile u32*)(a)));regarray[regindex].a=a; regarray[regindex].d=v; regarray[regindex].w=0; ++regindex; regindex &= 1023;return v;} ++ #define readl(a) (myreadl(a)) ++#endif ++ ++ ++#include <linux/libata.h> ++/*************************************************************************** ++* CONSTANTS ++***************************************************************************/ ++ ++#define DRIVER_AUTHOR "Oxford Semiconductor Ltd." ++#define DRIVER_DESC "934 SATA core controler" ++#define DRIVER_NAME "hipoxsata" ++ ++#define SATA_ABORT_WAIT_MS 5000 ++#define SATA_SRST_WAIT_MS 5000 ++ ++/************************************************************************** ++* PROTOTYPES ++**************************************************************************/ ++static int ox810sata_init_one(struct platform_device *); ++static int ox810sata_remove_one(struct platform_device *); ++ ++static void ox810sata_dev_config(struct ata_port *, struct ata_device *); ++static void ox810sata_set_piomode(struct ata_port *, struct ata_device *); ++static void ox810sata_set_dmamode(struct ata_port *, struct ata_device *); ++static void ox810sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf); ++static void ox810sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf); ++static void ox810sata_exec_command(struct ata_port *ap, const struct ata_taskfile *tf); ++static u8 ox810sata_check_status(struct ata_port *ap); ++static inline u8 ox810sata_check_altstatus(struct ata_port *ap); ++static void ox810sata_dev_select(struct ata_port *ap, unsigned int device); ++static void ox810sata_phy_reset(struct ata_port *ap); ++static void ox810sata_bmdma_setup(struct ata_queued_cmd *qc); ++static void ox810sata_bmdma_start(struct ata_queued_cmd *qc); ++static u8 ox810sata_bmdma_status(struct ata_port *ap); ++static struct ata_queued_cmd* ox810sata_qc_new(struct ata_port *ap); ++static void ox810sata_qc_free(struct ata_queued_cmd *qc); ++static unsigned int ox810sata_qc_issue(struct ata_queued_cmd *qc); ++static void ox810sata_eng_timeout(struct ata_port *ap); ++static irqreturn_t ox810sata_irq_handler(int, void *); ++static void ox810sata_eng_timeout(struct ata_port *ap); ++static void ox810sata_irq_clear(struct ata_port *); ++static int ox810sata_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val); ++static int ox810sata_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val); ++static int ox810sata_port_start(struct ata_port *ap); ++static void ox810sata_port_stop(struct ata_port *ap); ++static void ox810sata_host_stop(struct ata_host *host_set); ++static unsigned int ox810sata_devchk(struct ata_port *ap,unsigned int device); ++static u32* ox810sata_get_io_base(struct ata_port* ap); ++static u8 ox810sata_irq_on(struct ata_port *ap); ++static void ox810sata_bmdma_stop(struct ata_queued_cmd *qc); ++static void CrazyDumpDebug( void ); ++static void ox810sata_spot_the_end(struct work_struct *work); ++static void ox810sata_timeout_cleanup(struct ata_port *ap); ++static void ox810sata_error_handler(struct ata_port *ap); ++static void ox810sata_reset_core(void); ++static int ox810sata_prereset(struct ata_link *link, unsigned long deadline); ++static int ox810sata_hardreset(struct ata_link *link, unsigned int *class, unsigned long deadline); ++static void ox810sata_postreset(struct ata_link *link, unsigned int *classes); ++static void ox810sata_pio_start(struct work_struct *work); ++static void ox810sata_pio_task(struct work_struct *work); ++static void ox810sata_post_reset_init(struct ata_port* ap); ++static u32 inline __ox810sata_scr_read(u32* core_addr, unsigned int sc_reg); ++static void __ox810sata_scr_write(u32* core_addr, unsigned int sc_reg, u32 val); ++#ifdef ERROR_INJECTION ++static int ox810sata_error_inject_show(char *page, char **start, off_t off, int count, int *eof, void *data); ++static int ox810sata_error_inject_store(struct file *file,const char __user *buffer,unsigned long count,void *data); ++#endif ++ ++/************************************************************************** ++* STRUCTURES ++**************************************************************************/ ++typedef struct ++{ ++ struct kobject kobj; ++ struct platform_driver driver; ++ struct ata_port* ap[2]; ++ u32 error_inject; ++ struct workqueue_struct* spot_the_end_q; ++ u32 hw_raid_active; ++ struct ata_port* active_port; ++} ox810sata_driver_t; ++ ++/** ++ * Struct to hold per-port private (specific to this driver) data (still ++ * un-researched). ++ */ ++typedef struct ++{ ++ hipox_dma_channel_t* DmaChannel; ++ hipox_dma_sg_entry_t* sg_entries; ++ struct spot_the_end_work_s { ++ struct work_struct worker; ++ struct ata_port* ap; ++ } spot_the_end_work; ++ u32 ErrorsWithNoCommamnd; ++ u32 int_status; ++ u32 in_cleanup; ++} ox810sata_private_data; ++ ++ox810sata_driver_t ox810sata_driver = ++{ ++ .driver = ++ { ++ .driver.name = DRIVER_NAME, ++ .driver.bus = &platform_bus_type, ++ .probe = ox810sata_init_one, ++ .remove = ox810sata_remove_one, ++ }, ++ .ap = {0,0}, ++ .error_inject = 0, ++ .hw_raid_active = 0, ++ .active_port = 0, ++}; ++ ++/** If we were writing this in C++ then we would be deriving a subclass of ++ata_port, these would be the overridden functions*/ ++static struct ata_port_operations ox810sata_port_ops = ++{ ++ .dev_config = ox810sata_dev_config, ++ .set_piomode = ox810sata_set_piomode, ++ .set_dmamode = ox810sata_set_dmamode, ++ .tf_load = ox810sata_tf_load, ++ .tf_read = ox810sata_tf_read, ++ .exec_command = ox810sata_exec_command, ++ .check_status = ox810sata_check_status, ++ .check_altstatus = ox810sata_check_altstatus, ++ .dev_select = ox810sata_dev_select, ++ .phy_reset = ox810sata_phy_reset, ++ .bmdma_setup = ox810sata_bmdma_setup, ++ .bmdma_start = ox810sata_bmdma_start, ++ .bmdma_stop = ox810sata_bmdma_stop, ++ .bmdma_status = ox810sata_bmdma_status, ++ .qc_new = ox810sata_qc_new, ++ .qc_free = ox810sata_qc_free, ++ .qc_prep = ata_qc_prep, ++ .qc_issue = ox810sata_qc_issue, ++ .eng_timeout = ox810sata_eng_timeout, ++ .irq_handler = ox810sata_irq_handler, ++ .irq_clear = ox810sata_irq_clear, ++ .scr_read = ox810sata_scr_read, ++ .scr_write = ox810sata_scr_write, ++ .port_start = ox810sata_port_start, ++ .port_stop = ox810sata_port_stop, ++ .host_stop = ox810sata_host_stop, ++ .dev_chk = ox810sata_devchk, ++ .irq_on = ox810sata_irq_on, ++ .pio_task = ox810sata_pio_start, ++ .error_handler = ox810sata_error_handler, ++ .post_internal_cmd = ox810sata_bmdma_stop, ++}; ++ ++/** the scsi_host_template structure describes the basic capabilities of libata ++and our 921 core to the SCSI framework, it contains the addresses of functions ++in the libata library that handle top level comands from the SCSI library */ ++static struct scsi_host_template ox810sata_sht = ++{ ++ .module = THIS_MODULE, ++ .name = DRIVER_NAME, ++ .ioctl = ata_scsi_ioctl, ++ .queuecommand = ata_scsi_queuecmd, ++/* .eh_strategy_handler= ata_scsi_error,*/ ++ .can_queue = ATA_DEF_QUEUE, ++ .this_id = ATA_SHT_THIS_ID, ++/* .sg_tablesize = LIBATA_MAX_PRD,*/ ++ .sg_tablesize = CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES, ++ .max_sectors = 256, // Use the full 28-bit SATA value ++ .cmd_per_lun = ATA_SHT_CMD_PER_LUN, ++ .emulated = ATA_SHT_EMULATED, ++ .use_clustering = ATA_SHT_USE_CLUSTERING, ++ .proc_name = DRIVER_NAME, ++ .dma_boundary = ~0UL, // NAS has no DMA boundary restrictions ++ .slave_configure = ata_scsi_slave_config, ++ .bios_param = ata_std_bios_param, ++ .unchecked_isa_dma = 0, ++ ++}; ++ ++/** after PIO read operations, DRQ can remain set even when all the data has ++been read, when set, PretendDRQIsClear will mask out the DRQ bit in ++ox810sata_check_status operation */ ++static char PretendDRQIsClear; ++ ++/** ++ * used as a store for atomic test and set operations used to coordinate so ++ * that only one port is processing comnmands at any time */ ++static unsigned long ox810sata_command_active = 0; ++ ++/** ++ * A record of which drives have accumulated raid faults. A set bit indicates ++ * a fault has occured on that drive */ ++static u32 ox810sata_accumulated_RAID_faults = 0; ++ ++/**************************************************************************/ ++MODULE_LICENSE("GPL"); ++MODULE_VERSION(1.0); ++MODULE_AUTHOR(DRIVER_AUTHOR); ++MODULE_DESCRIPTION(DRIVER_DESC); ++ ++/************************************************************************** ++* FUCTIONS ++* prefix all with "ox810sata_" ++**************************************************************************/ ++ ++/** ++ * Gets the base of the ox810 port associated with the ata-port as known ++ * by lib-ata, The value returned changes to the single RAID port when ++ * hardware RAID commands are active. ++ * ++ * @param ap pointer to the appropriate ata_port structure ++ * @return the base address of the SATA core ++ */ ++static inline u32* ox810sata_get_tfio_base(struct ata_port* ap) ++{ ++ if ((ox810sata_driver.hw_raid_active) && ++ (ox810sata_driver.active_port == ap)) { ++ return (u32* )SATARAID_REGS_BASE; ++ } else { ++ return (u32* )ap->host->iomap; ++ } ++} ++ ++/** ++ * Gets the base address of the ata core from the ata_port structure. The value ++ * returned will remain the same when hardware raid is active. ++ * ++ * @param ap pointer to the appropriate ata_port structure ++ * @return the base address of the SATA core ++ */ ++static inline u32* ox810sata_get_io_base(struct ata_port* ap) ++{ ++ return (u32* )ap->host->iomap; ++} ++ ++/** ++ * Turns on the cores clock and resets it ++ */ ++static void ox810sata_reset_core( void ){ ++ // Enable the clock to the SATA block ++ writel(1UL << SYS_CTRL_CKEN_SATA_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ wmb(); ++ ++ // reset Controller, Link and PHY ++ writel( (1UL << SYS_CTRL_RSTEN_SATA_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SATA_LINK_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SATA_PHY_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ wmb(); ++ udelay(50); ++ ++ // un-reset the PHY, then Link and Controller ++ writel(1UL << SYS_CTRL_RSTEN_SATA_PHY_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ udelay(50); ++ writel( (1UL << SYS_CTRL_RSTEN_SATA_LINK_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SATA_BIT), SYS_CTRL_RSTEN_CLR_CTRL); ++ udelay(50); ++} ++ ++/** ++ * port capabilities for the ox810 sata ports. ++ */ ++static const struct ata_port_info ox810sata_port_info = { ++ .flags = ATA_FLAG_SATA | ATA_FLAG_SATA_RESET | ATA_FLAG_NO_LEGACY, ++ .pio_mask = 0x1f, /* pio modes 0..4*/ ++ .mwdma_mask = 0x07, /* mwdma0-2 */ ++ .udma_mask = 0x7f, /* udma0-5 */ ++ .port_ops = &ox810sata_port_ops, ++}; ++ ++/** ++ * The driver probe function. ++ * Registered with the amba bus driver as a parameter of ox810sata_driver.bus ++ * it will register the ata device with kernel first performing any ++ * initialisation required (if the correct device is present). ++ * @param pdev Pointer to the 921 device structure ++ * @return 0 if no errors ++ */ ++static int ox810sata_init_one(struct platform_device* pdev) ++{ ++ u32 version; ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ unsigned long reg; ++#endif // CONFIG_SATA_HIPOX_DISK_LIGHT ++ struct ata_host *host; ++ void __iomem* iomem; ++ const struct ata_port_info* port_info[] = { &ox810sata_port_info, NULL }; ++ struct resource* memres = platform_get_resource(pdev, IORESOURCE_MEM, 0 ); ++ int irq = platform_get_irq(pdev, 0); ++ ++ /* check resourses for sanity */ ++ if ((memres == NULL) || (irq < 0)) { ++ return 0; ++ } ++ iomem = (void __iomem* ) memres->start; ++ ++ /* check we support this version of the core */ ++ version = readl(((u32* )iomem) + OX810SATA_VERSION); ++ switch (version) { ++ case OX810SATA_CORE_VERSION: ++ printk(KERN_INFO"ox810sata: OX810 sata core.\n"); ++ break; ++ default: ++ printk(KERN_ERR"ox810sata: unknown sata core (version register = 0x%08x)\n",version); ++ return 0; ++ break; ++ } ++ ++ /* initialise a work queue to spot the end of transfers */ ++ ox810sata_driver.spot_the_end_q = create_singlethread_workqueue("sata-endQ"); ++ if (!ox810sata_driver.spot_the_end_q) { ++ printk(KERN_ERR DRIVER_NAME " Couldn't create a work queue.\n"); ++ return -1; ++ } ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* setup path */ ++ reg = ~(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ reg = ~(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ reg = ~(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE) & readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ writel(reg, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ ++ /* enable output */ ++ writel(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_ENABLE); ++ ++ /* disk light off */ ++ writel(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_CLEAR); ++#endif /* CONFIG_SATA_HIPOX_DISK_LIGHT */ ++ ++ /* setup the probe_ent structure which is basically info about the ports ++ capabilities */ ++ ++ /* allocate memory and check */ ++ host = ata_host_alloc_pinfo(&(pdev->dev), port_info, OX810SATA_MAX_PORTS); ++ if (!host) { ++ printk(KERN_ERR DRIVER_NAME " Couldn't create an ata host.\n"); ++ destroy_workqueue(ox810sata_driver.spot_the_end_q); ++ } ++ ++ /* set to base of ata core */ ++ host->iomap = iomem; ++ ++ /* call ata_device_add and begin probing for drives*/ ++ ata_host_activate(host, irq, ox810sata_irq_handler, IRQF_SHARED, &ox810sata_sht); ++ ++ return 0; ++} ++ ++/** ++ * Called when the amba bus tells this device to remove itself. ++ * @param pdev pointer to the device that needs to be shutdown ++ */ ++static int ox810sata_remove_one(struct platform_device* pdev) ++{ ++ struct ata_host *host_set = dev_get_drvdata( &(pdev->dev) ); ++ struct ata_port *ap; ++ unsigned int i; ++ ++ for (i = 0; i < host_set->n_ports; i++) ++ { ++ ap = host_set->ports[i]; ++ scsi_remove_host( ap->scsi_host ); ++ } ++ ++ /** @TODO etc. */ ++ ++ // Disable the clock to the SATA block ++ writel(1UL << SYS_CTRL_CKEN_SATA_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++ ++ return 0; ++} ++ ++/** ++ * module initialisation ++ * @return success ++ */ ++static int __init ox810sata_init( void ) ++{ ++ int ret; ++ ++ ret = platform_driver_register( &ox810sata_driver.driver ); ++ DPRINTK(" %i\n", ret); ++ ++#ifdef ERROR_INJECTION ++{ ++ struct proc_dir_entry *res=create_proc_entry("ox810sata_errorinject",0,NULL); ++ if (res) { ++ res->read_proc=ox810sata_error_inject_show; ++ res->write_proc=ox810sata_error_inject_store; ++ res->data=NULL; ++ } ++ //create_proc_read_entry("ox810sata_errorinject", 0, NULL, ox810sata_error_inject_show, NULL); ++} ++#endif ++ return ret; ++} ++ ++/** ++ * module cleanup ++ */ ++static void __exit ox810sata_exit( void ) ++{ ++ platform_driver_unregister( &ox810sata_driver.driver ); ++} ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(ox810sata_init); ++module_exit(ox810sata_exit); ++ ++/** ++ * Called after IDENTIFY [PACKET] DEVICE is issued to each device found. ++ * Typically used to apply device-specific fixups prior to issue of ++ * SET FEATURES - XFER MODE, and prior to operation. ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox810sata_dev_config(struct ata_port *ap, struct ata_device* pdev) ++{ ++ u32 reg; ++ u32 *ioaddr = ox810sata_get_io_base(ap); ++ ++ /* Set the bits to put the interface into 28 or 48-bit node */ ++ reg = readl(ioaddr + OX810SATA_DRIVE_CONTROL); ++ ++ /* mask out the pair of bits associaed with each port */ ++ reg &= ~(3 << (ap->port_no * 2)); ++ ++ /* set the mode pair associated with each port */ ++ reg |= ((pdev->flags & ATA_DFLAG_LBA48) ? OX810SATA_DR_CON_48 : ++ OX810SATA_DR_CON_28) << (ap->port_no * 2); ++ writel(reg, ioaddr + OX810SATA_DRIVE_CONTROL); ++ ++ /* if this is an ATA-6 disk, put the port into ATA-5 auto translate mode */ ++ if (pdev->flags & ATA_DFLAG_LBA48) { ++ reg = readl(ioaddr + OX810SATA_PORT_CONTROL); ++ reg |= 2; ++ writel(reg, ioaddr + OX810SATA_PORT_CONTROL); ++ } ++} ++ ++/** ++ * nothing to do ++ * ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox810sata_set_piomode(struct ata_port* port, struct ata_device* pdev) ++{ ++} ++ ++/** ++ * nothing to do ++ * ++ * @param port The port to configure ++ * @param pdev The hardware associated with controlling the port ++ */ ++static void ox810sata_set_dmamode(struct ata_port* port, struct ata_device* pdev) ++{ ++} ++ ++/** ++ * Output the taskfile for diagnostic reasons, it will always appear in the ++ * debug output as if it's a task file being written. ++ * @param tf The taskfile to output ++ */ ++static void tfdump(const struct ata_taskfile* tf) ++{ ++ if (tf->flags & ATA_TFLAG_LBA48) { ++#ifdef SATA_TF_DUMP ++ printk("Cmd %x Ft %x%x, LBA-48 %02x%02x%02x%02x%02x%02x, nsect %02x%02x, ctl %02x, dev %x\n", ++#else // SATA_TF_DUMP ++ DPRINTK("Cmd %x Ft %x%x, LBA-48 %02x%02x%02x%02x%02x%02x, nsect %02x%02x, ctl %02x, dev %x\n", ++#endif // SATA_TF_DUMP ++ tf->command, ++ ++ tf->hob_feature, ++ tf->feature, ++ ++ tf->hob_lbah, ++ tf->hob_lbam, ++ tf->hob_lbal, ++ tf->lbah, ++ tf->lbam, ++ tf->lbal, ++ ++ tf->hob_nsect, ++ tf->nsect, ++ tf->ctl, ++ tf->device ); ++ } else { ++#ifdef SATA_TF_DUMP ++ printk("Cmd %x Ft %x, LBA-28 %01x%02x%02x%02x, nsect %02x, ctl %02x, dev %x\n", ++#else // SATA_TF_DUMP ++ DPRINTK("Cmd %x Ft %x, LBA-28 %01x%02x%02x%02x, nsect %02x, ctl %02x, dev %x\n", ++#endif // SATA_TF_DUMP ++ tf->command, ++ ++ tf->feature, ++ ++ tf->device & 0x0f, ++ tf->lbah, ++ tf->lbam, ++ tf->lbal, ++ ++ tf->nsect, ++ tf->ctl, ++ tf->device ); ++ } ++} ++ ++/** ++ * called to write a taskfile into the ORB registers ++ * @param ap hardware with the registers in ++ * @param tf taskfile to write to the registers ++ */ ++static void ox810sata_tf_load(struct ata_port *ap, const struct ata_taskfile *tf) ++{ ++ u32 count = 0; ++ u32 Orb1 = 0; ++ u32 Orb2 = 0; ++ u32 Orb3 = 0; ++ u32 Orb4 = 0; ++ u32 Command_Reg; ++ u32 *ioaddr = ox810sata_get_tfio_base(ap); ++ unsigned int is_addr = tf->flags & ATA_TFLAG_ISADDR; ++ ++ /* wait a maximum of 10ms for the core to be idle */ ++ do { ++ Command_Reg = readl(ioaddr + OX810SATA_SATA_COMMAND); ++ if (!(Command_Reg & CMD_CORE_BUSY)) { ++ break; ++ } ++ count++; ++ udelay(50); ++ } while (count < 200); ++ ++ /* if the control register has changed, write it */ ++ if (tf->ctl != ap->last_ctl) ++ { ++ //DPRINTK("ap->last_ctl = %02x",ap->last_ctl); ++ Orb4 |= (tf->ctl) << 24; ++ ++ /* write value to register */ ++ writel(Orb4, ioaddr + OX810SATA_ORB4); ++ ++ ap->last_ctl = tf->ctl; ++ ++ /** @todo find a more elegant way to do this */ ++ /* if the new control value is a soft reset, command the core to send a ++ control FIS */ ++ if (tf->ctl & ATA_SRST) { ++ writel(CMD_WRITE_TO_ORB_REGS_NO_COMMAND, ioaddr + OX810SATA_SATA_COMMAND); ++ } ++ } ++ ++ /* check if the ctl register has interrupts disabled or enabled and ++ modify the interrupt enable registers on the ata core as required */ ++ if (tf->ctl & ATA_NIEN) { ++ /* interrupts disabled */ ++ ox810sata_irq_clear(ap); ++ } else { ++ /* interrupts enabled */ ++ ox810sata_irq_on(ap); ++ } ++ ++ /* write 48 or 28 bit tf parameters */ ++ if (is_addr) { ++ /* set LBA bit as it's an address */ ++ Orb1 |= (tf->device & ATA_LBA) << 24; ++ ++ if (tf->flags & ATA_TFLAG_LBA48) { ++ //DPRINTK(KERN_INFO" 48 bit tf load \n"); ++ Orb1 |= ATA_LBA << 24; ++ ++ Orb2 |= (tf->hob_nsect) << 8 ; ++ ++ Orb3 |= (tf->hob_lbal) << 24; ++ ++ Orb4 |= (tf->hob_lbam) << 0 ; ++ Orb4 |= (tf->hob_lbah) << 8 ; ++ Orb4 |= (tf->hob_feature)<< 16; ++ } else { ++ Orb3 |= (tf->device & 0xf)<< 24; ++ } ++ ++ /* write 28-bit lba */ ++ //DPRINTK(KERN_INFO" 28 bit tf load\n"); ++ Orb2 |= (tf->nsect) << 0 ; ++ Orb2 |= (tf->feature) << 16; ++ Orb2 |= (tf->command) << 24; ++ ++ Orb3 |= (tf->lbal) << 0 ; ++ Orb3 |= (tf->lbam) << 8 ; ++ Orb3 |= (tf->lbah) << 16; ++ ++ Orb4 |= (tf->ctl) << 24; ++ ++ /* write values to registers */ ++ writel(Orb1, ioaddr + OX810SATA_ORB1 ); ++ writel(Orb2, ioaddr + OX810SATA_ORB2 ); ++ writel(Orb3, ioaddr + OX810SATA_ORB3 ); ++ writel(Orb4, ioaddr + OX810SATA_ORB4 ); ++ } ++ ++ if (tf->flags & ATA_TFLAG_DEVICE) { ++ Orb1 |= (tf->device) << 24; ++ ++ /* write value to register */ ++ writel(Orb1, ioaddr + OX810SATA_ORB1); ++ } ++ ++ tfdump(tf); ++} ++ ++/** ++ * Called to read the hardware registers / DMA buffers, to ++ * obtain the current set of taskfile register values. ++ * @param ap hardware with the registers in ++ * @param tf taskfile to read the registers into ++ */ ++static void ox810sata_tf_read(struct ata_port *ap, struct ata_taskfile *tf) ++{ ++ u32 *ioaddr = ox810sata_get_tfio_base(ap); ++ ++ /* read the orb registers */ ++ u32 Orb1 = readl(ioaddr + OX810SATA_ORB1); ++ u32 Orb2 = readl(ioaddr + OX810SATA_ORB2); ++ u32 Orb3 = readl(ioaddr + OX810SATA_ORB3); ++ u32 Orb4 = readl(ioaddr + OX810SATA_ORB4); ++ ++ /* read common 28/48 bit tf parameters */ ++ tf->device = (Orb1 >> 24); ++ tf->nsect = (Orb2 >> 0); ++ tf->feature = (Orb2 >> 16); ++ tf->command = ox810sata_check_status(ap); ++ ++ /* read 48 or 28 bit tf parameters */ ++ if (tf->flags & ATA_TFLAG_LBA48) { ++ //DPRINTK(KERN_INFO" 48 bit tf read \n"); ++ tf->hob_nsect = (Orb2 >> 8) ; ++ ++ tf->lbal = (Orb3 >> 0) ; ++ tf->lbam = (Orb3 >> 8) ; ++ tf->lbah = (Orb3 >> 16) ; ++ tf->hob_lbal = (Orb3 >> 24) ; ++ ++ tf->hob_lbam = (Orb4 >> 0) ; ++ tf->hob_lbah = (Orb4 >> 8) ; ++ /* feature ext and control are write only */ ++ } else { ++ /* read 28-bit lba */ ++ //DPRINTK(KERN_INFO" 28 bit tf read\n"); ++ tf->lbal = (Orb3 >> 0) ; ++ tf->lbam = (Orb3 >> 8) ; ++ tf->lbah = (Orb3 >> 16) ; ++ } ++ ++ tfdump(tf); ++} ++ ++/** ++ * Causes an ATA command, previously loaded with ->tf_load(), to be ++ * initiated in hardware. The command is written into the registers again just ++ * to be sure. All the other registers that are in Orb2 are also written at the ++ * same time. The command is initiated in hardware by a poke to the COMMAND ++ * register. ++ * @param ap hardware with the registers in ++ * @param tf taskfile to write to the registers ++ */ ++static void ox810sata_exec_command(struct ata_port *ap, const struct ata_taskfile *tf) ++{ ++ u32 count =0; ++ u32 *ioaddr = ox810sata_get_tfio_base(ap); ++ u32 Orb2; ++ u32 Command_Reg; ++ ++#ifdef ERROR_INJECTION ++ static u32 prand = 10; ++ if (ox810sata_driver.error_inject) { ++ u32 *portaddr = ox810sata_get_io_base(ap); ++ prand = prand ? prand - 1 : 100; ++ if ( prand < ox810sata_driver.error_inject) { ++ DPRINTK("ox810sata_exec_command: error injection on\n"); ++ __ox810sata_scr_write( portaddr, 0x14 , 0xd ); ++ } else { ++ __ox810sata_scr_write( portaddr, 0x14 , 0x1 ); ++ DPRINTK("ox810sata_exec_command: error injection off\n"); ++ } ++ } ++#endif ++ ++ VPRINTK("\n"); ++ /* Wait a maximum af 10ms for the core to go idle */ ++ do { ++ Command_Reg = readl(ioaddr + OX810SATA_SATA_COMMAND); ++ if (!(Command_Reg & CMD_CORE_BUSY)) { ++ break; ++ } ++ count++; ++ udelay(50); ++ } while (count < 200); ++ ++ /* write all the things in Orb 2 */ ++ Orb2 = (tf->nsect) << 0 ; ++ if (tf->flags & ATA_TFLAG_LBA48) { ++ Orb2 |= (tf->hob_nsect) << 8; ++ } ++ Orb2 |= (tf->feature) << 16; ++ Orb2 |= (tf->command) << 24; ++ writel(Orb2 , ioaddr + OX810SATA_ORB2); ++ wmb(); ++ ++ do { ++ Command_Reg = readl(ioaddr + OX810SATA_SATA_COMMAND); ++ if (!(Command_Reg & CMD_CORE_BUSY)) { ++ break; ++ } ++ count++; ++ udelay(50); ++ } while (count < 200); ++ ++ /* Command that the orb registers get written to drive */ ++ Command_Reg &= ~SATA_OPCODE_MASK; ++ Command_Reg |= CMD_WRITE_TO_ORB_REGS; ++ writel(Command_Reg , ioaddr + OX810SATA_SATA_COMMAND); ++ wmb(); ++} ++ ++ ++/** ++ * Reads the Status ATA shadow register from hardware. Due to a fault with PIO ++ * transfers, it it sometimes necessary to mask out the DRQ bit ++ * @param ap hardware with the registers in ++ * @return The status register ++ */ ++static u8 ox810sata_check_status(struct ata_port *ap) ++{ ++ u32 Reg; ++ u8 status; ++ u32 *ioaddr = ox810sata_get_tfio_base(ap); ++ ++// VPRINTK(KERN_INFO"ox810sata_check_status "); ++ ++ /* read byte 3 of Orb2 register */ ++ status = readl(ioaddr + OX810SATA_ORB2) >> 24; ++ ++ /* check for the drive going missing indicated by SCR status bits 0-3 = 0 */ ++ if ( ox810sata_driver.hw_raid_active ) { ++ u32 Temp; ++ ox810sata_scr_read(ox810sata_driver.ap[0], SCR_STATUS, &Temp ); ++ ox810sata_scr_read(ox810sata_driver.ap[1], SCR_STATUS, &Reg); ++ Reg |= Temp; ++ } else { ++ ox810sata_scr_read(ap, SCR_STATUS, &Reg ); ++ } ++ if (!(Reg & 0x1)) { ++ status |= ATA_DF; ++ status |= ATA_ERR; ++ } ++ //VPRINTK("%02x\n",result); ++ ++ return status; ++} ++ ++/** ++ * Reads the alt status ATA shadow register from hardware. ++ * @param ap hardware with the registers in ++ * @return The alt status register ++ */ ++static u8 ox810sata_check_altstatus(struct ata_port *ap) ++{ ++ return readl(ox810sata_get_tfio_base(ap) + OX810SATA_ORB4) >> 24; ++} ++ ++/** ++ * Use the method defined in the ATA specification to make either device 0, ++ * or device 1, active on the ATA channel. If we ever get port multipliers ++ * to work, this will be where they would switch. ++ * ++ * @param ap hardware with the registers in ++ * @param number of the device to talk to (0..) ++ */ ++static void ox810sata_dev_select(struct ata_port *ap, unsigned int device) ++{ ++} ++ ++/** ++ * The very first step in the probe phase. Actions vary depending on the bus ++ * type, typically. After waking up the device and probing for device presence ++ * (PATA and SATA), typically a soft reset (SRST) will be performed. Drivers ++ * typically use the helper functions ata_bus_reset() or sata_phy_reset() for ++ * this hook. ++ * ++ * This should reset the SATA core and Phisical layer then jump back into the ++ * libata libraries for lots of other resetting ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox810sata_phy_reset(struct ata_port *ap) ++{ ++ u32 *ioaddr = ox810sata_get_io_base(ap); ++ ++ DPRINTK(KERN_INFO "base = %p\n", ioaddr); ++ ++ /* turn ata core on */ ++ writel((1 << SYS_CTRL_CKEN_SATA_BIT), SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* stop all the interrupts in the ata core */ ++ writel(~0, ioaddr + OX810SATA_INT_DISABLE); ++ writel(~0, ioaddr + OX810SATA_INT_CLEAR); ++ ++ /* get libata to perform a soft reset */ ++ ata_port_probe(ap); ++ ata_bus_reset(ap); ++} ++ ++/** ++ * When setting up an IDE BMDMA transaction, these hooks arm (->bmdma_setup) ++ * and fire (->bmdma_start) the hardware's DMA engine. ++ * ++ * @param qc the queued command to issue ++ */ ++static void ox810sata_bmdma_setup(struct ata_queued_cmd *qc) ++{ ++ ox810sata_private_data* PrivateData ; ++ hipox_dma_direction_t direction; ++ ++#ifdef SATA_DEBUG ++ printk(KERN_INFO"ox810sata_bmdma_setup: %s, %d element%s\n", (qc->dma_dir == DMA_FROM_DEVICE) ? "Read" : "Write", qc->n_elem, qc->n_elem ? "s" : ""); ++#else // SATA_DEBUG ++ DPRINTK(" %s, %d element%s\n", (qc->dma_dir == DMA_FROM_DEVICE) ? "Read" : "Write", qc->n_elem, qc->n_elem ? "s" : ""); ++#endif // SATA_DEBUG ++ ++ qc->private_data = qc->ap->private_data; ++ PrivateData = (ox810sata_private_data* )qc->private_data; ++ ++ // We check for DMA completion from ISR which cannot wait for all DMA channel ++ // housekeeping to complete, so need to wait here is case we try to reuse ++ // channel before that housekeeping has completed ++ while (hipox_dma_is_active(PrivateData->DmaChannel)) { ++ printk("DMA Setup Channel still active\n"); ++ } ++ ++ /* Do not use DMA callback */ ++ hipox_dma_set_callback(PrivateData->DmaChannel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ /* decide on DMA direction */ ++ direction = (qc->dma_dir == DMA_FROM_DEVICE) ? HIPOX_DMA_FROM_DEVICE : ++ HIPOX_DMA_TO_DEVICE; ++ ++ /* now set-up the DMA transfer */ ++ if (qc->n_elem > 1) ++ { ++#ifdef SATA_DEBUG ++ u32 total=0; ++ int i=0; ++ struct scatterlist* sg = qc->__sg; ++ printk("Lengths: "); ++ do { ++ u32 len = sg_dma_len(sg++); ++ printk("%u ", len); ++ total += len; ++ } while (++i < qc->n_elem); ++ printk("\nTotal len = %u\n", total); ++#endif // SATA_DEBUG ++ /* try and setup scatter gather controller */ ++ if (hipox_dma_device_set_prd( ++ PrivateData->DmaChannel, ++ direction, ++ qc->ap->prd, ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ PrivateData->sg_entries)) { ++ printk(KERN_ERR"Failed to setup DMA with disk.\n"); ++ return; ++ } ++ } ++ else ++ { ++#ifdef SATA_DEBUG ++ printk("Total len = %u\n", sg_dma_len(qc->__sg)); ++#endif // SATA_DEBUG ++ /* setup a single dma */ ++ hipox_dma_device_set( PrivateData->DmaChannel, ++ direction, ++ (unsigned char* )sg_dma_address(qc->__sg), ++ sg_dma_len(qc->__sg), ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ 1); /* paused */ ++ } ++} ++ ++/** ++ * When setting up an IDE BMDMA transaction, these hooks arm (->ignedmdma_setup) ++ * and fire (->bmdma_start) the hardware's DMA engine. ++ * ++ * @param qc the queued command to issue ++ */ ++static void ox810sata_bmdma_start(struct ata_queued_cmd *qc) ++{ ++ ox810sata_private_data* PrivateData ; ++ DPRINTK("\n"); ++ PrivateData = (ox810sata_private_data*)(qc->private_data); ++ ++ /* start DMA transfer */ ++ hipox_dma_start(PrivateData->DmaChannel); ++ qc->ap->ops->exec_command(qc->ap, &(qc->tf)); ++} ++ ++ ++/** ++ * ata_qc_new - Request an available ATA command, for queueing ++ * @ap: Port associated with device @dev ++ * @dev: Device from whom we request an available command structure ++ * ++ * LOCKING: ++ */ ++ ++static struct ata_queued_cmd* ox810sata_qc_new(struct ata_port *ap) ++{ ++ struct ata_queued_cmd *qc = NULL; ++ ++ VPRINTK("\n"); ++ /* no command while frozen */ ++ if (unlikely(ap->pflags & ATA_PFLAG_FROZEN)) ++ return NULL; ++ ++ /* check to see that there are no internal commands active on either port*/ ++ if ((ox810sata_driver.ap[0]) && (ox810sata_driver.ap[0]->qc_allocated)) ++ return qc; ++ if ((ox810sata_driver.ap[1]) && (ox810sata_driver.ap[1]->qc_allocated)) ++ return qc; ++ ++ /* check if we're not doing a command */ ++ if (test_and_set_bit(0, &ox810sata_command_active)) ++ return qc; ++ ++ /* now set the standard bits for compatibility */ ++ set_bit(0, &ap->qc_allocated); ++ qc = __ata_qc_from_tag(ap, 0); ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* disk light on */ ++ writel(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_SET); ++#endif // CONFIG_SATA_HIPOX_DISK_LIGHT ++#ifdef CONFIG_WDC_LEDS_TRIGGER_SATA_DISK ++ wdc_ledtrig_sata_activity(); ++#endif // CONFIG_WDC_LEDS_TRIGGER_SATA_DISK ++ ++ if (qc) { ++ qc->tag = 0; ++ } ++ ++ return qc; ++} ++ ++ ++/** ++ * ++ */ ++static void ox810sata_qc_free(struct ata_queued_cmd *qc) ++{ ++ unsigned int tag; ++ struct ata_port *ap = qc->ap; ++ ++ DPRINTK("\n"); ++ ++ qc->flags = 0; ++ tag = qc->tag; ++ if (likely(ata_tag_valid(tag))) { ++ qc->tag = ATA_TAG_POISON; ++ VPRINTK("clearing active bits\n"); ++ clear_bit(tag, &ap->qc_allocated); ++ clear_bit(0, &ox810sata_command_active); ++ ++#ifdef CONFIG_SATA_HIPOX_DISK_LIGHT ++ /* disk light off */ ++ writel(1 << CONFIG_OX810SATA_DISK_LIGHT_GPIO_LINE, GPIO_A_OUTPUT_CLEAR); ++#endif /* CONFIG_SATA_HIPOX_DISK_LIGHT */ ++ } ++} ++ ++/** ++ * qc_issue is used to make a command active, once the hardware and S/G tables ++ * have been prepared. IDE BMDMA drivers use the helper function ++ * ata_qc_issue_prot() for taskfile protocol-based dispatch. More advanced drivers ++ * roll their own ->qc_issue implementation, using this as the "issue new ATA ++ * command to hardware" hook. ++ * @param qc the queued command to issue ++ */ ++static unsigned int ox810sata_qc_issue(struct ata_queued_cmd *qc) ++{ ++ int this_port_fail; ++ struct bio* bio; ++ u32 reg; ++ ox810sata_private_data* private_data = (ox810sata_private_data*)qc->ap->private_data ; ++ u32 raid_reg = 0; /* default to no raid */ ++ int port0fail = 0; ++ int port1fail = 0; ++ unsigned long flags = 0; ++ ++ DPRINTK("\n"); ++ ++ /* get raid settings from the bio if they exist */ ++ if (qc->scsicmd && qc->scsicmd->request && qc->scsicmd->request->bio) { ++ bio = qc->scsicmd->request->bio; ++ raid_reg = bio->bi_raid ; ++ //if (raid_reg) {printk("Hardware RAID :");tfdump(&qc->tf);} ++ ++ } ++ ox810sata_driver.hw_raid_active = raid_reg; ++ ox810sata_driver.active_port = qc->ap; ++ ++ /* check cable is still connected */ ++ ox810sata_scr_read(qc->ap, SCR_STATUS, ®); ++ this_port_fail = (!(reg & 1)); ++ ++ /* check for failed ports prior to issuing raid-ed commands */ ++ if (raid_reg) { ++ port0fail = (! (__ox810sata_scr_read((u32* )SATA0_REGS_BASE, 0x20 + (4 * SCR_STATUS) ) & 1 ) ); ++ port1fail = (! (__ox810sata_scr_read((u32* )SATA1_REGS_BASE, 0x20 + (4 * SCR_STATUS) ) & 1 ) ); ++ this_port_fail |= port1fail; ++ ++ ox810sata_accumulated_RAID_faults |= port0fail ? 1 : 0 ; ++ ox810sata_accumulated_RAID_faults |= port1fail ? 2 : 0 ; ++ } ++ ++ if (!this_port_fail) { ++ /* clear phy/link errors */ ++ if (ox810sata_driver.ap[0]) ++ ox810sata_scr_write(ox810sata_driver.ap[0], SCR_ERROR, ~0); ++ if (ox810sata_driver.ap[1]) ++ ox810sata_scr_write(ox810sata_driver.ap[1], SCR_ERROR, ~0); ++ ++ /* clear errors on both hosts */ ++ reg = readl((u32* )SATA0_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32* )SATA0_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg = readl((u32* )SATA1_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32* )SATA1_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg = readl((u32* )SATARAID_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32* )SATARAID_REGS_BASE + OX810SATA_SATA_CONTROL); ++ ++ /* clear all interrupt bits */ ++ writel(~0, (u32* )SATA0_REGS_BASE + OX810SATA_INT_CLEAR); ++ writel(~0, (u32* )SATA1_REGS_BASE + OX810SATA_INT_CLEAR); ++ writel(~0, (u32* )SATARAID_REGS_BASE + OX810SATA_INT_CLEAR); ++ writel(~0, OX810SATA_CORE_IEC ); ++ ++ /* hardware RAID */ ++ if ( raid_reg ) { ++ /* set interrupt mode for raid controller interrupts only */ ++ writel(OX810SATA_RAID_INTS_WANTED, OX810SATA_CORE_IES ); ++ ++ /* at the moment we only do raid-1 */ ++ writel(HIPOXSATA_RAID1, OX810SATA_RAID_CONTROL); ++ writel(HIPOXSATA_RAID_TWODISKS, OX810SATA_RAID_SET); ++ } else { ++ /* set normal interrupt scheme */ ++ writel(OX810SATA_NORMAL_INTS_WANTED, OX810SATA_CORE_IES); ++ ++ /* Set the RAID controller hardware to idle */ ++ writel(HIPOXSATA_NOTRAID, OX810SATA_RAID_CONTROL); ++ } ++ ++ /* call the default, this should be changed to take advantage of orb ++ registers, etc... */ ++ return ata_qc_issue_prot(qc); ++ } else { ++ /* record the error */ ++ qc->err_mask |= AC_ERR_ATA_BUS; ++ ++ /* maybee call ata qc complete? */ ++ local_irq_save(flags); ++ ox810sata_irq_clear(qc->ap); ++ private_data->int_status = 0; ++ local_irq_restore(flags); ++ ata_qc_complete(qc); ++ ++ return 0; ++ } ++} ++ ++/** ++ * This is a high level error handling function, called from the error ++ * handling thread, when a command times out. ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox810sata_eng_timeout(struct ata_port *ap) ++{ ++ struct ata_queued_cmd *qc; ++ ox810sata_private_data* pd = (ox810sata_private_data*)ap->private_data; ++ DPRINTK("\n"); ++ ++ /* set the in cleanup flag */ ++ pd->in_cleanup = 1; ++ ++ /* if we're a PIO command existing cleanup won't be called */ ++ qc = ata_qc_from_tag(ap, ap->link.active_tag); ++ if (qc->tf.protocol == ATA_PROT_PIO) { ++ /* reset the core */ ++ ox810sata_timeout_cleanup(ap); ++ } ++ ++ /* clear the in cleanup flag */ ++ pd->in_cleanup = 0; ++} ++ ++/** ++ * irq_handler is the interrupt handling routine registered with the system, ++ * by libata. ++ */ ++static irqreturn_t ox810sata_irq_handler( ++ int irq, ++ void *dev_instance) ++{ ++ struct ata_port *ap = ((struct ata_host *)dev_instance)->ports[0]; ++ ox810sata_private_data *pd; ++ u32 *ioaddr; ++ u32 int_status; ++ u32 count ; ++ ++ DPRINTK("irq = %d\n", irq); ++ ++ if (!ap || !ap->private_data) ++ BUG(); ++ ++ /* check the ISR for the port to see if it created the interrupt */ ++ ioaddr = ox810sata_get_tfio_base(ap); ++ int_status = readl(ioaddr + OX810SATA_INT_STATUS); ++ if ( !(int_status & OX810SATA_INT_WANT ) ) { ++ VPRINTK("not me!\n"); ++ return IRQ_NONE; ++ } ++ ++ pd = (ox810sata_private_data*)ap->private_data; ++ while (int_status & OX810SATA_INT_MASKABLE) { ++ /* store interrupt status for the bottom end */ ++ pd->int_status |= int_status; ++ ++ /* Clear and mask pending interrupts */ ++ writel(int_status, ioaddr + OX810SATA_INT_CLEAR); ++ writel(int_status, ioaddr + OX810SATA_INT_DISABLE); ++ ++ int_status = readl(ioaddr + OX810SATA_INT_STATUS); ++ } ++ ++ // Wait a short while for the DMA to finish and if it doesn't start a thread ++ // to poll for the finish ++ pd->spot_the_end_work.ap = ap; ++ for (count = 0; count < 10; ++count) { ++ if (!hipox_dma_raw_isactive(pd->DmaChannel)) { ++ ox810sata_spot_the_end(&(pd->spot_the_end_work.worker)); ++ break; ++ } ++ udelay(100); ++ } ++ ++ if (count == 10) { ++ /* Start a worker thread looking for the DMA channel to become idle */ ++ VPRINTK("queueing work \n"); ++ queue_work(ox810sata_driver.spot_the_end_q, &pd->spot_the_end_work.worker); ++ } ++ VPRINTK("done\n"); ++ return IRQ_HANDLED; ++} ++ ++/** ++ * Work for a work queue, this will check for errors then wait for the DMA to ++ * complete. On the DMA completing it will call ata_qc_complete ++ */ ++static void ox810sata_spot_the_end(struct work_struct *work) ++{ ++ struct spot_the_end_work_s* stew = ++ container_of(work, struct spot_the_end_work_s, worker); ++ struct ata_port* ap = stew->ap; ++ ox810sata_private_data* PrivateData = (ox810sata_private_data* )ap->private_data; ++ struct ata_queued_cmd* qc = ata_qc_from_tag(ap, ap->link.active_tag); ++ unsigned long flags = 0; ++ ++ VPRINTK("\n"); ++ ++ /* If there's no command ending associated with this IRQ, ignore it. */ ++ if (qc == NULL) { ++ DPRINTK(" qc=null\n"); ++ return; ++ } ++ ++ /* The command may have aborted, this is indicated by the interrupt bit ++ * being masked */ ++ if (PrivateData->in_cleanup) { ++ DPRINTK("cleanup\n"); ++ return; ++ } ++ ++ /* get the status before any error cleanup */ ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ ++ /* Look to see if the core is indicating an error condition after a RAID ++ * command */ ++ if (qc->scsicmd && ++ qc->scsicmd->request && ++ qc->scsicmd->request->bio && ++ qc->scsicmd->request->bio->bi_raid ) { ++ unsigned long Port0Irq = readl(((u32)(SATA0_REGS_BASE)) + OX810SATA_INT_STATUS); ++ unsigned long Port1Irq = readl(((u32)(SATA1_REGS_BASE)) + OX810SATA_INT_STATUS); ++ ++ if (OX810SATA_RAW_ERROR & Port0Irq) { ++ printk(KERN_DEBUG"disk 0 error in hw-raid\n"); ++ ox810sata_accumulated_RAID_faults |= 1; ++ } ++ if (OX810SATA_RAW_ERROR & Port1Irq) { ++ printk(KERN_DEBUG"disk 1 error in hw-raid\n"); ++ ox810sata_accumulated_RAID_faults |= 2; ++ } ++ } ++ ++ /* if there was an error and the command hasn't finished, then we need to ++ * abort the command */ ++ if ((PrivateData->int_status & 0xfffe) && ++ !(PrivateData->int_status & 0x1) && ++ (qc->tf.protocol == ATA_PROT_DMA)) ++ { ++ DPRINTK(" int status 0x%08x, ata%u \n",PrivateData->int_status,ap->id); ++ local_irq_save(flags); ++ ox810sata_irq_clear(ap); ++ PrivateData->int_status = 0; ++ local_irq_restore(flags); ++ ata_qc_complete(qc); ++ return; ++ } ++ ++ if (!in_irq()) { ++ /* wait for the DMA to finish */ ++ while (hipox_dma_is_active(PrivateData->DmaChannel)) { ++ schedule(); ++ } ++ } ++ ++ if (!(qc->flags & ATA_QCFLAG_ACTIVE)) { ++ printk(KERN_WARNING "OX810 SATA: Command already completed!\n"); ++ return; ++ } ++ ++ /** @debug check for any padding */ ++ if(0) ++ { ++ unsigned int reg; ++ reg = readl(OX810SATA_EXCESS); ++ if (reg) { ++ printk("command finished with a hint of padding\n"); ++ CrazyDumpDebug(); ++ } ++ } ++ ++ /* tell libata we're done */ ++ DPRINTK(" returning err_mask=0x%x\n", qc->err_mask); ++ local_irq_save(flags); ++ ox810sata_irq_clear(ap); ++ PrivateData->int_status = 0; ++ local_irq_restore(flags); ++ ata_qc_complete(qc); ++} ++ ++/** ++ * ox810sata_irq_clear is called during probe just before the interrupt handler is ++ * registered, to be sure hardware is quiet. It clears and masks interrupt bits ++ * in the SATA core. ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox810sata_irq_clear(struct ata_port* ap) ++{ ++ u32 *ioaddr = ox810sata_get_tfio_base(ap); ++ //DPRINTK(KERN_INFO"ox810sata_irq_clear\n"); ++ ++ writel(~0, ioaddr + OX810SATA_INT_DISABLE); ++ writel(~0, ioaddr + OX810SATA_INT_CLEAR); ++} ++ ++static inline u32 __ox810sata_scr_read(u32* core_addr, unsigned int sc_reg) ++{ ++ u32 result; ++ u32 patience; ++ ++ /* we've got 8 other registers in before the start of the standard ones */ ++ writel(sc_reg, core_addr + OX810SATA_LINK_RD_ADDR ); ++ ++ for (patience = 0x100000; patience > 0; --patience) { ++ if (readl(core_addr + OX810SATA_LINK_CONTROL) & 0x00000001) { ++ break; ++ } ++ } ++ ++ result = readl(core_addr + OX810SATA_LINK_DATA); ++ ++ //DPRINTK(KERN_INFO"ox810sata_scr_read: [0x%02x]->0x%08x\n", sc_reg, result); ++ return result; ++} ++ ++/** ++ * Read standard SATA phy registers. Currently only used if ++ * ->phy_reset hook called the sata_phy_reset() helper function. ++ * ++ * These registers are in another clock domain to the processor, access is via ++ * some bridging registers ++ * ++ * @param ap hardware with the registers in ++ * @param sc_reg the SATA PHY register ++ * @return the value in the register ++ */ ++static int ox810sata_scr_read(struct ata_port *ap, unsigned int sc_reg, u32 *val) ++{ ++ u32* ioaddr = ox810sata_get_io_base(ap); ++ *val = __ox810sata_scr_read(ioaddr, 0x20 + (sc_reg*4)); ++ return 0; ++} ++ ++static void __ox810sata_scr_write(u32* core_addr, unsigned int sc_reg, u32 val) ++{ ++ u32 patience; ++ ++ //DPRINTK(KERN_INFO"ox810sata_scr_write: [0x%02x]<-0x%08x\n", sc_reg, val); ++ writel(val, core_addr + OX810SATA_LINK_DATA ); ++ wmb(); ++ writel(sc_reg , core_addr + OX810SATA_LINK_WR_ADDR ); ++ wmb(); ++ ++ for (patience = 0x100000; patience > 0;--patience) { ++ if (readl(core_addr + OX810SATA_LINK_CONTROL) & 0x00000001) { ++ break; ++ } ++ } ++} ++/** ++ * Write standard SATA phy registers. Currently only used if ++ * phy_reset hook called the sata_phy_reset() helper function. ++ * ++ * These registers are in another clock domain to the processor, access is via ++ * some bridging registers ++ * ++ * @param ap hardware with the registers in ++ * @param sc_reg the SATA PHY register ++ * @param val the value to write into the register ++ */ ++static int ox810sata_scr_write(struct ata_port *ap, unsigned int sc_reg, u32 val) ++{ ++ u32 *ioaddr = ox810sata_get_io_base(ap); ++ __ox810sata_scr_write(ioaddr, 0x20 + (sc_reg * 4), val); ++ return 0; ++} ++ ++/** ++ * port_start() is called just after the data structures for each port are ++ * initialized. Typically this is used to alloc per-port DMA buffers, tables ++ * rings, enable DMA engines and similar tasks. ++ * ++ * @return 0 = success ++ * @param ap hardware with the registers in ++ */ ++static int ox810sata_port_start(struct ata_port *ap) ++{ ++ ox810sata_private_data* pd; ++ struct device* pdev = ap->host->dev; ++ ++ ap->prd = dma_alloc_coherent(pdev, ATA_PRD_TBL_SZ, &ap->prd_dma, GFP_DMA); ++ if (!ap->prd) { ++ return -ENOMEM; ++ } ++ ++ /* allocate port private data memory and attach to port */ ++ if (!ap->private_data) { ++ ap->private_data = kmalloc(sizeof(ox810sata_private_data), GFP_KERNEL); ++ } ++ ++ if (!ap->private_data) { ++ return -ENOMEM; ++ } ++ ++ pd = (ox810sata_private_data* )ap->private_data; ++ pd->DmaChannel = 0; ++ pd->sg_entries = 0; ++ ++ DPRINTK("ap = %p, pd = %p\n",ap,ap->private_data); ++ ++ // Allocate DMA SG entries ++ if (hipox_dma_alloc_sg_entries(&pd->sg_entries, CONFIG_ARCH_HIPOX_MAX_SATA_SG_ENTRIES, 0)) { ++ printk(KERN_WARNING "ox810sata_port_start() Failed to obtain DMA SG entries\n"); ++ return -ENOMEM; ++ } ++ ++ // Hold on to a DMA channel for the life of the SATA driver ++ pd->DmaChannel = hipox_dma_request(1); ++ ++ if (!pd->DmaChannel) { ++ printk(KERN_WARNING "ox810sata_port_start() Failed to obtain DMA channel\n"); ++ return -ENOMEM; ++ } ++ ++ /* declare a work item to spot when a command finishes */ ++ INIT_WORK(&(pd->spot_the_end_work.worker), &ox810sata_spot_the_end); ++ ++ /* initialise to zero */ ++ pd->ErrorsWithNoCommamnd = 0; ++ pd->int_status = 0; ++ pd->in_cleanup = 0; ++ ++ /* store the ata_port pointer in the driver structure */ ++ if (ox810sata_get_io_base(ap) == (u32*)SATA0_REGS_BASE) { ++ ox810sata_driver.ap[0] = ap; ++ } else if (ox810sata_get_io_base(ap) == (u32*)SATA1_REGS_BASE) { ++ ox810sata_driver.ap[1] = ap; ++ } ++ ++ // turn ata core on ++ writel((1 << SYS_CTRL_CKEN_SATA_BIT), SYS_CTRL_CKEN_SET_CTRL); ++ ++ /* post reset init needs to be called for both ports as there's one reset ++ for both ports*/ ++ if (ox810sata_driver.ap[0]) { ++ ox810sata_post_reset_init(ox810sata_driver.ap[0]); ++ } ++ if (ox810sata_driver.ap[1]) { ++ ox810sata_post_reset_init(ox810sata_driver.ap[1]); ++ } ++ ++ return 0; ++} ++ ++static void ox810sata_post_reset_init(struct ata_port* ap) ++{ ++ u32 patience; ++ u32* ioaddr = ox810sata_get_io_base(ap); ++ uint dev; ++ ++ /* turn on phy error detection by removing the masks */ ++ writel(0x30003, ioaddr + OX810SATA_LINK_DATA ); ++ wmb(); ++ writel(0x0C, ioaddr + OX810SATA_LINK_WR_ADDR ); ++ wmb(); ++ for (patience = 0x100000; patience > 0;--patience) { ++ if (readl(ioaddr + OX810SATA_LINK_CONTROL) & 0x00000001) { ++ break; ++ } ++ } ++ ++ /* enable interrupts for ports */ ++ VPRINTK("Enable interrupts\n"); ++ writel(~0, OX810SATA_CORE_IEC); ++ writel(OX810SATA_NORMAL_INTS_WANTED, OX810SATA_CORE_IES); ++ ++ /* go through all the devices and configure them */ ++ for (dev = 0; dev < ATA_MAX_DEVICES; ++dev) { ++ if (ap->link.device[dev].class == ATA_DEV_ATA) { ++ ox810sata_phy_reset(ap); ++ ox810sata_dev_config(ap, &(ap->link.device[dev])); ++ } ++ } ++ ++ /* disable padding */ ++/* { ++ unsigned int reg = readl(OX810SATA_DEVICE_CONTROL); ++ reg &= ~OX810SATA_DEVICE_CONTROL_PAD ; ++ writel(reg, OX810SATA_DEVICE_CONTROL); ++ }*/ ++ { ++ unsigned int reg = readl(OX810SATA_DEVICE_CONTROL); ++ reg |= OX810SATA_DEVICE_CONTROL_PADPAT ; ++ writel(reg, OX810SATA_DEVICE_CONTROL); ++ } ++} ++ ++/** ++ * port_stop() is called after ->host_stop(). It's sole function is to ++ * release DMA/memory resources, now that they are no longer actively being ++ * used. ++ */ ++static void ox810sata_port_stop(struct ata_port *ap) ++{ ++ ox810sata_private_data* pd = (ox810sata_private_data* )ap->private_data; ++ ++ DPRINTK("\n"); ++ ++ if (pd->DmaChannel) { ++ hipox_dma_free(pd->DmaChannel); ++ pd->DmaChannel = 0; ++ } ++ ++ if (pd->sg_entries) { ++ hipox_dma_free_sg_entries(pd->sg_entries); ++ pd->sg_entries = 0; ++ } ++ ++ kfree(pd); ++} ++ ++/** ++ * host_stop() is called when the rmmod or hot unplug process begins. The ++ * hook must stop all hardware interrupts, DMA engines, etc. ++ * ++ * @param ap hardware with the registers in ++ */ ++static void ox810sata_host_stop(struct ata_host *host_set) ++{ ++ DPRINTK("\n"); ++} ++ ++/** ++ * PATA device presence detection ++ * @param ap ATA channel to examine ++ * @param device Device to examine (starting at zero) ++ * @return true if something found ++ * ++ * This technique was originally described in ++ * Hale Landis's ATADRVR (www.ata-atapi.com), and ++ * later found its way into the ATA/ATAPI spec. ++ * ++ * Write a pattern to the ATA shadow registers, ++ * and if a device is present, it will respond by ++ * correctly storing and echoing back the ++ * ATA shadow register contents. ++ * ++ * LOCKING: ++ * caller. ++ */ ++static unsigned int ox810sata_devchk(struct ata_port *ap,unsigned int device) ++{ ++ DPRINTK("\n"); ++ ++ return 0; /* nothing found */ ++} ++ ++static void ox810sata_pio_start(struct work_struct *work) ++{ ++ struct ata_port *ap = container_of(work, struct ata_port, port_task.work); ++ ox810sata_private_data* pd = (ox810sata_private_data*)ap->private_data; ++ struct ata_queued_cmd* qc = ap->port_task_data; ++ u32* ioaddr = ox810sata_get_io_base(ap); ++ unsigned long flags = 0; ++ ++ VPRINTK("\n"); ++ // We check for DMA completion from ISR which cannot wait for all DMA channel ++ // housekeeping to complete, so need to wait here is case we try to reuse ++ // channel before that housekeeping has completed ++ if (hipox_dma_is_active(pd->DmaChannel)) { ++ printk(KERN_WARNING "PIO start Channel still active\n"); ++ /* if the DMA is still busy, schedule a task to poll again in 1 ms */ ++ ata_port_queue_task(ap, ox810sata_pio_start, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ ++ if (qc->tf.protocol != ATA_PROT_NODATA) { ++ hipox_dma_direction_t direction = (qc->dma_dir == DMA_FROM_DEVICE) ? ++ HIPOX_DMA_FROM_DEVICE : ++ HIPOX_DMA_TO_DEVICE; ++ ++ /* Do not use DMA callback */ ++ hipox_dma_set_callback(pd->DmaChannel, HIPOX_DMA_CALLBACK_NUL, HIPOX_DMA_CALLBACK_ARG_NUL); ++ ++ /* map memory for dma */ ++ dma_map_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ ++ /* setup a scatter gather dma */ ++ hipox_dma_device_set_sg(pd->DmaChannel, ++ direction, ++ qc->__sg, ++ qc->n_elem, ++ &hipox_sata_dma_settings, ++ HIPOX_DMA_MODE_INC, ++ 0); ++ ++ hipox_dma_start(pd->DmaChannel); ++ ++ if (hipox_dma_is_active(pd->DmaChannel)) { ++ /* if the DMA is still busy, schedule a task to poll again in 1 ms */ ++ ata_port_queue_task(ap, ox810sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ ++ /* cleanup DMA */ ++ dma_unmap_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ } else { ++ /* if the core is still busy, reschedule */ ++ if (readl(ioaddr + OX810SATA_SATA_COMMAND) & CMD_CORE_BUSY) { ++ ata_port_queue_task(ap, ox810sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ } ++ ++ /* notify of completion */ ++ PretendDRQIsClear = 1; ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ spin_lock_irqsave(ap->lock, flags); ++ ap->ops->irq_on(ap); ++ ata_qc_complete(qc); ++ spin_unlock_irqrestore(ap->lock, flags); ++} ++ ++/** ++ * This is the top level of the PIO task. It is responsible for organising the ++ * transfer of data, collecting and reacting to status changes and notification ++ * of command completion. ++ * ++ */ ++static void ox810sata_pio_task(struct work_struct *work) ++{ ++ struct ata_port *ap = container_of(work, struct ata_port, port_task.work); ++ struct ata_queued_cmd *qc = ap->port_task_data; ++ u32* ioaddr = ox810sata_get_io_base(ap); ++ unsigned long flags = 0; ++ VPRINTK("\n"); ++ ++ if (qc->tf.protocol != ATA_PROT_NODATA) { ++ ox810sata_private_data* pd = (ox810sata_private_data* )ap->private_data; ++ ++ /* if the DMA is still busy and there is no error, re-schedule the task */ ++ /* try again in 1 ms */ ++ if ((hipox_dma_is_active(pd->DmaChannel)) && ++ !(readl(ioaddr + OX810SATA_INT_STATUS) & OX810SATA_RAW_ERROR) ) { ++ ata_port_queue_task(ap, ox810sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ ++ /* cleanup DMA */ ++ dma_unmap_sg(NULL, qc->__sg, qc->n_elem, qc->dma_dir); ++ } else { ++ /* if the core is still busy, reschedule */ ++ if ((readl(ioaddr + OX810SATA_SATA_COMMAND) & CMD_CORE_BUSY) && ++ !(readl(ioaddr + OX810SATA_INT_STATUS) & OX810SATA_RAW_ERROR) ) { ++ ata_port_queue_task(ap, ox810sata_pio_task, qc, ATA_SHORT_PAUSE); ++ return; ++ } ++ } ++ ++ /* notify of completion */ ++ PretendDRQIsClear = 1; ++ qc->err_mask = ac_err_mask(ata_chk_status(ap)); ++ spin_lock_irqsave(ap->lock, flags); ++ ap->ops->irq_on(ap); ++ ata_qc_complete(qc); ++ spin_unlock_irqrestore(ap->lock, flags); ++} ++ ++static void ox810sata_bmdma_stop(struct ata_queued_cmd *qc) ++{ ++ struct ata_port *ap = qc->ap; ++ ox810sata_private_data* private_data = (ox810sata_private_data*)ap->private_data; ++ ++ /* Check if DMA is in progress, if so abort */ ++ if (hipox_dma_is_active(private_data->DmaChannel)) { ++ /* ++ * Attempt to abort any current transfer: ++ * Abort DMA transfer at the DMA controller, ++ */ ++ printk(KERN_ERR "ox810sata_bmdma_stop - aborting DMA\n"); ++ ++ hipox_dma_abort(private_data->DmaChannel, 1); ++ } ++ ++ /* perform core cleanups and resets as required */ ++ ox810sata_timeout_cleanup(ap); ++} ++ ++/** ++ * @param ap ata port, not used ++ */ ++static void ox810sata_timeout_cleanup(struct ata_port *ap) { ++ u32 reg; ++ u32 patience; ++ ++// CrazyDumpDebug(); ++ ++ /* Clear error bits in both ports */ ++ reg = readl((u32*)SATA0_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32*)SATA0_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg = readl((u32*)SATA1_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32*)SATA1_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg = readl((u32* )SATARAID_REGS_BASE + OX810SATA_SATA_CONTROL); ++ reg |= OX810SATA_SCTL_CLR_ERR ; ++ writel(reg, (u32* )SATARAID_REGS_BASE + OX810SATA_SATA_CONTROL); ++ ++ /* Test SATA core idle state */ ++ if ( !(~readl(OX810SATA_IDLE_STATUS) & OX810SATA_IDLE_CORES) ) { ++ return; ++ } ++ ++// CrazyDumpDebug(); ++ ++ /* abort DMA */ ++ printk(KERN_INFO"ox810sata aborting DMA.\n"); ++ reg = readl(OX810SATA_DEVICE_CONTROL); ++ writel(reg | OX810SATA_DEVICE_CONTROL_ABORT, OX810SATA_DEVICE_CONTROL); ++ ++ /* wait until patience runs out for the core to go idle */ ++ patience = 50; ++ do { ++ /* if the core is idle, clear the abort bit and return */ ++ if ( !(~readl(OX810SATA_IDLE_STATUS) & OX810SATA_IDLE_CORES) ) { ++ writel(reg & ~OX810SATA_DEVICE_CONTROL_ABORT, OX810SATA_DEVICE_CONTROL); ++ return; ++ } ++ mdelay(1); ++ } while (--patience); ++ writel(reg & ~OX810SATA_DEVICE_CONTROL_ABORT, OX810SATA_DEVICE_CONTROL); ++ ++// CrazyDumpDebug(); ++ ++ /* command a sync escape on both ports */ ++ printk(KERN_INFO"ox810sata sending sync escapes\n"); ++ ++ /* port 0 */ ++ reg = readl((u32*)SATA0_REGS_BASE + OX810SATA_SATA_COMMAND); ++ reg &= ~SATA_OPCODE_MASK; ++ reg |= CMD_SYNC_ESCAPE; ++ writel(reg, (u32*)SATA0_REGS_BASE + OX810SATA_SATA_COMMAND); ++ ++ /* wait until patience runs out for the core to go idle */ ++ patience = 50; ++ do { ++ /* if the core is idle, clear the abort bit and return */ ++ if ( !(~readl(OX810SATA_IDLE_STATUS) & OX810SATA_IDLE_CORES) ) { ++ return; ++ } ++ mdelay(1); ++ } while (--patience); ++ ++ /* port 1 */ ++ reg = readl((u32*)SATA1_REGS_BASE + OX810SATA_SATA_COMMAND); ++ reg &= ~SATA_OPCODE_MASK; ++ reg |= CMD_SYNC_ESCAPE; ++ writel(reg, (u32*)SATA1_REGS_BASE + OX810SATA_SATA_COMMAND); ++ ++ /* wait until patience runs out for the core to go idle */ ++ patience = 50; ++ do { ++ /* if the core is idle, clear the abort bit and return */ ++ if ( !(~readl(OX810SATA_IDLE_STATUS) & OX810SATA_IDLE_CORES) ) { ++ return; ++ } ++ mdelay(1); ++ } while (--patience); ++ ++// CrazyDumpDebug(); ++ ++ /* SATA core did not go idle, so cause a SATA core reset from the RPS */ ++ CrazyDumpDebug(); ++ printk(KERN_INFO "ox810sata core reset\n"); ++ ox810sata_reset_core(); ++ ++ /* Read SATA core idle state */ ++ if (~readl(OX810SATA_IDLE_STATUS) & OX810SATA_IDLE_CORES) { ++ printk(KERN_INFO"ox810sata core still busy\n"); ++ CrazyDumpDebug(); ++ } ++ ++ /* Perform any SATA core re-initialisation after reset */ ++ /* post reset init needs to be called for both ports as there's one reset ++ for both ports*/ ++ if (ox810sata_driver.ap[0]) { ++ ox810sata_post_reset_init(ox810sata_driver.ap[0]); ++ } ++ if (ox810sata_driver.ap[1]) { ++ ox810sata_post_reset_init(ox810sata_driver.ap[1]); ++ } ++} ++ ++ ++static void ox810sata_error_handler(struct ata_port *ap) ++{ ++ return ata_bmdma_drive_eh(ap, ox810sata_prereset, ata_std_softreset, ++ ox810sata_hardreset, ox810sata_postreset); ++} ++ ++ ++ ++/** ++ * bmdma_status return a made up version of a BMDMA status register ++ * ++ * @param ap Hardware with the registers in ++ * @return the value ATA_DMA_INTR if the interrupt came from the DMA finishing ++ */ ++static u8 ox810sata_bmdma_status(struct ata_port *ap) ++{ ++ return ATA_DMA_INTR; ++} ++ ++/** ++ * turn on the interrupts from the ata drive ++ * wait for idle, clear any pending interrupts. ++ * ++ * @param ap Hardware with the registers in ++ */ ++static u8 ox810sata_irq_on(struct ata_port *ap) ++{ ++ u32* ioaddr = ox810sata_get_tfio_base(ap); ++ u8 tmp; ++ ++ //DPRINTK(KERN_INFO"ox810sata_irq_on\n"); ++ ++ /* enable End of command interrupt */ ++ writel(~0, ioaddr + OX810SATA_INT_CLEAR); ++ writel(OX810SATA_INT_WANT, ioaddr + OX810SATA_INT_ENABLE); ++ tmp = ata_wait_idle(ap); ++ ++ return tmp; ++} ++ ++/** ++ * ox810_prereset - prepare for reset ++ * @param link ATA link to be reset ++ * @param deadline deadline jiffies for the operation ++ * ++ * link is about to be reset. Initialize it. Failure from ++ * prereset makes libata abort whole reset sequence and give up ++ * that port, so prereset should be best-effort. It does its ++ * best to prepare for reset sequence but if things go wrong, it ++ * should just whine, not fail. ++ * ++ * LOCKING: ++ * Kernel thread context (may sleep) ++ * ++ * RETURNS: ++ * 0 on success, -errno otherwise. ++ */ ++static int ox810sata_prereset(struct ata_link *link, unsigned long deadline) { ++ struct ata_port *ap = link->ap; ++ struct ata_eh_context *ehc = &link->eh_context; ++ const unsigned long *timing = sata_ehc_deb_timing(ehc); ++ ox810sata_private_data* private_data; ++ int rc; ++ ++ VPRINTK("\n"); ++ /* handle link resume */ ++ if ((ehc->i.flags & ATA_EHI_RESUME_LINK) && (link->flags & ATA_LFLAG_HRST_TO_RESUME)) ++ ehc->i.action |= ATA_EH_HARDRESET; ++ ++ /* Some PMPs don't work with only SRST, force hardreset if PMP ++ * is supported. ++ */ ++ if (ap->flags & ATA_FLAG_PMP) ++ ehc->i.action |= ATA_EH_HARDRESET; ++ ++ /* if we're about to do hardreset, nothing more to do */ ++ if (ehc->i.action & ATA_EH_HARDRESET) ++ return 0; ++ ++ /* we want both ports to be idle as soft-reset requires being able to send ++ commands. If a command is running, abort it. */ ++ private_data = (ox810sata_private_data*)ap->private_data; ++ ++ /* Check if DMA is in progress, if so abort */ ++ if (hipox_dma_is_active(private_data->DmaChannel)) { ++ /* ++ * Attempt to abort any current transfer: ++ * Abort DMA transfer at the DMA controller, ++ */ ++ printk(KERN_ERR "aborting DMA\n"); ++ hipox_dma_abort(private_data->DmaChannel, 1); ++ } ++ ++ /* perform core cleanups and resets */ ++ ox810sata_timeout_cleanup(NULL); ++ ++ /* if SATA, resume link */ ++ if (ap->flags & ATA_FLAG_SATA) { ++ rc = sata_link_resume(link, timing, deadline); ++ /* whine about phy resume failure but proceed */ ++ if (rc && rc != -EOPNOTSUPP) ++ ata_link_printk(link, KERN_WARNING, "failed to resume " ++ "link for reset (errno=%d)\n", rc); ++ } ++ ++ /* Wait for !BSY if the controller can wait for the first D2H ++ * Reg FIS and we don't know that no device is attached. ++ */ ++ if (!(link->flags & ATA_LFLAG_SKIP_D2H_BSY) && !ata_link_offline(link)) { ++ rc = ata_wait_ready(ap, deadline); ++ if (rc && rc != -ENODEV) { ++ ata_link_printk(link, KERN_WARNING, "device not ready " ++ "(errno=%d), forcing hardreset\n", rc); ++ ehc->i.action |= ATA_EH_HARDRESET; ++ } ++ } ++ ++ return 0; ++} ++/** ++ * sata_std_hardreset - reset host port via SATA phy reset ++ * @link: link to reset ++ * @class: resulting class of attached device ++ * @deadline: deadline jiffies for the operation ++ * ++ * SATA phy-reset host port using DET bits of SControl register, ++ * wait for !BSY and classify the attached device. ++ * ++ * LOCKING: ++ * Kernel thread context (may sleep) ++ * ++ * RETURNS: ++ * 0 on success, -errno otherwise. ++ */ ++static int ox810sata_hardreset(struct ata_link *link, unsigned int *class, ++ unsigned long deadline) ++{ ++ struct ata_port *ap = link->ap; ++ const unsigned long *timing = sata_ehc_deb_timing(&link->eh_context); ++ int rc; ++ ++ DPRINTK("ENTER\n"); ++ ++ /* do hardreset */ ++ rc = sata_link_hardreset(link, timing, deadline); ++ if (rc) { ++ ata_link_printk(link, KERN_ERR, ++ "COMRESET failed (errno=%d)\n", rc); ++ return rc; ++ } ++ ++ /* TODO: phy layer with polling, timeouts, etc. */ ++ if (ata_link_offline(link)) { ++ *class = ATA_DEV_NONE; ++ DPRINTK("EXIT, link offline\n"); ++ return 0; ++ } ++ ++ /* wait a while before checking status */ ++ ata_wait_after_reset(ap, deadline); ++ ++ /* If PMP is supported, we have to do follow-up SRST. Note ++ * that some PMPs don't send D2H Reg FIS after hardreset at ++ * all if the first port is empty. Wait for it just for a ++ * second and request follow-up SRST. ++ */ ++ if (ap->flags & ATA_FLAG_PMP) { ++ ata_wait_ready(ap, jiffies + HZ); ++ return -EAGAIN; ++ } ++ ++ rc = ata_wait_ready(ap, deadline); ++ /* link occupied, -ENODEV too is an error */ ++ if (rc) { ++ ata_link_printk(link, KERN_ERR, ++ "COMRESET failed (errno=%d)\n", rc); ++ return rc; ++ } ++ ++ *class = ata_dev_try_classify(link->device, 1, NULL); ++ ++ DPRINTK("EXIT, class=%u\n", *class); ++ return 0; ++} ++ ++/** ++ * ata_std_postreset - standard postreset callback ++ * @link: the target ata_link ++ * @classes: classes of attached devices ++ * ++ * This function is invoked after a successful reset. Note that ++ * the device might have been reset more than once using ++ * different reset methods before postreset is invoked. ++ * ++ * LOCKING: ++ * Kernel thread context (may sleep) ++ */ ++static void ox810sata_postreset(struct ata_link *link, unsigned int *classes) ++{ ++ struct ata_port *ap = link->ap; ++ u32 serror; ++ unsigned int dev; ++ ++ DPRINTK("ENTER\n"); ++ ++ /* print link status */ ++ sata_print_link_status(link); ++ ++ /* clear SError */ ++ if (sata_scr_read(link, SCR_ERROR, &serror) == 0) ++ sata_scr_write(link, SCR_ERROR, serror); ++ link->eh_info.serror = 0; ++ ++ /* turn on phy error detection by removing the masks */ ++ __ox810sata_scr_write((u32* )SATA0_REGS_BASE , 0x0c, 0x30003 ); ++ __ox810sata_scr_write((u32* )SATA1_REGS_BASE , 0x0c, 0x30003 ); ++ ++ /* bail out if no device is present */ ++ if (classes[0] == ATA_DEV_NONE && classes[1] == ATA_DEV_NONE) { ++ DPRINTK("EXIT, no device\n"); ++ return; ++ } ++ ++ /* go through all the devices and configure them */ ++ for (dev = 0; dev < ATA_MAX_DEVICES; ++dev) { ++ if (ap->link.device[dev].class == ATA_DEV_ATA) { ++ ox810sata_dev_config(ap, &(ap->link.device[dev])); ++ } ++ } ++ ++ /* disable padding */ ++ { ++ unsigned int reg = readl(OX810SATA_DEVICE_CONTROL); ++ reg &= ~OX810SATA_DEVICE_CONTROL_PAD ; ++ writel(reg, OX810SATA_DEVICE_CONTROL); ++ } ++ ++ /** @todo fix by using tf/tf_load as in ata_bus_softreset */ ++ #if 0 ++ /* set up device control */ ++ if (ap->ioaddr.ctl_addr) ++ iowrite8(ap->ctl, ap->ioaddr.ctl_addr); ++ #endif ++ ++ DPRINTK("EXIT\n"); ++} ++ ++/** ++ * Outputs all the registers in the SATA core for diagnosis of faults. ++ * ++ * @param ap Hardware with the registers in ++ */ ++static void CrazyDumpDebug() ++{ ++#ifdef CRAZY_DUMP_DEBUG ++ u32 offset; ++ u32 result; ++ u32 patience; ++ volatile u32* ioaddr; ++ ++#if 0 ++ { ++ u32 i ; ++ for(i = 0;i < 1024;++i) { ++ printk("[%08x]%s%08x\n", ++ regarray[regindex].a, ++ regarray[regindex].w ? "<=" : "=>", ++ regarray[regindex].d ++ ); ++ ++regindex; ++ regindex &= 1023; ++ } ++ } ++#endif ++ ++ /* port 0 */ ++ ioaddr = (u32* )SATA0_REGS_BASE; ++ printk("Port 0 High level registers\n"); ++ for(offset = 0; offset < 48;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, *(ioaddr + offset)); ++ } ++ ++ printk("Port 0 link layer registers\n"); ++ for(offset = 0; offset < 16;++offset) ++ { ++ *(ioaddr + OX810SATA_LINK_RD_ADDR ) = (offset*4); ++ wmb(); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (*(ioaddr + OX810SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ result = *(ioaddr + OX810SATA_LINK_DATA); ++ printk("[%02x] %08x\n", offset*4, result); ++ } ++ ++ /* port 1 */ ++ ioaddr = (u32* )SATA1_REGS_BASE; ++ printk("Port 1 High level registers\n"); ++ for(offset = 0; offset < 48;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, *(ioaddr + offset)); ++ } ++ ++ printk("Port 1 link layer registers\n"); ++ for(offset = 0; offset < 16;++offset) ++ { ++ *(ioaddr + OX810SATA_LINK_RD_ADDR ) = (offset*4); ++ wmb(); ++ ++ for (patience = 0x100000;patience > 0;--patience) ++ { ++ if (*(ioaddr + OX810SATA_LINK_CONTROL) & 0x00000001) ++ break; ++ } ++ ++ result = *(ioaddr + OX810SATA_LINK_DATA); ++ printk("[%02x] %08x\n", offset*4, result); ++ } ++ ++ /* port 14 */ ++ ioaddr = (u32* )SATARAID_REGS_BASE; ++ printk("RAID registers\n"); ++ for(offset = 0; offset < 48;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, *(ioaddr + offset)); ++ } ++ ++ /* port 15 */ ++ ioaddr = (u32* )SATACORE_REGS_BASE; ++ printk("CORE registers\n"); ++ for(offset = 0; offset < 48;offset++) ++ { ++ printk("[%02x] %08x\n", offset * 4, *(ioaddr + offset)); ++ } ++ ++ hipox_dma_dump_registers(); ++ ++#endif ++} ++ ++/************************************************************************** ++* DEVICE CODE ++**************************************************************************/ ++ ++/** ++ * Describes the identity of the SATA core and the resources it requires ++ */ ++static struct resource ox810sata_port0_resources[] = { ++ { ++ .name = "sata_port_0_registers", ++ .start = SATA0_REGS_BASE, ++ .end = SATA0_REGS_BASE + 0xff, ++ .flags = IORESOURCE_MEM, ++ }, ++ { ++ .name = "sata_irq", ++ .start = SATA_1_INTERRUPT, ++ .flags = IORESOURCE_IRQ, ++ } ++}; ++ ++static struct resource ox810sata_port1_resources[] = { ++ { ++ .name = "sata_port_1_registers", ++ .start = SATA1_REGS_BASE, ++ .end = SATA1_REGS_BASE + 0xff, ++ .flags = IORESOURCE_MEM, ++ }, ++ { ++ .name = "sata_irq", ++ .start = SATA_1_INTERRUPT, ++ .flags = IORESOURCE_IRQ, ++ }, ++}; ++ ++static struct platform_device ox810sata_dev0 = ++{ ++ .name = DRIVER_NAME, ++ .id = 0, ++ .num_resources = 2, ++ .resource = ox810sata_port0_resources, ++ .dev.coherent_dma_mask = 0xffffffff, ++}; ++ ++static struct platform_device ox810sata_dev1 = ++{ ++ .name = DRIVER_NAME, ++ .id = 1, ++ .num_resources = 2, ++ .resource = ox810sata_port1_resources, ++ .dev.coherent_dma_mask = 0xffffffff, ++}; ++ ++/** ++ * module initialisation ++ * @return success is 0 ++ */ ++static int __init ox810sata_device_init( void ) ++{ ++ int ret; ++ ++ /* reset the core */ ++ ox810sata_reset_core(); ++ ++ { ++ // register the ata device for the driver to find ++ ret = platform_device_register( &ox810sata_dev0 ); ++ DPRINTK(" %i\n", ret); ++ } ++ ++#ifndef CONFIG_OX810SATA_SINGLE_SATA ++ { ++ // register the ata device for the driver to find ++ ret = platform_device_register( &ox810sata_dev1 ); ++ DPRINTK(" %i\n", ret); ++ } ++#endif /* CONFIG_OX810_SINGLE_SATA */ ++ ++ return ret; ++} ++ ++/** ++ * module cleanup ++ */ ++static void __exit ox810sata_device_exit(void) ++{ ++ platform_device_unregister( &ox810sata_dev0 ); ++ platform_device_unregister( &ox810sata_dev1 ); ++} ++ ++/** ++ * Returns accumulated RAID faults and then clears the accumulation ++ * @return accumulated RAID faults indicated by set bits ++ */ ++int hipoxsata_RAID_faults( void ) { ++ int temp = ox810sata_accumulated_RAID_faults; ++ ox810sata_accumulated_RAID_faults = 0; ++ return temp; ++} ++ ++/** ++ * Returns ox810 port number the request queue is serviced by. ++ * ++ * @param queue The queue under investigation. ++ * @return The ox810 sata port number servicing the queue or -1 if not found. ++ */ ++int hipoxsata_get_port_no(struct request_queue* q) ++{ ++ struct ata_port* ap = 0; ++ struct scsi_device* sdev = 0; ++ ++ /* check port 0 */ ++ ap = ox810sata_driver.ap[0]; ++ if (ap) ++ shost_for_each_device(sdev, ap->scsi_host) { ++ if (sdev->request_queue == q) { ++ DPRINTK("Queue %p on port 0\n", q); ++ return 0; ++ } ++ } ++ ++ /* check port 1 */ ++ ap = ox810sata_driver.ap[1]; ++ if (ap) ++ shost_for_each_device(sdev, ap->scsi_host) { ++ if (sdev->request_queue == q) { ++ DPRINTK("Queue %p on port 1\n", q); ++ return 1; ++ } ++ } ++ ++ /* not found */ ++ return -1; ++} ++ ++/** ++ * @return true if all the drives attached to the internal SATA ports use the ++ * same LBA size. ++ */ ++int hipoxsata_LBA_schemes_compatible( void ) ++{ ++ unsigned long flags0 ; ++ unsigned long flags1 ; ++ struct ata_port* ap ; ++ ++ /* check port 0 */ ++ ap = ox810sata_driver.ap[0]; ++ if (ap) ++ flags0 = ap->link.device[0].flags & ATA_DFLAG_LBA48 ; ++ else ++ return 0; ++ ++ /* check port 1 */ ++ ap = ox810sata_driver.ap[1]; ++ if (ap) ++ flags1 = ap->link.device[0].flags & ATA_DFLAG_LBA48 ; ++ else ++ return 0; ++ ++ /* compare */ ++ return (flags0 == flags1); ++} ++ ++EXPORT_SYMBOL( hipoxsata_RAID_faults ); ++EXPORT_SYMBOL( hipoxsata_get_port_no ); ++EXPORT_SYMBOL( hipoxsata_LBA_schemes_compatible ); ++ ++ ++#ifdef ERROR_INJECTION ++ ++/** ++ * @param kobj Not Used ++ * @param attr Used to determine which file is being accessed ++ * @param buffer Space to put the file contents ++ * @return The number of bytes transferred or an error ++ */ ++static int ox810sata_error_inject_show( ++ char *page, char **start, off_t off, int count, int *eof, void *data) ++{ ++ if (page) ++ { ++ if ( ox810sata_driver.error_inject ) { ++ page[0] = ox810sata_driver.error_inject + '0'; ++ page[1] = '\n'; ++ page[2] = 0; ++ return 3; ++ } else { ++ strcpy(page, "off\n" ); ++ return 5; ++ } ++ } ++ ++ /* if we get here, there's been an error */ ++ return -EIO; ++} ++ ++ ++static int ox810sata_error_inject_store(struct file *file, ++ const char __user *buffer, ++ unsigned long count, ++ void *data) { ++ if (count) ++ { ++ if ((buffer[0] >= '0') && ++ (buffer[0] <= '9')) { ++ ox810sata_driver.error_inject = buffer[0] - '0'; ++ } ++ return count; ++ } ++ ++ /* if we get here, there's been an error */ ++ return -EIO; ++} ++ ++#endif /* ERROR_INJECTION */ ++ ++ ++ ++/** ++ * macros to register intiialisation and exit functions with kernal ++ */ ++module_init(ox810sata_device_init); ++module_exit(ox810sata_device_exit); +diff -Nurd linux-2.6.24/drivers/ata/pata_hpt366.c linux-2.6.24-oxe810/drivers/ata/pata_hpt366.c +--- linux-2.6.24/drivers/ata/pata_hpt366.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/pata_hpt366.c 2008-06-11 17:50:32.000000000 +0200 +@@ -27,7 +27,7 @@ + #include <linux/libata.h> + + #define DRV_NAME "pata_hpt366" +-#define DRV_VERSION "0.6.1" ++#define DRV_VERSION "0.6.2" + + struct hpt_clock { + u8 xfer_speed; +@@ -180,9 +180,9 @@ + if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33)) + mask &= ~ATA_MASK_UDMA; + if (hpt_dma_blacklisted(adev, "UDMA3", bad_ata66_3)) +- mask &= ~(0x07 << ATA_SHIFT_UDMA); ++ mask &= ~(0xF8 << ATA_SHIFT_UDMA); + if (hpt_dma_blacklisted(adev, "UDMA4", bad_ata66_4)) +- mask &= ~(0x0F << ATA_SHIFT_UDMA); ++ mask &= ~(0xF0 << ATA_SHIFT_UDMA); + } + return ata_pci_default_filter(adev, mask); + } +diff -Nurd linux-2.6.24/drivers/ata/pata_hpt37x.c linux-2.6.24-oxe810/drivers/ata/pata_hpt37x.c +--- linux-2.6.24/drivers/ata/pata_hpt37x.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/pata_hpt37x.c 2008-06-11 17:50:32.000000000 +0200 +@@ -24,7 +24,7 @@ + #include <linux/libata.h> + + #define DRV_NAME "pata_hpt37x" +-#define DRV_VERSION "0.6.9" ++#define DRV_VERSION "0.6.11" + + struct hpt_clock { + u8 xfer_speed; +@@ -281,7 +281,7 @@ + if (hpt_dma_blacklisted(adev, "UDMA", bad_ata33)) + mask &= ~ATA_MASK_UDMA; + if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5)) +- mask &= ~(0x1F << ATA_SHIFT_UDMA); ++ mask &= ~(0xE0 << ATA_SHIFT_UDMA); + } + return ata_pci_default_filter(adev, mask); + } +@@ -297,7 +297,7 @@ + { + if (adev->class == ATA_DEV_ATA) { + if (hpt_dma_blacklisted(adev, "UDMA100", bad_ata100_5)) +- mask &= ~ (0x1F << ATA_SHIFT_UDMA); ++ mask &= ~(0xE0 << ATA_SHIFT_UDMA); + } + return ata_pci_default_filter(adev, mask); + } +diff -Nurd linux-2.6.24/drivers/ata/pata_serverworks.c linux-2.6.24-oxe810/drivers/ata/pata_serverworks.c +--- linux-2.6.24/drivers/ata/pata_serverworks.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/ata/pata_serverworks.c 2008-06-11 17:50:32.000000000 +0200 +@@ -226,7 +226,7 @@ + + for (i = 0; (p = csb_bad_ata100[i]) != NULL; i++) { + if (!strcmp(p, model_num)) +- mask &= ~(0x1F << ATA_SHIFT_UDMA); ++ mask &= ~(0xE0 << ATA_SHIFT_UDMA); + } + return ata_pci_default_filter(adev, mask); + } +diff -Nurd linux-2.6.24/drivers/base/firmware_class.c linux-2.6.24-oxe810/drivers/base/firmware_class.c +--- linux-2.6.24/drivers/base/firmware_class.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/base/firmware_class.c 2008-06-11 17:50:32.000000000 +0200 +@@ -292,7 +292,8 @@ + + static inline void fw_setup_device_id(struct device *f_dev, struct device *dev) + { +- snprintf(f_dev->bus_id, BUS_ID_SIZE, "firmware-%s", dev->bus_id); ++ /* XXX warning we should watch out for name collisions */ ++ strlcpy(f_dev->bus_id, dev->bus_id, BUS_ID_SIZE); + } + + static int fw_register_device(struct device **dev_p, const char *fw_name, +diff -Nurd linux-2.6.24/drivers/base/platform.c linux-2.6.24-oxe810/drivers/base/platform.c +--- linux-2.6.24/drivers/base/platform.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/base/platform.c 2008-06-11 17:50:32.000000000 +0200 +@@ -647,7 +647,7 @@ + high_totalram += high_totalram - 1; + mask = (((u64)high_totalram) << 32) + 0xffffffff; + } +- return mask & *dev->dma_mask; ++ return mask; + } + EXPORT_SYMBOL_GPL(dma_get_required_mask); + #endif +diff -Nurd linux-2.6.24/drivers/block/ub.c linux-2.6.24-oxe810/drivers/block/ub.c +--- linux-2.6.24/drivers/block/ub.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/block/ub.c 2008-06-11 17:49:32.000000000 +0200 +@@ -657,7 +657,6 @@ + if ((cmd = ub_get_cmd(lun)) == NULL) + return -1; + memset(cmd, 0, sizeof(struct ub_scsi_cmd)); +- sg_init_table(cmd->sgv, UB_MAX_REQ_SG); + + blkdev_dequeue_request(rq); + +@@ -668,6 +667,7 @@ + /* + * get scatterlist from block layer + */ ++ sg_init_table(&urq->sgv[0], UB_MAX_REQ_SG); + n_elem = blk_rq_map_sg(lun->disk->queue, rq, &urq->sgv[0]); + if (n_elem < 0) { + /* Impossible, because blk_rq_map_sg should not hit ENOMEM. */ +diff -Nurd linux-2.6.24/drivers/char/defkeymap.c_shipped linux-2.6.24-oxe810/drivers/char/defkeymap.c_shipped +--- linux-2.6.24/drivers/char/defkeymap.c_shipped 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/char/defkeymap.c_shipped 2008-06-11 17:49:52.000000000 +0200 +@@ -223,40 +223,40 @@ + }; + + struct kbdiacruc accent_table[MAX_DIACR] = { +- {'`', 'A', '\300'}, {'`', 'a', '\340'}, +- {'\'', 'A', '\301'}, {'\'', 'a', '\341'}, +- {'^', 'A', '\302'}, {'^', 'a', '\342'}, +- {'~', 'A', '\303'}, {'~', 'a', '\343'}, +- {'"', 'A', '\304'}, {'"', 'a', '\344'}, +- {'O', 'A', '\305'}, {'o', 'a', '\345'}, +- {'0', 'A', '\305'}, {'0', 'a', '\345'}, +- {'A', 'A', '\305'}, {'a', 'a', '\345'}, +- {'A', 'E', '\306'}, {'a', 'e', '\346'}, +- {',', 'C', '\307'}, {',', 'c', '\347'}, +- {'`', 'E', '\310'}, {'`', 'e', '\350'}, +- {'\'', 'E', '\311'}, {'\'', 'e', '\351'}, +- {'^', 'E', '\312'}, {'^', 'e', '\352'}, +- {'"', 'E', '\313'}, {'"', 'e', '\353'}, +- {'`', 'I', '\314'}, {'`', 'i', '\354'}, +- {'\'', 'I', '\315'}, {'\'', 'i', '\355'}, +- {'^', 'I', '\316'}, {'^', 'i', '\356'}, +- {'"', 'I', '\317'}, {'"', 'i', '\357'}, +- {'-', 'D', '\320'}, {'-', 'd', '\360'}, +- {'~', 'N', '\321'}, {'~', 'n', '\361'}, +- {'`', 'O', '\322'}, {'`', 'o', '\362'}, +- {'\'', 'O', '\323'}, {'\'', 'o', '\363'}, +- {'^', 'O', '\324'}, {'^', 'o', '\364'}, +- {'~', 'O', '\325'}, {'~', 'o', '\365'}, +- {'"', 'O', '\326'}, {'"', 'o', '\366'}, +- {'/', 'O', '\330'}, {'/', 'o', '\370'}, +- {'`', 'U', '\331'}, {'`', 'u', '\371'}, +- {'\'', 'U', '\332'}, {'\'', 'u', '\372'}, +- {'^', 'U', '\333'}, {'^', 'u', '\373'}, +- {'"', 'U', '\334'}, {'"', 'u', '\374'}, +- {'\'', 'Y', '\335'}, {'\'', 'y', '\375'}, +- {'T', 'H', '\336'}, {'t', 'h', '\376'}, +- {'s', 's', '\337'}, {'"', 'y', '\377'}, +- {'s', 'z', '\337'}, {'i', 'j', '\377'}, ++ {'`', 'A', 0300}, {'`', 'a', 0340}, ++ {'\'', 'A', 0301}, {'\'', 'a', 0341}, ++ {'^', 'A', 0302}, {'^', 'a', 0342}, ++ {'~', 'A', 0303}, {'~', 'a', 0343}, ++ {'"', 'A', 0304}, {'"', 'a', 0344}, ++ {'O', 'A', 0305}, {'o', 'a', 0345}, ++ {'0', 'A', 0305}, {'0', 'a', 0345}, ++ {'A', 'A', 0305}, {'a', 'a', 0345}, ++ {'A', 'E', 0306}, {'a', 'e', 0346}, ++ {',', 'C', 0307}, {',', 'c', 0347}, ++ {'`', 'E', 0310}, {'`', 'e', 0350}, ++ {'\'', 'E', 0311}, {'\'', 'e', 0351}, ++ {'^', 'E', 0312}, {'^', 'e', 0352}, ++ {'"', 'E', 0313}, {'"', 'e', 0353}, ++ {'`', 'I', 0314}, {'`', 'i', 0354}, ++ {'\'', 'I', 0315}, {'\'', 'i', 0355}, ++ {'^', 'I', 0316}, {'^', 'i', 0356}, ++ {'"', 'I', 0317}, {'"', 'i', 0357}, ++ {'-', 'D', 0320}, {'-', 'd', 0360}, ++ {'~', 'N', 0321}, {'~', 'n', 0361}, ++ {'`', 'O', 0322}, {'`', 'o', 0362}, ++ {'\'', 'O', 0323}, {'\'', 'o', 0363}, ++ {'^', 'O', 0324}, {'^', 'o', 0364}, ++ {'~', 'O', 0325}, {'~', 'o', 0365}, ++ {'"', 'O', 0326}, {'"', 'o', 0366}, ++ {'/', 'O', 0330}, {'/', 'o', 0370}, ++ {'`', 'U', 0331}, {'`', 'u', 0371}, ++ {'\'', 'U', 0332}, {'\'', 'u', 0372}, ++ {'^', 'U', 0333}, {'^', 'u', 0373}, ++ {'"', 'U', 0334}, {'"', 'u', 0374}, ++ {'\'', 'Y', 0335}, {'\'', 'y', 0375}, ++ {'T', 'H', 0336}, {'t', 'h', 0376}, ++ {'s', 's', 0337}, {'"', 'y', 0377}, ++ {'s', 'z', 0337}, {'i', 'j', 0377}, + }; + + unsigned int accent_table_size = 68; +diff -Nurd linux-2.6.24/drivers/char/drm/drm_stub.c linux-2.6.24-oxe810/drivers/char/drm/drm_stub.c +--- linux-2.6.24/drivers/char/drm/drm_stub.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/char/drm/drm_stub.c 2008-06-11 17:49:50.000000000 +0200 +@@ -218,6 +218,7 @@ + if (ret) + goto err_g1; + ++ pci_set_master(pdev); + if ((ret = drm_fill_in_dev(dev, pdev, ent, driver))) { + printk(KERN_ERR "DRM: Fill_in_dev failed.\n"); + goto err_g2; +diff -Nurd linux-2.6.24/drivers/char/drm/drm_vm.c linux-2.6.24-oxe810/drivers/char/drm/drm_vm.c +--- linux-2.6.24/drivers/char/drm/drm_vm.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/char/drm/drm_vm.c 2008-06-11 17:49:50.000000000 +0200 +@@ -506,6 +506,7 @@ + vma->vm_ops = &drm_vm_dma_ops; + + vma->vm_flags |= VM_RESERVED; /* Don't swap */ ++ vma->vm_flags |= VM_DONTEXPAND; + + vma->vm_file = filp; /* Needed for drm_vm_open() */ + drm_vm_open_locked(vma); +@@ -655,6 +656,7 @@ + return -EINVAL; /* This should never happen. */ + } + vma->vm_flags |= VM_RESERVED; /* Don't swap */ ++ vma->vm_flags |= VM_DONTEXPAND; + + vma->vm_file = filp; /* Needed for drm_vm_open() */ + drm_vm_open_locked(vma); +diff -Nurd linux-2.6.24/drivers/char/mspec.c linux-2.6.24-oxe810/drivers/char/mspec.c +--- linux-2.6.24/drivers/char/mspec.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/char/mspec.c 2008-06-11 17:49:52.000000000 +0200 +@@ -283,7 +283,7 @@ + vdata->refcnt = ATOMIC_INIT(1); + vma->vm_private_data = vdata; + +- vma->vm_flags |= (VM_IO | VM_RESERVED | VM_PFNMAP); ++ vma->vm_flags |= (VM_IO | VM_RESERVED | VM_PFNMAP | VM_DONTEXPAND); + if (vdata->type == MSPEC_FETCHOP || vdata->type == MSPEC_UNCACHED) + vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot); + vma->vm_ops = &mspec_vm_ops; +diff -Nurd linux-2.6.24/drivers/char/vt.c linux-2.6.24-oxe810/drivers/char/vt.c +--- linux-2.6.24/drivers/char/vt.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/char/vt.c 2008-06-11 17:49:52.000000000 +0200 +@@ -702,6 +702,7 @@ + if (is_switch) { + set_leds(); + compute_shiftstate(); ++ notify_update(vc); + } + } + +diff -Nurd linux-2.6.24/drivers/dma/Kconfig linux-2.6.24-oxe810/drivers/dma/Kconfig +--- linux-2.6.24/drivers/dma/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/dma/Kconfig 2008-06-11 17:49:45.000000000 +0200 +@@ -4,7 +4,7 @@ + + menuconfig DMADEVICES + bool "DMA Engine support" +- depends on (PCI && X86) || ARCH_IOP32X || ARCH_IOP33X || ARCH_IOP13XX ++ depends on (PCI && X86) || ARCH_IOP32X || ARCH_IOP33X || ARCH_IOP13XX || ARCH_HIPOX + help + DMA engines can do asynchronous data transfers without + involving the host CPU. Currently, this framework can be +@@ -36,6 +36,14 @@ + help + Enable support for the Intel(R) IOP Series RAID engines. + ++config HIPOX_ADMA ++ tristate "Oxford Semiconductor ADAM support" ++ depends on ARCH_HIPOX ++ select ASYNC_CORE ++ select DMA_ENGINE ++ help ++ Enable support for the Oxford Semiconductor async. DMA engine ++ + config DMA_ENGINE + bool + +diff -Nurd linux-2.6.24/drivers/dma/Makefile linux-2.6.24-oxe810/drivers/dma/Makefile +--- linux-2.6.24/drivers/dma/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/dma/Makefile 2008-06-11 17:49:45.000000000 +0200 +@@ -3,3 +3,4 @@ + obj-$(CONFIG_INTEL_IOATDMA) += ioatdma.o + ioatdma-objs := ioat.o ioat_dma.o ioat_dca.o + obj-$(CONFIG_INTEL_IOP_ADMA) += iop-adma.o ++obj-$(CONFIG_HIPOX_ADMA) += hipox_adma.o +diff -Nurd linux-2.6.24/drivers/dma/ioat_dma.c linux-2.6.24-oxe810/drivers/dma/ioat_dma.c +--- linux-2.6.24/drivers/dma/ioat_dma.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/dma/ioat_dma.c 2008-06-11 17:49:45.000000000 +0200 +@@ -726,6 +726,7 @@ + + if (new) { + new->len = len; ++ new->async_tx.ack = 0; + return &new->async_tx; + } else + return NULL; +@@ -749,6 +750,7 @@ + + if (new) { + new->len = len; ++ new->async_tx.ack = 0; + return &new->async_tx; + } else + return NULL; +diff -Nurd linux-2.6.24/drivers/dma/hipox_adma.c linux-2.6.24-oxe810/drivers/dma/hipox_adma.c +--- linux-2.6.24/drivers/dma/hipox_adma.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/dma/hipox_adma.c 2008-06-11 17:49:45.000000000 +0200 +@@ -0,0 +1,272 @@ ++/* ++ * drivers/dma/hipox_adma.c ++ * ++ * Copyright (C) 2008 Oxford Semiconductor Ltd ++ * ++ * 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/dmaengine.h> ++#include <linux/platform_device.h> ++#include <asm/dma.h> ++ ++/* MODULE API */ ++MODULE_VERSION("1.0"); ++MODULE_LICENSE("GPL"); ++MODULE_AUTHOR("Oxford Semiconductor Ltd."); ++ ++typedef struct hipox_adma_device { ++ struct dma_device common; ++ struct platform_device *platform_device; ++} hipox_adma_device_t; ++ ++typedef struct hipox_adma_channel { ++ struct dma_chan common; ++ hipox_dma_channel_t *hipox_channel; ++ /* Need a queue for pending descriptors */ ++ /* May need a queue for completed descriptors that haven't been acked yet */ ++} hipox_adma_channel_t; ++ ++typedef struct hipox_adma_desc { ++ struct dma_async_tx_descriptor async_desc; ++ size_t len; ++ dma_addr_t src_adr; ++ dma_addr_t dst_adr; ++} hipox_adma_desc_t; ++ ++static int __devexit hipox_adma_remove(struct platform_device *dev) ++{ ++ hipox_adma_device_t *hipox_adma_device = platform_get_drvdata(dev); ++ struct dma_device *dma_device = &hipox_adma_device->common; ++ struct dma_chan *channel, *_channel; ++ ++ dma_async_device_unregister(dma_device); ++ ++ list_for_each_entry_safe(channel, _channel, &dma_device->channels, device_node) { ++ list_del(&channel->device_node); ++ kfree(channel); ++ } ++ kfree(hipox_adma_device); ++ ++ return 0; ++} ++ ++static void hipox_adma_set_src(dma_addr_t addr, struct dma_async_tx_descriptor *tx, int index) ++{ ++ hipox_adma_desc_t *desc = container_of(tx, hipox_adma_desc_t, async_desc); ++ desc->src_adr = addr; ++} ++ ++static void hipox_adm_set_dest(dma_addr_t addr, struct dma_async_tx_descriptor *tx, int index) ++{ ++ hipox_adma_desc_t *desc = container_of(tx, hipox_adma_desc_t, async_desc); ++ desc->dst_adr = addr; ++} ++ ++static void hipox_dma_callback( ++ hipox_dma_channel_t *channel, ++ hipox_callback_arg_t arg, ++ hipox_dma_callback_status_t status, ++ u16 checksum, ++ int interrupt_count) ++{ ++ hipox_adma_desc_t *desc = (hipox_adma_desc_t*)arg; ++ ++ /* Use cookies to record that this descriptor's transfer has completed */ ++ ++ /* Store the completion status with the descriptor */ ++ ++ /* If there is a queued descriptor, start its transfer now - if that's ++ possible from a DMA callback - with the callback arg updated */ ++} ++ ++static dma_cookie_t hipox_adma_submit_tx(struct dma_async_tx_descriptor *tx) ++{ ++ hipox_adma_desc_t *desc = container_of(tx, hipox_adma_desc_t, async_desc); ++ hipox_adma_channel_t *channel = container_of(tx->chan, hipox_adma_channel_t, common); ++ dma_cookie_t cookie; ++ ++ if (hipox_dma_set(channel->hipox_channel, ++ (unsigned char*)desc->src_adr, ++ desc->len, ++ (unsigned char*)desc->dst_adr, ++ HIPOX_DMA_MODE_INC, ++ HIPOX_DMA_MODE_INC, ++ 0, 0)) { ++ return -1; ++ } ++ ++ /* Allocate a cookie for this descriptor */ ++ cookie = -1; ++ ++ /* Be careful to syn. properly with DMA callback here */ ++ if (hipox_dma_is_active(channel->hipox_channel)) { ++ /* Queue the new descriptor to be started when current transfer completes */ ++ } else { ++ /* Start the new transfer */ ++ hipox_dma_set_callback(channel->hipox_channel, hipox_dma_callback, desc) ++ hipox_dma_start(channel->hipox_channel); ++ } ++ ++ return cookie; ++} ++ ++/** Allocate a DMA channel and prepare it for memory to memory transfers. Could ++ * preallocate descriptors here ++ */ ++static int hipox_adma_alloc_chan_resources(struct dma_chan *chan) ++{ ++ hipox_adma_channel_t *channel = container_of(chan, hipox_adma_channel_t, common); ++ ++ channel->hipox_channel = hipox_dma_request(0); ++ if (!channel->hipox_channel) { ++ return 0; ++ } ++ ++ /* Pretend we've allocated one descriptor */ ++ return 1; ++} ++ ++static void hipox_adma_free_chan_resources(struct dma_chan *chan) ++{ ++ hipox_adma_channel_t *channel = container_of(chan, hipox_adma_channel_t, common); ++ hipox_dma_free(channel->hipox_channel); ++ ++ /* May need to free leftover descriptors here as well */ ++} ++ ++/** Poll for the DMA channel's active status. There can be multiple transfers ++ * queued with the DMA channel identified by cookies, so should be checking ++ * lists containing all pending transfers and all completed transfers that have ++ * not yet been polled for completion ++ */ ++static enum dma_status hipox_adma_is_tx_complete( ++ struct dma_chan *chan, ++ dma_cookie_t cookie, ++ dma_cookie_t *last, ++ dma_cookie_t *used) ++{ ++ hipox_adma_channel_t *channel = container_of(chan, hipox_adma_channel_t, common); ++ ++ /* Use cookies to report completion status */ ++ ++ return hipox_dma_is_active(channel->hipox_channel) ? DMA_IN_PROGRESS : DMA_SUCCESS; ++} ++ ++/** To push outstanding transfers to h/w. This should use the list of pending ++ * transfers identified by cookies to select the next transfer and pass this to ++ * the hardware ++ */ ++static void hipox_adma_issue_pending(struct dma_chan *chan) ++{ ++ /* If there isn't a transfer in progress and one is queued start it now, ++ being careful to sync. with DMA callback function */ ++} ++ ++static void hipox_adma_dependency_added(struct dma_chan *chan) ++{ ++ /* What is supposed to happen here? */ ++} ++ ++/** Allocate descriptors capable of mapping the requested length of memory */ ++static struct dma_async_tx_descriptor *hipox_adma_prep_dma_memcpy(struct dma_chan *chan, size_t len, int int_en) ++{ ++ hipox_adma_desc_t *desc = kzalloc(sizeof(hipox_adma_desc_t), GFP_KERNEL); ++ if (unlikely(!desc)) { ++ return NULL; ++ } ++ ++ desc->async_desc.tx_set_src = hipox_adma_set_src; ++ desc->async_desc.tx_set_dest = hipox_adm_set_dest; ++ desc->async_desc.tx_submit = hipox_adma_submit_tx; ++ desc->len = len; ++ ++ return &desc->async_desc; ++} ++ ++static int enumerate_dma_channels(struct dma_device *dma_device) ++{ ++ int i; ++ ++ dma_device->chancnt = 3; ++ ++ for (i = 0; i < dma_device->chancnt; i++) { ++ hipox_adma_channel_t *channel = kzalloc(sizeof(hipox_adma_channel_t), GFP_KERNEL); ++ if (!channel) { ++ dma_device->chancnt = i; ++ break; ++ } ++ ++ channel->common.device = dma_device; ++ list_add_tail(&channel->common.device_node, &dma_device->channels); ++ } ++ ++ return dma_device->chancnt; ++} ++ ++static int __devinit hipox_adma_probe(struct platform_device *platform_device) ++{ ++ hipox_adma_device_t *hipox_adma_device; ++ struct dma_device *dma_device; ++ ++ hipox_adma_device = kzalloc(sizeof(hipox_adma_device_t), GFP_KERNEL); ++ if (!hipox_adma_device) { ++ return -ENOMEM; ++ } ++ ++ hipox_adma_device->platform_device = platform_device; ++ dma_device = &hipox_adma_device->common; ++ ++ platform_set_drvdata(platform_device, hipox_adma_device); ++ ++ INIT_LIST_HEAD(&dma_device->channels); ++ enumerate_dma_channels(dma_device); ++ ++ dma_cap_set(DMA_MEMCPY, dma_device->cap_mask); ++ dma_device->device_alloc_chan_resources = hipox_adma_alloc_chan_resources; ++ dma_device->device_free_chan_resources = hipox_adma_free_chan_resources; ++ dma_device->device_is_tx_complete = hipox_adma_is_tx_complete; ++ dma_device->device_issue_pending = hipox_adma_issue_pending; ++ dma_device->device_dependency_added = hipox_adma_dependency_added; ++ dma_device->dev = &platform_device->dev; ++ dma_device->device_prep_dma_memcpy = hipox_adma_prep_dma_memcpy; ++ ++ dma_async_device_register(dma_device); ++ ++ return 0; ++} ++ ++static struct platform_driver hipox_adma_driver = { ++ .probe = hipox_adma_probe, ++ .remove = hipox_adma_remove, ++ .driver = { ++ .owner = THIS_MODULE, ++ .name = "hipox-adma", ++ }, ++}; ++ ++static int __init hipox_adma_init_module(void) ++{ ++ return platform_driver_register(&hipox_adma_driver); ++} ++ ++module_init(hipox_adma_init_module); ++ ++static void __exit hipox_adma_exit_module(void) ++{ ++ platform_driver_unregister(&hipox_adma_driver); ++ return; ++} ++ ++module_exit(hipox_adma_exit_module); +diff -Nurd linux-2.6.24/drivers/firmware/dmi_scan.c linux-2.6.24-oxe810/drivers/firmware/dmi_scan.c +--- linux-2.6.24/drivers/firmware/dmi_scan.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/firmware/dmi_scan.c 2008-06-11 17:49:40.000000000 +0200 +@@ -469,12 +469,3 @@ + + return year; + } +- +-/** +- * dmi_get_slot - return dmi_ident[slot] +- * @slot: index into dmi_ident[] +- */ +-char *dmi_get_slot(int slot) +-{ +- return(dmi_ident[slot]); +-} +diff -Nurd linux-2.6.24/drivers/i2c/algos/Kconfig linux-2.6.24-oxe810/drivers/i2c/algos/Kconfig +--- linux-2.6.24/drivers/i2c/algos/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/algos/Kconfig 2008-06-11 17:50:33.000000000 +0200 +@@ -34,6 +34,10 @@ + This support is also available as a module. If so, the module + will be called i2c-algo-pca. + ++config I2C_ALGOOXSEMI ++ tristate "HIPOX I2C interface" ++ depends on I2C ++ + config I2C_ALGO_SGI + tristate "I2C SGI interfaces" + depends on SGI_IP22 || SGI_IP32 || X86_VISWS +diff -Nurd linux-2.6.24/drivers/i2c/algos/Makefile linux-2.6.24-oxe810/drivers/i2c/algos/Makefile +--- linux-2.6.24/drivers/i2c/algos/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/algos/Makefile 2008-06-11 17:50:34.000000000 +0200 +@@ -5,6 +5,7 @@ + obj-$(CONFIG_I2C_ALGOBIT) += i2c-algo-bit.o + obj-$(CONFIG_I2C_ALGOPCF) += i2c-algo-pcf.o + obj-$(CONFIG_I2C_ALGOPCA) += i2c-algo-pca.o ++obj-$(CONFIG_I2C_ALGOOXSEMI) += i2c-algo-hipox.o + obj-$(CONFIG_I2C_ALGO_SGI) += i2c-algo-sgi.o + + ifeq ($(CONFIG_I2C_DEBUG_ALGO),y) +diff -Nurd linux-2.6.24/drivers/i2c/algos/i2c-algo-hipox.c linux-2.6.24-oxe810/drivers/i2c/algos/i2c-algo-hipox.c +--- linux-2.6.24/drivers/i2c/algos/i2c-algo-hipox.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/algos/i2c-algo-hipox.c 2008-06-11 17:50:33.000000000 +0200 +@@ -0,0 +1,858 @@ ++/* ++ * i2c-algo-hipox.c i2x driver algorithms for MPChipox ++ * Copyright (c) 1999 Dan Malek (dmalek@jlc.net). ++ * ++ 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. ++ * ++ */ ++ ++// XXX todo ++// timeout sleep? ++ ++ ++/* $Id: i2c-algo-hipox.c,v 1.15 2004/11/20 08:02:24 khali Exp $ */ ++ ++#include <linux/kernel.h> ++#include <linux/module.h> ++#include <linux/delay.h> ++#include <linux/slab.h> ++#include <linux/init.h> ++#include <linux/errno.h> ++#include <linux/sched.h> ++#include "linux/i2c.h" ++#include "linux/i2c-algo-hipox.h" ++#include <asm/bitops.h> ++ ++ ++ ++#define HIPOX_MAX_READ 513 ++/* #define I2C_CHIP_ERRATA */ /* Try uncomment this if you have an older CPU(earlier than rev D4) */ //NOTE ++static wait_queue_head_t iic_wait; ++ ++int hipox_debug = 1; ++int hipox_scan = 1; ++ ++static inline void hipox_iic_algo_dump_reg( void ) ++{ ++ i2c_registers_hipox_t* i2c = (i2c_registers_hipox_t*) I2C_BASE; // SERIAL_MASTER_CONTROL_BASE; ++ ++ printk( KERN_INFO "\n\n ==================================================================" ); ++ printk( KERN_INFO " i2c->SerialControlRegister; == 0x%08x @ %p\n", i2c->SerialControlRegister , &(i2c->SerialControlRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x00; */ ++ printk( KERN_INFO " i2c->SerialAddressRegister; == 0x%08x @ %p\n", i2c->SerialAddressRegister , &(i2c->SerialAddressRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x04; */ ++ printk( KERN_INFO " i2c->SerialSWControlOutRegister; == 0x%08x @ %p\n", i2c->SerialSWControlOutRegister , &(i2c->SerialSWControlOutRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x08; */ ++ printk( KERN_INFO " i2c->SerialSWControlInRegister; == 0x%08x @ %p\n", i2c->SerialSWControlInRegister , &(i2c->SerialSWControlInRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x0C; */ ++ printk( KERN_INFO " i2c->SerialInterruptStatusRegister; == 0x%08x @ %p\n", i2c->SerialInterruptStatusRegister , &(i2c->SerialInterruptStatusRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x10; */ ++ printk( KERN_INFO " i2c->SerialInterruptEnableRegister; == 0x%08x @ %p\n", i2c->SerialInterruptEnableRegister , &(i2c->SerialInterruptEnableRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x14; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->SerialReadData1Register; == 0x%08x @ %p\n", i2c->SerialReadData1Register , &(i2c->SerialReadData1Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x20; */ ++ printk( KERN_INFO " i2c->SerialReadData2Register; == 0x%08x @ %p\n", i2c->SerialReadData2Register , &(i2c->SerialReadData2Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x24; */ ++ printk( KERN_INFO " i2c->SerialReadData3Register; == 0x%08x @ %p\n", i2c->SerialReadData3Register , &(i2c->SerialReadData3Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x28; */ ++ printk( KERN_INFO " i2c->SerialReadData4Register; == 0x%08x @ %p\n", i2c->SerialReadData4Register , &(i2c->SerialReadData4Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x2C; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->SerialWriteData1Register; == 0x%08x @ %p\n", i2c->SerialWriteData1Register , &(i2c->SerialWriteData1Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x40; */ ++ printk( KERN_INFO " i2c->SerialWriteData2Register; == 0x%08x @ %p\n", i2c->SerialWriteData2Register , &(i2c->SerialWriteData2Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x44; */ ++ printk( KERN_INFO " i2c->SerialWriteData3Register; == 0x%08x @ %p\n", i2c->SerialWriteData3Register , &(i2c->SerialWriteData3Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x48; */ ++ printk( KERN_INFO " i2c->SerialWriteData4Register; == 0x%08x @ %p\n", i2c->SerialWriteData4Register , &(i2c->SerialWriteData4Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x4C; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->GenericSerialControlRegister; == 0x%08x @ %p\n", i2c->GenericSerialControlRegister , &(i2c->GenericSerialControlRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x80; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->GenericSerialInterruptStatusRegister; == 0x%08x @ %p\n", i2c->GenericSerialInterruptStatusRegister , &(i2c->GenericSerialInterruptStatusRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x90; */ ++ printk( KERN_INFO " i2c->GenericSerialInterruptEnableRegister; == 0x%08x @ %p\n", i2c->GenericSerialInterruptEnableRegister , &(i2c->GenericSerialInterruptEnableRegister ) ); /* SERIAL_MASTER_CONTROL_BASE + 0x94; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->GenericSerialReadData1Register; == 0x%08x @ %p\n", i2c->GenericSerialReadData1Register , &(i2c->GenericSerialReadData1Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xA0; */ ++ printk( KERN_INFO " i2c->GenericSerialReadData2Register; == 0x%08x @ %p\n", i2c->GenericSerialReadData2Register , &(i2c->GenericSerialReadData2Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xA4; */ ++ printk( KERN_INFO " i2c->GenericSerialReadData3Register; == 0x%08x @ %p\n", i2c->GenericSerialReadData3Register , &(i2c->GenericSerialReadData3Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xA8; */ ++ printk( KERN_INFO " i2c->GenericSerialReadData4Register; == 0x%08x @ %p\n", i2c->GenericSerialReadData4Register , &(i2c->GenericSerialReadData4Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xAC; */ ++ printk( KERN_INFO "\n" ); /* PAD REGISTER PACKING ***/ ++ printk( KERN_INFO " i2c->GenericSerialWriteData1Register; == 0x%08x @ %p\n", i2c->GenericSerialWriteData1Register , &(i2c->GenericSerialWriteData1Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xC0; */ ++ printk( KERN_INFO " i2c->GenericSerialWriteData2Register; == 0x%08x @ %p\n", i2c->GenericSerialWriteData2Register , &(i2c->GenericSerialWriteData2Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xC4; */ ++ printk( KERN_INFO " i2c->GenericSerialWriteData3Register; == 0x%08x @ %p\n", i2c->GenericSerialWriteData3Register , &(i2c->GenericSerialWriteData3Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xC8; */ ++ printk( KERN_INFO " i2c->GenericSerialWriteData4Register; == 0x%08x @ %p\n", i2c->GenericSerialWriteData4Register , &(i2c->GenericSerialWriteData4Register ) ); /* SERIAL_MASTER_CONTROL_BASE + 0xCC; */ ++ printk( KERN_INFO "\n\n ==================================================================" ); ++ ++ ++} ++ ++static inline int hipox_iic_algo_bus_reset( volatile struct i2c_algo_hipox_data* hipox ) ++{ ++ /* perform a bus reset to clean up */ ++ ++ unsigned long flags, tmo; ++ volatile i2c_registers_hipox_t *pI2C = (i2c_registers_hipox_t *) hipox; ++ ++ local_irq_save(flags); ++ hipox->iTransferInProgress_ = 1; ++ ++ pI2C->SerialControlRegister = ++ (I2C_SCR_RESET << I2C_SCR_TRANSACTION_TYPE_BIT ) | ++ (I2C_SCR_RESET << I2C_SCR_TRANSACTION_PROGRESS_BIT ); ++ ++ /* Wait for IIC transfer */ ++ tmo = interruptible_sleep_on_timeout(&iic_wait,1*HZ); ++ ++ // Flag that the transfer has finished ++ hipox->iTransferInProgress_ = 0; ++ ++ local_irq_restore(flags); ++ ++ return (tmo < 1*HZ); ++} ++ ++ ++static void ++hipox_iic_algo_interrupt(void *dev_id, struct pt_regs *regs) ++{ ++ volatile i2c_registers_hipox_t *i2cReg = (i2c_registers_hipox_t *)dev_id; ++ if (hipox_debug) ++ printk("hipox_iic_algo_interrupt(dev_id=%p)\n", dev_id); ++ ++ /* Clear interrupt. ++ */ ++ i2cReg->SerialInterruptStatusRegister &= ~(1UL << I2C_ISR_INTERRUPT_STATUS_BIT); ++ ++ /* Get 'me going again. ++ */ ++ wake_up_interruptible(&iic_wait); ++} ++ ++static void ++hipox_iic_algo_init(struct i2c_algo_hipox_data *hipox) ++{ ++ u32 temp; ++ volatile i2c_registers_hipox_t* i2c = hipox->i2c; ++ ++ if (hipox_debug) printk(KERN_INFO "hipox_iic_algo_init()\n"); ++ ++ /* Initialize ++ * Set up the IIC parameters ++ */ ++ temp = i2c->SerialControlRegister & I2C_SCR_READ_MASK; ++ temp >>= I2C_SCR_AUTO_INCREMENT_BUFFER_SIZE_BIT; ++ temp &= ~(0xffffffff << ( I2C_SCR_AUTO_INCREMENT_BUFFER_SIZE_NUM_BITS )); ++ hipox->iMaxAutoIncTransfer_ = temp; ++ ++ // Initialise the Serial controller(s) ++ { ++ // syslib::Lock lock(mutex); ++ ++ // TODO: Ensure the Serial block is properly reset ++ // BlockResetRegister& blockResetRegister = BlockResetRegister::Acquire(); ++ // blockResetRegister.ResetSerial(); ++ // blockResetRegister.CommitWrites(); ++ // blockResetRegister.Release(); ++ ++ // TODO: Enable the clock to the Serial block ++ // ClockStartRegister& clockStartRegister = ClockStartRegister::Acquire(); ++ // clockStartRegister.RefreshReadData(); ++ // clockStartRegister.StartSerialClock(); ++ // clockStartRegister.CommitWrites(); ++ // clockStartRegister.Release(); ++ ++ // TODO: Set the Serial clock rate ++ // SerialClockSelectRegister& serialClockSelectRegister = SerialClockSelectRegister::GetInstance(); ++ // serialClockSelectRegister.SetClockRate(SerialClockSelectRegister::PLL_DIV_32768); ++ // serialClockSelectRegister.CommitWrites(); ++ ++ // Disable the Serial Interrupt ++ if (hipox_debug) printk(KERN_INFO " - Disabling pre existing i2c interrupt\n"); ++ i2c->SerialInterruptEnableRegister &= ~(1UL << I2C_IER_SERIAL_ENABLE_BIT); ++ ++ // Disable the Generic serial Interrupt ++ if (hipox_debug) printk(KERN_INFO " - Disabling pre existing gen serial interrupt\n"); ++ i2c->SerialInterruptEnableRegister &= ~(1UL << I2C_IER_GEN_ENABLE_BIT); ++ ++ // Clear any pending Serial interrupts ++ if ( i2c->SerialInterruptStatusRegister | (1UL << I2C_ISR_INTERRUPT_STATUS_BIT) ) ++ { ++ // Yes, so clear the interrupt ++ if (hipox_debug) printk(KERN_INFO " - Clearing pre existing i2c interrupt\n"); ++ *( &(i2c->SerialInterruptStatusRegister) ) |= (1UL << I2C_ISR_INTERRUPT_STATUS_BIT); ++ } ++ ++ // Clear any pending Generic serial interrupts ++ if ( i2c->SerialInterruptStatusRegister | (1UL << I2C_ISR_GEN_INTERRUPT_STATUS_BIT) ) ++ { ++ // Yes, so clear the interrupt ++ if (hipox_debug) printk(KERN_INFO " - Clearing pre existing generic serial interrupt\n"); ++ *( &(i2c->SerialInterruptStatusRegister) ) |= (1UL << I2C_ISR_GEN_INTERRUPT_STATUS_BIT); ++ } ++ ++ ++ // Initialise the generic serial hardware, which shares reset, ++ // clock and interrupt hardware with the Serial controller(s) ++ // TODO: GenericSerialHelper::Init(); ++ ++ } ++ ++ init_waitqueue_head(&iic_wait); ++ ++ /* Install interrupt handler. ++ */ ++ if (hipox_debug) { ++ printk ("%s[%d] Install ISR for IRQ %d\n", ++ __func__,__LINE__, I2C_INTERRUPT ); ++ } ++ ++ (*hipox->setisr)( (int) I2C_INTERRUPT, &hipox_iic_algo_interrupt, (void *)i2c); ++if (hipox_debug)hipox_iic_algo_dump_reg(); ++} ++ ++ ++static int ++hipox_iic_algo_shutdown(struct i2c_algo_hipox_data *hipox) ++{ ++ volatile i2c_registers_hipox_t *i2c = hipox->i2c; ++ ++ if (hipox_debug) printk("hipox_iic_algo_shutdown()\n"); ++ ++ /* Shut down IIC. ++ */ ++ // TODO: syslib::Lock lock(mutex); ++ ++ // TODO: Reset Serial block to ensure there are no actve transfers ++ // BlockResetRegister& blockResetRegister = BlockResetRegister::Acquire(); ++ // blockResetRegister.ResetSerial(); ++ // blockResetRegister.CommitWrites(); ++ // blockResetRegister.Release(); ++ ++ // Disable the Serial Interrupt ++ if (hipox_debug) printk(KERN_INFO " - Disabling pre existing i2c interrupt\n"); ++ i2c->SerialInterruptEnableRegister &= ~(1UL << I2C_IER_SERIAL_ENABLE_BIT); ++ ++ // Disable the Generic serial Interrupt ++ if (hipox_debug) printk(KERN_INFO " - Disabling pre existing gen serial interrupt\n"); ++ i2c->SerialInterruptEnableRegister &= ~(1UL << I2C_IER_GEN_ENABLE_BIT); ++ ++ ++ // Shutdown the generic serial hardware, which shares reset, clock and ++ // interrupt hardware with the Serial controller(s) ++ // TODO: GenericSerialHelper::Shutdown(); ++ ++ // TODO: Disable the clock to the Serial block ++ // ClockStopRegister& clockStopRegister = ClockStopRegister::Acquire(); ++ // clockStopRegister.RefreshReadData(); ++ // clockStopRegister.StopSerialClock(); ++ // clockStopRegister.CommitWrites(); ++ // clockStopRegister.Release(); ++ ++ (*hipox->clearisr)( (int) I2C_INTERRUPT, (void *)i2c); ++if (hipox_debug)hipox_iic_algo_dump_reg(); ++ ++ return(0); ++} ++ ++ ++#define BD_SC_NAK ((ushort)0x0004) /* NAK - did not respond */ ++#define BD_SC_OV ((ushort)0x0002) /* OV - receive overrun */ ++#define HIPOX_CR_CLOSE_RXBD ((ushort)0x0007) ++ ++static void force_close(struct i2c_algo_hipox_data *hipox) ++{ ++ volatile i2c_registers_hipox_t *i2c = hipox->i2c; ++ ++ if (hipox_debug) printk("force_close()\n"); ++ ++ *( &(i2c->SerialControlRegister) ) |= (1UL << I2C_SCR_ABORT_BIT); ++ ++ /* perform a bus reset to clean up */ ++ hipox_iic_algo_bus_reset(hipox); ++ ++if (hipox_debug)hipox_iic_algo_dump_reg(); ++} ++ ++ ++/* Read from IIC... ++ * abyte = address byte, with r/w flag already set ++ */ ++static int ++hipox_iic_algo_read(struct i2c_algo_hipox_data *hipox, u_char abyte, char *readBuffer, int readBufferLength) ++{ ++ volatile i2c_registers_hipox_t *i2c = hipox->i2c; ++ const unsigned char* pData; ++ unsigned long flags, tmo, temp, bytesTransfered; ++ ++ ++ if (hipox_debug) printk("hipox_iic_algo_read(abyte=0x%x)\n", abyte); ++ ++ if (readBufferLength >= hipox->iMaxAutoIncTransfer_ ) { ++ if (hipox_debug) printk("hipox_iic_algo_read $RFailed to reaad %d auto. max is %d\n", readBufferLength, hipox->iMaxAutoIncTransfer_ ); ++ return -EINVAL; ++ } ++ ++ ++ if( 1 /*TODO: Split into multipacks. */ ) ++ { ++ ++ local_irq_save(flags); ++ ++ /* QUESTION: Does this get locked by the parent? it should be!! */ ++ hipox->iTransferInProgress_ = 1; ++ hipox->iError_ = 0; ++ ++ // Set up the 7-bit slave address ++ i2c->SerialAddressRegister = I2C_SAR_WRITE_MASK & ((abyte >> 1) << I2C_SAR_SEVEN_BIT_ADDRESS_BIT); ++ ++ // Setup the control register ++ temp = ( I2C_SCR_READ << I2C_SCR_READ_WRITE_BIT ) | ++ ( I2C_SCR_NORMAL << I2C_SCR_TRANSACTION_TYPE_BIT ) | ++ ( I2C_SCR_SEVEN_BIT << I2C_SCR_ADDRESS_MODE_BIT ) | ++ ( 0 << I2C_SCR_SCCB_MODE_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_SCCB_MODE_RESPECT_ACK_BIT ) | ++ ( 1 << I2C_SCR_AUTO_INCREMENT_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_ENABLE_SLAVE_HOLD_OFF_BIT ) | ++ ( 0 << I2C_SCR_HIGH_SPEED_DRIVE_BIT ) | ++ ( readBufferLength << I2C_SCR_BYTES_TO_TRANSFER_BIT ); ++ ++ temp &= I2C_SCR_WRITE_MASK; ++ i2c->SerialControlRegister = temp; ++ ++ /* Enable some interupts */ ++ *( &(i2c->SerialInterruptEnableRegister) ) |= (1UL << I2C_IER_SERIAL_ENABLE_BIT); ++ ++ /* Begin transmission */ ++ *( &(i2c->SerialControlRegister) ) |= (1UL << I2C_SCR_TRANSACTION_PROGRESS_BIT); ++ ++ /* Wait for IIC transfer */ ++ tmo = interruptible_sleep_on_timeout(&iic_wait,1*HZ); ++ ++ /* Woken. Copy data out of special registers. */ ++ ++ temp = i2c->SerialControlRegister; ++ ++ // How many bytes were read from the slave? ++ bytesTransfered = (temp >> I2C_SCR_BYTES_TO_TRANSFER_BIT) & ++ ~(0xffffffff << I2C_SCR_BYTES_TO_TRANSFER_NUM_BITS); ++ ++ // Did the transfer fail ++ if ( temp | (1UL << I2C_SCR_TRANSACTION_STATUS_BIT) ) ++ { ++ // Yes, so remember the error ++ hipox->iError_ = 1; ++ readBufferLength = 0; ++ } ++ else if (readBuffer) ++ { ++ if (bytesTransfered > readBufferLength) ++ { ++ // More bytes were read than we have buffer space to ++ // store them ++ hipox->iError_ = 1; ++ } ++ else ++ { ++ // Copy the received data into the buffer that was provided by the ++ // original caller to the Read() or ReadImmediate() method ++ if (bytesTransfered > 0) ++ { ++ int i=0; ++ temp = i2c->SerialReadData1Register; ++ pData = (const unsigned char*) (&temp); ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 1) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 2) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 3) ++ { ++ readBuffer[i++] = *pData++; ++ } ++ } ++ } ++ ++ if (bytesTransfered > 4) ++ { ++ temp = i2c->SerialReadData2Register; ++ pData = (const unsigned char*) (&temp); ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 5) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 6) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 7) ++ { ++ readBuffer[i++] = *pData++; ++ } ++ } ++ } ++ } ++ ++ if (bytesTransfered > 8) ++ { ++ temp = i2c->SerialReadData3Register; ++ pData = (const unsigned char*) (&temp); ++ if (bytesTransfered > 9) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 10) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 11) ++ { ++ readBuffer[i++] = *pData++; ++ } ++ } ++ } ++ } ++ ++ if (bytesTransfered > 12) ++ { ++ temp = i2c->SerialReadData4Register; ++ pData = (const unsigned char*) (&temp); ++ if (bytesTransfered > 13) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 14) ++ { ++ readBuffer[i++] = *pData++; ++ if (bytesTransfered > 15) ++ { ++ readBuffer[i++] = *pData++; ++ } ++ } ++ } ++ } ++ } ++ } ++ } ++ ++ ++ // Flag that the transfer has finished ++ hipox->iTransferInProgress_ = 0; ++ ++ local_irq_restore(flags); ++ } ++ ++ /* IDEA: busy wait for small transfers, its faster time_after(jiffies, tmo) */ ++ ++ if (signal_pending(current) || !tmo){ ++ force_close(hipox); ++ if(hipox_debug) ++ printk("IIC read: timeout!\n"); ++ return -EIO; ++ } ++ ++ if ( i2c->SerialControlRegister | (1UL << I2C_SCR_TRANSACTION_STATUS_BIT) ) { ++ if (hipox_debug) ++ printk("IIC read; no ack\n"); ++ return -EREMOTEIO; ++ } ++ ++ if (bytesTransfered > readBufferLength) { ++ if (hipox_debug) ++ printk("IIC read; Overrun\n"); ++ return -EREMOTEIO;; ++ } ++ ++ if (hipox_debug) printk("read %u bytes\n", readBufferLength); ++ ++ if (bytesTransfered < readBufferLength) { ++ if (hipox_debug) ++ printk("IIC read; short, wanted %lu got %ld\n", ++ bytesTransfered, readBufferLength); ++ return 0; ++ } ++ ++ return bytesTransfered; ++} ++ ++ ++static void LoadWriteRegisters( ++ volatile i2c_registers_hipox_t *i2c, ++ char *data, ++ int length ) ++{ ++ // Copy the data to be transmited into the write registers ++ u32 temp; ++ if (length > 0) ++ { ++ int i=0; ++ unsigned char* pData = (unsigned char*) &temp; ++ *pData++ = (data[i++]); ++ if (length > 1) ++ { ++ *pData++ = (data[i++]); ++ if (length > 2) ++ { ++ *pData++ = (data[i++]); ++ if (length > 3) ++ { ++ *pData++ = (data[i++]); ++ } ++ } ++ } ++ i2c->SerialWriteData1Register = temp; ++ ++ if (length > 4) ++ { ++ pData = (unsigned char*) (&temp); ++ *pData++ = (data[i++]); ++ if (length > 5) ++ { ++ *pData++ = (data[i++]); ++ if (length > 6) ++ { ++ *pData++ = (data[i++]); ++ if (length > 7) ++ { ++ *pData++ = (data[i++]); ++ } ++ } ++ } ++ i2c->SerialWriteData2Register = temp; ++ } ++ ++ if (length > 8) ++ { ++ pData = (unsigned char*) (&temp); ++ *pData++ = (data[i++]); ++ if (length > 9) ++ { ++ *pData++ = (data[i++]); ++ if (length > 10) ++ { ++ *pData++ = (data[i++]); ++ if (length > 11) ++ { ++ *pData++ = (data[i++]); ++ } ++ } ++ } ++ i2c->SerialWriteData3Register = temp; ++ } ++ ++ if (length > 12) ++ { ++ pData = (unsigned char*) (&temp); ++ *pData++ = (data[i++]); ++ if (length > 13) ++ { ++ *pData++ = (data[i++]); ++ if (length > 14) ++ { ++ *pData++ = (data[i++]); ++ if (length > 15) ++ { ++ *pData++ = (data[i++]); ++ } ++ } ++ } ++ i2c->SerialWriteData4Register = temp; ++ } ++ } ++} ++ ++ ++/* Write to IIC... ++ * addr = address byte, with r/w flag already set ++ */ ++static int ++hipox_iic_algo_write(struct i2c_algo_hipox_data *hipox, u_char abyte, char *buf,int count) ++{ ++ volatile i2c_registers_hipox_t *i2c = hipox->i2c; ++ unsigned long flags, tmo, bytesTransfered, temp; ++ ++ if (hipox_debug) printk("hipox_iic_algo_write(abyte=0x%x)\n", abyte); ++ ++ if (count >= hipox->iMaxAutoIncTransfer_ ) { ++ if (hipox_debug) printk("hipox_iic_algo_read $RFailed to reaad %d auto. max is %d\n", count, hipox->iMaxAutoIncTransfer_ ); ++ return -EINVAL; ++ } ++ ++ if( 1 /* TODO: Split longer messages */ ) ++ { ++ LoadWriteRegisters( i2c, buf, count ); ++ ++ local_irq_save(flags); ++ ++ /* QUESTION: Does this get locked by the parent? it should be!! */ ++ hipox->iTransferInProgress_ = 1; ++ hipox->iError_ = 0; ++ ++ // Set up the 7-bit slave address ++ i2c->SerialAddressRegister = I2C_SAR_WRITE_MASK & ((abyte >> 1) << I2C_SAR_SEVEN_BIT_ADDRESS_BIT); ++ ++ // Setup the control register ++ temp = ( I2C_SCR_WRITE << I2C_SCR_READ_WRITE_BIT ) | ++ ( I2C_SCR_NORMAL << I2C_SCR_TRANSACTION_TYPE_BIT ) | ++ ( I2C_SCR_SEVEN_BIT << I2C_SCR_ADDRESS_MODE_BIT ) | ++ ( 0 << I2C_SCR_SCCB_MODE_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_SCCB_MODE_RESPECT_ACK_BIT ) | ++ ( 1 << I2C_SCR_AUTO_INCREMENT_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_ENABLE_SLAVE_HOLD_OFF_BIT ) | ++ ( 0 << I2C_SCR_HIGH_SPEED_DRIVE_BIT ) | ++ ( count << I2C_SCR_BYTES_TO_TRANSFER_BIT ); ++ ++ temp &= I2C_SCR_WRITE_MASK; ++ i2c->SerialControlRegister = temp; ++ ++ /* Enable some interupts */ ++ *( &(i2c->SerialInterruptEnableRegister) ) |= (1UL << I2C_IER_SERIAL_ENABLE_BIT); ++ ++ /* Begin transmission */ ++ *( &i2c->SerialControlRegister ) |= (1UL << I2C_SCR_TRANSACTION_PROGRESS_BIT); ++ ++ /* Begin transmission */ ++ ++ /* Wait for IIC transfer */ ++ tmo = interruptible_sleep_on_timeout(&iic_wait,1*HZ); ++ local_irq_restore(flags); ++ } ++ ++ /* IDEA: busy wait for small transfers, its faster time_after(jiffies, tmo) */ ++ ++ ++ if (signal_pending(current) || !tmo){ ++ force_close(hipox); ++ if(hipox_debug) ++ printk("IIC read: timeout!\n"); ++ return -EIO; ++ } ++ ++ if ( i2c->SerialControlRegister | (1UL << I2C_SCR_TRANSACTION_STATUS_BIT)) { ++ if (hipox_debug) ++ printk("IIC read; no ack\n"); ++ return -EREMOTEIO; ++ } ++ ++ // How many bytes were read from the slave? ++ bytesTransfered = (temp >> I2C_SCR_BYTES_TO_TRANSFER_BIT) & ++ ~(0xffffffff << I2C_SCR_BYTES_TO_TRANSFER_NUM_BITS); ++ ++ if (bytesTransfered > count) { ++ if (hipox_debug) ++ printk("IIC read; Overrun\n"); ++ return -EREMOTEIO;; ++ } ++ ++ if (hipox_debug) printk("read %lu bytes\n", bytesTransfered); ++ ++ if (bytesTransfered < count) { ++ if (hipox_debug) ++ printk("IIC read; short, wanted %u got %lu\n", ++ count, bytesTransfered); ++ return 0; ++ } ++ ++ return bytesTransfered; ++} ++ ++/* See if an IIC address exists.. ++ * addr = 7 bit address, unshifted ++ */ ++static int ++hipox_iic_algo_tryaddress(struct i2c_algo_hipox_data *hipox, int addr) ++{ ++ volatile i2c_registers_hipox_t *i2c = hipox->i2c; ++ unsigned long flags, length, tmo, temp, bytesTransfered; ++ ++ if (hipox_debug) printk("hipox_iic_algo_tryaddress(hipox=%p/%p,addr=%d)\n", hipox, i2c, addr); ++ ++ /* do a simple read */ ++ length = 2; ++ ++ { ++ local_irq_save(flags); ++ ++ /* QUESTION: Does this get locked by the parent? it should be!! */ ++ hipox->iTransferInProgress_ = 1; ++ hipox->iError_ = 0; ++ ++ // Set up the 7-bit slave address ++ i2c->SerialAddressRegister = I2C_SAR_WRITE_MASK & ((addr) << I2C_SAR_SEVEN_BIT_ADDRESS_BIT); ++ ++ // Setup the control register ++ temp = ( I2C_SCR_WRITE << I2C_SCR_READ_WRITE_BIT ) | ++ ( I2C_SCR_NORMAL << I2C_SCR_TRANSACTION_TYPE_BIT ) | ++ ( I2C_SCR_SEVEN_BIT << I2C_SCR_ADDRESS_MODE_BIT ) | ++ ( 0 << I2C_SCR_SCCB_MODE_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_SCCB_MODE_RESPECT_ACK_BIT ) | ++ ( 1 << I2C_SCR_AUTO_INCREMENT_ENABLE_BIT ) | ++ ( 1 << I2C_SCR_ENABLE_SLAVE_HOLD_OFF_BIT ) | ++ ( 0 << I2C_SCR_HIGH_SPEED_DRIVE_BIT ) | ++ ( length << I2C_SCR_BYTES_TO_TRANSFER_BIT ); ++ ++ temp &= I2C_SCR_WRITE_MASK; ++ i2c->SerialControlRegister = temp; ++ ++ /* Enable some interupts */ ++ *( &(i2c->SerialInterruptEnableRegister) ) |= (1UL << I2C_IER_SERIAL_ENABLE_BIT); ++ ++ /* Begin transmission */ ++ *( &i2c->SerialControlRegister ) |= (1UL << I2C_SCR_TRANSACTION_PROGRESS_BIT); ++ ++ /* Begin transmission */ ++ ++ /* Wait for IIC transfer */ ++ tmo = interruptible_sleep_on_timeout(&iic_wait,1*HZ); ++ local_irq_restore(flags); ++ } ++ ++ /* IDEA: busy wait for small transfers, its faster time_after(jiffies, tmo) */ ++ ++ ++ if (signal_pending(current) || !tmo){ ++ force_close(hipox); ++ if(hipox_debug) ++ printk("$rIIC test_addr: timeout!\n"); ++ return -EIO; ++ } ++ ++ if ( i2c->SerialControlRegister | (1UL << I2C_SCR_TRANSACTION_STATUS_BIT)) { ++ if (hipox_debug) ++ printk("$rIIC test_addr; no ack\n"); ++ return -EREMOTEIO; ++ } ++ ++ // How many bytes were read from the slave? ++ bytesTransfered = (temp >> I2C_SCR_BYTES_TO_TRANSFER_BIT) & ++ ~(0xffffffff << I2C_SCR_BYTES_TO_TRANSFER_NUM_BITS); ++ ++ if (bytesTransfered > 2) { ++ if (hipox_debug) ++ printk("$rIIC test_addr; Overrun\n"); ++ return -EREMOTEIO;; ++ } ++ ++ if (hipox_debug) printk("$rtest_addr %lu bytes\n", bytesTransfered); ++ ++ if (bytesTransfered < 2) { ++ if (hipox_debug) ++ printk("$rIIC test_addr; short, wanted %d got %lu\n", ++ 2, bytesTransfered); ++ return 0; ++ } ++ printk("$GIIC found @ test_addr (hipox=%p,addr=%d)\n", hipox, addr); ++ return 1; ++} ++ ++static int hipox_xfer( ++ struct i2c_adapter *adap, ++ struct i2c_msg msgs[], ++ int num) ++{ ++ struct i2c_algo_hipox_data *hipox = adap->algo_data; ++ struct i2c_msg *pmsg; ++ int i, ret; ++ u_char addr; ++ ++ if (hipox_debug > 1) printk("hipox_xfer()\n"); ++ for (i = 0; i < num; i++) { ++ pmsg = &msgs[i]; ++ ++ if (hipox_debug) ++ printk("i2c-algo-hipox.o: " ++ "#%d addr=0x%x flags=0x%x len=%d\n buf=%lx\n", ++ i, pmsg->addr, pmsg->flags, pmsg->len, (unsigned long)pmsg->buf); ++ ++ addr = pmsg->addr << 1; ++ if (pmsg->flags & I2C_M_RD ) ++ addr |= 1; ++ if (pmsg->flags & I2C_M_REV_DIR_ADDR ) ++ addr ^= 1; ++ ++ if (!(pmsg->flags & I2C_M_NOSTART)) { ++ } ++ if (pmsg->flags & I2C_M_RD ) { ++ /* read bytes into buffer*/ ++ ret = hipox_iic_algo_read(hipox, addr, pmsg->buf, pmsg->len); ++ if (hipox_debug) ++ printk("i2c-algo-hipox.o: read %d bytes\n", ret); ++ if (ret < pmsg->len ) { ++ return (ret<0)? ret : -EREMOTEIO; ++ } ++ } else { ++ /* write bytes from buffer */ ++ ret = hipox_iic_algo_write(hipox, addr, pmsg->buf, pmsg->len); ++ if (hipox_debug) ++ printk("i2c-algo-hipox.o: wrote %d\n", ret); ++ if (ret < pmsg->len ) { ++ return (ret<0) ? ret : -EREMOTEIO; ++ } ++ } ++ } ++ return (num); ++} ++ ++static u32 hipox_func(struct i2c_adapter *adap) ++{ ++ if (hipox_debug > 1) printk("hipox_func(I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING)\n"); ++ ++ return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | ++ I2C_FUNC_PROTOCOL_MANGLING; ++} ++ ++/* -----exported algorithm data: ------------------------------------- */ ++ ++static struct i2c_algorithm hipox_algo = { ++ .name = "Hipox algorithm", ++ .id = I2C_ALGO_OCP, ++ .master_xfer = hipox_xfer, ++ .functionality = hipox_func, ++}; ++ ++/* ++ * registering functions to load algorithms at runtime ++ */ ++int i2c_hipox_algo_add_bus(struct i2c_adapter *adap) ++{ ++ int i; ++ struct i2c_algo_hipox_data *hipox = adap->algo_data; ++ ++ if (hipox_debug) printk("i2c_hipox_algo_add_bus: hw routines for %s registered.\n", adap->name); ++ ++ /* register new adapter to i2c module... */ ++ ++ adap->id |= hipox_algo.id; ++ adap->algo = &hipox_algo; ++ ++ hipox_iic_algo_init(hipox); ++ i2c_add_adapter(adap); ++ ++ /* scan bus */ ++ if ( hipox_scan ) { ++ if (hipox_debug) printk(KERN_INFO " i2c_hipox_algo_add_bus: scanning bus %s...\n", adap->name); ++ for (i = 0; i < 128; i++) { ++ if (hipox_debug) printk(KERN_INFO " scanning addr %d...\n", i); ++ if (hipox_iic_algo_tryaddress(hipox, i)) { ++ printk("(%02x)",i<<1); ++ } ++ } ++ printk("\n"); ++ } ++ ++ return 0; ++} ++ ++ ++int i2c_hipox_algo_del_bus(struct i2c_adapter *adap) ++{ ++ struct i2c_algo_hipox_data *hipox = adap->algo_data; ++ ++ hipox_iic_algo_shutdown(hipox); ++ ++ return i2c_del_adapter(adap); ++} ++ ++EXPORT_SYMBOL(i2c_hipox_algo_add_bus); ++EXPORT_SYMBOL(i2c_hipox_algo_del_bus); ++ ++MODULE_AUTHOR("Chris FOrd <....>"); ++MODULE_DESCRIPTION("I2C-Bus hipox algorithm"); ++MODULE_LICENSE("GPL"); ++ +diff -Nurd linux-2.6.24/drivers/i2c/busses/Kconfig linux-2.6.24-oxe810/drivers/i2c/busses/Kconfig +--- linux-2.6.24/drivers/i2c/busses/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/busses/Kconfig 2008-06-11 17:50:33.000000000 +0200 +@@ -321,6 +321,15 @@ + This driver can also be built as a module. If so, the module + will be called i2c-nforce2. + ++config I2C_HIPOX_BITBASH ++ tristate "HIPOX bitbashed I2C interface" ++ depends on I2C_ALGOBIT ++ help ++ Say Y here if you want to use I2C GPIO bit-bash interface ++ ++ This driver can also be built as a module. If so, the module ++ will be called i2c-hipox-bitbash. ++ + config I2C_OCORES + tristate "OpenCores I2C Controller" + depends on EXPERIMENTAL +diff -Nurd linux-2.6.24/drivers/i2c/busses/Makefile linux-2.6.24-oxe810/drivers/i2c/busses/Makefile +--- linux-2.6.24/drivers/i2c/busses/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/busses/Makefile 2008-06-11 17:50:33.000000000 +0200 +@@ -28,6 +28,7 @@ + obj-$(CONFIG_I2C_OCORES) += i2c-ocores.o + obj-$(CONFIG_I2C_OMAP) += i2c-omap.o + obj-$(CONFIG_I2C_PARPORT) += i2c-parport.o ++obj-$(CONFIG_I2C_HIPOX_BITBASH) += i2c-hipox-bitbash.o + obj-$(CONFIG_I2C_PARPORT_LIGHT) += i2c-parport-light.o + obj-$(CONFIG_I2C_PASEMI) += i2c-pasemi.o + obj-$(CONFIG_I2C_PCA_ISA) += i2c-pca-isa.o +diff -Nurd linux-2.6.24/drivers/i2c/busses/i2c-hipox-bitbash.c linux-2.6.24-oxe810/drivers/i2c/busses/i2c-hipox-bitbash.c +--- linux-2.6.24/drivers/i2c/busses/i2c-hipox-bitbash.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/i2c/busses/i2c-hipox-bitbash.c 2008-06-11 17:50:33.000000000 +0200 +@@ -0,0 +1,158 @@ ++/* ++ * drivers/i2c/busses/i2c_hipox_bitbash.c ++ * ++ * Copyright (C) 2006-2008 Oxford Semiconductor Ltd ++ * ++ * 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/module.h> ++#include <linux/kernel.h> ++#include <linux/init.h> ++#include <linux/delay.h> ++#include <linux/i2c.h> ++#include <linux/i2c-algo-bit.h> ++#include <asm/hardware.h> ++#include <asm/io.h> ++ ++#define I2C_HIPOX_BITBASH_I2C_SDA_OUT (1UL << (CONFIG_HIPOX_I2C_SDA)) ++#define I2C_HIPOX_BITBASH_I2C_SCL_OUT (1UL << (CONFIG_HIPOX_I2C_SCL)) ++#define I2C_HIPOX_BB_PULSEWIDTH (40) ++#define OPEN_COLLECTOR_CLOCK 1 ++ ++extern spinlock_t hipox_gpio_spinlock; ++ ++static void i2c_hipox_bitbash_setsda(void *data,int state) ++{ ++ if (state) { ++ // tristae as input to set line on bus ++ writel(I2C_HIPOX_BITBASH_I2C_SDA_OUT, GPIO_A_OUTPUT_ENABLE_CLEAR); ++ } else { ++ // tristate as output (with latch to zero) to assert zero on the bus ++ writel(I2C_HIPOX_BITBASH_I2C_SDA_OUT, GPIO_A_OUTPUT_CLEAR); ++ writel(I2C_HIPOX_BITBASH_I2C_SDA_OUT, GPIO_A_OUTPUT_ENABLE_SET); ++ } ++} ++ ++static void i2c_hipox_bitbash_setscl(void *data,int state) ++{ ++#if OPEN_COLLECTOR_CLOCK ++ if (state) { ++ // tristae as input to set line on bus ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_ENABLE_CLEAR); ++ } else { ++ // tristate as output (with latch to zero) to assert zero on the bus ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_CLEAR); ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_ENABLE_SET); ++ } ++#else // driven clock ++ if (state) { ++ // tristae as input to set line on bus ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_SET); ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_ENABLE_CLEAR); ++ } else { ++ // tristate as output (with latch to zero) to assert zero on the bus ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_CLEAR); ++ writel(I2C_HIPOX_BITBASH_I2C_SCL_OUT, GPIO_A_OUTPUT_ENABLE_SET); ++ } ++ ++#endif ++} ++ ++static int i2c_hipox_bitbash_getsda(void *data) ++{ ++ return ((readl(GPIO_A_DATA ) & I2C_HIPOX_BITBASH_I2C_SDA_OUT) != 0); ++} ++ ++static int i2c_hipox_bitbash_getscl(void *data) ++{ ++ return ((readl(GPIO_A_DATA ) & I2C_HIPOX_BITBASH_I2C_SCL_OUT) != 0); ++} ++ ++static struct i2c_algo_bit_data bit_i2c_hipox_bitbash_data = { ++ .setsda = i2c_hipox_bitbash_setsda, ++ .setscl = i2c_hipox_bitbash_setscl, ++ .getsda = i2c_hipox_bitbash_getsda, ++ .getscl = i2c_hipox_bitbash_getscl, ++ .udelay = I2C_HIPOX_BB_PULSEWIDTH, ++ .timeout = HZ ++}; ++ ++static struct i2c_adapter hipox_i2c_bitbash_adapter = { ++ .owner = THIS_MODULE, ++ .name = "i2c_hipox_bitbash adapter driver", ++ .id = I2C_HW_B_HIPOX, ++ .algo_data = &bit_i2c_hipox_bitbash_data, ++}; ++ ++static int __init i2c_hipox_bitbash_init(void) ++{ ++ unsigned long flags; ++ unsigned long mask = I2C_HIPOX_BITBASH_I2C_SDA_OUT | I2C_HIPOX_BITBASH_I2C_SCL_OUT; ++ int ret = 0; ++ ++ /* Dedicate the GPIO over to i2c. ++ * NOTE: This may be confusing, but we are not using the i2c core here we ++ * are using bit-bashed GPIO, so we must disable the primary, secondary and ++ * tertiary functions of the relevant GPIO pins ++ */ ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) & ~mask, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) & ~mask, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0) & ~mask, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ i2c_hipox_bitbash_setsda(NULL, 1); ++ i2c_hipox_bitbash_setscl(NULL, 1); ++ ret = i2c_bit_add_bus(&hipox_i2c_bitbash_adapter); ++ if (!ret) { ++#if defined(CONFIG_HIPOX_RTC) || defined(CONFIG_HIPOX_RTC_MODULE) ++ /* Register the ST MT4100 RTC */ ++ struct i2c_board_info rtc_info = { ++ .driver_name = "rtc-ds1307", ++ .type = "m41t00", ++ .flags = 0, ++ .addr = 0x68, ++ .platform_data = NULL, ++ .irq = 0 ++ }; ++ ++ struct i2c_client *client = i2c_new_device(&hipox_i2c_bitbash_adapter, &rtc_info); ++ if (!client) { ++ printk(KERN_WARNING "HIPOX bit-bash I2C driver failed to register RTC device\n"); ++ ret = -EIO; ++ } ++#endif // CONFIG_HIPOX_RTC || CONFIG_HIPOX_RTC_MODULE ++ } ++ ++ printk(KERN_INFO "HIPOX bit-bash I2C driver initialisation %s\n", ret ? "failed": "OK"); ++ return ret; ++} ++ ++static void __exit i2c_hipox_bitbash_exit(void) ++{ ++ i2c_hipox_bitbash_setsda(NULL, 1); ++ i2c_hipox_bitbash_setscl(NULL, 1); ++ i2c_del_adapter(&hipox_i2c_bitbash_adapter); ++} ++ ++MODULE_AUTHOR("Brian Clarke"); ++MODULE_DESCRIPTION("HIPOX bit-bash I2C bus driver"); ++MODULE_LICENSE("GPL"); ++MODULE_VERSION("v2.0"); ++ ++module_init (i2c_hipox_bitbash_init); ++module_exit (i2c_hipox_bitbash_exit); ++ +diff -Nurd linux-2.6.24/drivers/leds/Kconfig linux-2.6.24-oxe810/drivers/leds/Kconfig +--- linux-2.6.24/drivers/leds/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/leds/Kconfig 2008-06-11 17:50:12.000000000 +0200 +@@ -62,6 +62,20 @@ + This option enables support for LEDs connected to GPIO lines + on Samsung S3C24XX series CPUs, such as the S3C2410 and S3C2440. + ++config WDC_LEDS_HIPOX800 ++ tristate "LED Support for WDC HIPOX800 GPIO LEDs" ++ depends on LEDS_CLASS && ARCH_HIPOX ++ help ++ This option enables support for LEDs connected to GPIO lines on ++ Oxford Semiconductor NAS800 in the Western Digital My Book NAS. ++ ++config HIPOX_WD810_LEDS ++ tristate "LED Support for 810 based WD NAS" ++ depends on LEDS_CLASS && ARCH_HIPOX ++ help ++ This option enables support for LEDs connected to GPIO lines on the ++ Oxford Semiconductor OX810 in the Western Digital NAS ++ + config LEDS_AMS_DELTA + tristate "LED Support for the Amstrad Delta (E3)" + depends on LEDS_CLASS && MACH_AMS_DELTA +@@ -137,6 +151,13 @@ + This allows LEDs to be controlled by IDE disk activity. + If unsure, say Y. + ++config WDC_LEDS_TRIGGER_SATA_DISK ++ bool "WDC LED SATA Disk Trigger" ++ depends on LEDS_TRIGGERS ++ help ++ This allows WDC LEDs to be controlled by SATA disk activity. ++ If unsure, say Y. ++ + config LEDS_TRIGGER_HEARTBEAT + tristate "LED Heartbeat Trigger" + depends on LEDS_TRIGGERS +diff -Nurd linux-2.6.24/drivers/macintosh/smu.c linux-2.6.24-oxe810/drivers/macintosh/smu.c +--- linux-2.6.24/drivers/macintosh/smu.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/macintosh/smu.c 2008-06-11 17:49:30.000000000 +0200 +@@ -85,6 +85,7 @@ + u32 cmd_buf_abs; /* command buffer absolute */ + struct list_head cmd_list; + struct smu_cmd *cmd_cur; /* pending command */ ++ int broken_nap; + struct list_head cmd_i2c_list; + struct smu_i2c_cmd *cmd_i2c_cur; /* pending i2c command */ + struct timer_list i2c_timer; +@@ -135,6 +136,19 @@ + fend = faddr + smu->cmd_buf->length + 2; + flush_inval_dcache_range(faddr, fend); + ++ ++ /* We also disable NAP mode for the duration of the command ++ * on U3 based machines. ++ * This is slightly racy as it can be written back to 1 by a sysctl ++ * but that never happens in practice. There seem to be an issue with ++ * U3 based machines such as the iMac G5 where napping for the ++ * whole duration of the command prevents the SMU from fetching it ++ * from memory. This might be related to the strange i2c based ++ * mechanism the SMU uses to access memory. ++ */ ++ if (smu->broken_nap) ++ powersave_nap = 0; ++ + /* This isn't exactly a DMA mapping here, I suspect + * the SMU is actually communicating with us via i2c to the + * northbridge or the CPU to access RAM. +@@ -211,6 +225,10 @@ + misc = cmd->misc; + mb(); + cmd->status = rc; ++ ++ /* Re-enable NAP mode */ ++ if (smu->broken_nap) ++ powersave_nap = 1; + bail: + /* Start next command if any */ + smu_start_cmd(); +@@ -461,7 +479,7 @@ + if (np == NULL) + return -ENODEV; + +- printk(KERN_INFO "SMU driver %s %s\n", VERSION, AUTHOR); ++ printk(KERN_INFO "SMU: Driver %s %s\n", VERSION, AUTHOR); + + if (smu_cmdbuf_abs == 0) { + printk(KERN_ERR "SMU: Command buffer not allocated !\n"); +@@ -533,6 +551,11 @@ + goto fail; + } + ++ /* U3 has an issue with NAP mode when issuing SMU commands */ ++ smu->broken_nap = pmac_get_uninorth_variant() < 4; ++ if (smu->broken_nap) ++ printk(KERN_INFO "SMU: using NAP mode workaround\n"); ++ + sys_ctrler = SYS_CTRLER_SMU; + return 0; + +diff -Nurd linux-2.6.24/drivers/md/Kconfig linux-2.6.24-oxe810/drivers/md/Kconfig +--- linux-2.6.24/drivers/md/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/md/Kconfig 2008-06-11 17:50:20.000000000 +0200 +@@ -229,6 +229,22 @@ + + If unsure, say N. + ++config DM_OX_CRYPT ++ tristate "OX800 Hardware Cryptograpy target support" ++ depends on BLK_DEV_DM && EXPERIMENTAL && CRYPTO_OXAESLRW ++ ---help--- ++ Based on dm-crypt by Fruhwirth & Saout it has been modified ++ to work with the LRW-AES core in the OX800 NAS chip from ++ Oxford Semiconductor Ltd. ++ ++ This device-mapper target allows you to create a device that ++ transparently encrypts the data on it. ++ ++ To compile this code as a module, choose M here: the module will ++ be called dm-ox-crypt. ++ ++ If unsure, say N. ++ + config DM_SNAPSHOT + tristate "Snapshot target (EXPERIMENTAL)" + depends on BLK_DEV_DM && EXPERIMENTAL +diff -Nurd linux-2.6.24/drivers/md/Makefile linux-2.6.24-oxe810/drivers/md/Makefile +--- linux-2.6.24/drivers/md/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/md/Makefile 2008-06-11 17:50:20.000000000 +0200 +@@ -33,6 +33,7 @@ + obj-$(CONFIG_BLK_DEV_MD) += md-mod.o + obj-$(CONFIG_BLK_DEV_DM) += dm-mod.o + obj-$(CONFIG_DM_CRYPT) += dm-crypt.o ++obj-$(CONFIG_DM_OX_CRYPT) += dm-ox-crypt.o + obj-$(CONFIG_DM_DELAY) += dm-delay.o + obj-$(CONFIG_DM_MULTIPATH) += dm-multipath.o dm-round-robin.o + obj-$(CONFIG_DM_MULTIPATH_EMC) += dm-emc.o +diff -Nurd linux-2.6.24/drivers/md/dm-ox-crypt.c linux-2.6.24-oxe810/drivers/md/dm-ox-crypt.c +--- linux-2.6.24/drivers/md/dm-ox-crypt.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/md/dm-ox-crypt.c 2008-06-11 17:50:20.000000000 +0200 +@@ -0,0 +1,791 @@ ++/* linux/drivers/md/dm-ox-crypt.c ++ * ++ * OX800 DPE core compatable device encryption ++ */ ++ ++/* ++ * Copyright (C) 2003 Christophe Saout <christophe@saout.de> ++ * Copyright (C) 2004 Clemens Fruhwirth <clemens@endorphin.org> ++ * ++ * This file is released under the GPL. ++ */ ++ ++#include <linux/module.h> ++#include <linux/init.h> ++#include <linux/kernel.h> ++#include <linux/bio.h> ++#include <linux/blkdev.h> ++#include <linux/mempool.h> ++#include <linux/slab.h> ++#include <linux/crypto.h> ++#include <linux/workqueue.h> ++#include <asm/atomic.h> ++#include <asm/scatterlist.h> ++#include <asm/page.h> ++#include <asm/arch/cipher.h> ++ ++#include "dm.h" ++ ++#define DM_MSG_PREFIX "ox-crypt: " ++ ++/* ++ * per bio private data ++ */ ++struct oxcrypt_io { ++ struct dm_target *target; ++ struct bio *bio; ++ struct bio *first_clone; ++ struct work_struct work; ++ atomic_t pending; ++ int error; ++}; ++ ++/* ++ * context holding the current state of a multi-part conversion ++ */ ++struct convert_context { ++ struct bio *bio_in; ++ struct bio *bio_out; ++ unsigned int offset_in; ++ unsigned int offset_out; ++ unsigned int idx_in; ++ unsigned int idx_out; ++ sector_t sector; ++ int write; ++}; ++ ++struct oxcrypt_config; ++ ++struct oxcrypt_iv_operations { ++ int (*ctr)(struct oxcrypt_config *cc, struct dm_target *ti, ++ const char *opts); ++ void (*dtr)(struct oxcrypt_config *cc); ++ const char *(*status)(struct oxcrypt_config *cc); ++ int (*generator)(struct oxcrypt_config *cc, u8 *iv, sector_t sector); ++}; ++ ++/* ++ * Crypt: maps a linear range of a block device ++ * and encrypts / decrypts at the same time. ++ */ ++ ++struct oxcrypt_config { ++ struct dm_dev *dev; ++ sector_t start; ++ ++ /* ++ * pool for per bio private data and ++ * for encryption buffer pages ++ */ ++ mempool_t *io_pool; ++ mempool_t *page_pool; ++ ++ /* ++ * crypto related data ++ */ ++ struct oxcrypt_iv_operations *iv_gen_ops; ++ void *iv_gen_private; ++ sector_t iv_offset; ++ unsigned int iv_size; ++ ++ struct crypto_tfm *tfm; ++ u8 key[OX800DPE_KEYSIZE]; /* size of key is fixed by hardware */ ++ u8 iv_key[OX800DPE_KEYSIZE]; ++}; ++ ++#define MIN_IOS 256 ++#define MIN_POOL_PAGES 32 ++#define MIN_BIO_PAGES 8 ++ ++static struct kmem_cache *_oxcrypt_io_pool; ++ ++/* ++ * Mempool alloc and free functions for the page ++ */ ++static void *mempool_alloc_page(gfp_t gfp_mask, void *data) ++{ ++ return alloc_page(gfp_mask); ++} ++ ++static void mempool_free_page(void *page, void *data) ++{ ++ __free_page(page); ++} ++ ++ ++/* ++ * Different IV generation algorithms: ++ * ++ * oxsemi: ++ * Uses the 32 sector number and a reproducable hash of target device ++ * properties to generate bits 35-32 ++ * ++ */ ++ ++static int oxcrypt_iv_oxsemi_gen(struct oxcrypt_config *cc, u8 *iv, sector_t sector) ++{ ++ *((u32* )iv) = cpu_to_le32(sector & 0xffffffff); ++ *( ((u32* )iv) + 1) = 0; /** @todo bits 35 - 32 */ ++ ++ return 0; ++} ++ ++static struct oxcrypt_iv_operations oxcrypt_iv_oxsemi_ops = { ++ .generator = oxcrypt_iv_oxsemi_gen ++}; ++ ++ ++/*static inline*/ int ++oxcrypt_convert_scatterlist(struct oxcrypt_config *cc, struct scatterlist *out, ++ struct scatterlist *in, unsigned int length, ++ int write, sector_t sector) ++{ ++ u8 iv[OX800DPE_KEYSIZE]; ++ int r = 0; ++ ++ if (cc->iv_gen_ops) { /* probably no need to check this */ ++ u8* pri = cc->key; ++ u8* twe = cc->iv_key; ++ ++ r = cc->iv_gen_ops->generator(cc, iv, sector); ++ if (r < 0) ++ return r; ++ ++ if (write) ++ r = ox800_aeslrw_encrypt(in, out, 1, iv, pri, twe); ++ else ++ r = ox800_aeslrw_decrypt(in, out, 1, iv, pri, twe); ++ } else { ++ BUG(); ++ } ++ ++ //printk("back\n"); ++ if (r < 0) { ++ printk(KERN_ERR"oxcrypt_convert_scatterlist: core driver returned error %d\n",r); ++ } ++ ++ return r; ++} ++ ++static void ++oxcrypt_convert_init(struct oxcrypt_config *cc, struct convert_context *ctx, ++ struct bio *bio_out, struct bio *bio_in, ++ sector_t sector, int write) ++{ ++ ctx->bio_in = bio_in; ++ ctx->bio_out = bio_out; ++ ctx->offset_in = 0; ++ ctx->offset_out = 0; ++ ctx->idx_in = bio_in ? bio_in->bi_idx : 0; ++ ctx->idx_out = bio_out ? bio_out->bi_idx : 0; ++ ctx->sector = sector + cc->iv_offset; ++ ctx->write = write; ++} ++ ++/** ++ * Encrypt / decrypt data from one bio to another one (can be the same one) ++ * ++ * @todo This only goes atr one sector at a time, could it be made to this in ++ * a scatter gather list of multiple sectors? ++ */ ++static int oxcrypt_convert(struct oxcrypt_config *cc, ++ struct convert_context *ctx) ++{ ++ int r = 0; ++ struct bio_vec *bv_in ; ++ struct bio_vec *bv_out ; ++ struct scatterlist sg_in; ++ struct scatterlist sg_out; ++ ++ //printk("oxcrypt_convert config %p context %p \n", cc, ctx); ++ ++ while(ctx->idx_in < ctx->bio_in->bi_vcnt && ++ ctx->idx_out < ctx->bio_out->bi_vcnt) { ++ ++ bv_in = bio_iovec_idx(ctx->bio_in, ctx->idx_in); ++ bv_out = bio_iovec_idx(ctx->bio_out, ctx->idx_out); ++ ++ sg_in.page = bv_in->bv_page; ++ sg_in.offset = bv_in->bv_offset + ctx->offset_in; ++ sg_in.length = 1 << SECTOR_SHIFT; ++ ++ sg_out.page = bv_out->bv_page; ++ sg_out.offset = bv_out->bv_offset + ctx->offset_out; ++ sg_out.length = 1 << SECTOR_SHIFT; ++ ++ ctx->offset_in += sg_in.length; ++ if (ctx->offset_in >= bv_in->bv_len) { ++ ctx->offset_in = 0; ++ ctx->idx_in++; ++ } ++ ++ ctx->offset_out += sg_out.length; ++ if (ctx->offset_out >= bv_out->bv_len) { ++ ctx->offset_out = 0; ++ ctx->idx_out++; ++ } ++ ++ r = oxcrypt_convert_scatterlist(cc, &sg_out, &sg_in, sg_in.length, ++ ctx->write, ctx->sector); ++ if (r < 0) ++ break; ++ ++ ctx->sector++; ++ } ++ ++ return r; ++} ++ ++/* ++ * Generate a new unfragmented bio with the given size ++ * This should never violate the device limitations ++ * May return a smaller bio when running out of pages ++ */ ++static struct bio * ++oxcrypt_alloc_buffer(struct oxcrypt_config *cc, unsigned int size, ++ struct bio *base_bio, unsigned int *bio_vec_idx) ++{ ++ struct bio *bio; ++ unsigned int nr_iovecs = dm_div_up(size, PAGE_SIZE); ++ int gfp_mask = GFP_NOIO | __GFP_HIGHMEM; ++ unsigned long flags = current->flags; ++ unsigned int i; ++ ++ /* ++ * Tell VM to act less aggressively and fail earlier. ++ * This is not necessary but increases throughput. ++ * FIXME: Is this really intelligent? ++ */ ++ current->flags &= ~PF_MEMALLOC; ++ ++ if (base_bio) ++ bio = bio_clone(base_bio, GFP_NOIO); ++ else ++ bio = bio_alloc(GFP_NOIO, nr_iovecs); ++ if (!bio) { ++ if (flags & PF_MEMALLOC) ++ current->flags |= PF_MEMALLOC; ++ return NULL; ++ } ++ ++ /* if the last bio was not complete, continue where that one ended */ ++ bio->bi_idx = *bio_vec_idx; ++ bio->bi_vcnt = *bio_vec_idx; ++ bio->bi_size = 0; ++ bio->bi_flags &= ~(1 << BIO_SEG_VALID); ++ ++ /* bio->bi_idx pages have already been allocated */ ++ size -= bio->bi_idx * PAGE_SIZE; ++ ++ for(i = bio->bi_idx; i < nr_iovecs; i++) { ++ struct bio_vec *bv = bio_iovec_idx(bio, i); ++ ++ bv->bv_page = mempool_alloc(cc->page_pool, gfp_mask); ++ if (!bv->bv_page) ++ break; ++ ++ /* ++ * if additional pages cannot be allocated without waiting, ++ * return a partially allocated bio, the caller will then try ++ * to allocate additional bios while submitting this partial bio ++ */ ++ if ((i - bio->bi_idx) == (MIN_BIO_PAGES - 1)) ++ gfp_mask = (gfp_mask | __GFP_NOWARN) & ~__GFP_WAIT; ++ ++ bv->bv_offset = 0; ++ if (size > PAGE_SIZE) ++ bv->bv_len = PAGE_SIZE; ++ else ++ bv->bv_len = size; ++ ++ bio->bi_size += bv->bv_len; ++ bio->bi_vcnt++; ++ size -= bv->bv_len; ++ } ++ ++ if (flags & PF_MEMALLOC) ++ current->flags |= PF_MEMALLOC; ++ ++ if (!bio->bi_size) { ++ bio_put(bio); ++ return NULL; ++ } ++ ++ /* ++ * Remember the last bio_vec allocated to be able ++ * to correctly continue after the splitting. ++ */ ++ *bio_vec_idx = bio->bi_vcnt; ++ ++ return bio; ++} ++ ++static void oxcrypt_free_buffer_pages(struct oxcrypt_config *cc, ++ struct bio *bio, unsigned int bytes) ++{ ++ unsigned int i, start, end; ++ struct bio_vec *bv; ++ ++ /* ++ * This is ugly, but Jens Axboe thinks that using bi_idx in the ++ * endio function is too dangerous at the moment, so I calculate the ++ * correct position using bi_vcnt and bi_size. ++ * The bv_offset and bv_len fields might already be modified but we ++ * know that we always allocated whole pages. ++ * A fix to the bi_idx issue in the kernel is in the works, so ++ * we will hopefully be able to revert to the cleaner solution soon. ++ */ ++ i = bio->bi_vcnt - 1; ++ bv = bio_iovec_idx(bio, i); ++ end = (i << PAGE_SHIFT) + (bv->bv_offset + bv->bv_len) - bio->bi_size; ++ start = end - bytes; ++ ++ start >>= PAGE_SHIFT; ++ if (!bio->bi_size) ++ end = bio->bi_vcnt; ++ else ++ end >>= PAGE_SHIFT; ++ ++ for(i = start; i < end; i++) { ++ bv = bio_iovec_idx(bio, i); ++ BUG_ON(!bv->bv_page); ++ mempool_free(bv->bv_page, cc->page_pool); ++ bv->bv_page = NULL; ++ } ++} ++ ++/* ++ * One of the bios was finished. Check for completion of ++ * the whole request and correctly clean up the buffer. ++ */ ++static void dec_pending(struct oxcrypt_io *io, int error) ++{ ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) io->target->private; ++ ++ if (error < 0) ++ io->error = error; ++ ++ if (!atomic_dec_and_test(&io->pending)) ++ return; ++ ++ if (io->first_clone) ++ bio_put(io->first_clone); ++ ++ bio_endio(io->bio, io->bio->bi_size, io->error); ++ ++ mempool_free(io, cc->io_pool); ++} ++ ++/* ++ * kcryptd: ++ * ++ * Needed because it would be very unwise to do decryption in an ++ * interrupt context, so bios returning from read requests get ++ * queued here. ++ */ ++static struct workqueue_struct *_kcryptd_workqueue; ++ ++static void kcryptd_do_work(struct work_struct *work) ++{ ++ struct oxcrypt_io *io = container_of(work, struct oxcrypt_io, work); ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) io->target->private; ++ struct convert_context ctx; ++ int r; ++ ++ oxcrypt_convert_init(cc, &ctx, io->bio, io->bio, ++ io->bio->bi_sector - io->target->begin, 0); ++ ++ /* printk("kcryptd_do_work %d sectors\n", ctx.bio_in->bi_vcnt ); */ ++ r = oxcrypt_convert(cc, &ctx); ++ ++ dec_pending(io, r); ++} ++ ++static void kcryptd_queue_io(struct oxcrypt_io *io) ++{ ++ INIT_WORK(&io->work, kcryptd_do_work); ++ queue_work(_kcryptd_workqueue, &io->work); ++} ++ ++/* ++ * Decode key from its hex representation ++ */ ++static int oxcrypt_decode_key(u8 *key, char *hex, unsigned int size) ++{ ++ char buffer[3]; ++ char *endp; ++ unsigned int i; ++ ++ buffer[2] = '\0'; ++ ++ for(i = 0; i < size; i++) { ++ buffer[0] = *hex++; ++ buffer[1] = *hex++; ++ key[i] = (u8)simple_strtoul(buffer, &endp, 16); ++ ++ if (endp != &buffer[2]) ++ return -EINVAL; ++ } ++ ++ if (*hex != '\0') ++ return -EINVAL; ++ ++ /* ++ printk(KERN_INFO"key ="); ++ for (i = 0; i < OX800DPE_KEYSIZE; ++i) ++ printk("%02x", key[i]); ++ printk("\n"); ++ */ ++ ++ return 0; ++} ++ ++/* ++ * Encode key into its hex representation ++ */ ++static void oxcrypt_encode_key(char *hex, u8 *key, unsigned int size) ++{ ++ unsigned int i; ++ ++ for(i = 0; i < size; i++) { ++ sprintf(hex, "%02x", *key); ++ hex += 2; ++ key++; ++ } ++} ++ ++/* ++ * Construct an encryption mapping, much simpler: ++ * <key> <iv-key> <iv_offset> <dev_path> <start> ++ */ ++static int oxcrypt_ctr(struct dm_target *ti, unsigned int argc, char **argv) ++{ ++ struct oxcrypt_config *cc; ++ unsigned long long tmpll; ++ ++ if (argc != 5) { ++ ti->error = DM_MSG_PREFIX "Not enough arguments"; ++ return -EINVAL; ++ } ++ ++ cc = kmalloc(sizeof(*cc) , GFP_KERNEL); ++ if (cc == NULL) { ++ ti->error = ++ DM_MSG_PREFIX "Cannot allocate transparent encryption context"; ++ return -ENOMEM; ++ } ++ ++ memset( cc, 0, sizeof(*cc) ); ++ ++ if (oxcrypt_decode_key(cc->key, argv[0], OX800DPE_KEYSIZE) < 0) { ++ ti->error = DM_MSG_PREFIX "Error decoding key"; ++ goto bad1; ++ } ++ ++ if (oxcrypt_decode_key(cc->iv_key, argv[1], OX800DPE_KEYSIZE) < 0) { ++ ti->error = DM_MSG_PREFIX "Error decoding iv key"; ++ goto bad1; ++ } ++ ++ /* ++ * Force the ivmode to the ox-semi version ++ */ ++ cc->iv_gen_ops = &oxcrypt_iv_oxsemi_ops; ++ ++ cc->io_pool = mempool_create(MIN_IOS, mempool_alloc_slab, ++ mempool_free_slab, _oxcrypt_io_pool); ++ if (!cc->io_pool) { ++ ti->error = DM_MSG_PREFIX "Cannot allocate crypt io mempool"; ++ goto bad3; ++ } ++ ++ cc->page_pool = mempool_create(MIN_POOL_PAGES, mempool_alloc_page, ++ mempool_free_page, NULL); ++ if (!cc->page_pool) { ++ ti->error = DM_MSG_PREFIX "Cannot allocate page mempool"; ++ goto bad4; ++ } ++ ++ if (sscanf(argv[2], "%llu", &tmpll) != 1) { ++ ti->error = DM_MSG_PREFIX "Invalid iv_offset sector"; ++ goto bad5; ++ } ++ cc->iv_offset = tmpll; ++ ++ if (sscanf(argv[4], "%llu", &tmpll) != 1) { ++ ti->error = DM_MSG_PREFIX "Invalid device sector"; ++ goto bad5; ++ } ++ cc->start = tmpll; ++ ++ if (dm_get_device(ti, argv[3], cc->start, ti->len, ++ dm_table_get_mode(ti->table), &cc->dev)) { ++ ti->error = DM_MSG_PREFIX "Device lookup failed"; ++ goto bad5; ++ } ++ ++ ++ ti->private = cc; ++ ++ return 0; ++ ++bad5: ++ mempool_destroy(cc->page_pool); ++bad4: ++ mempool_destroy(cc->io_pool); ++bad3: ++ if (cc->iv_gen_ops && cc->iv_gen_ops->dtr) ++ cc->iv_gen_ops->dtr(cc); ++bad1: ++ kfree(cc); ++ return -EINVAL; ++} ++ ++static void oxcrypt_dtr(struct dm_target *ti) ++{ ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) ti->private; ++ ++ mempool_destroy(cc->page_pool); ++ mempool_destroy(cc->io_pool); ++ ++ if (cc->iv_gen_ops && cc->iv_gen_ops->dtr) ++ cc->iv_gen_ops->dtr(cc); ++ dm_put_device(ti, cc->dev); ++ ++ kfree(cc); ++} ++ ++static int oxcrypt_endio(struct bio *bio, unsigned int done, int error) ++{ ++ struct oxcrypt_io *io = (struct oxcrypt_io *) bio->bi_private; ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) io->target->private; ++ ++ if (bio_data_dir(bio) == WRITE) { ++ /* ++ * free the processed pages, even if ++ * it's only a partially completed write ++ */ ++ oxcrypt_free_buffer_pages(cc, bio, done); ++ } ++ ++ if (bio->bi_size) ++ return 1; ++ ++ bio_put(bio); ++ ++ /* ++ * successful reads are decrypted by the worker thread ++ */ ++ if ((bio_data_dir(bio) == READ) ++ && bio_flagged(bio, BIO_UPTODATE)) { ++ kcryptd_queue_io(io); ++ return 0; ++ } ++ ++ dec_pending(io, error); ++ return error; ++} ++ ++static struct bio * ++oxcrypt_clone(struct oxcrypt_config *cc, struct oxcrypt_io *io, struct bio *bio, ++ sector_t sector, unsigned int *bvec_idx, ++ struct convert_context *ctx) ++{ ++ struct bio *clone; ++ ++ if (bio_data_dir(bio) == WRITE) { ++ clone = oxcrypt_alloc_buffer(cc, bio->bi_size, ++ io->first_clone, bvec_idx); ++ if (clone) { ++ ctx->bio_out = clone; ++ if (oxcrypt_convert(cc, ctx) < 0) { ++ oxcrypt_free_buffer_pages(cc, clone, ++ clone->bi_size); ++ bio_put(clone); ++ return NULL; ++ } ++ } ++ } else { ++ /* ++ * The block layer might modify the bvec array, so always ++ * copy the required bvecs because we need the original ++ * one in order to decrypt the whole bio data *afterwards*. ++ */ ++ clone = bio_alloc(GFP_NOIO, bio_segments(bio)); ++ if (clone) { ++ clone->bi_idx = 0; ++ clone->bi_vcnt = bio_segments(bio); ++ clone->bi_size = bio->bi_size; ++ memcpy(clone->bi_io_vec, bio_iovec(bio), ++ sizeof(struct bio_vec) * clone->bi_vcnt); ++ } ++ } ++ ++ if (!clone) ++ return NULL; ++ ++ clone->bi_private = io; ++ clone->bi_end_io = oxcrypt_endio; ++ clone->bi_bdev = cc->dev->bdev; ++ clone->bi_sector = cc->start + sector; ++ clone->bi_rw = bio->bi_rw; ++ ++ return clone; ++} ++ ++static int oxcrypt_map(struct dm_target *ti, struct bio *bio, ++ union map_info *map_context) ++{ ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) ti->private; ++ struct oxcrypt_io *io = mempool_alloc(cc->io_pool, GFP_NOIO); ++ struct convert_context ctx; ++ struct bio *clone; ++ unsigned int remaining = bio->bi_size; ++ sector_t sector = bio->bi_sector - ti->begin; ++ unsigned int bvec_idx = 0; ++ ++ io->target = ti; ++ io->bio = bio; ++ io->first_clone = NULL; ++ io->error = 0; ++ atomic_set(&io->pending, 1); /* hold a reference */ ++ ++ if (bio_data_dir(bio) == WRITE) ++ oxcrypt_convert_init(cc, &ctx, NULL, bio, sector, 1); ++ ++ /* ++ * The allocated buffers can be smaller than the whole bio, ++ * so repeat the whole process until all the data can be handled. ++ */ ++ while (remaining) { ++ clone = oxcrypt_clone(cc, io, bio, sector, &bvec_idx, &ctx); ++ if (!clone) ++ goto cleanup; ++ ++ if (!io->first_clone) { ++ /* ++ * hold a reference to the first clone, because it ++ * holds the bio_vec array and that can't be freed ++ * before all other clones are released ++ */ ++ bio_get(clone); ++ io->first_clone = clone; ++ } ++ atomic_inc(&io->pending); ++ ++ remaining -= clone->bi_size; ++ sector += bio_sectors(clone); ++ ++ generic_make_request(clone); ++ ++ /* out of memory -> run queues */ ++ if (remaining) ++ congestion_wait(bio_data_dir(clone), HZ/100); ++ } ++ ++ /* drop reference, clones could have returned before we reach this */ ++ dec_pending(io, 0); ++ return 0; ++ ++cleanup: ++ if (io->first_clone) { ++ dec_pending(io, -ENOMEM); ++ return 0; ++ } ++ ++ /* if no bio has been dispatched yet, we can directly return the error */ ++ mempool_free(io, cc->io_pool); ++ return -ENOMEM; ++} ++ ++static int oxcrypt_status(struct dm_target *ti, status_type_t type, ++ char *result, unsigned int maxlen) ++{ ++ struct oxcrypt_config *cc = (struct oxcrypt_config *) ti->private; ++ char buffer[32]; ++ const char *cipher; ++ const char *chainmode = NULL; ++ unsigned int sz = 0; ++ ++ switch (type) { ++ case STATUSTYPE_INFO: ++ result[0] = '\0'; ++ break; ++ ++ case STATUSTYPE_TABLE: ++ cipher = "AES"; ++ ++ chainmode = "ecb"; ++ ++ DMEMIT("%s-%s ", cipher, chainmode); ++ ++ oxcrypt_encode_key(result + sz, cc->key, OX800DPE_KEYSIZE); ++ sz += OX800DPE_KEYSIZE << 1; ++ ++ format_dev_t(buffer, cc->dev->bdev->bd_dev); ++ DMEMIT(" %llu %s %llu", (unsigned long long)cc->iv_offset, ++ buffer, (unsigned long long)cc->start); ++ break; ++ } ++ return 0; ++} ++ ++static struct target_type oxcrypt_target = { ++ .name = "ox-crypt", ++ .version= {1, 1, 0}, ++ .module = THIS_MODULE, ++ .ctr = oxcrypt_ctr, ++ .dtr = oxcrypt_dtr, ++ .map = oxcrypt_map, ++ .status = oxcrypt_status, ++}; ++ ++static int __init dm_oxcrypt_init(void) ++{ ++ int r; ++ ++ _oxcrypt_io_pool = kmem_cache_create("dm-ox-oxcrypt_io", ++ sizeof(struct oxcrypt_io), ++ 0, 0, NULL); ++ if (!_oxcrypt_io_pool) ++ return -ENOMEM; ++ ++ _kcryptd_workqueue = create_workqueue("kcryptd"); ++ if (!_kcryptd_workqueue) { ++ r = -ENOMEM; ++ DMERR("couldn't create kcryptd"); ++ goto bad1; ++ } ++ ++ r = dm_register_target(&oxcrypt_target); ++ if (r < 0) { ++ DMERR("register failed %d", r); ++ goto bad2; ++ } ++ ++ return 0; ++ ++bad2: ++ destroy_workqueue(_kcryptd_workqueue); ++bad1: ++ kmem_cache_destroy(_oxcrypt_io_pool); ++ return r; ++} ++ ++static void __exit dm_oxcrypt_exit(void) ++{ ++ int r = dm_unregister_target(&oxcrypt_target); ++ ++ if (r < 0) ++ DMERR("unregister failed %d", r); ++ ++ destroy_workqueue(_kcryptd_workqueue); ++ kmem_cache_destroy(_oxcrypt_io_pool); ++} ++ ++module_init(dm_oxcrypt_init); ++module_exit(dm_oxcrypt_exit); ++ ++MODULE_AUTHOR("Oxford Semiconductor based on work of Christophe Saout"); ++MODULE_DESCRIPTION(DM_NAME " target for hardware encryption / decryption"); ++MODULE_LICENSE("GPL"); +diff -Nurd linux-2.6.24/drivers/md/raid1.c linux-2.6.24-oxe810/drivers/md/raid1.c +--- linux-2.6.24/drivers/md/raid1.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/md/raid1.c 2008-06-11 17:50:20.000000000 +0200 +@@ -34,6 +34,12 @@ + #include "dm-bio-list.h" + #include <linux/raid/raid1.h> + #include <linux/raid/bitmap.h> ++#ifdef CONFIG_SATA_OX800 ++#include <asm/arch/sata.h> ++#endif ++#ifdef CONFIG_SATA_OX810 ++#include <asm/arch/ox810sata.h> ++#endif + + #define DEBUG 0 + #if DEBUG +@@ -67,6 +73,79 @@ + return r1_bio; + } + ++/** ++ * Assesses if the current raid configuration is suitable for implementation ++ * by the raid HW, if so, will enable it ++ */ ++static void raid1_hw_raidable(mddev_t *mddev) ++{ ++ mdk_rdev_t *rdev0; ++ mdk_rdev_t *rdev1; ++ conf_t *conf = mddev_to_conf(mddev); ++ ++ /*default to SW RAID */ ++ conf->hw_raid1_settings = 0; ++ ++#if defined(CONFIG_SATA_OX800) || defined(CONFIG_SATA_OX810) ++ /* if this drive is suitable for HW raid then enable it */ ++ if (mddev->raid_disks != 2) { ++ printk(KERN_NOTICE"raid1 not hw raidable %d disks (needs to be 2)\n",mddev->raid_disks); ++ return; ++ } ++ ++ rdev0 = rcu_dereference(conf->mirrors[0].rdev); ++ rdev1 = rcu_dereference(conf->mirrors[1].rdev); ++ ++ /* are there two working disks */ ++ if (!rdev0 || ++ !rdev1 || ++ test_bit(Faulty, &rdev0->flags) || ++ test_bit(Faulty, &rdev1->flags) ) { ++ printk(KERN_NOTICE"raid1 not hw raidable, needs two working disks.\n"); ++ return; ++ } ++ ++ if (!rdev0->bdev || ++ !rdev1->bdev || ++ !rdev0->bdev->bd_part || ++ !rdev1->bdev->bd_part ) { ++ printk(KERN_NOTICE"raid1 not hw raidable, mirrors not ready\n"); ++ return; ++ } ++ ++ if (rdev0->bdev->bd_part->start_sect != ++ rdev1->bdev->bd_part->start_sect) { ++ printk(KERN_NOTICE"raid1 not hw raidable, partition start sectors differ %lu, %lu\n", ++ rdev0->bdev->bd_part->start_sect, ++ rdev1->bdev->bd_part->start_sect); ++ return; ++ } ++ ++ if (!rdev0->bdev->bd_disk || ++ !rdev0->bdev->bd_disk->queue || ++ (hipoxsata_get_port_no(rdev0->bdev->bd_disk->queue) < 0)) { ++ printk(KERN_NOTICE"raid1 not hw raidable, RAID disk 0 not on internal SATA port.\n"); ++ return; ++ } ++ ++ if (!rdev1->bdev->bd_disk || ++ !rdev1->bdev->bd_disk->queue || ++ (hipoxsata_get_port_no(rdev1->bdev->bd_disk->queue) < 0)) { ++ printk(KERN_NOTICE"raid1 not hw raidable, RAID disk 1 not on internal SATA port.\n"); ++ return; ++ } ++ ++ /* cannot mix 28 and 48-bit LBA devices */ ++ if (!hipoxsata_LBA_schemes_compatible()) { ++ printk(KERN_NOTICE"raid0 not hw raidable, disks need to use same LBA size (28 vs 48)\n"); ++ return; ++ } ++ ++ conf->hw_raid1_settings = HIPOXSATA_RAID1; ++ printk(KERN_NOTICE"raid1 using hardware RAID 0x%08x\n",conf->hw_raid1_settings); ++#endif /*CONFIG_SCSI_OX800SATA*/ ++} ++ + static void r1bio_pool_free(void *r1_bio, void *data) + { + kfree(r1_bio); +@@ -325,9 +404,29 @@ + r1_bio->bios[mirror] = NULL; + to_put = bio; + if (!uptodate) { ++#if defined(CONFIG_SATA_OX800) || defined(CONFIG_SATA_OX810) ++ if ((mirror == 0) && (bio->bi_raid)) { ++ /* command was sent to part 0 for both drives, need to find ++ * which drive caused the error */ ++ int device = hipoxsata_RAID_faults(); ++ ++ /* it's unlikely, but both disks could fail at once */ ++ if (device & 1) md_error(r1_bio->mddev, conf->mirrors[0].rdev); ++ if (device & 2) md_error(r1_bio->mddev, conf->mirrors[1].rdev); ++ ++ /* an I/O failed, we can't clear the bitmap */ ++ set_bit(R1BIO_Degraded, &r1_bio->state); ++ ++ if (!(device & 3)) ++ set_bit(R1BIO_Uptodate, &r1_bio->state); ++ } else { ++#endif // CONFIG_SCSI_OX800SATA + md_error(r1_bio->mddev, conf->mirrors[mirror].rdev); + /* an I/O failed, we can't clear the bitmap */ + set_bit(R1BIO_Degraded, &r1_bio->state); ++#if defined(CONFIG_SATA_OX800) || defined(CONFIG_SATA_OX810) ++ } ++#endif // CONFIG_SCSI_OX800SATA + } else + /* + * Set R1BIO_Uptodate in our master bio, so that +@@ -824,6 +923,53 @@ + } + #endif + rcu_read_lock(); ++ ++ /* start of oxsemi hw raid code */ ++ if ((rcu_dereference(conf->mirrors[0].rdev)) && ++ (rcu_dereference(conf->mirrors[1].rdev)) && ++ !test_bit(Faulty, &rcu_dereference(conf->mirrors[0].rdev)->flags) && ++ !test_bit(Faulty, &rcu_dereference(conf->mirrors[1].rdev)->flags) && ++ (conf->hw_raid1_settings) ) ++ { ++ struct bio *mbio; ++ ++ rdev = rcu_dereference(conf->mirrors[0].rdev); ++ atomic_inc(&rdev->nr_pending); ++ r1_bio->bios[0] = bio; ++ targets++; ++ ++ rcu_read_unlock(); ++ ++ /* do behind I/O ? */ ++ if (bitmap && ++ atomic_read(&bitmap->behind_writes) < bitmap->max_write_behind && ++ (behind_pages = alloc_behind_pages(bio)) != NULL) ++ set_bit(R1BIO_BehindIO, &r1_bio->state); ++ ++ atomic_set(&r1_bio->remaining, 0); ++ atomic_set(&r1_bio->behind_remaining, 0); ++ ++ do_barriers = bio_barrier(bio); ++ if (do_barriers) ++ set_bit(R1BIO_Barrier, &r1_bio->state); ++ ++ bio_list_init(&bl); ++ ++ mbio = bio_clone(bio, GFP_NOIO); ++ r1_bio->bios[0] = mbio; ++ ++ mbio->bi_sector = r1_bio->sector + conf->mirrors[0].rdev->data_offset; ++ mbio->bi_bdev = conf->mirrors[0].rdev->bdev; ++ mbio->bi_end_io = raid1_end_write_request; ++ mbio->bi_rw = WRITE | do_barriers | do_sync; ++ mbio->bi_private = r1_bio; ++ mbio->bi_raid = conf->hw_raid1_settings ; ++ ++ atomic_inc(&r1_bio->remaining); ++ ++ bio_list_add(&bl, mbio); ++ /* end of hw_raid code */ ++ } else { + for (i = 0; i < disks; i++) { + if ((rdev=rcu_dereference(conf->mirrors[i].rdev)) != NULL && + !test_bit(Faulty, &rdev->flags)) { +@@ -896,6 +1042,8 @@ + + bio_list_add(&bl, mbio); + } ++ } ++ + kfree(behind_pages); /* the behind pages are attached to the bios now */ + + bitmap_startwrite(bitmap, bio->bi_sector, r1_bio->sectors, +@@ -969,6 +1117,9 @@ + printk(KERN_ALERT "raid1: Disk failure on %s, disabling device. \n" + " Operation continuing on %d devices\n", + bdevname(rdev->bdev,b), conf->raid_disks - mddev->degraded); ++ ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); + } + + static void print_conf(conf_t *conf) +@@ -1027,6 +1178,9 @@ + } + } + ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); ++ + print_conf(conf); + return 0; + } +@@ -1064,6 +1218,9 @@ + break; + } + ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); ++ + print_conf(conf); + return found; + } +@@ -1092,6 +1249,8 @@ + } + } + abort: ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); + + print_conf(conf); + return err; +@@ -1719,6 +1878,7 @@ + bio->bi_size = 0; + bio->bi_end_io = NULL; + bio->bi_private = NULL; ++ bio->bi_raid = 0; + + rdev = rcu_dereference(conf->mirrors[i].rdev); + if (rdev == NULL || +@@ -1966,6 +2126,9 @@ + */ + mddev->array_size = mddev->size; + ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); ++ + mddev->queue->unplug_fn = raid1_unplug; + mddev->queue->backing_dev_info.congested_fn = raid1_congested; + mddev->queue->backing_dev_info.congested_data = mddev; +@@ -2035,6 +2198,9 @@ + } + mddev->size = mddev->array_size; + mddev->resync_max_sectors = sectors; ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); ++ + return 0; + } + +@@ -2138,6 +2304,9 @@ + mddev->delta_disks = 0; + + conf->last_used = 0; /* just make sure it is in-range */ ++ /* check to see if this new configuration is supported by hardware RAID */ ++ raid1_hw_raidable(mddev); ++ + lower_barrier(conf); + + set_bit(MD_RECOVERY_NEEDED, &mddev->recovery); +diff -Nurd linux-2.6.24/drivers/media/video/cx23885/cx23885-cards.c linux-2.6.24-oxe810/drivers/media/video/cx23885/cx23885-cards.c +--- linux-2.6.24/drivers/media/video/cx23885/cx23885-cards.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/media/video/cx23885/cx23885-cards.c 2008-06-11 17:48:59.000000000 +0200 +@@ -138,6 +138,10 @@ + .card = CX23885_BOARD_HAUPPAUGE_HVR1800, + },{ + .subvendor = 0x0070, ++ .subdevice = 0x7809, ++ .card = CX23885_BOARD_HAUPPAUGE_HVR1800, ++ },{ ++ .subvendor = 0x0070, + .subdevice = 0x7911, + .card = CX23885_BOARD_HAUPPAUGE_HVR1250, + },{ +diff -Nurd linux-2.6.24/drivers/message/fusion/mptsas.c linux-2.6.24-oxe810/drivers/message/fusion/mptsas.c +--- linux-2.6.24/drivers/message/fusion/mptsas.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/message/fusion/mptsas.c 2008-06-11 17:49:11.000000000 +0200 +@@ -1699,6 +1699,11 @@ + if (error) + goto out_free_consistent; + ++ if (!buffer->NumPhys) { ++ error = -ENODEV; ++ goto out_free_consistent; ++ } ++ + /* save config data */ + port_info->num_phys = buffer->NumPhys; + port_info->phy_info = kcalloc(port_info->num_phys, +diff -Nurd linux-2.6.24/drivers/net/Kconfig linux-2.6.24-oxe810/drivers/net/Kconfig +--- linux-2.6.24/drivers/net/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/Kconfig 2008-06-11 17:50:11.000000000 +0200 +@@ -2368,6 +2368,14 @@ + To compile this driver as a module, choose M here. The module + will be called atl1. + ++config SYNOPSYS_GMAC ++ tristate "Synopsys Gigabit MAC" ++ select CRC32 ++ select MII ++ depends on ARCH_HIPOX ++ help ++ Driver for the Synopsys Gigabit MAC ++ + endif # NETDEV_1000 + + # +diff -Nurd linux-2.6.24/drivers/net/bonding/bond_main.c linux-2.6.24-oxe810/drivers/net/bonding/bond_main.c +--- linux-2.6.24/drivers/net/bonding/bond_main.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/bonding/bond_main.c 2008-06-11 17:50:00.000000000 +0200 +@@ -4883,14 +4883,16 @@ + down_write(&bonding_rwsem); + + /* Check to see if the bond already exists. */ +- list_for_each_entry_safe(bond, nxt, &bond_dev_list, bond_list) +- if (strnicmp(bond->dev->name, name, IFNAMSIZ) == 0) { +- printk(KERN_ERR DRV_NAME ++ if (name) { ++ list_for_each_entry_safe(bond, nxt, &bond_dev_list, bond_list) ++ if (strnicmp(bond->dev->name, name, IFNAMSIZ) == 0) { ++ printk(KERN_ERR DRV_NAME + ": cannot add bond %s; it already exists\n", +- name); +- res = -EPERM; +- goto out_rtnl; +- } ++ name); ++ res = -EPERM; ++ goto out_rtnl; ++ } ++ } + + bond_dev = alloc_netdev(sizeof(struct bonding), name ? name : "", + ether_setup); +diff -Nurd linux-2.6.24/drivers/net/dl2k.h linux-2.6.24-oxe810/drivers/net/dl2k.h +--- linux-2.6.24/drivers/net/dl2k.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/dl2k.h 2008-06-11 17:50:11.000000000 +0200 +@@ -388,8 +388,8 @@ + MII_MSSR_CFG_RES = 0x4000, + MII_MSSR_LOCAL_RCV_STATUS = 0x2000, + MII_MSSR_REMOTE_RCVR = 0x1000, +- MII_MSSR_LP_1000BT_HD = 0x0800, +- MII_MSSR_LP_1000BT_FD = 0x0400, ++ MII_MSSR_LP_1000BT_FD = 0x0800, ++ MII_MSSR_LP_1000BT_HD = 0x0400, + MII_MSSR_IDLE_ERR_COUNT = 0x00ff, + }; + +diff -Nurd linux-2.6.24/drivers/net/e1000e/netdev.c linux-2.6.24-oxe810/drivers/net/e1000e/netdev.c +--- linux-2.6.24/drivers/net/e1000e/netdev.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/e1000e/netdev.c 2008-06-11 17:50:07.000000000 +0200 +@@ -1686,6 +1686,9 @@ + else + rctl |= E1000_RCTL_LPE; + ++ /* Enable hardware CRC frame stripping */ ++ rctl |= E1000_RCTL_SECRC; ++ + /* Setup buffer sizes */ + rctl &= ~E1000_RCTL_SZ_4096; + rctl |= E1000_RCTL_BSEX; +@@ -1751,9 +1754,6 @@ + + /* Enable Packet split descriptors */ + rctl |= E1000_RCTL_DTYP_PS; +- +- /* Enable hardware CRC frame stripping */ +- rctl |= E1000_RCTL_SECRC; + + psrctl |= adapter->rx_ps_bsize0 >> + E1000_PSRCTL_BSIZE0_SHIFT; +diff -Nurd linux-2.6.24/drivers/net/forcedeth.c linux-2.6.24-oxe810/drivers/net/forcedeth.c +--- linux-2.6.24/drivers/net/forcedeth.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/forcedeth.c 2008-06-11 17:50:11.000000000 +0200 +@@ -5593,35 +5593,35 @@ + }, + { /* MCP77 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_32), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP77 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_33), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP77 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_34), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP77 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_35), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP79 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_36), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP79 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_37), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP79 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_38), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + { /* MCP79 Ethernet Controller */ + PCI_DEVICE(PCI_VENDOR_ID_NVIDIA, PCI_DEVICE_ID_NVIDIA_NVENET_39), +- .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT, ++ .driver_data = DEV_NEED_TIMERIRQ|DEV_NEED_LINKTIMER|DEV_HAS_CHECKSUM|DEV_HAS_HIGH_DMA|DEV_HAS_MSI|DEV_HAS_POWER_CNTRL|DEV_HAS_PAUSEFRAME_TX|DEV_HAS_STATISTICS_V2|DEV_HAS_TEST_EXTENDED|DEV_HAS_MGMT_UNIT|DEV_HAS_CORRECT_MACADDR, + }, + {0,}, + }; +diff -Nurd linux-2.6.24/drivers/net/macb.c linux-2.6.24-oxe810/drivers/net/macb.c +--- linux-2.6.24/drivers/net/macb.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/macb.c 2008-06-11 17:50:11.000000000 +0200 +@@ -148,7 +148,7 @@ + + if (phydev->duplex) + reg |= MACB_BIT(FD); +- if (phydev->speed) ++ if (phydev->speed == SPEED_100) + reg |= MACB_BIT(SPD); + + macb_writel(bp, NCFGR, reg); +diff -Nurd linux-2.6.24/drivers/net/mii.c linux-2.6.24-oxe810/drivers/net/mii.c +--- linux-2.6.24/drivers/net/mii.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/mii.c 2008-06-11 17:50:11.000000000 +0200 +@@ -46,11 +46,13 @@ + u32 advert, bmcr, lpa, nego; + u32 advert2 = 0, bmcr2 = 0, lpa2 = 0; + ++ int supports_gmii = mii->mdio_read(dev, mii->phy_id, MII_BMSR) & BMSR_ESTATEN; ++ + ecmd->supported = + (SUPPORTED_10baseT_Half | SUPPORTED_10baseT_Full | + SUPPORTED_100baseT_Half | SUPPORTED_100baseT_Full | + SUPPORTED_Autoneg | SUPPORTED_TP | SUPPORTED_MII); +- if (mii->supports_gmii) ++ if (supports_gmii) + ecmd->supported |= SUPPORTED_1000baseT_Half | + SUPPORTED_1000baseT_Full; + +@@ -65,7 +67,7 @@ + + ecmd->advertising = ADVERTISED_TP | ADVERTISED_MII; + advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE); +- if (mii->supports_gmii) ++ if (supports_gmii) + advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); + + if (advert & ADVERTISE_10HALF) +@@ -83,7 +85,7 @@ + + bmcr = mii->mdio_read(dev, mii->phy_id, MII_BMCR); + lpa = mii->mdio_read(dev, mii->phy_id, MII_LPA); +- if (mii->supports_gmii) { ++ if (supports_gmii) { + bmcr2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); + lpa2 = mii->mdio_read(dev, mii->phy_id, MII_STAT1000); + } +@@ -132,6 +134,8 @@ + { + struct net_device *dev = mii->dev; + ++ int supports_gmii = mii->mdio_read(dev, mii->phy_id, MII_BMSR) & BMSR_ESTATEN; ++ + if (ecmd->speed != SPEED_10 && + ecmd->speed != SPEED_100 && + ecmd->speed != SPEED_1000) +@@ -146,7 +150,7 @@ + return -EINVAL; + if (ecmd->autoneg != AUTONEG_DISABLE && ecmd->autoneg != AUTONEG_ENABLE) + return -EINVAL; +- if ((ecmd->speed == SPEED_1000) && (!mii->supports_gmii)) ++ if ((ecmd->speed == SPEED_1000) && (!supports_gmii)) + return -EINVAL; + + /* ignore supported, maxtxpkt, maxrxpkt */ +@@ -166,7 +170,7 @@ + /* advertise only what has been requested */ + advert = mii->mdio_read(dev, mii->phy_id, MII_ADVERTISE); + tmp = advert & ~(ADVERTISE_ALL | ADVERTISE_100BASE4); +- if (mii->supports_gmii) { ++ if (supports_gmii) { + advert2 = mii->mdio_read(dev, mii->phy_id, MII_CTRL1000); + tmp2 = advert2 & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL); + } +@@ -178,7 +182,7 @@ + tmp |= ADVERTISE_100HALF; + if (ecmd->advertising & ADVERTISED_100baseT_Full) + tmp |= ADVERTISE_100FULL; +- if (mii->supports_gmii) { ++ if (supports_gmii) { + if (ecmd->advertising & ADVERTISED_1000baseT_Half) + tmp2 |= ADVERTISE_1000HALF; + if (ecmd->advertising & ADVERTISED_1000baseT_Full) +@@ -188,7 +192,7 @@ + mii->mdio_write(dev, mii->phy_id, MII_ADVERTISE, tmp); + mii->advertising = tmp; + } +- if ((mii->supports_gmii) && (advert2 != tmp2)) ++ if (advert2 != tmp2) + mii->mdio_write(dev, mii->phy_id, MII_CTRL1000, tmp2); + + /* turn on autonegotiation, and force a renegotiate */ +@@ -312,6 +316,7 @@ + unsigned int old_carrier, new_carrier; + int advertise, lpa, media, duplex; + int lpa2 = 0; ++ int supports_gmii = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_ESTATEN; + + /* if forced media, go no further */ + if (mii->force_media) +@@ -348,7 +353,7 @@ + mii->advertising = advertise; + } + lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA); +- if (mii->supports_gmii) ++ if (supports_gmii) + lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000); + + /* figure out media and duplex from advertise and LPA values */ +@@ -373,6 +378,148 @@ + return 0; /* duplex did not change */ + } + ++ ++unsigned int mii_check_media_ex( ++ struct mii_if_info *mii, ++ unsigned int ok_to_print, ++ unsigned int init_media, ++ int *has_gigabit_changed, ++ int *has_pause_changed, ++ void (*link_state_change_callback)(int link_state, void* arg), ++ void *link_state_change_arg) ++{ ++ unsigned int old_carrier, new_carrier; ++ int advertise, lpa; ++ unsigned int negotiated_10_100; ++ int advertise2 = 0, lpa2 = 0; ++ unsigned int negotiated_1000; ++ int duplex = 0; ++ int using_100 = 0; ++ int using_1000 = 0; ++ int using_pause = 0; ++ int duplex_changed = 0; ++ int changed_100 = 0; ++ int changed_1000 = 0; ++ int changed_pause = 0; ++ int supports_gmii = mii->mdio_read(mii->dev, mii->phy_id, MII_BMSR) & BMSR_ESTATEN; ++ ++ // Initialise user's locations for returned gigabit and pause changed values ++ // to no-change ++ *has_gigabit_changed = 0; ++ *has_pause_changed = 0; ++ ++ /* if forced media, go no further */ ++ if (mii->force_media) ++ return 0; /* duplex did not change */ ++ ++ /* check current and old link status */ ++ old_carrier = netif_carrier_ok(mii->dev) ? 1 : 0; ++ new_carrier = (unsigned int) mii_link_ok(mii); ++ ++ /* if carrier state did not change, this is a "bounce", ++ * just exit as everything is already set correctly ++ */ ++ if ((!init_media) && (old_carrier == new_carrier)) ++ return 0; /* duplex did not change */ ++ ++ /* no carrier, nothing much to do */ ++ if (!new_carrier) { ++ netif_carrier_off(mii->dev); ++ if (ok_to_print) { ++ printk(KERN_INFO "%s: link down\n", mii->dev->name); ++ } ++ link_state_change_callback(0, link_state_change_arg); ++ return 0; /* duplex did not change */ ++ } ++ ++ /* ++ * we have carrier, see who's on the other end ++ */ ++ netif_carrier_on(mii->dev); ++ ++ /* Get our advertise values */ ++ if ((!init_media) && (mii->advertising)) ++ advertise = mii->advertising; ++ else { ++ advertise = mii->mdio_read(mii->dev, mii->phy_id, MII_ADVERTISE); ++ mii->advertising = advertise; ++ } ++//printk("mii_check_media_ex() MII_ADVERTISE read as 0x%08x\n", advertise); ++ if (supports_gmii) { ++ advertise2 = mii->mdio_read(mii->dev, mii->phy_id, MII_CTRL1000); ++//printk("mii_check_media_ex() MII_CTRL1000 read as 0x%08x\n", advertise2); ++ } ++ ++ /* Get link partner advertise values */ ++ lpa = mii->mdio_read(mii->dev, mii->phy_id, MII_LPA); ++//printk("mii_check_media_ex() MII_LPA read as 0x%08x\n", lpa); ++ if (supports_gmii) { ++ lpa2 = mii->mdio_read(mii->dev, mii->phy_id, MII_STAT1000); ++//printk("mii_check_media_ex() MII_STAT1000 read as 0x%08x\n", lpa2); ++ } ++ ++//printk("Us pause = %d, async pause = %d\n", advertise & ADVERTISE_PAUSE_CAP, advertise & ADVERTISE_PAUSE_ASYM); ++//printk("Link partner pause = %d, async pause = %d\n", lpa & LPA_PAUSE_CAP, lpa & LPA_PAUSE_ASYM); ++ ++ /* Determine negotiated mode/duplex from our and link partner's advertise values */ ++ negotiated_10_100 = mii_nway_result(lpa & advertise); ++ negotiated_1000 = mii_nway_result_1000(lpa2, advertise2); ++ ++ /* Determine the rate we're operating at */ ++ if (negotiated_1000 & (LPA_1000FULL | LPA_1000HALF)) { ++ using_1000 = 1; ++ duplex = (negotiated_1000 & LPA_1000FULL) ? 1 : 0; ++ } else { ++ if (negotiated_10_100 & (LPA_100FULL | LPA_100HALF)) { ++ using_100 = 1; ++ } ++ duplex = (negotiated_10_100 & ADVERTISE_FULL) ? 1 : 0; ++ } ++ ++ /* Does link partner advertise that we can send pause frames to it? */ ++ using_pause = (lpa & LPA_PAUSE_CAP) ? 1 : 0; ++ ++ if (ok_to_print) ++ printk(KERN_INFO "%s: link up, %sMbps, %s-duplex, %s pause, lpa 0x%04X\n", ++ mii->dev->name, ++ using_1000 ? "1000" : ++ using_100 ? "100" : "10", ++ duplex ? "full" : "half", ++ using_pause ? "using" : "not using", ++ lpa); ++ ++ link_state_change_callback(1, link_state_change_arg); ++ ++ if (mii->full_duplex != duplex) { ++ duplex_changed = 1; ++ } ++ if (mii->using_100 != using_100) { ++ changed_100 = 1; ++ } ++ if (mii->using_1000 != using_1000) { ++ changed_1000 = 1; ++ } ++ if (mii->using_pause != using_pause) { ++ changed_pause = 1; ++ } ++ ++ if (init_media || changed_100 || changed_1000 || changed_pause || duplex_changed) { ++ mii->full_duplex = duplex; ++ mii->using_100 = using_100; ++ mii->using_1000 = using_1000; ++ mii->using_pause = using_pause; ++ if (init_media || changed_1000) { ++ *has_gigabit_changed = 1; ++ } ++ if (init_media || changed_pause) { ++ *has_pause_changed = 1; ++ } ++ return init_media || duplex_changed; ++ } ++ ++ return 0; /* duplex did not change */ ++} ++ + /** + * generic_mii_ioctl - main MII ioctl interface + * @mii_if: the MII interface +@@ -465,6 +612,7 @@ + EXPORT_SYMBOL(mii_ethtool_sset); + EXPORT_SYMBOL(mii_check_link); + EXPORT_SYMBOL(mii_check_media); ++EXPORT_SYMBOL(mii_check_media_ex); + EXPORT_SYMBOL(mii_check_gmii_support); + EXPORT_SYMBOL(generic_mii_ioctl); + +diff -Nurd linux-2.6.24/drivers/net/niu.c linux-2.6.24-oxe810/drivers/net/niu.c +--- linux-2.6.24/drivers/net/niu.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/niu.c 2008-06-11 17:50:11.000000000 +0200 +@@ -33,8 +33,8 @@ + + #define DRV_MODULE_NAME "niu" + #define PFX DRV_MODULE_NAME ": " +-#define DRV_MODULE_VERSION "0.6" +-#define DRV_MODULE_RELDATE "January 5, 2008" ++#define DRV_MODULE_VERSION "0.7" ++#define DRV_MODULE_RELDATE "February 18, 2008" + + static char version[] __devinitdata = + DRV_MODULE_NAME ".c:v" DRV_MODULE_VERSION " (" DRV_MODULE_RELDATE ")\n"; +@@ -1616,12 +1616,13 @@ + if (index >= niu_num_alt_addr(np)) + return -EINVAL; + +- if (np->flags & NIU_FLAGS_XMAC) ++ if (np->flags & NIU_FLAGS_XMAC) { + reg = XMAC_ADDR_CMPEN; +- else ++ mask = 1 << index; ++ } else { + reg = BMAC_ADDR_CMPEN; +- +- mask = 1 << index; ++ mask = 1 << (index + 1); ++ } + + val = nr64_mac(reg); + if (on) +@@ -5147,7 +5148,12 @@ + index++; + } + } else { +- for (i = 0; i < niu_num_alt_addr(np); i++) { ++ int alt_start; ++ if (np->flags & NIU_FLAGS_XMAC) ++ alt_start = 0; ++ else ++ alt_start = 1; ++ for (i = alt_start; i < niu_num_alt_addr(np); i++) { + err = niu_enable_alt_mac(np, i, 0); + if (err) + printk(KERN_WARNING PFX "%s: Error %d " +diff -Nurd linux-2.6.24/drivers/net/niu.h linux-2.6.24-oxe810/drivers/net/niu.h +--- linux-2.6.24/drivers/net/niu.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/niu.h 2008-06-11 17:50:11.000000000 +0200 +@@ -499,7 +499,7 @@ + #define BMAC_ADDR2 0x00110UL + #define BMAC_ADDR2_ADDR2 0x000000000000ffffULL + +-#define BMAC_NUM_ALT_ADDR 7 ++#define BMAC_NUM_ALT_ADDR 6 + + #define BMAC_ALT_ADDR0(NUM) (0x00118UL + (NUM)*0x18UL) + #define BMAC_ALT_ADDR0_ADDR0 0x000000000000ffffULL +diff -Nurd linux-2.6.24/drivers/net/pcmcia/smc91c92_cs.c linux-2.6.24-oxe810/drivers/net/pcmcia/smc91c92_cs.c +--- linux-2.6.24/drivers/net/pcmcia/smc91c92_cs.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/pcmcia/smc91c92_cs.c 2008-06-11 17:50:04.000000000 +0200 +@@ -559,8 +559,16 @@ + + /* Read the station address from the CIS. It is stored as the last + (fourth) string in the Version 1 Version/ID tuple. */ +- if (link->prod_id[3]) { +- station_addr = link->prod_id[3]; ++ tuple->DesiredTuple = CISTPL_VERS_1; ++ if (first_tuple(link, tuple, parse) != CS_SUCCESS) { ++ rc = -1; ++ goto free_cfg_mem; ++ } ++ /* Ugh -- the EM1144 card has two VERS_1 tuples!?! */ ++ if (next_tuple(link, tuple, parse) != CS_SUCCESS) ++ first_tuple(link, tuple, parse); ++ if (parse->version_1.ns > 3) { ++ station_addr = parse->version_1.str + parse->version_1.ofs[3]; + if (cvt_ascii_address(dev, station_addr) == 0) { + rc = 0; + goto free_cfg_mem; +diff -Nurd linux-2.6.24/drivers/net/sky2.c linux-2.6.24-oxe810/drivers/net/sky2.c +--- linux-2.6.24/drivers/net/sky2.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/sky2.c 2008-06-11 17:50:11.000000000 +0200 +@@ -621,6 +621,7 @@ + static const u32 phy_power[] = { PCI_Y2_PHY1_POWD, PCI_Y2_PHY2_POWD }; + static const u32 coma_mode[] = { PCI_Y2_PHY1_COMA, PCI_Y2_PHY2_COMA }; + ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_ON); + reg1 = sky2_pci_read32(hw, PCI_DEV_REG1); + /* Turn on/off phy power saving */ + if (onoff) +@@ -632,7 +633,8 @@ + reg1 |= coma_mode[port]; + + sky2_pci_write32(hw, PCI_DEV_REG1, reg1); +- reg1 = sky2_pci_read32(hw, PCI_DEV_REG1); ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_OFF); ++ sky2_pci_read32(hw, PCI_DEV_REG1); + + udelay(100); + } +@@ -1412,6 +1414,7 @@ + imask |= portirq_msk[port]; + sky2_write32(hw, B0_IMSK, imask); + ++ sky2_set_multicast(dev); + return 0; + + err_out: +@@ -2426,6 +2429,7 @@ + if (status & (Y2_IS_MST_ERR | Y2_IS_IRQ_STAT)) { + u16 pci_err; + ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_ON); + pci_err = sky2_pci_read16(hw, PCI_STATUS); + if (net_ratelimit()) + dev_err(&pdev->dev, "PCI hardware error (0x%x)\n", +@@ -2433,12 +2437,14 @@ + + sky2_pci_write16(hw, PCI_STATUS, + pci_err | PCI_STATUS_ERROR_BITS); ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_OFF); + } + + if (status & Y2_IS_PCI_EXP) { + /* PCI-Express uncorrectable Error occurred */ + u32 err; + ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_ON); + err = sky2_read32(hw, Y2_CFG_AER + PCI_ERR_UNCOR_STATUS); + sky2_write32(hw, Y2_CFG_AER + PCI_ERR_UNCOR_STATUS, + 0xfffffffful); +@@ -2446,6 +2452,7 @@ + dev_err(&pdev->dev, "PCI Express error (0x%x)\n", err); + + sky2_read32(hw, Y2_CFG_AER + PCI_ERR_UNCOR_STATUS); ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_OFF); + } + + if (status & Y2_HWE_L1_MASK) +@@ -2811,6 +2818,7 @@ + } + + sky2_power_on(hw); ++ sky2_write8(hw, B2_TST_CTRL1, TST_CFG_WRITE_OFF); + + for (i = 0; i < hw->ports; i++) { + sky2_write8(hw, SK_REG(i, GMAC_LINK_CTRL), GMLC_RST_SET); +@@ -3533,8 +3541,6 @@ + err = sky2_up(dev); + if (err) + dev_close(dev); +- else +- sky2_set_multicast(dev); + } + + return err; +@@ -4368,8 +4374,6 @@ + dev_close(dev); + goto out; + } +- +- sky2_set_multicast(dev); + } + } + +diff -Nurd linux-2.6.24/drivers/net/via-velocity.c linux-2.6.24-oxe810/drivers/net/via-velocity.c +--- linux-2.6.24/drivers/net/via-velocity.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/via-velocity.c 2008-06-11 17:50:11.000000000 +0200 +@@ -72,7 +72,6 @@ + #include <linux/mii.h> + #include <linux/in.h> + #include <linux/if_arp.h> +-#include <linux/if_vlan.h> + #include <linux/ip.h> + #include <linux/tcp.h> + #include <linux/udp.h> +@@ -81,170 +80,50 @@ + + #include "via-velocity.h" + ++// Default MAC address ++static const u8 DEFAULT_MAC_ADDRESS[] = { 0x00, 0x30, 0xe0, 0x00, 0x00, 0xff }; ++static u32 mac_hi=0; ++static u32 mac_lo=0; + +-static int velocity_nics = 0; +-static int msglevel = MSG_LEVEL_INFO; +- +-/** +- * mac_get_cam_mask - Read a CAM mask +- * @regs: register block for this velocity +- * @mask: buffer to store mask +- * +- * Fetch the mask bits of the selected CAM and store them into the +- * provided mask buffer. +- */ +- +-static void mac_get_cam_mask(struct mac_regs __iomem * regs, u8 * mask) +-{ +- int i; +- +- /* Select CAM mask */ +- BYTE_REG_BITS_SET(CAMCR_PS_CAM_MASK, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +- writeb(0, ®s->CAMADDR); +- +- /* read mask */ +- for (i = 0; i < 8; i++) +- *mask++ = readb(&(regs->MARCAM[i])); +- +- /* disable CAMEN */ +- writeb(0, ®s->CAMADDR); +- +- /* Select mar */ +- BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +-} +- +- +-/** +- * mac_set_cam_mask - Set a CAM mask +- * @regs: register block for this velocity +- * @mask: CAM mask to load +- * +- * Store a new mask into a CAM +- */ +- +-static void mac_set_cam_mask(struct mac_regs __iomem * regs, u8 * mask) +-{ +- int i; +- /* Select CAM mask */ +- BYTE_REG_BITS_SET(CAMCR_PS_CAM_MASK, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +- writeb(CAMADDR_CAMEN, ®s->CAMADDR); +- +- for (i = 0; i < 8; i++) { +- writeb(*mask++, &(regs->MARCAM[i])); +- } +- /* disable CAMEN */ +- writeb(0, ®s->CAMADDR); +- +- /* Select mar */ +- BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +-} +- +-static void mac_set_vlan_cam_mask(struct mac_regs __iomem * regs, u8 * mask) +-{ +- int i; +- /* Select CAM mask */ +- BYTE_REG_BITS_SET(CAMCR_PS_CAM_MASK, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +- writeb(CAMADDR_CAMEN | CAMADDR_VCAMSL, ®s->CAMADDR); +- +- for (i = 0; i < 8; i++) { +- writeb(*mask++, &(regs->MARCAM[i])); +- } +- /* disable CAMEN */ +- writeb(0, ®s->CAMADDR); +- +- /* Select mar */ +- BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +-} +- +-/** +- * mac_set_cam - set CAM data +- * @regs: register block of this velocity +- * @idx: Cam index +- * @addr: 2 or 6 bytes of CAM data +- * +- * Load an address or vlan tag into a CAM +- */ +- +-static void mac_set_cam(struct mac_regs __iomem * regs, int idx, const u8 *addr) +-{ +- int i; +- +- /* Select CAM mask */ +- BYTE_REG_BITS_SET(CAMCR_PS_CAM_DATA, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +- idx &= (64 - 1); +- +- writeb(CAMADDR_CAMEN | idx, ®s->CAMADDR); +- +- for (i = 0; i < 6; i++) { +- writeb(*addr++, &(regs->MARCAM[i])); +- } +- BYTE_REG_BITS_ON(CAMCR_CAMWR, ®s->CAMCR); +- +- udelay(10); ++#define EXTRA_RX_SKB_SPACE 32 ++#define MAX_HW_FRAGMENTS 6 ++//#define VELOCITY_ZERO_COPY_SUPPORT ++//#define LOAD_FROM_EEPROM + +- writeb(0, ®s->CAMADDR); ++#define VELOCITY_DESC_IN_SRAM + +- /* Select mar */ +- BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +-} ++#ifdef VELOCITY_DESC_IN_SRAM ++#include <asm/arch/desc_alloc.h> ++#endif // VELOCITY_DESC_IN_SRAM + +-static void mac_set_vlan_cam(struct mac_regs __iomem * regs, int idx, +- const u8 *addr) ++/* Parse netdev kernel cmdline options */ ++static int __init do_setup(char *str) + { ++ int i; ++ int ints[5]; // Hold arg count and four args + +- /* Select CAM mask */ +- BYTE_REG_BITS_SET(CAMCR_PS_CAM_DATA, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); +- +- idx &= (64 - 1); +- +- writeb(CAMADDR_CAMEN | CAMADDR_VCAMSL | idx, ®s->CAMADDR); +- writew(*((u16 *) addr), ®s->MARCAM[0]); +- +- BYTE_REG_BITS_ON(CAMCR_CAMWR, ®s->CAMCR); +- +- udelay(10); +- +- writeb(0, ®s->CAMADDR); +- +- /* Select mar */ +- BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ get_options(str, sizeof(ints)/sizeof(int), ints); ++ for (i=1; i<=ints[0]; i++) { ++ switch (i) { ++ case 3: ++ mac_hi = ints[i]; ++ break; ++ case 4: ++ mac_lo = ints[i]; ++ break; ++ default: ++ break; ++ } ++ } ++ return 0; + } ++__setup("netdev=",do_setup); + +- +-/** +- * mac_wol_reset - reset WOL after exiting low power +- * @regs: register block of this velocity +- * +- * Called after we drop out of wake on lan mode in order to +- * reset the Wake on lan features. This function doesn't restore +- * the rest of the logic from the result of sleep/wakeup +- */ +- +-static void mac_wol_reset(struct mac_regs __iomem * regs) +-{ +- +- /* Turn off SWPTAG right after leaving power mode */ +- BYTE_REG_BITS_OFF(STICKHW_SWPTAG, ®s->STICKHW); +- /* clear sticky bits */ +- BYTE_REG_BITS_OFF((STICKHW_DS1 | STICKHW_DS0), ®s->STICKHW); +- +- BYTE_REG_BITS_OFF(CHIPGCR_FCGMII, ®s->CHIPGCR); +- BYTE_REG_BITS_OFF(CHIPGCR_FCMODE, ®s->CHIPGCR); +- /* disable force PME-enable */ +- writeb(WOLCFG_PMEOVR, ®s->WOLCFGClr); +- /* disable power-event config bit */ +- writew(0xFFFF, ®s->WOLCRClr); +- /* clear power status */ +- writew(0xFFFF, ®s->WOLSRClr); +-} ++static int velocity_nics = 0; ++static int msglevel = MSG_LEVEL_INFO; + + static int velocity_mii_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd); +-static const struct ethtool_ops velocity_ethtool_ops; ++static struct ethtool_ops velocity_ethtool_ops; + + /* + Define module options +@@ -269,6 +148,15 @@ + #define TX_DESC_DEF 64 + VELOCITY_PARAM(TxDescriptors, "Number of transmit descriptors"); + ++#define VLAN_ID_MIN 0 ++#define VLAN_ID_MAX 4095 ++#define VLAN_ID_DEF 0 ++/* VID_setting[] is used for setting the VID of NIC. ++ 0: default VID. ++ 1-4094: other VIDs. ++*/ ++VELOCITY_PARAM(VID_setting, "802.1Q VLAN ID"); ++ + #define RX_THRESH_MIN 0 + #define RX_THRESH_MAX 3 + #define RX_THRESH_DEF 0 +@@ -282,7 +170,8 @@ + + #define DMA_LENGTH_MIN 0 + #define DMA_LENGTH_MAX 7 +-#define DMA_LENGTH_DEF 0 ++#define DMA_LENGTH_100M_DEF 6 ++#define DMA_LENGTH_1000M_DEF 6 + + /* DMA_length[] is used for controlling the DMA length + 0: 8 DWORDs +@@ -294,7 +183,15 @@ + 6: SF(flush till emply) + 7: SF(flush till emply) + */ +-VELOCITY_PARAM(DMA_length, "DMA length"); ++VELOCITY_PARAM(DMA_length_100M, "DMA length 100M"); ++VELOCITY_PARAM(DMA_length_1000M, "DMA length 1000M"); ++ ++#define TAGGING_DEF 0 ++/* enable_tagging[] is used for enabling 802.1Q VID tagging. ++ 0: disable VID seeting(default). ++ 1: enable VID setting. ++*/ ++VELOCITY_PARAM(enable_tagging, "Enable 802.1Q tagging"); + + #define IP_ALIG_DEF 0 + /* IP_byte_align[] is used for IP header DWORD byte aligned +@@ -378,7 +275,7 @@ + static int velocity_open(struct net_device *dev); + static int velocity_change_mtu(struct net_device *dev, int mtu); + static int velocity_xmit(struct sk_buff *skb, struct net_device *dev); +-static int velocity_intr(int irq, void *dev_instance); ++static int velocity_intr(int irq, void *dev_instance, struct pt_regs *regs); + static void velocity_set_multi(struct net_device *dev); + static struct net_device_stats *velocity_get_stats(struct net_device *dev); + static int velocity_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); +@@ -401,25 +298,23 @@ + static u32 mii_check_media_mode(struct mac_regs __iomem * regs); + static u32 check_connection_type(struct mac_regs __iomem * regs); + static int velocity_set_media_mode(struct velocity_info *vptr, u32 mii_status); ++static void hw_set_mac_address(struct velocity_info *vptr, unsigned char* addr); ++static int set_mac_address(struct net_device *dev, void *p); + + #ifdef CONFIG_PM + + static int velocity_suspend(struct pci_dev *pdev, pm_message_t state); + static int velocity_resume(struct pci_dev *pdev); + +-static DEFINE_SPINLOCK(velocity_dev_list_lock); +-static LIST_HEAD(velocity_dev_list); +- +-#endif +- +-#if defined(CONFIG_PM) && defined(CONFIG_INET) +- + static int velocity_netdev_event(struct notifier_block *nb, unsigned long notification, void *ptr); + + static struct notifier_block velocity_inetaddr_notifier = { + .notifier_call = velocity_netdev_event, + }; + ++static DEFINE_SPINLOCK(velocity_dev_list_lock); ++static LIST_HEAD(velocity_dev_list); ++ + static void velocity_register_notifier(void) + { + register_inetaddr_notifier(&velocity_inetaddr_notifier); +@@ -430,12 +325,12 @@ + unregister_inetaddr_notifier(&velocity_inetaddr_notifier); + } + +-#else ++#else /* CONFIG_PM */ + + #define velocity_register_notifier() do {} while (0) + #define velocity_unregister_notifier() do {} while (0) + +-#endif ++#endif /* !CONFIG_PM */ + + /* + * Internal board variants. At the moment we have only one +@@ -466,7 +361,7 @@ + * a pointer a static string valid while the driver is loaded. + */ + +-static const char __devinit *get_chip_name(enum chip_type chip_id) ++static char __devinit *get_chip_name(enum chip_type chip_id) + { + int i; + for (i = 0; chip_info_table[i].name != NULL; i++) +@@ -557,11 +452,11 @@ + if (val == -1) + *opt |= (def ? flag : 0); + else if (val < 0 || val > 1) { +- printk(KERN_NOTICE "%s: the value of parameter %s is invalid, the valid range is (0-1)\n", ++ printk(KERN_NOTICE "%s: the value of parameter %s is invalid, the valid range is (0-1)\n", + devname, name); + *opt |= (def ? flag : 0); + } else { +- printk(KERN_INFO "%s: set parameter %s to %s\n", ++ printk(KERN_INFO "%s: set parameter %s to %s\n", + devname, name, val ? "TRUE" : "FALSE"); + *opt |= (val ? flag : 0); + } +@@ -581,10 +476,12 @@ + { + + velocity_set_int_opt(&opts->rx_thresh, rx_thresh[index], RX_THRESH_MIN, RX_THRESH_MAX, RX_THRESH_DEF, "rx_thresh", devname); +- velocity_set_int_opt(&opts->DMA_length, DMA_length[index], DMA_LENGTH_MIN, DMA_LENGTH_MAX, DMA_LENGTH_DEF, "DMA_length", devname); ++ velocity_set_int_opt(&opts->DMA_length_100M, DMA_length_100M[index], DMA_LENGTH_MIN, DMA_LENGTH_MAX, DMA_LENGTH_100M_DEF, "DMA_length 100M", devname); ++ velocity_set_int_opt(&opts->DMA_length_1000M, DMA_length_1000M[index], DMA_LENGTH_MIN, DMA_LENGTH_MAX, DMA_LENGTH_1000M_DEF, "DMA_length 1000M", devname); + velocity_set_int_opt(&opts->numrx, RxDescriptors[index], RX_DESC_MIN, RX_DESC_MAX, RX_DESC_DEF, "RxDescriptors", devname); + velocity_set_int_opt(&opts->numtx, TxDescriptors[index], TX_DESC_MIN, TX_DESC_MAX, TX_DESC_DEF, "TxDescriptors", devname); +- ++ velocity_set_int_opt(&opts->vid, VID_setting[index], VLAN_ID_MIN, VLAN_ID_MAX, VLAN_ID_DEF, "VID_setting", devname); ++ velocity_set_bool_opt(&opts->flags, enable_tagging[index], TAGGING_DEF, VELOCITY_FLAGS_TAGGING, "enable_tagging", devname); + velocity_set_bool_opt(&opts->flags, txcsum_offload[index], TX_CSUM_DEF, VELOCITY_FLAGS_TX_CSUM, "txcsum_offload", devname); + velocity_set_int_opt(&opts->flow_cntl, flow_control[index], FLOW_CNTL_MIN, FLOW_CNTL_MAX, FLOW_CNTL_DEF, "flow_control", devname); + velocity_set_bool_opt(&opts->flags, IP_byte_align[index], IP_ALIG_DEF, VELOCITY_FLAGS_IP_ALIGN, "IP_byte_align", devname); +@@ -606,61 +503,35 @@ + static void velocity_init_cam_filter(struct velocity_info *vptr) + { + struct mac_regs __iomem * regs = vptr->mac_regs; +- unsigned short vid; + + /* Turn on MCFG_PQEN, turn off MCFG_RTGOPT */ + WORD_REG_BITS_SET(MCFG_PQEN, MCFG_RTGOPT, ®s->MCFG); + WORD_REG_BITS_ON(MCFG_VIDFR, ®s->MCFG); + + /* Disable all CAMs */ +- memset(vptr->vCAMmask, 0, sizeof(u8) * 8); +- memset(vptr->mCAMmask, 0, sizeof(u8) * 8); +- mac_set_vlan_cam_mask(regs, vptr->vCAMmask); +- mac_set_cam_mask(regs, vptr->mCAMmask); ++ memset(vptr->vCAMmask, 0, VCAM_SIZE / 8); ++ memset(vptr->mCAMmask, 0, MCAM_SIZE / 8); ++ mac_set_cam_mask(regs, vptr->vCAMmask, VELOCITY_VLAN_ID_CAM); ++ mac_set_cam_mask(regs, vptr->mCAMmask, VELOCITY_MULTICAST_CAM); + + /* Enable first VCAM */ +- if (vptr->vlgrp) { +- for (vid = 0; vid < VLAN_VID_MASK; vid++) { +- if (vlan_group_get_device(vptr->vlgrp, vid)) { +- /* If Tagging option is enabled and +- VLAN ID is not zero, then +- turn on MCFG_RTGOPT also */ +- if (vid != 0) +- WORD_REG_BITS_ON(MCFG_RTGOPT, ®s->MCFG); ++ if (vptr->flags & VELOCITY_FLAGS_TAGGING) { ++ /* If Tagging option is enabled and VLAN ID is not zero, then ++ turn on MCFG_RTGOPT also */ ++ if (vptr->options.vid != 0) ++ WORD_REG_BITS_ON(MCFG_RTGOPT, ®s->MCFG); + +- mac_set_vlan_cam(regs, 0, (u8 *) &vid); +- } +- } ++ mac_set_cam(regs, 0, (u8 *) & (vptr->options.vid), VELOCITY_VLAN_ID_CAM); + vptr->vCAMmask[0] |= 1; +- mac_set_vlan_cam_mask(regs, vptr->vCAMmask); ++ mac_set_cam_mask(regs, vptr->vCAMmask, VELOCITY_VLAN_ID_CAM); + } else { + u16 temp = 0; +- mac_set_vlan_cam(regs, 0, (u8 *) &temp); ++ mac_set_cam(regs, 0, (u8 *) &temp, VELOCITY_VLAN_ID_CAM); + temp = 1; +- mac_set_vlan_cam_mask(regs, (u8 *) &temp); ++ mac_set_cam_mask(regs, (u8 *) &temp, VELOCITY_VLAN_ID_CAM); + } + } + +-static void velocity_vlan_rx_add_vid(struct net_device *dev, unsigned short vid) +-{ +- struct velocity_info *vptr = netdev_priv(dev); +- +- spin_lock_irq(&vptr->lock); +- velocity_init_cam_filter(vptr); +- spin_unlock_irq(&vptr->lock); +-} +- +-static void velocity_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid) +-{ +- struct velocity_info *vptr = netdev_priv(dev); +- +- spin_lock_irq(&vptr->lock); +- vlan_group_set_device(vptr->vlgrp, vid, NULL); +- velocity_init_cam_filter(vptr); +- spin_unlock_irq(&vptr->lock); +-} +- +- + /** + * velocity_rx_reset - handle a receive reset + * @vptr: velocity we are resetting +@@ -690,6 +561,61 @@ + } + + /** ++ * Cause the eeprom to be read into the chip. ++ * @returns Zero on success ++ */ ++int mac_eeprom_reload(struct mac_regs __iomem *regs) ++{ ++#if 0 ++{ ++int i; ++unsigned char __iomem *ptr = (unsigned char __iomem *)regs; ++printk("Before eeprom load regs:\n"); ++printk("0x00:\t"); ++for (i=0; i <= MAC_REG_BYTEMSK3_3; ++i) { ++ printk("0x%02x\t", readb(&(ptr[i]))); ++ if (!((i+1) % 8)) { ++ printk("\n0x%02x:\t", i+1); ++ } ++} ++} ++#endif ++ BYTE_REG_BITS_ON(EECSR_RELOAD, &((regs)->EECSR)); ++ mdelay(100); ++#if 0 ++{ ++int i; ++unsigned char __iomem *ptr = (unsigned char __iomem *)regs; ++printk("\nAfter eeprom load regs:\n"); ++printk("0x00:\t"); ++for (i=0; i <= MAC_REG_BYTEMSK3_3; ++i) { ++ printk("0x%02x\t", readb(&(ptr[i]))); ++ if (!((i+1) % 8)) { ++ printk("\n0x%02x:\t", i+1); ++ } ++} ++} ++#endif ++ return BYTE_REG_BITS_IS_ON(EECSR_RELOAD, &((regs)->EECSR)); ++} ++ ++ ++static inline void mac_set_dma_length(struct velocity_info *vptr) ++{ ++ struct mac_regs __iomem *regs = vptr->mac_regs; ++ int burst_size = vptr->options.DMA_length_100M; ++ ++ if (!(vptr->mii_status & VELOCITY_LINK_FAIL) && ++ (vptr->options.spd_dpx == SPD_DPX_AUTO) && ++ (vptr->mii_status & VELOCITY_SPEED_1000)) { ++ burst_size = vptr->options.DMA_length_1000M; ++ } ++ ++//printk("Setting fifo burst size to %d\n", burst_size); ++ BYTE_REG_BITS_SET(burst_size, 0x07, &(regs->DCFG)); ++} ++ ++/** + * velocity_init_registers - initialise MAC registers + * @vptr: velocity to init + * @type: type of initialisation (hot or cold) +@@ -698,7 +624,7 @@ + * hardware. + */ + +-static void velocity_init_registers(struct velocity_info *vptr, ++static void velocity_init_registers(struct velocity_info *vptr, + enum velocity_init_type type) + { + struct mac_regs __iomem * regs = vptr->mac_regs; +@@ -726,11 +652,12 @@ + netif_wake_queue(vptr->dev); + } + ++ mac_set_dma_length(vptr); + enable_flow_control_ability(vptr); + + mac_clear_isr(regs); + writel(CR0_STOP, ®s->CR0Clr); +- writel((CR0_DPOLL | CR0_TXON | CR0_RXON | CR0_STRT), ++ writel((CR0_DPOLL | CR0_TXON | CR0_RXON | CR0_STRT), + ®s->CR0Set); + + break; +@@ -743,16 +670,27 @@ + velocity_soft_reset(vptr); + mdelay(5); + ++#ifdef LOAD_FROM_EEPROM + mac_eeprom_reload(regs); ++#endif // LOAD_FROM_EEPROM ++ + for (i = 0; i < 6; i++) { + writeb(vptr->dev->dev_addr[i], &(regs->PAR[i])); + } ++ ++ // Initialise the hardware's record of our primary MAC address ++ hw_set_mac_address(vptr, vptr->dev->dev_addr); ++ ++ /* ++ * Set LED Select bits to CASE_1 ++ */ ++ BYTE_REG_BITS_SET(CFGA_PHYLEDS1, (CFGA_PHYLEDS1 | CFGA_PHYLEDS0), &(regs->CFGA)); ++ + /* + * clear Pre_ACPI bit. + */ + BYTE_REG_BITS_OFF(CFGA_PACPI, &(regs->CFGA)); + mac_set_rx_thresh(regs, vptr->options.rx_thresh); +- mac_set_dma_length(regs, vptr->options.DMA_length); + + writeb(WOLCFG_SAM | WOLCFG_SAB, ®s->WOLCFGSet); + /* +@@ -805,7 +743,9 @@ + netif_wake_queue(vptr->dev); + } + ++ mac_set_dma_length(vptr); + enable_flow_control_ability(vptr); ++ + mac_hw_mibs_init(regs); + mac_write_int_mask(vptr->int_mask, regs); + mac_clear_isr(regs); +@@ -866,7 +806,7 @@ + * can support more than MAX_UNITS. + */ + if (velocity_nics >= MAX_UNITS) { +- dev_notice(&pdev->dev, "already found %d NICs.\n", ++ dev_notice(&pdev->dev, "already found %d NICs.\n", + velocity_nics); + return -ENODEV; + } +@@ -876,15 +816,16 @@ + dev_err(&pdev->dev, "allocate net device failed.\n"); + goto out; + } +- ++ + /* Chain it all together */ +- ++ ++ SET_MODULE_OWNER(dev); + SET_NETDEV_DEV(dev, &pdev->dev); + vptr = netdev_priv(dev); + + + if (first) { +- printk(KERN_INFO "%s Ver. %s\n", ++ printk(KERN_INFO "%s Ver. %s\n", + VELOCITY_FULL_DRV_NAM, VELOCITY_VERSION); + printk(KERN_INFO "Copyright (c) 2002, 2003 VIA Networking Technologies, Inc.\n"); + printk(KERN_INFO "Copyright (c) 2004 Red Hat Inc.\n"); +@@ -898,7 +839,7 @@ + dev->irq = pdev->irq; + + ret = pci_enable_device(pdev); +- if (ret < 0) ++ if (ret < 0) + goto err_free_dev; + + ret = velocity_get_pci_info(vptr, pdev); +@@ -928,19 +869,32 @@ + for (i = 0; i < 6; i++) + dev->dev_addr[i] = readb(®s->PAR[i]); + ++ // Tell the kernel of our MAC address ++ if ((mac_hi==0)&&(mac_lo==0)) { ++ memcpy(dev->dev_addr, DEFAULT_MAC_ADDRESS, dev->addr_len); ++ } else { ++ int i; ++ for (i=0; i < dev->addr_len; i++) { ++ if (i < sizeof(u32)) { ++ dev->dev_addr[i] = ((mac_hi >> (((sizeof(u32)-1)-i)*8)) & 0xff); ++ } else { ++ dev->dev_addr[i] = ((mac_lo >> (((sizeof(u32)+1)-i)*8)) & 0xff); ++ } ++ } ++ } + + velocity_get_options(&vptr->options, velocity_nics, dev->name); + +- /* ++ /* + * Mask out the options cannot be set to the chip + */ +- ++ + vptr->options.flags &= info->flags; + + /* + * Enable the chip specified capbilities + */ +- ++ + vptr->flags = vptr->options.flags | (info->flags & 0xFF000000UL); + + vptr->wol_opts = vptr->options.wol_opts; +@@ -957,17 +911,14 @@ + dev->do_ioctl = velocity_ioctl; + dev->ethtool_ops = &velocity_ethtool_ops; + dev->change_mtu = velocity_change_mtu; +- +- dev->vlan_rx_add_vid = velocity_vlan_rx_add_vid; +- dev->vlan_rx_kill_vid = velocity_vlan_rx_kill_vid; +- ++ dev->set_mac_address = set_mac_address; + #ifdef VELOCITY_ZERO_COPY_SUPPORT + dev->features |= NETIF_F_SG; + #endif +- dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_FILTER; + +- if (vptr->flags & VELOCITY_FLAGS_TX_CSUM) ++ if (vptr->flags & VELOCITY_FLAGS_TX_CSUM) { + dev->features |= NETIF_F_IP_CSUM; ++ } + + ret = register_netdev(dev); + if (ret < 0) +@@ -978,9 +929,9 @@ + + velocity_print_info(vptr); + pci_set_drvdata(pdev, dev); +- ++ + /* and leave the chip powered down */ +- ++ + pci_set_power_state(pdev, PCI_D3hot); + #ifdef CONFIG_PM + { +@@ -1019,9 +970,9 @@ + struct net_device *dev = vptr->dev; + + printk(KERN_INFO "%s: %s\n", dev->name, get_chip_name(vptr->chip_id)); +- printk(KERN_INFO "%s: Ethernet Address: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n", +- dev->name, +- dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2], ++ printk(KERN_INFO "%s: Ethernet Address: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n", ++ dev->name, ++ dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2], + dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]); + } + +@@ -1044,7 +995,6 @@ + vptr->pdev = pdev; + vptr->chip_id = info->chip_id; + vptr->num_txq = info->txqueue; +- vptr->multicast_limit = MCAM_SIZE; + spin_lock_init(&vptr->lock); + INIT_LIST_HEAD(&vptr->list); + } +@@ -1061,12 +1011,12 @@ + static int __devinit velocity_get_pci_info(struct velocity_info *vptr, struct pci_dev *pdev) + { + vptr->rev_id = pdev->revision; +- ++ + pci_set_master(pdev); + + vptr->ioaddr = pci_resource_start(pdev, 0); + vptr->memaddr = pci_resource_start(pdev, 1); +- ++ + if (!(pci_resource_flags(pdev, 0) & IORESOURCE_IO)) { + dev_err(&pdev->dev, + "region #0 is not an I/O resource, aborting.\n"); +@@ -1105,20 +1055,25 @@ + u8 *pool; + + /* +- * Allocate all RD/TD rings a single pool ++ * Allocate all RD/TD rings a single pool + */ +- +- psize = vptr->options.numrx * sizeof(struct rx_desc) + ++ ++ psize = vptr->options.numrx * sizeof(struct rx_desc) + + vptr->options.numtx * sizeof(struct tx_desc) * vptr->num_txq; + + /* + * pci_alloc_consistent() fulfills the requirement for 64 bytes + * alignment + */ +- pool = pci_alloc_consistent(vptr->pdev, psize, &pool_dma); ++#ifdef VELOCITY_DESC_IN_SRAM ++ pool = (u8*)GMAC_DESC_ALLOC_START; ++ pool_dma = GMAC_DESC_ALLOC_START_PA; ++#else ++ pool = pci_alloc_consistent(vptr->pdev, psize, &pool_dma); ++#endif // VELOCITY_DESC_IN_SRAM + + if (pool == NULL) { +- printk(KERN_ERR "%s : DMA memory allocation failed.\n", ++ printk(KERN_ERR "%s : DMA memory allocation failed.\n", + vptr->dev->name); + return -ENOMEM; + } +@@ -1130,13 +1085,15 @@ + vptr->rd_pool_dma = pool_dma; + + tsize = vptr->options.numtx * PKT_BUF_SZ * vptr->num_txq; +- vptr->tx_bufs = pci_alloc_consistent(vptr->pdev, tsize, ++ vptr->tx_bufs = pci_alloc_consistent(vptr->pdev, tsize, + &vptr->tx_bufs_dma); + + if (vptr->tx_bufs == NULL) { +- printk(KERN_ERR "%s: DMA memory allocation failed.\n", ++ printk(KERN_ERR "%s: DMA memory allocation failed.\n", + vptr->dev->name); ++#ifndef VELOCITY_DESC_IN_SRAM + pci_free_consistent(vptr->pdev, psize, pool, pool_dma); ++#endif // !VELOCITY_DESC_IN_SRAM + return -ENOMEM; + } + +@@ -1167,10 +1124,12 @@ + { + int size; + +- size = vptr->options.numrx * sizeof(struct rx_desc) + ++ size = vptr->options.numrx * sizeof(struct rx_desc) + + vptr->options.numtx * sizeof(struct tx_desc) * vptr->num_txq; + ++#ifndef VELOCITY_DESC_IN_SRAM + pci_free_consistent(vptr->pdev, size, vptr->rd_ring, vptr->rd_pool_dma); ++#endif // !VELOCITY_DESC_IN_SRAM + + size = vptr->options.numtx * PKT_BUF_SZ * vptr->num_txq; + +@@ -1219,7 +1178,7 @@ + break; + } + done++; +- dirty = (dirty < vptr->options.numrx - 1) ? dirty + 1 : 0; ++ dirty = (dirty < vptr->options.numrx - 1) ? dirty + 1 : 0; + } while (dirty != vptr->rd_curr); + + if (done) { +@@ -1241,15 +1200,14 @@ + + static int velocity_init_rd_ring(struct velocity_info *vptr) + { +- int ret; +- int mtu = vptr->dev->mtu; +- +- vptr->rx_buf_sz = (mtu <= ETH_DATA_LEN) ? PKT_BUF_SZ : mtu + 32; ++ int ret = -ENOMEM; ++ unsigned int rsize = sizeof(struct velocity_rd_info) * ++ vptr->options.numrx; + +- vptr->rd_info = kcalloc(vptr->options.numrx, +- sizeof(struct velocity_rd_info), GFP_KERNEL); +- if (!vptr->rd_info) +- return -ENOMEM; ++ vptr->rd_info = kmalloc(rsize, GFP_KERNEL); ++ if(vptr->rd_info == NULL) ++ goto out; ++ memset(vptr->rd_info, 0, rsize); + + vptr->rd_filled = vptr->rd_dirty = vptr->rd_curr = 0; + +@@ -1259,7 +1217,7 @@ + "%s: failed to allocate RX buffer.\n", vptr->dev->name); + velocity_free_rd_ring(vptr); + } +- ++out: + return ret; + } + +@@ -1306,26 +1264,28 @@ + * Returns zero on success or a negative posix errno code for + * failure. + */ +- ++ + static int velocity_init_td_ring(struct velocity_info *vptr) + { + int i, j; + dma_addr_t curr; + struct tx_desc *td; + struct velocity_td_info *td_info; ++ unsigned int tsize = sizeof(struct velocity_td_info) * ++ vptr->options.numtx; + + /* Init the TD ring entries */ + for (j = 0; j < vptr->num_txq; j++) { + curr = vptr->td_pool_dma[j]; + +- vptr->td_infos[j] = kcalloc(vptr->options.numtx, +- sizeof(struct velocity_td_info), +- GFP_KERNEL); +- if (!vptr->td_infos[j]) { ++ vptr->td_infos[j] = kmalloc(tsize, GFP_KERNEL); ++ if(vptr->td_infos[j] == NULL) ++ { + while(--j >= 0) + kfree(vptr->td_infos[j]); + return -ENOMEM; + } ++ memset(vptr->td_infos[j], 0, tsize); + + for (i = 0; i < vptr->options.numtx; i++, curr += sizeof(struct tx_desc)) { + td = &(vptr->td_rings[j][i]); +@@ -1340,31 +1300,12 @@ + return 0; + } + +-/* +- * FIXME: could we merge this with velocity_free_tx_buf ? +- */ +- +-static void velocity_free_td_ring_entry(struct velocity_info *vptr, +- int q, int n) ++static void velocity_free_td_ring_entry(struct velocity_info *vptr, int q, int n) + { + struct velocity_td_info * td_info = &(vptr->td_infos[q][n]); +- int i; +- +- if (td_info == NULL) +- return; + +- if (td_info->skb) { +- for (i = 0; i < td_info->nskb_dma; i++) +- { +- if (td_info->skb_dma[i]) { +- pci_unmap_single(vptr->pdev, td_info->skb_dma[i], +- td_info->skb->len, PCI_DMA_TODEVICE); +- td_info->skb_dma[i] = (dma_addr_t) NULL; +- } +- } +- dev_kfree_skb(td_info->skb); +- td_info->skb = NULL; +- } ++ if (td_info && td_info->skb) ++ velocity_free_tx_buf(vptr, td_info); + } + + /** +@@ -1374,17 +1315,16 @@ + * Free up the transmit ring for this particular velocity adapter. + * We free the ring contents but not the ring itself. + */ +- ++ + static void velocity_free_td_ring(struct velocity_info *vptr) + { + int i, j; + +- for (j = 0; j < vptr->num_txq; j++) { ++ for (j=0; j < vptr->num_txq; j++) { + if (vptr->td_infos[j] == NULL) + continue; +- for (i = 0; i < vptr->options.numtx; i++) { ++ for (i=0; i < vptr->options.numtx; i++) { + velocity_free_td_ring_entry(vptr, j, i); +- + } + kfree(vptr->td_infos[j]); + vptr->td_infos[j] = NULL; +@@ -1400,14 +1340,14 @@ + * any received packets from the receive queue. Hand the ring + * slots back to the adapter for reuse. + */ +- ++ + static int velocity_rx_srv(struct velocity_info *vptr, int status) + { + struct net_device_stats *stats = &vptr->stats; + int rd_curr = vptr->rd_curr; + int works = 0; + +- do { ++ while (1) { + struct rx_desc *rd = vptr->rd_ring + rd_curr; + + if (!vptr->rd_info[rd_curr].skb) +@@ -1422,15 +1362,19 @@ + * Don't drop CE or RL error frame although RXOK is off + */ + if ((rd->rdesc0.RSR & RSR_RXOK) || (!(rd->rdesc0.RSR & RSR_RXOK) && (rd->rdesc0.RSR & (RSR_CE | RSR_RL)))) { +- if (velocity_receive_frame(vptr, rd_curr) < 0) +- stats->rx_dropped++; ++ if (velocity_receive_frame(vptr, rd_curr) < 0) { ++ /* velocity_receive_frame() has already recorded the type of */ ++ /* so just inc overall rx error count */ ++ ++stats->rx_errors; ++ } + } else { + if (rd->rdesc0.RSR & RSR_CRC) + stats->rx_crc_errors++; + if (rd->rdesc0.RSR & RSR_FAE) + stats->rx_frame_errors++; + +- stats->rx_dropped++; ++ /* We've had an error of some sort so inc. overall rx error count */ ++ ++stats->rx_errors; + } + + rd->inten = 1; +@@ -1440,7 +1384,9 @@ + rd_curr++; + if (rd_curr >= vptr->options.numrx) + rd_curr = 0; +- } while (++works <= 15); ++ ++ ++works; ++ } + + vptr->rd_curr = rd_curr; + +@@ -1461,14 +1407,14 @@ + * Process the status bits for the received packet and determine + * if the checksum was computed and verified by the hardware + */ +- ++ + static inline void velocity_rx_csum(struct rx_desc *rd, struct sk_buff *skb) + { + skb->ip_summed = CHECKSUM_NONE; + + if (rd->rdesc1.CSM & CSM_IPKT) { + if (rd->rdesc1.CSM & CSM_IPOK) { +- if ((rd->rdesc1.CSM & CSM_TCPKT) || ++ if ((rd->rdesc1.CSM & CSM_TCPKT) || + (rd->rdesc1.CSM & CSM_UDPKT)) { + if (!(rd->rdesc1.CSM & CSM_TUPOK)) { + return; +@@ -1499,20 +1445,19 @@ + if (pkt_size < rx_copybreak) { + struct sk_buff *new_skb; + +- new_skb = dev_alloc_skb(pkt_size + 2); ++ /* Always realign IP header to quad boundary if copying anyway */ ++ new_skb = dev_alloc_skb(pkt_size + NET_IP_ALIGN); + if (new_skb) { + new_skb->dev = vptr->dev; + new_skb->ip_summed = rx_skb[0]->ip_summed; + +- if (vptr->flags & VELOCITY_FLAGS_IP_ALIGN) +- skb_reserve(new_skb, 2); ++ skb_reserve(new_skb, NET_IP_ALIGN); + +- skb_copy_from_linear_data(rx_skb[0], new_skb->data, +- pkt_size); ++ memcpy(new_skb->data, rx_skb[0]->data, pkt_size); + *rx_skb = new_skb; + ret = 0; + } +- ++ + } + return ret; + } +@@ -1529,13 +1474,10 @@ + static inline void velocity_iph_realign(struct velocity_info *vptr, + struct sk_buff *skb, int pkt_size) + { +- /* FIXME - memmove ? */ + if (vptr->flags & VELOCITY_FLAGS_IP_ALIGN) { +- int i; +- +- for (i = pkt_size; i >= 0; i--) +- *(skb->data + i + 2) = *(skb->data + i); +- skb_reserve(skb, 2); ++//printk("velocity_iph_realign()\n"); ++ memmove(skb->data + NET_IP_ALIGN, skb->data, pkt_size); ++ skb_reserve(skb, NET_IP_ALIGN); + } + } + +@@ -1543,11 +1485,11 @@ + * velocity_receive_frame - received packet processor + * @vptr: velocity we are handling + * @idx: ring index +- * ++ * + * A packet has arrived. We process the packet and if appropriate + * pass the frame up the network stack + */ +- ++ + static int velocity_receive_frame(struct velocity_info *vptr, int idx) + { + void (*pci_action)(struct pci_dev *, dma_addr_t, size_t, int); +@@ -1558,7 +1500,7 @@ + struct sk_buff *skb; + + if (rd->rdesc0.RSR & (RSR_STP | RSR_EDP)) { +- VELOCITY_PRT(MSG_LEVEL_VERBOSE, KERN_ERR " %s : the received frame span multple RDs.\n", vptr->dev->name); ++ VELOCITY_PRT(MSG_LEVEL_VERBOSE, KERN_ERR " %s : the received frame spans multple RDs.\n", vptr->dev->name); + stats->rx_length_errors++; + return -EINVAL; + } +@@ -1567,6 +1509,7 @@ + vptr->stats.multicast++; + + skb = rd_info->skb; ++ skb->dev = vptr->dev; + + pci_dma_sync_single_for_cpu(vptr->pdev, rd_info->skb_dma, + vptr->rx_buf_sz, PCI_DMA_FROMDEVICE); +@@ -1574,7 +1517,6 @@ + /* + * Drop frame not meeting IEEE 802.3 + */ +- + if (vptr->flags & VELOCITY_FLAGS_VAL_PKT_LEN) { + if (rd->rdesc0.RSR & RSR_RL) { + stats->rx_length_errors++; +@@ -1596,9 +1538,11 @@ + PCI_DMA_FROMDEVICE); + + skb_put(skb, pkt_len - 4); +- skb->protocol = eth_type_trans(skb, vptr->dev); ++ skb->protocol = eth_type_trans(skb, skb->dev); + + stats->rx_bytes += pkt_len; ++ ++stats->rx_packets; ++ + netif_rx(skb); + + return 0; +@@ -1614,7 +1558,7 @@ + * requires *64* byte alignment of the buffer which makes life + * less fun than would be ideal. + */ +- ++ + static int velocity_alloc_rx_buf(struct velocity_info *vptr, int idx) + { + struct rx_desc *rd = &(vptr->rd_ring[idx]); +@@ -1631,11 +1575,10 @@ + skb_reserve(rd_info->skb, (unsigned long) rd_info->skb->data & 63); + rd_info->skb->dev = vptr->dev; + rd_info->skb_dma = pci_map_single(vptr->pdev, rd_info->skb->data, vptr->rx_buf_sz, PCI_DMA_FROMDEVICE); +- ++ + /* + * Fill in the descriptor to match +- */ +- ++ */ + *((u32 *) & (rd->rdesc0)) = 0; + rd->len = cpu_to_le32(vptr->rx_buf_sz); + rd->inten = 1; +@@ -1651,9 +1594,9 @@ + * + * Scan the queues looking for transmitted packets that + * we can complete and clean up. Update any statistics as +- * necessary/ ++ * neccessary/ + */ +- ++ + static int velocity_tx_srv(struct velocity_info *vptr, u32 status) + { + struct tx_desc *td; +@@ -1665,7 +1608,7 @@ + struct net_device_stats *stats = &vptr->stats; + + for (qnum = 0; qnum < vptr->num_txq; qnum++) { +- for (idx = vptr->td_tail[qnum]; vptr->td_used[qnum] > 0; ++ for (idx = vptr->td_tail[qnum]; vptr->td_used[qnum] > 0; + idx = (idx + 1) % vptr->options.numtx) { + + /* +@@ -1677,8 +1620,7 @@ + if (td->tdesc0.owner == OWNED_BY_NIC) + break; + +- if ((works++ > 15)) +- break; ++ ++works; + + if (td->tdesc0.TSR & TSR0_TERR) { + stats->tx_errors++; +@@ -1730,7 +1672,7 @@ + if (vptr->mii_status & VELOCITY_LINK_FAIL) { + VELOCITY_PRT(MSG_LEVEL_INFO, KERN_NOTICE "%s: failed to detect cable link\n", vptr->dev->name); + } else if (vptr->options.spd_dpx == SPD_DPX_AUTO) { +- VELOCITY_PRT(MSG_LEVEL_INFO, KERN_NOTICE "%s: Link auto-negotiation", vptr->dev->name); ++ VELOCITY_PRT(MSG_LEVEL_INFO, KERN_NOTICE "%s: Link autonegation", vptr->dev->name); + + if (vptr->mii_status & VELOCITY_SPEED_1000) + VELOCITY_PRT(MSG_LEVEL_INFO, " speed 1000M bps"); +@@ -1765,17 +1707,48 @@ + } + + /** ++ * velocity_update_hw_mibs - fetch MIB counters from chip ++ * @vptr: velocity to update ++ * ++ * The velocity hardware keeps certain counters in the hardware ++ * side. We need to read these when the user asks for statistics ++ * or when they overflow (causing an interrupt). The read of the ++ * statistic clears it, so we keep running master counters in user ++ * space. ++ */ ++static void velocity_update_hw_mibs(struct velocity_info *vptr) ++{ ++ int i; ++ ++ /* Toggle flush to update MIB SRAM from fast counters */ ++ BYTE_REG_BITS_ON(MIBCR_MIBFLSH, &(vptr->mac_regs->MIBCR)); ++ while (BYTE_REG_BITS_IS_ON(MIBCR_MIBFLSH, &(vptr->mac_regs->MIBCR))); ++ ++ /* Toggle MIBINI to begin MIB SRAM read out. Datasheet says always reads as ++ zero, so no point polling for it to return to zero after setting */ ++ BYTE_REG_BITS_ON(MIBCR_MPTRINI, &(vptr->mac_regs->MIBCR)); ++ ++ for (i=0; i < HW_MIB_SIZE; ++i) { ++ /* Read MIB, preserving both index and count */ ++ u32 mib = readl(&(vptr->mac_regs->MIBData)); ++ int index = (mib & 0xff000000) >> 24; ++ u32 count = mib & 0x00ffffff; ++ vptr->mib_counter[index] += count; ++ } ++} ++ ++/** + * velocity_error - handle error from controller + * @vptr: velocity + * @status: card status + * + * Process an error report from the hardware and attempt to recover +- * the card itself. At the moment we cannot recover from some ++ * the card itself. At the moment we cannot recover from some + * theoretically impossible errors but this could be fixed using + * the pci_device_failed logic to bounce the hardware + * + */ +- ++ + static void velocity_error(struct velocity_info *vptr, int status) + { + +@@ -1786,7 +1759,7 @@ + BYTE_REG_BITS_ON(TXESR_TDSTR, ®s->TXESR); + writew(TRDCSR_RUN, ®s->TDCSRClr); + netif_stop_queue(vptr->dev); +- ++ + /* FIXME: port over the pci_device_failed code and use it + here */ + } +@@ -1799,7 +1772,7 @@ + vptr->mii_status = check_connection_type(regs); + + /* +- * If it is a 3119, disable frame bursting in ++ * If it is a 3119, disable frame bursting in + * halfduplex mode and enable it in fullduplex + * mode + */ +@@ -1832,13 +1805,15 @@ + } + + velocity_print_link_status(vptr); ++ ++ mac_set_dma_length(vptr); + enable_flow_control_ability(vptr); + + /* +- * Re-enable auto-polling because SRCI will disable ++ * Re-enable auto-polling because SRCI will disable + * auto-polling + */ +- ++ + enable_mii_autopoll(regs); + + if (vptr->mii_status & VELOCITY_LINK_FAIL) +@@ -1846,9 +1821,11 @@ + else + netif_wake_queue(vptr->dev); + +- }; ++ } ++ + if (status & ISR_MIBFI) + velocity_update_hw_mibs(vptr); ++ + if (status & ISR_LSTEI) + mac_rx_queue_wake(vptr->mac_regs); + } +@@ -1858,29 +1835,35 @@ + * @vptr: velocity + * @tdinfo: buffer + * +- * Release an transmit buffer. If the buffer was preallocated then ++ * Release a transmit buffer. If the buffer was preallocated then + * recycle it, if not then unmap the buffer. + */ +- + static void velocity_free_tx_buf(struct velocity_info *vptr, struct velocity_td_info *tdinfo) + { + struct sk_buff *skb = tdinfo->skb; + int i; + +- /* +- * Don't unmap the pre-allocated tx_bufs +- */ +- if (tdinfo->skb_dma && (tdinfo->skb_dma[0] != tdinfo->buf_dma)) { ++ /* Don't unmap the pre-allocated tx_bufs */ ++ if (tdinfo->skb_dma[0] && (tdinfo->skb_dma[0] != tdinfo->buf_dma)) { ++ if (tdinfo->nskb_dma == 1) { ++ /* Either no fragments originally, or was linearized because too ++ many fragments */ ++ pci_unmap_single(vptr->pdev, tdinfo->skb_dma[0], skb->len, PCI_DMA_TODEVICE); ++ tdinfo->skb_dma[0] = 0; ++ } else { ++ /* Unmap the head buffer */ ++ pci_unmap_single(vptr->pdev, tdinfo->skb_dma[0], skb_headlen(skb), PCI_DMA_TODEVICE); ++ tdinfo->skb_dma[0] = 0; + +- for (i = 0; i < tdinfo->nskb_dma; i++) { +-#ifdef VELOCITY_ZERO_COPY_SUPPORT +- pci_unmap_single(vptr->pdev, tdinfo->skb_dma[i], td->tdesc1.len, PCI_DMA_TODEVICE); +-#else +- pci_unmap_single(vptr->pdev, tdinfo->skb_dma[i], skb->len, PCI_DMA_TODEVICE); +-#endif +- tdinfo->skb_dma[i] = 0; +- } ++ /* Unmap the fragment buffers */ ++ for (i=0; i < tdinfo->nskb_dma-1; ++i) { ++ pci_unmap_page(vptr->pdev, tdinfo->skb_dma[i+1], ++ skb_shinfo(skb)->frags[i].size, PCI_DMA_TODEVICE); ++ tdinfo->skb_dma[i+1] = 0; ++ } ++ } + } ++ + dev_kfree_skb_irq(skb); + tdinfo->skb = NULL; + } +@@ -1895,12 +1878,14 @@ + * All the ring allocation and set up is done on open for this + * adapter to minimise memory usage when inactive + */ +- ++ + static int velocity_open(struct net_device *dev) + { + struct velocity_info *vptr = netdev_priv(dev); + int ret; + ++ vptr->rx_buf_sz = dev->mtu + NET_IP_ALIGN + EXTRA_RX_SKB_SPACE; ++ + ret = velocity_init_rings(vptr); + if (ret < 0) + goto out; +@@ -1912,13 +1897,13 @@ + ret = velocity_init_td_ring(vptr); + if (ret < 0) + goto err_free_rd_ring; +- +- /* Ensure chip is running */ ++ ++ /* Ensure chip is running */ + pci_set_power_state(vptr->pdev, PCI_D0); +- ++ + velocity_init_registers(vptr, VELOCITY_INIT_COLD); + +- ret = request_irq(vptr->pdev->irq, &velocity_intr, IRQF_SHARED, ++ ret = request_irq(vptr->pdev->irq, &velocity_intr, SA_SHIRQ, + dev->name, dev); + if (ret < 0) { + /* Power down the chip */ +@@ -1941,7 +1926,7 @@ + goto out; + } + +-/** ++/** + * velocity_change_mtu - MTU change callback + * @dev: network device + * @new_mtu: desired MTU +@@ -1950,7 +1935,7 @@ + * this interface. It gets called on a change by the network layer. + * Return zero for success or negative posix error code. + */ +- ++ + static int velocity_change_mtu(struct net_device *dev, int new_mtu) + { + struct velocity_info *vptr = netdev_priv(dev); +@@ -1959,16 +1944,11 @@ + int ret = 0; + + if ((new_mtu < VELOCITY_MIN_MTU) || new_mtu > (VELOCITY_MAX_MTU)) { +- VELOCITY_PRT(MSG_LEVEL_ERR, KERN_NOTICE "%s: Invalid MTU.\n", ++ VELOCITY_PRT(MSG_LEVEL_ERR, KERN_NOTICE "%s: Invalid MTU.\n", + vptr->dev->name); + return -EINVAL; + } + +- if (!netif_running(dev)) { +- dev->mtu = new_mtu; +- return 0; +- } +- + if (new_mtu != oldmtu) { + spin_lock_irqsave(&vptr->lock, flags); + +@@ -1978,7 +1958,7 @@ + velocity_free_td_ring(vptr); + velocity_free_rd_ring(vptr); + +- dev->mtu = new_mtu; ++ dev->mtu = new_mtu + NET_IP_ALIGN + EXTRA_RX_SKB_SPACE; + + ret = velocity_init_rd_ring(vptr); + if (ret < 0) +@@ -2006,7 +1986,7 @@ + * Shuts down the internal operations of the velocity and + * disables interrupts, autopolling, transmit and receive + */ +- ++ + static void velocity_shutdown(struct velocity_info *vptr) + { + struct mac_regs __iomem * regs = vptr->mac_regs; +@@ -2037,10 +2017,10 @@ + velocity_get_ip(vptr); + if (dev->irq != 0) + free_irq(dev->irq, dev); +- ++ + /* Power down the chip */ + pci_set_power_state(vptr->pdev, PCI_D3hot); +- ++ + /* Free the resources */ + velocity_free_td_ring(vptr); + velocity_free_rd_ring(vptr); +@@ -2058,7 +2038,7 @@ + * Called by the networ layer to request a packet is queued to + * the velocity. Returns zero on success. + */ +- ++ + static int velocity_xmit(struct sk_buff *skb, struct net_device *dev) + { + struct velocity_info *vptr = netdev_priv(dev); +@@ -2067,16 +2047,22 @@ + struct velocity_td_info *tdinfo; + unsigned long flags; + int index; +- +- int pktlen = skb->len; +- ++ int pktlen; ++printk("Tx"); + #ifdef VELOCITY_ZERO_COPY_SUPPORT +- if (skb_shinfo(skb)->nr_frags > 6 && __skb_linearize(skb)) { +- kfree_skb(skb); +- return 0; ++ if (skb_shinfo(skb)->nr_frags > MAX_HW_FRAGMENTS) { ++//printk("Too many fragments (%d), linearizing\n", skb_shinfo(skb)->nr_frags); ++ if (__skb_linearize(skb, GFP_ATOMIC)) { ++//printk("Linearization failed, dropping Tx packet\n"); ++ kfree_skb(skb); ++ return 0; ++ } + } + #endif + ++ // Get packet length after any linearization has occured ++ pktlen = skb->len; ++ + spin_lock_irqsave(&vptr->lock, flags); + + index = vptr->td_curr[qnum]; +@@ -2088,19 +2074,28 @@ + td_ptr->td_buf[0].queue = 0; + + /* +- * Pad short frames. ++ * Pad short frames. + */ + if (pktlen < ETH_ZLEN) { +- /* Cannot occur until ZC support */ ++ int pad_required = ETH_ZLEN - skb->len; ++printk("Padding short Tx frame\n"); + pktlen = ETH_ZLEN; +- skb_copy_from_linear_data(skb, tdinfo->buf, skb->len); +- memset(tdinfo->buf + skb->len, 0, ETH_ZLEN - skb->len); + tdinfo->skb = skb; +- tdinfo->skb_dma[0] = tdinfo->buf_dma; ++ ++ if (skb_tailroom(skb) >= pad_required) { ++//printk("Using short frame\n"); ++ tdinfo->skb_dma[0] = pci_map_single(vptr->pdev, skb->data, pktlen, PCI_DMA_TODEVICE); ++ } else { ++//printk("Copying short frame\n"); ++ memcpy(tdinfo->buf, skb->data, skb->len); ++ memset(tdinfo->buf + skb->len, 0, ETH_ZLEN - skb->len); ++ tdinfo->skb_dma[0] = tdinfo->buf_dma; ++ } ++ + td_ptr->tdesc0.pktsize = pktlen; + td_ptr->td_buf[0].pa_low = cpu_to_le32(tdinfo->skb_dma[0]); + td_ptr->td_buf[0].pa_high = 0; +- td_ptr->td_buf[0].bufsize = td_ptr->tdesc0.pktsize; ++ td_ptr->td_buf[0].bufsize = pktlen; + tdinfo->nskb_dma = 1; + td_ptr->tdesc1.CMDZ = 2; + } else +@@ -2108,41 +2103,46 @@ + if (skb_shinfo(skb)->nr_frags > 0) { + int nfrags = skb_shinfo(skb)->nr_frags; + tdinfo->skb = skb; +- if (nfrags > 6) { +- skb_copy_from_linear_data(skb, tdinfo->buf, skb->len); +- tdinfo->skb_dma[0] = tdinfo->buf_dma; +- td_ptr->tdesc0.pktsize = ++ td_ptr->tdesc0.pktsize = pktlen; ++ ++ if (nfrags > MAX_HW_FRAGMENTS) { ++//printk("Using linearized skb\n"); ++ /* SKB has already been linearized above, so use direct from skb */ ++ tdinfo->skb_dma[0] = pci_map_single(vptr->pdev, skb->data, pktlen, PCI_DMA_TODEVICE); + td_ptr->td_buf[0].pa_low = cpu_to_le32(tdinfo->skb_dma[0]); + td_ptr->td_buf[0].pa_high = 0; +- td_ptr->td_buf[0].bufsize = td_ptr->tdesc0.pktsize; ++ td_ptr->td_buf[0].bufsize = pktlen; + tdinfo->nskb_dma = 1; + td_ptr->tdesc1.CMDZ = 2; + } else { + int i = 0; +- tdinfo->nskb_dma = 0; +- tdinfo->skb_dma[i] = pci_map_single(vptr->pdev, skb->data, skb->len - skb->data_len, PCI_DMA_TODEVICE); + +- td_ptr->tdesc0.pktsize = pktlen; ++ tdinfo->skb_dma[0] = pci_map_single(vptr->pdev, skb->data, skb_headlen(skb), PCI_DMA_TODEVICE); + +- /* FIXME: support 48bit DMA later */ +- td_ptr->td_buf[i].pa_low = cpu_to_le32(tdinfo->skb_dma); +- td_ptr->td_buf[i].pa_high = 0; +- td_ptr->td_buf[i].bufsize = skb->len->skb->data_len; ++ td_ptr->td_buf[0].pa_low = cpu_to_le32(tdinfo->skb_dma[0]); ++ td_ptr->td_buf[0].pa_high = 0; ++ td_ptr->td_buf[0].bufsize = skb_headlen(skb); + +- for (i = 0; i < nfrags; i++) { ++ for (i=0; i < nfrags; ++i) { + skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; +- void *addr = ((void *) page_address(frag->page + frag->page_offset)); + +- tdinfo->skb_dma[i + 1] = pci_map_single(vptr->pdev, addr, frag->size, PCI_DMA_TODEVICE); ++ tdinfo->skb_dma[i+1] = pci_map_page(vptr->pdev, frag->page, frag->page_offset, frag->size, PCI_DMA_TODEVICE); + +- td_ptr->td_buf[i + 1].pa_low = cpu_to_le32(tdinfo->skb_dma[i + 1]); +- td_ptr->td_buf[i + 1].pa_high = 0; +- td_ptr->td_buf[i + 1].bufsize = frag->size; ++ td_ptr->td_buf[i+1].pa_low = cpu_to_le32(tdinfo->skb_dma[i+1]); ++ td_ptr->td_buf[i+1].pa_high = 0; ++ td_ptr->td_buf[i+1].bufsize = frag->size; + } +- tdinfo->nskb_dma = i - 1; +- td_ptr->tdesc1.CMDZ = i; +- } + ++ tdinfo->nskb_dma = nfrags+1; ++ td_ptr->tdesc1.CMDZ = nfrags+2; ++ ++//printk("Num frags = %d\n", nfrags); ++//printk("skb: 0x%08lx:0x%08x, %d\n", (unsigned long)skb->data, tdinfo->skb_dma[0], skb_headlen(skb)); ++//for (i=0; i < nfrags; ++i) { ++// skb_frag_t *frag = &skb_shinfo(skb)->frags[i]; ++// printk("frag: 0x%08lx:0x%08x, %d\n", (unsigned long)page_address(frag->page) + frag->page_offset, tdinfo->skb_dma[i+1], frag->size); ++//} ++ } + } else + #endif + { +@@ -2155,13 +2155,18 @@ + td_ptr->tdesc0.pktsize = pktlen; + td_ptr->td_buf[0].pa_low = cpu_to_le32(tdinfo->skb_dma[0]); + td_ptr->td_buf[0].pa_high = 0; +- td_ptr->td_buf[0].bufsize = td_ptr->tdesc0.pktsize; ++ td_ptr->td_buf[0].bufsize = pktlen; + tdinfo->nskb_dma = 1; + td_ptr->tdesc1.CMDZ = 2; ++printk("0x%08x:%u\n", td_ptr->td_buf[0].pa_low, td_ptr->td_buf[0].bufsize); ++printk("TdInd0=0x%04hx\n", readw(&vptr->mac_regs->TDIdx[0])); ++printk("TdInd1=0x%04hx\n", readw(&vptr->mac_regs->TDIdx[1])); ++printk("TdInd2=0x%04hx\n", readw(&vptr->mac_regs->TDIdx[2])); ++printk("TdInd3=0x%04hx\n", readw(&vptr->mac_regs->TDIdx[3])); + } + +- if (vptr->vlgrp && vlan_tx_tag_present(skb)) { +- td_ptr->tdesc1.pqinf.VID = vlan_tx_tag_get(skb); ++ if (vptr->flags & VELOCITY_FLAGS_TAGGING) { ++ td_ptr->tdesc1.pqinf.VID = (vptr->options.vid & 0xfff); + td_ptr->tdesc1.pqinf.priority = 0; + td_ptr->tdesc1.pqinf.CFI = 0; + td_ptr->tdesc1.TCR |= TCR0_VETAG; +@@ -2170,21 +2175,23 @@ + /* + * Handle hardware checksum + */ +- if ((vptr->flags & VELOCITY_FLAGS_TX_CSUM) +- && (skb->ip_summed == CHECKSUM_PARTIAL)) { +- const struct iphdr *ip = ip_hdr(skb); ++ if ((vptr->flags & VELOCITY_FLAGS_TX_CSUM) && ++ (skb->ip_summed == CHECKSUM_HW)) { ++ struct iphdr *ip = skb->nh.iph; ++ + if (ip->protocol == IPPROTO_TCP) + td_ptr->tdesc1.TCR |= TCR0_TCPCK; + else if (ip->protocol == IPPROTO_UDP) + td_ptr->tdesc1.TCR |= (TCR0_UDPCK); ++ + td_ptr->tdesc1.TCR |= TCR0_IPCK; + } + { +- + int prev = index - 1; + + if (prev < 0) + prev = vptr->options.numtx - 1; ++ + td_ptr->tdesc0.owner = OWNED_BY_NIC; + vptr->td_used[qnum]++; + vptr->td_curr[qnum] = (index + 1) % vptr->options.numtx; +@@ -2196,8 +2203,10 @@ + td_ptr->td_buf[0].queue = 1; + mac_tx_queue_wake(vptr->mac_regs, qnum); + } ++ + dev->trans_start = jiffies; + spin_unlock_irqrestore(&vptr->lock, flags); ++printk("xT\n"); + return 0; + } + +@@ -2205,57 +2214,55 @@ + * velocity_intr - interrupt callback + * @irq: interrupt number + * @dev_instance: interrupting device ++ * @pt_regs: CPU register state at interrupt + * + * Called whenever an interrupt is generated by the velocity + * adapter IRQ line. We may not be the source of the interrupt + * and need to identify initially if we are, and if not exit as + * efficiently as possible. + */ +- +-static int velocity_intr(int irq, void *dev_instance) ++ ++static int velocity_intr(int irq, void *dev_instance, struct pt_regs *regs) + { + struct net_device *dev = dev_instance; + struct velocity_info *vptr = netdev_priv(dev); + u32 isr_status; + int max_count = 0; + +- ++printk("I"); + spin_lock(&vptr->lock); + isr_status = mac_read_isr(vptr->mac_regs); ++printk("0x%08x ", isr_status); + +- /* Not us ? */ +- if (isr_status == 0) { ++ if (!isr_status) { + spin_unlock(&vptr->lock); ++printk("N "); + return IRQ_NONE; + } + + mac_disable_int(vptr->mac_regs); + +- /* +- * Keep processing the ISR until we have completed +- * processing and the isr_status becomes zero +- */ +- +- while (isr_status != 0) { ++ /* Process all pending interrupts */ ++ while (isr_status) { ++ /* Ack all pending interrupt sources */ + mac_write_isr(vptr->mac_regs, isr_status); +- if (isr_status & (~(ISR_PRXI | ISR_PPRXI | ISR_PTXI | ISR_PPTXI))) +- velocity_error(vptr, isr_status); +- if (isr_status & (ISR_PRXI | ISR_PPRXI)) ++ ++ velocity_error(vptr, isr_status); ++ if (isr_status & (ISR_PRXI | ISR_PPRXI)) { ++printk("R"); + max_count += velocity_rx_srv(vptr, isr_status); +- if (isr_status & (ISR_PTXI | ISR_PPTXI)) ++ } ++ if (isr_status & (ISR_PTXI | ISR_PPTXI)) { ++printk("T"); + max_count += velocity_tx_srv(vptr, isr_status); +- isr_status = mac_read_isr(vptr->mac_regs); +- if (max_count > vptr->options.int_works) +- { +- printk(KERN_WARNING "%s: excessive work at interrupt.\n", +- dev->name); +- max_count = 0; + } ++ isr_status = mac_read_isr(vptr->mac_regs); + } ++ + spin_unlock(&vptr->lock); ++printk("i"); + mac_enable_int(vptr->mac_regs); + return IRQ_HANDLED; +- + } + + +@@ -2267,41 +2274,70 @@ + * for a velocity adapter. Reload the CAMs with the new address + * filter ruleset. + */ ++static void clear_all_multicast(struct velocity_info *vptr) ++{ ++ struct mac_regs __iomem * regs = vptr->mac_regs; ++ ++ /* Do not allow any multicast packets through the multicast hash table */ ++ writel(0x0, ®s->MARCAM[0]); ++ writel(0x0, ®s->MARCAM[4]); ++} ++ ++static void set_all_multicast(struct velocity_info *vptr) ++{ ++ struct mac_regs __iomem * regs = vptr->mac_regs; ++ ++ /* Allow all multicast packets through the multicast hash table */ ++ writel(0xffffffff, ®s->MARCAM[0]); ++ writel(0xffffffff, ®s->MARCAM[4]); ++} + + static void velocity_set_multi(struct net_device *dev) + { + struct velocity_info *vptr = netdev_priv(dev); + struct mac_regs __iomem * regs = vptr->mac_regs; +- u8 rx_mode; +- int i; + struct dev_mc_list *mclist; ++ int i; ++ u8 rx_mode = RCR_AB; /* Always enable broadcast packet reception */ + +- if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ +- writel(0xffffffff, ®s->MARCAM[0]); +- writel(0xffffffff, ®s->MARCAM[4]); +- rx_mode = (RCR_AM | RCR_AB | RCR_PROM); +- } else if ((dev->mc_count > vptr->multicast_limit) +- || (dev->flags & IFF_ALLMULTI)) { +- writel(0xffffffff, ®s->MARCAM[0]); +- writel(0xffffffff, ®s->MARCAM[4]); +- rx_mode = (RCR_AM | RCR_AB); +- } else { +- int offset = MCAM_SIZE - vptr->multicast_limit; +- mac_get_cam_mask(regs, vptr->mCAMmask); ++ /* Clear out the multicast hash table */ ++ clear_all_multicast(vptr); + ++ /* Disable all multicast CAM entries */ ++ memset(vptr->mCAMmask, 0, MCAM_SIZE / 8); ++ mac_set_cam_mask(regs, vptr->mCAMmask, VELOCITY_MULTICAST_CAM); ++ ++ if (dev->flags & IFF_PROMISC) { ++ /* Enable promiscuous mode */ ++ printk(KERN_NOTICE "%s: Promiscuous mode enabled.\n", dev->name); ++ ++ set_all_multicast(vptr); ++ rx_mode |= (RCR_PROM | RCR_AM); ++ } else if ((dev->mc_count > MCAM_SIZE) || ++ (dev->flags & IFF_ALLMULTI)) { ++ /* ALL_MULTI or too many entries for perfect filtering, so allow all ++ * multicast packets through hash table */ ++ set_all_multicast(vptr); ++ rx_mode |= RCR_AM; ++ } else { ++ /* Write a CAM entry for each multicast address */ + for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count; i++, mclist = mclist->next) { +- mac_set_cam(regs, i + offset, mclist->dmi_addr); +- vptr->mCAMmask[(offset + i) / 8] |= 1 << ((offset + i) & 7); ++ mac_set_cam(regs, i, mclist->dmi_addr, VELOCITY_MULTICAST_CAM); ++ vptr->mCAMmask[i / 8] |= 1 << (i & 7); + } + +- mac_set_cam_mask(regs, vptr->mCAMmask); +- rx_mode = (RCR_AM | RCR_AB); ++ /* Enable those multicast CAM entries just written */ ++ mac_set_cam_mask(regs, vptr->mCAMmask, VELOCITY_MULTICAST_CAM); ++ ++ /* Enable multicast perfect matching */ ++ rx_mode |= (RCR_AM | RCR_AP); + } ++ ++ /* Allow large packets if indicated by MTU */ + if (dev->mtu > 1500) + rx_mode |= RCR_AL; + +- BYTE_REG_BITS_ON(rx_mode, ®s->RCR); +- ++ BYTE_REG_BITS_SET(rx_mode, RCR_AM | RCR_AB | RCR_PROM | RCR_AL | RCR_AP, ®s->RCR); + } + + /** +@@ -2314,36 +2350,32 @@ + * the hardware into the counters before letting the network + * layer display them. + */ +- ++ + static struct net_device_stats *velocity_get_stats(struct net_device *dev) + { +- struct velocity_info *vptr = netdev_priv(dev); +- +- /* If the hardware is down, don't touch MII */ +- if(!netif_running(dev)) +- return &vptr->stats; +- +- spin_lock_irq(&vptr->lock); +- velocity_update_hw_mibs(vptr); +- spin_unlock_irq(&vptr->lock); ++ struct velocity_info *vptr = dev->priv; + +- vptr->stats.rx_packets = vptr->mib_counter[HW_MIB_ifRxAllPkts]; +- vptr->stats.rx_errors = vptr->mib_counter[HW_MIB_ifRxErrorPkts]; +- vptr->stats.rx_length_errors = vptr->mib_counter[HW_MIB_ifInRangeLengthErrors]; ++#if 0 ++ /* Only access the MIBs if the hardware is up */ ++ if (netif_running(dev)) { ++ int i; + +-// unsigned long rx_dropped; /* no space in linux buffers */ +- vptr->stats.collisions = vptr->mib_counter[HW_MIB_ifTxEtherCollisions]; +- /* detailed rx_errors: */ +-// unsigned long rx_length_errors; +-// unsigned long rx_over_errors; /* receiver ring buff overflow */ +- vptr->stats.rx_crc_errors = vptr->mib_counter[HW_MIB_ifRxPktCRCE]; +-// unsigned long rx_frame_errors; /* recv'd frame alignment error */ +-// unsigned long rx_fifo_errors; /* recv'r fifo overrun */ +-// unsigned long rx_missed_errors; /* receiver missed packet */ ++ /* Transfer from fast counters to MIB SRAM, locking against ++ simulatanous access by ISR due to MIB high threshold being ++ exceeded */ ++ spin_lock_irq(&vptr->lock); ++ velocity_update_hw_mibs(vptr); ++ spin_unlock_irq(&vptr->lock); + +- /* detailed tx_errors */ +-// unsigned long tx_fifo_errors; ++ /* Print MIB statistics */ ++ printk("MIBs:\n"); ++ for (i=0; i < HW_MIB_SIZE; ++i) { ++ printk("%02d: %08d\n", i, vptr->mib_counter[i]); ++ } ++ } ++#endif + ++ /* Return only the statistics gathered by the driver, not MIBs */ + return &vptr->stats; + } + +@@ -2357,7 +2389,7 @@ + * Called when the user issues an ioctl request to the network + * device in question. The velocity interface supports MII. + */ +- ++ + static int velocity_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) + { + struct velocity_info *vptr = netdev_priv(dev); +@@ -2365,10 +2397,10 @@ + + /* If we are asked for information and the device is power + saving then we need to bring the device back up to talk to it */ +- ++ + if (!netif_running(dev)) + pci_set_power_state(vptr->pdev, PCI_D0); +- ++ + switch (cmd) { + case SIOCGMIIPHY: /* Get address of MII PHY in use. */ + case SIOCGMIIREG: /* Read MII PHY register. */ +@@ -2381,8 +2413,8 @@ + } + if (!netif_running(dev)) + pci_set_power_state(vptr->pdev, PCI_D3hot); +- +- ++ ++ + return ret; + } + +@@ -2390,7 +2422,7 @@ + * Definition for our device driver. The PCI layer interface + * uses this to handle all our card discover and plugging + */ +- ++ + static struct pci_driver velocity_driver = { + .name = VELOCITY_NAME, + .id_table = velocity_id_table, +@@ -2410,13 +2442,13 @@ + * the probe functions for each velocity adapter installed + * in the system. + */ +- ++ + static int __init velocity_init_module(void) + { + int ret; + + velocity_register_notifier(); +- ret = pci_register_driver(&velocity_driver); ++ ret = pci_module_init(&velocity_driver); + if (ret < 0) + velocity_unregister_notifier(); + return ret; +@@ -2426,11 +2458,11 @@ + * velocity_cleanup - module unload + * + * When the velocity hardware is unloaded this function is called. +- * It will clean up the notifiers and the unregister the PCI ++ * It will clean up the notifiers and the unregister the PCI + * driver interface for this hardware. This in turn cleans up + * all discovered interfaces before returning from the function + */ +- ++ + static void __exit velocity_cleanup_module(void) + { + velocity_unregister_notifier(); +@@ -2444,8 +2476,8 @@ + /* + * MII access , media link mode setting functions + */ +- +- ++ ++ + /** + * mii_init - set up MII + * @vptr: velocity adapter +@@ -2453,7 +2485,7 @@ + * + * Set up the PHY for the current link state. + */ +- ++ + static void mii_init(struct velocity_info *vptr, u32 mii_status) + { + u16 BMCR; +@@ -2466,7 +2498,7 @@ + MII_REG_BITS_OFF((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR, vptr->mac_regs); + /* + * Turn on ECHODIS bit in NWay-forced full mode and turn it +- * off it in NWay-forced half mode for NWay-forced v.s. ++ * off it in NWay-forced half mode for NWay-forced v.s. + * legacy-forced issue. + */ + if (vptr->mii_status & VELOCITY_DUPLEX_FULL) +@@ -2486,7 +2518,7 @@ + MII_REG_BITS_ON((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR, vptr->mac_regs); + /* + * Turn on ECHODIS bit in NWay-forced full mode and turn it +- * off it in NWay-forced half mode for NWay-forced v.s. ++ * off it in NWay-forced half mode for NWay-forced v.s. + * legacy-forced issue + */ + if (vptr->mii_status & VELOCITY_DUPLEX_FULL) +@@ -2498,11 +2530,11 @@ + case PHYID_MARVELL_1000: + case PHYID_MARVELL_1000S: + /* +- * Assert CRS on Transmit ++ * Assert CRS on Transmit + */ + MII_REG_BITS_ON(PSCR_ACRSTX, MII_REG_PSCR, vptr->mac_regs); + /* +- * Reset to hardware default ++ * Reset to hardware default + */ + MII_REG_BITS_ON((ANAR_ASMDIR | ANAR_PAUSE), MII_REG_ANAR, vptr->mac_regs); + break; +@@ -2522,7 +2554,7 @@ + * + * Turn off the autopoll and wait for it to disable on the chip + */ +- ++ + static void safe_disable_mii_autopoll(struct mac_regs __iomem * regs) + { + u16 ww; +@@ -2576,7 +2608,7 @@ + * Perform a single read of an MII 16bit register. Returns zero + * on success or -ETIMEDOUT if the PHY did not respond. + */ +- ++ + static int velocity_mii_read(struct mac_regs __iomem *regs, u8 index, u16 *data) + { + u16 ww; +@@ -2612,7 +2644,7 @@ + * Perform a single write to an MII 16bit register. Returns zero + * on success or -ETIMEDOUT if the PHY did not respond. + */ +- ++ + static int velocity_mii_write(struct mac_regs __iomem *regs, u8 mii_addr, u16 data) + { + u16 ww; +@@ -2651,7 +2683,7 @@ + * mii_status accordingly. The requested link state information + * is also returned. + */ +- ++ + static u32 velocity_get_opt_media_mode(struct velocity_info *vptr) + { + u32 status = 0; +@@ -2683,7 +2715,7 @@ + * + * Enable autonegotation on this interface + */ +- ++ + static void mii_set_auto_on(struct velocity_info *vptr) + { + if (MII_REG_BITS_IS_ON(BMCR_AUTO, MII_REG_BMCR, vptr->mac_regs)) +@@ -2707,7 +2739,7 @@ + * Set up the flow control on this interface according to + * the supplied user/eeprom options. + */ +- ++ + static void set_mii_flow_control(struct velocity_info *vptr) + { + /*Enable or Disable PAUSE in ANAR */ +@@ -2744,7 +2776,7 @@ + * PHY and also velocity hardware setup accordingly. In particular + * we need to set up CD polling and frame bursting. + */ +- ++ + static int velocity_set_media_mode(struct velocity_info *vptr, u32 mii_status) + { + u32 curr_status; +@@ -2854,7 +2886,7 @@ + * Check the current MII status and determine the link status + * accordingly + */ +- ++ + static u32 mii_check_media_mode(struct mac_regs __iomem * regs) + { + u32 status = 0; +@@ -2986,14 +3018,14 @@ + * Called before an ethtool operation. We need to make sure the + * chip is out of D3 state before we poke at it. + */ +- ++ + static int velocity_ethtool_up(struct net_device *dev) + { + struct velocity_info *vptr = netdev_priv(dev); + if (!netif_running(dev)) + pci_set_power_state(vptr->pdev, PCI_D0); + return 0; +-} ++} + + /** + * velocity_ethtool_down - post hook for ethtool +@@ -3002,7 +3034,7 @@ + * Called after an ethtool operation. Restore the chip back to D3 + * state if it isn't running. + */ +- ++ + static void velocity_ethtool_down(struct net_device *dev) + { + struct velocity_info *vptr = netdev_priv(dev); +@@ -3040,7 +3072,21 @@ + cmd->duplex = DUPLEX_FULL; + else + cmd->duplex = DUPLEX_HALF; +- ++ ++#if 0 ++{ ++int i; ++unsigned char __iomem *ptr = (unsigned char __iomem *)regs; ++printk("Regs:\n"); ++printk("0x00:\t"); ++for (i=0; i <= MAC_REG_BYTEMSK3_3; ++i) { ++ printk("0x%02x\t", readb(&(ptr[i]))); ++ if (!((i+1) % 8)) { ++ printk("\n0x%02x:\t", i+1); ++ } ++} ++} ++#endif + return 0; + } + +@@ -3050,7 +3096,7 @@ + u32 curr_status; + u32 new_status = 0; + int ret = 0; +- ++ + curr_status = check_connection_type(vptr->mac_regs); + curr_status &= (~VELOCITY_LINK_FAIL); + +@@ -3061,8 +3107,10 @@ + + if ((new_status & VELOCITY_AUTONEG_ENABLE) && (new_status != (curr_status | VELOCITY_AUTONEG_ENABLE))) + ret = -EINVAL; +- else ++ else { + velocity_set_media_mode(vptr, new_status); ++ mac_set_dma_length(vptr); ++ } + + return ret; + } +@@ -3139,7 +3187,7 @@ + msglevel = value; + } + +-static const struct ethtool_ops velocity_ethtool_ops = { ++static struct ethtool_ops velocity_ethtool_ops = { + .get_settings = velocity_get_settings, + .set_settings = velocity_set_settings, + .get_drvinfo = velocity_get_drvinfo, +@@ -3162,7 +3210,7 @@ + * are used by tools like kudzu to interrogate the link state of the + * hardware + */ +- ++ + static int velocity_mii_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) + { + struct velocity_info *vptr = netdev_priv(dev); +@@ -3170,7 +3218,7 @@ + unsigned long flags; + struct mii_ioctl_data *miidata = if_mii(ifr); + int err; +- ++ + switch (cmd) { + case SIOCGMIIPHY: + miidata->phy_id = readb(®s->MIIADR) & 0x1f; +@@ -3197,11 +3245,36 @@ + return 0; + } + ++static void hw_set_mac_address(struct velocity_info *vptr, unsigned char* p) ++{ ++ struct mac_regs __iomem * regs = vptr->mac_regs; ++ ++ int i; ++ for (i = 0; i < 6; i++) { ++ writeb(p[i], &(regs->PAR[i])); ++ } ++} ++ ++static int set_mac_address(struct net_device *dev, void *p) ++{ ++ struct sockaddr *addr = p; ++ struct velocity_info *vptr = dev->priv; ++ ++ if (!is_valid_ether_addr(addr->sa_data)) { ++ return -EADDRNOTAVAIL; ++ } ++ ++ memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); ++ hw_set_mac_address(vptr, addr->sa_data); ++ ++ return 0; ++} ++ + #ifdef CONFIG_PM + + /** + * velocity_save_context - save registers +- * @vptr: velocity ++ * @vptr: velocity + * @context: buffer for stored context + * + * Retrieve the current configuration from the velocity hardware +@@ -3209,7 +3282,7 @@ + * restore functions. This allows us to save things we need across + * power down states + */ +- ++ + static void velocity_save_context(struct velocity_info *vptr, struct velocity_context * context) + { + struct mac_regs __iomem * regs = vptr->mac_regs; +@@ -3229,13 +3302,13 @@ + + /** + * velocity_restore_context - restore registers +- * @vptr: velocity ++ * @vptr: velocity + * @context: buffer for stored context + * +- * Reload the register configuration from the velocity context ++ * Reload the register configuration from the velocity context + * created by velocity_save_context. + */ +- ++ + static void velocity_restore_context(struct velocity_info *vptr, struct velocity_context *context) + { + struct mac_regs __iomem * regs = vptr->mac_regs; +@@ -3301,7 +3374,7 @@ + } + /* Finally, invert the result once to get the correct data */ + crc = ~crc; +- return bitrev32(crc) >> 16; ++ return bitreverse(crc) >> 16; + } + + /** +@@ -3461,8 +3534,6 @@ + return 0; + } + +-#ifdef CONFIG_INET +- + static int velocity_netdev_event(struct notifier_block *nb, unsigned long notification, void *ptr) + { + struct in_ifaddr *ifa = (struct in_ifaddr *) ptr; +@@ -3483,6 +3554,4 @@ + } + return NOTIFY_DONE; + } +- +-#endif + #endif +diff -Nurd linux-2.6.24/drivers/net/via-velocity.h linux-2.6.24-oxe810/drivers/net/via-velocity.h +--- linux-2.6.24/drivers/net/via-velocity.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/via-velocity.h 2008-06-11 17:50:11.000000000 +0200 +@@ -25,8 +25,6 @@ + #ifndef VELOCITY_H + #define VELOCITY_H + +-#define VELOCITY_TX_CSUM_SUPPORT +- + #define VELOCITY_NAME "via-velocity" + #define VELOCITY_FULL_DRV_NAM "VIA Networking Velocity Family Gigabit Ethernet Adapter Driver" + #define VELOCITY_VERSION "1.14" +@@ -35,6 +33,8 @@ + + #define PKT_BUF_SZ 1540 + ++#define PKT_BUF_SZ ETH_ZLEN ++ + #define MAX_UNITS 8 + #define OPTION_DEFAULT { [0 ... MAX_UNITS-1] = -1} + +@@ -716,6 +716,8 @@ + /* + * Bits in the CFGA register + */ ++#define CFGA_PHYLEDS1 0x20 ++#define CFGA_PHYLEDS0 0x10 + + #define CFGA_PMHCTG 0x08 + #define CFGA_GPIO1PD 0x04 +@@ -766,6 +768,7 @@ + #define DCFG_XMRM 0x4000 + #define DCFG_XMRL 0x2000 + #define DCFG_PERDIS 0x1000 ++#define DCFG_MRDPL 0x0800 + #define DCFG_MRWAIT 0x0400 + #define DCFG_MWWAIT 0x0200 + #define DCFG_LATMEN 0x0100 +@@ -1173,7 +1176,7 @@ + + struct velocity_info_tbl { + enum chip_type chip_id; +- const char *name; ++ char *name; + int txqueue; + u32 flags; + }; +@@ -1194,8 +1197,12 @@ + #define mac_disable_int(regs) writel(CR0_GINTMSK1,&((regs)->CR0Clr)) + #define mac_enable_int(regs) writel(CR0_GINTMSK1,&((regs)->CR0Set)) + +-#define mac_set_dma_length(regs, n) {\ +- BYTE_REG_BITS_SET((n),0x07,&((regs)->DCFG));\ ++#define mac_hw_mibs_read(regs, MIBs) {\ ++ int i;\ ++ BYTE_REG_BITS_ON(MIBCR_MPTRINI,&((regs)->MIBCR));\ ++ for (i=0;i<HW_MIB_SIZE;i++) {\ ++ (MIBs)[i]=readl(&((regs)->MIBData));\ ++ }\ + } + + #define mac_set_rx_thresh(regs, n) {\ +@@ -1218,17 +1225,184 @@ + writew(TRDCSR_WAK<<(n*4),&((regs)->TDCSRSet));\ + } + +-static inline void mac_eeprom_reload(struct mac_regs __iomem * regs) { +- int i=0; ++enum velocity_cam_type { ++ VELOCITY_VLAN_ID_CAM = 0, ++ VELOCITY_MULTICAST_CAM ++}; + +- BYTE_REG_BITS_ON(EECSR_RELOAD,&(regs->EECSR)); +- do { +- udelay(10); +- if (i++>0x1000) +- break; +- } while (BYTE_REG_BITS_IS_ON(EECSR_RELOAD,&(regs->EECSR))); ++/** ++ * mac_get_cam_mask - Read a CAM mask ++ * @regs: register block for this velocity ++ * @mask: buffer to store mask ++ * @cam_type: CAM to fetch ++ * ++ * Fetch the mask bits of the selected CAM and store them into the ++ * provided mask buffer. ++ */ ++ ++static inline void mac_get_cam_mask(struct mac_regs __iomem * regs, u8 * mask, enum velocity_cam_type cam_type) ++{ ++ int i; ++ /* Select CAM mask */ ++ BYTE_REG_BITS_SET(CAMCR_PS_CAM_MASK, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ writeb(CAMADDR_VCAMSL, ®s->CAMADDR); ++ else ++ writeb(0, ®s->CAMADDR); ++ ++ /* read mask */ ++ for (i = 0; i < 8; i++) ++ *mask++ = readb(&(regs->MARCAM[i])); ++ ++ /* disable CAMEN */ ++ writeb(0, ®s->CAMADDR); ++ ++ /* Select mar */ ++ BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ ++} ++ ++/** ++ * mac_set_cam_mask - Set a CAM mask ++ * @regs: register block for this velocity ++ * @mask: CAM mask to load ++ * @cam_type: CAM to store ++ * ++ * Store a new mask into a CAM ++ */ ++ ++static inline void mac_set_cam_mask(struct mac_regs __iomem * regs, u8 * mask, enum velocity_cam_type cam_type) ++{ ++ int i; ++ /* Select CAM mask */ ++ BYTE_REG_BITS_SET(CAMCR_PS_CAM_MASK, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ writeb(CAMADDR_CAMEN | CAMADDR_VCAMSL, ®s->CAMADDR); ++ else ++ writeb(CAMADDR_CAMEN, ®s->CAMADDR); ++ ++ for (i = 0; i < 8; i++) { ++ writeb(*mask++, &(regs->MARCAM[i])); ++ } ++ /* disable CAMEN */ ++ writeb(0, ®s->CAMADDR); ++ ++ /* Select mar */ ++ BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); + } + ++/** ++ * mac_set_cam - set CAM data ++ * @regs: register block of this velocity ++ * @idx: Cam index ++ * @addr: 2 or 6 bytes of CAM data ++ * @cam_type: CAM to load ++ * ++ * Load an address or vlan tag into a CAM ++ */ ++ ++static inline void mac_set_cam(struct mac_regs __iomem * regs, int idx, u8 *addr, enum velocity_cam_type cam_type) ++{ ++ int i; ++ ++ /* Select CAM mask */ ++ BYTE_REG_BITS_SET(CAMCR_PS_CAM_DATA, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ ++ idx &= (64 - 1); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ writeb(CAMADDR_CAMEN | CAMADDR_VCAMSL | idx, ®s->CAMADDR); ++ else ++ writeb(CAMADDR_CAMEN | idx, ®s->CAMADDR); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ writew(*((u16 *) addr), ®s->MARCAM[0]); ++ else { ++ for (i = 0; i < 6; i++) { ++ writeb(*addr++, &(regs->MARCAM[i])); ++ } ++ } ++ BYTE_REG_BITS_ON(CAMCR_CAMWR, ®s->CAMCR); ++ ++ udelay(10); ++ ++ writeb(0, ®s->CAMADDR); ++ ++ /* Select mar */ ++ BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++} ++ ++/** ++ * mac_get_cam - fetch CAM data ++ * @regs: register block of this velocity ++ * @idx: Cam index ++ * @addr: buffer to hold up to 6 bytes of CAM data ++ * @cam_type: CAM to load ++ * ++ * Load an address or vlan tag from a CAM into the buffer provided by ++ * the caller. VLAN tags are 2 bytes the address cam entries are 6. ++ */ ++ ++static inline void mac_get_cam(struct mac_regs __iomem * regs, int idx, u8 *addr, enum velocity_cam_type cam_type) ++{ ++ int i; ++ ++ /* Select CAM mask */ ++ BYTE_REG_BITS_SET(CAMCR_PS_CAM_DATA, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++ ++ idx &= (64 - 1); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ writeb(CAMADDR_CAMEN | CAMADDR_VCAMSL | idx, ®s->CAMADDR); ++ else ++ writeb(CAMADDR_CAMEN | idx, ®s->CAMADDR); ++ ++ BYTE_REG_BITS_ON(CAMCR_CAMRD, ®s->CAMCR); ++ ++ udelay(10); ++ ++ if (cam_type == VELOCITY_VLAN_ID_CAM) ++ *((u16 *) addr) = readw(&(regs->MARCAM[0])); ++ else ++ for (i = 0; i < 6; i++, addr++) ++ *((u8 *) addr) = readb(&(regs->MARCAM[i])); ++ ++ writeb(0, ®s->CAMADDR); ++ ++ /* Select mar */ ++ BYTE_REG_BITS_SET(CAMCR_PS_MAR, CAMCR_PS1 | CAMCR_PS0, ®s->CAMCR); ++} ++ ++/** ++ * mac_wol_reset - reset WOL after exiting low power ++ * @regs: register block of this velocity ++ * ++ * Called after we drop out of wake on lan mode in order to ++ * reset the Wake on lan features. This function doesn't restore ++ * the rest of the logic from the result of sleep/wakeup ++ */ ++ ++static inline void mac_wol_reset(struct mac_regs __iomem * regs) ++{ ++ ++ /* Turn off SWPTAG right after leaving power mode */ ++ BYTE_REG_BITS_OFF(STICKHW_SWPTAG, ®s->STICKHW); ++ /* clear sticky bits */ ++ BYTE_REG_BITS_OFF((STICKHW_DS1 | STICKHW_DS0), ®s->STICKHW); ++ ++ BYTE_REG_BITS_OFF(CHIPGCR_FCGMII, ®s->CHIPGCR); ++ BYTE_REG_BITS_OFF(CHIPGCR_FCMODE, ®s->CHIPGCR); ++ /* disable force PME-enable */ ++ writeb(WOLCFG_PMEOVR, ®s->WOLCFGClr); ++ /* disable power-event config bit */ ++ writew(0xFFFF, ®s->WOLCRClr); ++ /* clear power status */ ++ writew(0xFFFF, ®s->WOLSRClr); ++} ++ ++ + /* + * Header for WOL definitions. Used to compute hashes + */ +@@ -1515,8 +1689,9 @@ + int numrx; /* Number of RX descriptors */ + int numtx; /* Number of TX descriptors */ + enum speed_opt spd_dpx; /* Media link mode */ +- +- int DMA_length; /* DMA length */ ++ int vid; /* vlan id */ ++ int DMA_length_100M; /* DMA length at 100Mb/s */ ++ int DMA_length_1000M; /* DMA length at 1Gb/s */ + int rx_thresh; /* RX_THRESH */ + int flow_cntl; + int wol_opts; /* Wake on lan options */ +@@ -1541,7 +1716,6 @@ + dma_addr_t tx_bufs_dma; + u8 *tx_bufs; + +- struct vlan_group *vlgrp; + u8 ip_addr[4]; + enum chip_type chip_id; + +@@ -1578,7 +1752,6 @@ + int rx_buf_sz; + u32 mii_status; + u32 phy_id; +- int multicast_limit; + + u8 vCAMmask[(VCAM_SIZE / 8)]; + u8 mCAMmask[(MCAM_SIZE / 8)]; +@@ -1623,32 +1796,6 @@ + } + + /** +- * velocity_update_hw_mibs - fetch MIB counters from chip +- * @vptr: velocity to update +- * +- * The velocity hardware keeps certain counters in the hardware +- * side. We need to read these when the user asks for statistics +- * or when they overflow (causing an interrupt). The read of the +- * statistic clears it, so we keep running master counters in user +- * space. +- */ +- +-static inline void velocity_update_hw_mibs(struct velocity_info *vptr) +-{ +- u32 tmp; +- int i; +- BYTE_REG_BITS_ON(MIBCR_MIBFLSH, &(vptr->mac_regs->MIBCR)); +- +- while (BYTE_REG_BITS_IS_ON(MIBCR_MIBFLSH, &(vptr->mac_regs->MIBCR))); +- +- BYTE_REG_BITS_ON(MIBCR_MPTRINI, &(vptr->mac_regs->MIBCR)); +- for (i = 0; i < HW_MIB_SIZE; i++) { +- tmp = readl(&(vptr->mac_regs->MIBData)) & 0x00FFFFFFUL; +- vptr->mib_counter[i] += tmp; +- } +-} +- +-/** + * init_flow_control_register - set up flow control + * @vptr: velocity to configure + * +diff -Nurd linux-2.6.24/drivers/net/wireless/b43/dma.c linux-2.6.24-oxe810/drivers/net/wireless/b43/dma.c +--- linux-2.6.24/drivers/net/wireless/b43/dma.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43/dma.c 2008-06-11 17:49:58.000000000 +0200 +@@ -165,7 +165,7 @@ + addrhi = (((u64) dmaaddr >> 32) & ~SSB_DMA_TRANSLATION_MASK); + addrext = (((u64) dmaaddr >> 32) & SSB_DMA_TRANSLATION_MASK) + >> SSB_DMA_TRANSLATION_SHIFT; +- addrhi |= ssb_dma_translation(ring->dev->dev); ++ addrhi |= (ssb_dma_translation(ring->dev->dev) << 1); + if (slot == ring->nr_slots - 1) + ctl0 |= B43_DMA64_DCTL0_DTABLEEND; + if (start) +@@ -426,9 +426,21 @@ + static int alloc_ringmemory(struct b43_dmaring *ring) + { + struct device *dev = ring->dev->dev->dev; ++ gfp_t flags = GFP_KERNEL; + ++ /* The specs call for 4K buffers for 30- and 32-bit DMA with 4K ++ * alignment and 8K buffers for 64-bit DMA with 8K alignment. Testing ++ * has shown that 4K is sufficient for the latter as long as the buffer ++ * does not cross an 8K boundary. ++ * ++ * For unknown reasons - possibly a hardware error - the BCM4311 rev ++ * 02, which uses 64-bit DMA, needs the ring buffer in very low memory, ++ * which accounts for the GFP_DMA flag below. ++ */ ++ if (ring->dma64) ++ flags |= GFP_DMA; + ring->descbase = dma_alloc_coherent(dev, B43_DMA_RINGMEMSIZE, +- &(ring->dmabase), GFP_KERNEL); ++ &(ring->dmabase), flags); + if (!ring->descbase) { + b43err(ring->dev->wl, "DMA ringmemory allocation failed\n"); + return -ENOMEM; +@@ -483,7 +495,7 @@ + return 0; + } + +-/* Reset the RX DMA channel */ ++/* Reset the TX DMA channel */ + int b43_dmacontroller_tx_reset(struct b43_wldev *dev, u16 mmio_base, int dma64) + { + int i; +@@ -647,7 +659,7 @@ + b43_dma_write(ring, B43_DMA64_TXRINGHI, + ((ringbase >> 32) & + ~SSB_DMA_TRANSLATION_MASK) +- | trans); ++ | (trans << 1)); + } else { + u32 ringbase = (u32) (ring->dmabase); + +@@ -680,8 +692,9 @@ + b43_dma_write(ring, B43_DMA64_RXRINGHI, + ((ringbase >> 32) & + ~SSB_DMA_TRANSLATION_MASK) +- | trans); +- b43_dma_write(ring, B43_DMA64_RXINDEX, 200); ++ | (trans << 1)); ++ b43_dma_write(ring, B43_DMA64_RXINDEX, ring->nr_slots * ++ sizeof(struct b43_dmadesc64)); + } else { + u32 ringbase = (u32) (ring->dmabase); + +@@ -695,11 +708,12 @@ + b43_dma_write(ring, B43_DMA32_RXRING, + (ringbase & ~SSB_DMA_TRANSLATION_MASK) + | trans); +- b43_dma_write(ring, B43_DMA32_RXINDEX, 200); ++ b43_dma_write(ring, B43_DMA32_RXINDEX, ring->nr_slots * ++ sizeof(struct b43_dmadesc32)); + } + } + +- out: ++out: + return err; + } + +@@ -1106,7 +1120,7 @@ + { + const struct b43_dma_ops *ops = ring->ops; + u8 *header; +- int slot; ++ int slot, old_top_slot, old_used_slots; + int err; + struct b43_dmadesc_generic *desc; + struct b43_dmadesc_meta *meta; +@@ -1116,20 +1130,31 @@ + #define SLOTS_PER_PACKET 2 + B43_WARN_ON(skb_shinfo(skb)->nr_frags); + ++ old_top_slot = ring->current_slot; ++ old_used_slots = ring->used_slots; ++ + /* Get a slot for the header. */ + slot = request_slot(ring); + desc = ops->idx2desc(ring, slot, &meta_hdr); + memset(meta_hdr, 0, sizeof(*meta_hdr)); + + header = &(ring->txhdr_cache[slot * sizeof(struct b43_txhdr_fw4)]); +- b43_generate_txhdr(ring->dev, header, ++ err = b43_generate_txhdr(ring->dev, header, + skb->data, skb->len, ctl, + generate_cookie(ring, slot)); ++ if (unlikely(err)) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; ++ return err; ++ } + + meta_hdr->dmaaddr = map_descbuffer(ring, (unsigned char *)header, + sizeof(struct b43_txhdr_fw4), 1); +- if (dma_mapping_error(meta_hdr->dmaaddr)) ++ if (dma_mapping_error(meta_hdr->dmaaddr)) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; + return -EIO; ++ } + ops->fill_descriptor(ring, desc, meta_hdr->dmaaddr, + sizeof(struct b43_txhdr_fw4), 1, 0, 0); + +@@ -1147,6 +1172,8 @@ + if (dma_mapping_error(meta->dmaaddr)) { + bounce_skb = __dev_alloc_skb(skb->len, GFP_ATOMIC | GFP_DMA); + if (!bounce_skb) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; + err = -ENOMEM; + goto out_unmap_hdr; + } +@@ -1157,6 +1184,8 @@ + meta->skb = skb; + meta->dmaaddr = map_descbuffer(ring, skb->data, skb->len, 1); + if (dma_mapping_error(meta->dmaaddr)) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; + err = -EIO; + goto out_free_bounce; + } +@@ -1219,6 +1248,13 @@ + B43_WARN_ON(ring->stopped); + + err = dma_tx_fragment(ring, skb, ctl); ++ if (unlikely(err == -ENOKEY)) { ++ /* Drop this packet, as we don't have the encryption key ++ * anymore and must not transmit it unencrypted. */ ++ dev_kfree_skb_any(skb); ++ err = 0; ++ goto out_unlock; ++ } + if (unlikely(err)) { + b43err(dev->wl, "DMA tx mapping failure\n"); + goto out_unlock; +diff -Nurd linux-2.6.24/drivers/net/wireless/b43/main.c linux-2.6.24-oxe810/drivers/net/wireless/b43/main.c +--- linux-2.6.24/drivers/net/wireless/b43/main.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43/main.c 2008-06-11 17:49:58.000000000 +0200 +@@ -101,6 +101,7 @@ + SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_80211, 7), + SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_80211, 9), + SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_80211, 10), ++ SSB_DEVICE(SSB_VENDOR_BROADCOM, SSB_DEV_80211, 13), + SSB_DEVTABLE_END + }; + +@@ -1800,6 +1801,18 @@ + err = -EOPNOTSUPP; + goto out; + } ++ if (fwrev > 351) { ++ b43err(dev->wl, "YOUR FIRMWARE IS TOO NEW. Please downgrade your " ++ "firmware.\n"); ++ b43err(dev->wl, "Use this firmware tarball: " ++ "http://downloads.openwrt.org/sources/broadcom-wl-4.80.53.0.tar.bz2\n"); ++ b43err(dev->wl, "Use this b43-fwcutter tarball: " ++ "http://bu3sch.de/b43/fwcutter/b43-fwcutter-009.tar.bz2\n"); ++ b43err(dev->wl, "Read, understand and _do_ what this message says, please.\n"); ++ b43_write32(dev, B43_MMIO_MACCTL, 0); ++ err = -EOPNOTSUPP; ++ goto out; ++ } + b43dbg(dev->wl, "Loading firmware version %u.%u " + "(20%.2i-%.2i-%.2i %.2i:%.2i:%.2i)\n", + fwrev, fwpatch, +@@ -3067,7 +3080,7 @@ + unsupported = 1; + break; + case B43_PHYTYPE_G: +- if (phy_rev > 8) ++ if (phy_rev > 9) + unsupported = 1; + break; + default: +@@ -3395,8 +3408,6 @@ + b43_bluetooth_coext_enable(dev); + + ssb_bus_powerup(bus, 1); /* Enable dynamic PCTL */ +- memset(wl->bssid, 0, ETH_ALEN); +- memset(wl->mac_addr, 0, ETH_ALEN); + b43_upload_card_macaddress(dev); + b43_security_init(dev); + b43_rng_init(wl); +@@ -3493,6 +3504,13 @@ + int did_init = 0; + int err = 0; + ++ /* Kill all old instance specific information to make sure ++ * the card won't use it in the short timeframe between start ++ * and mac80211 reconfiguring it. */ ++ memset(wl->bssid, 0, ETH_ALEN); ++ memset(wl->mac_addr, 0, ETH_ALEN); ++ wl->filter_flags = 0; ++ + /* First register RFkill. + * LEDs that are registered later depend on it. */ + b43_rfkill_init(dev); +diff -Nurd linux-2.6.24/drivers/net/wireless/b43/xmit.c linux-2.6.24-oxe810/drivers/net/wireless/b43/xmit.c +--- linux-2.6.24/drivers/net/wireless/b43/xmit.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43/xmit.c 2008-06-11 17:49:58.000000000 +0200 +@@ -177,7 +177,7 @@ + return 0; + } + +-static void generate_txhdr_fw4(struct b43_wldev *dev, ++static int generate_txhdr_fw4(struct b43_wldev *dev, + struct b43_txhdr_fw4 *txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, +@@ -235,7 +235,15 @@ + + B43_WARN_ON(key_idx >= dev->max_nr_keys); + key = &(dev->key[key_idx]); +- B43_WARN_ON(!key->keyconf); ++ ++ if (unlikely(!key->keyconf)) { ++ /* This key is invalid. This might only happen ++ * in a short timeframe after machine resume before ++ * we were able to reconfigure keys. ++ * Drop this packet completely. Do not transmit it ++ * unencrypted to avoid leaking information. */ ++ return -ENOKEY; ++ } + + /* Hardware appends ICV. */ + plcp_fragment_len += txctl->icv_len; +@@ -352,16 +360,18 @@ + txhdr->mac_ctl = cpu_to_le32(mac_ctl); + txhdr->phy_ctl = cpu_to_le16(phy_ctl); + txhdr->extra_ft = extra_ft; ++ ++ return 0; + } + +-void b43_generate_txhdr(struct b43_wldev *dev, ++int b43_generate_txhdr(struct b43_wldev *dev, + u8 * txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, + const struct ieee80211_tx_control *txctl, u16 cookie) + { +- generate_txhdr_fw4(dev, (struct b43_txhdr_fw4 *)txhdr, +- fragment_data, fragment_len, txctl, cookie); ++ return generate_txhdr_fw4(dev, (struct b43_txhdr_fw4 *)txhdr, ++ fragment_data, fragment_len, txctl, cookie); + } + + static s8 b43_rssi_postprocess(struct b43_wldev *dev, +diff -Nurd linux-2.6.24/drivers/net/wireless/b43/xmit.h linux-2.6.24-oxe810/drivers/net/wireless/b43/xmit.h +--- linux-2.6.24/drivers/net/wireless/b43/xmit.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43/xmit.h 2008-06-11 17:49:58.000000000 +0200 +@@ -82,7 +82,7 @@ + #define B43_TX4_PHY_ANT1 0x0100 /* Use antenna 1 */ + #define B43_TX4_PHY_ANTLAST 0x0300 /* Use last used antenna */ + +-void b43_generate_txhdr(struct b43_wldev *dev, ++int b43_generate_txhdr(struct b43_wldev *dev, + u8 * txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, +diff -Nurd linux-2.6.24/drivers/net/wireless/b43legacy/dma.c linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/dma.c +--- linux-2.6.24/drivers/net/wireless/b43legacy/dma.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/dma.c 2008-06-11 17:49:57.000000000 +0200 +@@ -1164,7 +1164,7 @@ + { + const struct b43legacy_dma_ops *ops = ring->ops; + u8 *header; +- int slot; ++ int slot, old_top_slot, old_used_slots; + int err; + struct b43legacy_dmadesc_generic *desc; + struct b43legacy_dmadesc_meta *meta; +@@ -1174,6 +1174,9 @@ + #define SLOTS_PER_PACKET 2 + B43legacy_WARN_ON(skb_shinfo(skb)->nr_frags != 0); + ++ old_top_slot = ring->current_slot; ++ old_used_slots = ring->used_slots; ++ + /* Get a slot for the header. */ + slot = request_slot(ring); + desc = ops->idx2desc(ring, slot, &meta_hdr); +@@ -1181,9 +1184,14 @@ + + header = &(ring->txhdr_cache[slot * sizeof( + struct b43legacy_txhdr_fw3)]); +- b43legacy_generate_txhdr(ring->dev, header, ++ err = b43legacy_generate_txhdr(ring->dev, header, + skb->data, skb->len, ctl, + generate_cookie(ring, slot)); ++ if (unlikely(err)) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; ++ return err; ++ } + + meta_hdr->dmaaddr = map_descbuffer(ring, (unsigned char *)header, + sizeof(struct b43legacy_txhdr_fw3), 1); +@@ -1206,6 +1214,8 @@ + if (dma_mapping_error(meta->dmaaddr)) { + bounce_skb = __dev_alloc_skb(skb->len, GFP_ATOMIC | GFP_DMA); + if (!bounce_skb) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; + err = -ENOMEM; + goto out_unmap_hdr; + } +@@ -1216,6 +1226,8 @@ + meta->skb = skb; + meta->dmaaddr = map_descbuffer(ring, skb->data, skb->len, 1); + if (dma_mapping_error(meta->dmaaddr)) { ++ ring->current_slot = old_top_slot; ++ ring->used_slots = old_used_slots; + err = -EIO; + goto out_free_bounce; + } +@@ -1282,6 +1294,13 @@ + B43legacy_BUG_ON(ring->stopped); + + err = dma_tx_fragment(ring, skb, ctl); ++ if (unlikely(err == -ENOKEY)) { ++ /* Drop this packet, as we don't have the encryption key ++ * anymore and must not transmit it unencrypted. */ ++ dev_kfree_skb_any(skb); ++ err = 0; ++ goto out_unlock; ++ } + if (unlikely(err)) { + b43legacyerr(dev->wl, "DMA tx mapping failure\n"); + goto out_unlock; +diff -Nurd linux-2.6.24/drivers/net/wireless/b43legacy/main.c linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/main.c +--- linux-2.6.24/drivers/net/wireless/b43legacy/main.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/main.c 2008-06-11 17:49:57.000000000 +0200 +@@ -3215,8 +3215,6 @@ + b43legacy_shm_write16(dev, B43legacy_SHM_SHARED, 0x0414, 0x01F4); + + ssb_bus_powerup(bus, 1); /* Enable dynamic PCTL */ +- memset(wl->bssid, 0, ETH_ALEN); +- memset(wl->mac_addr, 0, ETH_ALEN); + b43legacy_upload_card_macaddress(dev); + b43legacy_security_init(dev); + b43legacy_rng_init(wl); +@@ -3311,6 +3309,13 @@ + int did_init = 0; + int err = 0; + ++ /* Kill all old instance specific information to make sure ++ * the card won't use it in the short timeframe between start ++ * and mac80211 reconfiguring it. */ ++ memset(wl->bssid, 0, ETH_ALEN); ++ memset(wl->mac_addr, 0, ETH_ALEN); ++ wl->filter_flags = 0; ++ + mutex_lock(&wl->mutex); + + if (b43legacy_status(dev) < B43legacy_STAT_INITIALIZED) { +diff -Nurd linux-2.6.24/drivers/net/wireless/b43legacy/pio.c linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/pio.c +--- linux-2.6.24/drivers/net/wireless/b43legacy/pio.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/pio.c 2008-06-11 17:49:57.000000000 +0200 +@@ -181,7 +181,7 @@ + struct b43legacy_txhdr_fw3 txhdr_fw3; + }; + +-static void pio_tx_write_fragment(struct b43legacy_pioqueue *queue, ++static int pio_tx_write_fragment(struct b43legacy_pioqueue *queue, + struct sk_buff *skb, + struct b43legacy_pio_txpacket *packet, + size_t txhdr_size) +@@ -189,14 +189,17 @@ + union txhdr_union txhdr_data; + u8 *txhdr = NULL; + unsigned int octets; ++ int err; + + txhdr = (u8 *)(&txhdr_data.txhdr_fw3); + + B43legacy_WARN_ON(skb_shinfo(skb)->nr_frags != 0); +- b43legacy_generate_txhdr(queue->dev, ++ err = b43legacy_generate_txhdr(queue->dev, + txhdr, skb->data, skb->len, + &packet->txstat.control, + generate_cookie(queue, packet)); ++ if (err) ++ return err; + + tx_start(queue); + octets = skb->len + txhdr_size; +@@ -204,6 +207,8 @@ + octets--; + tx_data(queue, txhdr, (u8 *)skb->data, octets); + tx_complete(queue, skb); ++ ++ return 0; + } + + static void free_txpacket(struct b43legacy_pio_txpacket *packet, +@@ -226,6 +231,7 @@ + struct b43legacy_pioqueue *queue = packet->queue; + struct sk_buff *skb = packet->skb; + u16 octets; ++ int err; + + octets = (u16)skb->len + sizeof(struct b43legacy_txhdr_fw3); + if (queue->tx_devq_size < octets) { +@@ -247,8 +253,14 @@ + if (queue->tx_devq_used + octets > queue->tx_devq_size) + return -EBUSY; + /* Now poke the device. */ +- pio_tx_write_fragment(queue, skb, packet, ++ err = pio_tx_write_fragment(queue, skb, packet, + sizeof(struct b43legacy_txhdr_fw3)); ++ if (unlikely(err == -ENOKEY)) { ++ /* Drop this packet, as we don't have the encryption key ++ * anymore and must not transmit it unencrypted. */ ++ free_txpacket(packet, 1); ++ return 0; ++ } + + /* Account for the packet size. + * (We must not overflow the device TX queue) +@@ -486,6 +498,9 @@ + queue = parse_cookie(dev, status->cookie, &packet); + B43legacy_WARN_ON(!queue); + ++ if (!packet->skb) ++ return; ++ + queue->tx_devq_packets--; + queue->tx_devq_used -= (packet->skb->len + + sizeof(struct b43legacy_txhdr_fw3)); +diff -Nurd linux-2.6.24/drivers/net/wireless/b43legacy/xmit.c linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/xmit.c +--- linux-2.6.24/drivers/net/wireless/b43legacy/xmit.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/xmit.c 2008-06-11 17:49:57.000000000 +0200 +@@ -181,7 +181,7 @@ + return 0; + } + +-static void generate_txhdr_fw3(struct b43legacy_wldev *dev, ++static int generate_txhdr_fw3(struct b43legacy_wldev *dev, + struct b43legacy_txhdr_fw3 *txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, +@@ -252,6 +252,13 @@ + iv_len = min((size_t)txctl->iv_len, + ARRAY_SIZE(txhdr->iv)); + memcpy(txhdr->iv, ((u8 *)wlhdr) + wlhdr_len, iv_len); ++ } else { ++ /* This key is invalid. This might only happen ++ * in a short timeframe after machine resume before ++ * we were able to reconfigure keys. ++ * Drop this packet completely. Do not transmit it ++ * unencrypted to avoid leaking information. */ ++ return -ENOKEY; + } + } + b43legacy_generate_plcp_hdr((struct b43legacy_plcp_hdr4 *) +@@ -344,16 +351,18 @@ + /* Apply the bitfields */ + txhdr->mac_ctl = cpu_to_le32(mac_ctl); + txhdr->phy_ctl = cpu_to_le16(phy_ctl); ++ ++ return 0; + } + +-void b43legacy_generate_txhdr(struct b43legacy_wldev *dev, ++int b43legacy_generate_txhdr(struct b43legacy_wldev *dev, + u8 *txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, + const struct ieee80211_tx_control *txctl, + u16 cookie) + { +- generate_txhdr_fw3(dev, (struct b43legacy_txhdr_fw3 *)txhdr, ++ return generate_txhdr_fw3(dev, (struct b43legacy_txhdr_fw3 *)txhdr, + fragment_data, fragment_len, + txctl, cookie); + } +diff -Nurd linux-2.6.24/drivers/net/wireless/b43legacy/xmit.h linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/xmit.h +--- linux-2.6.24/drivers/net/wireless/b43legacy/xmit.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/net/wireless/b43legacy/xmit.h 2008-06-11 17:49:57.000000000 +0200 +@@ -76,7 +76,7 @@ + + + +-void b43legacy_generate_txhdr(struct b43legacy_wldev *dev, ++int b43legacy_generate_txhdr(struct b43legacy_wldev *dev, + u8 *txhdr, + const unsigned char *fragment_data, + unsigned int fragment_len, +diff -Nurd linux-2.6.24/drivers/pci/hotplug/fakephp.c linux-2.6.24-oxe810/drivers/pci/hotplug/fakephp.c +--- linux-2.6.24/drivers/pci/hotplug/fakephp.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/pci/hotplug/fakephp.c 2008-06-11 17:49:28.000000000 +0200 +@@ -39,6 +39,7 @@ + #include <linux/init.h> + #include <linux/string.h> + #include <linux/slab.h> ++#include <linux/workqueue.h> + #include "../pci.h" + + #if !defined(MODULE) +@@ -63,10 +64,16 @@ + struct list_head node; + struct hotplug_slot *slot; + struct pci_dev *dev; ++ struct work_struct remove_work; ++ unsigned long removed; + }; + + static int debug; + static LIST_HEAD(slot_list); ++static struct workqueue_struct *dummyphp_wq; ++ ++static void pci_rescan_worker(struct work_struct *work); ++static DECLARE_WORK(pci_rescan_work, pci_rescan_worker); + + static int enable_slot (struct hotplug_slot *slot); + static int disable_slot (struct hotplug_slot *slot); +@@ -109,7 +116,7 @@ + slot->name = &dev->dev.bus_id[0]; + dbg("slot->name = %s\n", slot->name); + +- dslot = kmalloc(sizeof(struct dummy_slot), GFP_KERNEL); ++ dslot = kzalloc(sizeof(struct dummy_slot), GFP_KERNEL); + if (!dslot) + goto error_info; + +@@ -164,6 +171,14 @@ + err("Problem unregistering a slot %s\n", dslot->slot->name); + } + ++/* called from the single-threaded workqueue handler to remove a slot */ ++static void remove_slot_worker(struct work_struct *work) ++{ ++ struct dummy_slot *dslot = ++ container_of(work, struct dummy_slot, remove_work); ++ remove_slot(dslot); ++} ++ + /** + * pci_rescan_slot - Rescan slot + * @temp: Device template. Should be set: bus and devfn. +@@ -267,11 +282,17 @@ + pci_rescan_buses(&pci_root_buses); + } + ++/* called from the single-threaded workqueue handler to rescan all pci buses */ ++static void pci_rescan_worker(struct work_struct *work) ++{ ++ pci_rescan(); ++} + + static int enable_slot(struct hotplug_slot *hotplug_slot) + { + /* mis-use enable_slot for rescanning of the pci bus */ +- pci_rescan(); ++ cancel_work_sync(&pci_rescan_work); ++ queue_work(dummyphp_wq, &pci_rescan_work); + return -ENODEV; + } + +@@ -306,6 +327,10 @@ + err("Can't remove PCI devices with other PCI devices behind it yet.\n"); + return -ENODEV; + } ++ if (test_and_set_bit(0, &dslot->removed)) { ++ dbg("Slot already scheduled for removal\n"); ++ return -ENODEV; ++ } + /* search for subfunctions and disable them first */ + if (!(dslot->dev->devfn & 7)) { + for (func = 1; func < 8; func++) { +@@ -328,8 +353,9 @@ + /* remove the device from the pci core */ + pci_remove_bus_device(dslot->dev); + +- /* blow away this sysfs entry and other parts. */ +- remove_slot(dslot); ++ /* queue work item to blow away this sysfs entry and other parts. */ ++ INIT_WORK(&dslot->remove_work, remove_slot_worker); ++ queue_work(dummyphp_wq, &dslot->remove_work); + + return 0; + } +@@ -340,6 +366,7 @@ + struct list_head *next; + struct dummy_slot *dslot; + ++ destroy_workqueue(dummyphp_wq); + list_for_each_safe (tmp, next, &slot_list) { + dslot = list_entry (tmp, struct dummy_slot, node); + remove_slot(dslot); +@@ -351,6 +378,10 @@ + { + info(DRIVER_DESC "\n"); + ++ dummyphp_wq = create_singlethread_workqueue(MY_NAME); ++ if (!dummyphp_wq) ++ return -ENOMEM; ++ + return pci_scan_buses(); + } + +diff -Nurd linux-2.6.24/drivers/pci/probe.c linux-2.6.24-oxe810/drivers/pci/probe.c +--- linux-2.6.24/drivers/pci/probe.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/pci/probe.c 2008-06-11 17:49:28.000000000 +0200 +@@ -991,8 +991,18 @@ + for (func = 0; func < 8; func++, devfn++) { + struct pci_dev *dev; + +- dev = pci_scan_single_device(bus, devfn); +- if (dev) { ++#ifdef CONFIG_PCI_HIPOX_CARDBUS ++ // printk(KERN_INFO "pci_scan_slot %u\n", PCI_SLOT(devfn) ); ++ scan_all_fns = 1; ++ if ( PCI_SLOT(devfn) == 5 ) ++ dev = pci_scan_single_device(bus, devfn); ++ else ++ dev = 0; ++#else /* ifndef CONFIG_HIPOX_CARDBUS */ ++ dev = pci_scan_single_device(bus, devfn); ++#endif /* CONFIG_HIPOX_CARDBUS */ ++ ++ if (dev) { + nr++; + + /* +diff -Nurd linux-2.6.24/drivers/rtc/rtc-ds1307.c linux-2.6.24-oxe810/drivers/rtc/rtc-ds1307.c +--- linux-2.6.24/drivers/rtc/rtc-ds1307.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/rtc/rtc-ds1307.c 2008-06-11 17:49:41.000000000 +0200 +@@ -17,7 +17,7 @@ + #include <linux/rtc.h> + #include <linux/bcd.h> + +- ++#define ACCEPT_UNINITIALIZED_DEVICE_IN_PROBE + + /* We can't determine type by probing, but if we expect pre-Linux code + * to have set the chip up as a clock (turning on the oscillator and +@@ -445,6 +445,7 @@ + break; + } + ++#ifndef ACCEPT_UNINITIALIZED_DEVICE_IN_PROBE + tmp = ds1307->regs[DS1307_REG_SECS]; + tmp = BCD2BIN(tmp & 0x7f); + if (tmp > 60) +@@ -460,6 +461,7 @@ + tmp = BCD2BIN(ds1307->regs[DS1307_REG_MONTH] & 0x1f); + if (tmp == 0 || tmp > 12) + goto exit_bad; ++#endif // !ACCEPT_UNINITIALIZED_DEVICE_IN_PROBE + + tmp = ds1307->regs[DS1307_REG_HOUR]; + switch (ds1307->type) { +diff -Nurd linux-2.6.24/drivers/s390/char/defkeymap.c linux-2.6.24-oxe810/drivers/s390/char/defkeymap.c +--- linux-2.6.24/drivers/s390/char/defkeymap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/s390/char/defkeymap.c 2008-06-11 17:49:17.000000000 +0200 +@@ -151,8 +151,8 @@ + }; + + struct kbdiacruc accent_table[MAX_DIACR] = { +- {'^', 'c', '\003'}, {'^', 'd', '\004'}, +- {'^', 'z', '\032'}, {'^', '\012', '\000'}, ++ {'^', 'c', 0003}, {'^', 'd', 0004}, ++ {'^', 'z', 0032}, {'^', 0012, 0000}, + }; + + unsigned int accent_table_size = 4; +diff -Nurd linux-2.6.24/drivers/scsi/Kconfig linux-2.6.24-oxe810/drivers/scsi/Kconfig +--- linux-2.6.24/drivers/scsi/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/Kconfig 2008-06-11 17:50:29.000000000 +0200 +@@ -556,6 +556,15 @@ + To compile this driver as a module, choose M here: the + module will be called arcmsr (modprobe arcmsr). + ++config SCSI_SATA_DISK_DETECTION_TENACITY ++ int "The number of attempts to detect a disk." ++ default 1 ++ depends on SCSI_SATA ++ help ++ Sets the number of times taken to repeat a 700 ms process of detecting a disk. Some disks will not respond to detection until they have spun-up and they won't spin-up untill they receive some communication from the host. ++ ++ If unsure, use 1. ++ + config SCSI_ARCMSR_AER + bool "Enable PCI Error Recovery Capability in Areca Driver(ARCMSR)" + depends on SCSI_ARCMSR && PCIEAER +diff -Nurd linux-2.6.24/drivers/scsi/advansys.c linux-2.6.24-oxe810/drivers/scsi/advansys.c +--- linux-2.6.24/drivers/scsi/advansys.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/advansys.c 2008-06-11 17:50:28.000000000 +0200 +@@ -566,7 +566,7 @@ + ASC_SCSI_BIT_ID_TYPE unit_not_ready; + ASC_SCSI_BIT_ID_TYPE queue_full_or_busy; + ASC_SCSI_BIT_ID_TYPE start_motor; +- uchar overrun_buf[ASC_OVERRUN_BSIZE] __aligned(8); ++ uchar *overrun_buf; + dma_addr_t overrun_dma; + uchar scsi_reset_wait; + uchar chip_no; +@@ -6439,7 +6439,7 @@ + i += 2; + len += 2; + } else { +- unsigned char off = buf[i] * 2; ++ unsigned int off = buf[i] * 2; + unsigned short word = (buf[off + 1] << 8) | buf[off]; + AdvWriteWordAutoIncLram(iop_base, word); + len += 2; +@@ -13833,6 +13833,12 @@ + */ + if (ASC_NARROW_BOARD(boardp)) { + ASC_DBG(2, "AscInitAsc1000Driver()\n"); ++ ++ asc_dvc_varp->overrun_buf = kzalloc(ASC_OVERRUN_BSIZE, GFP_KERNEL); ++ if (!asc_dvc_varp->overrun_buf) { ++ ret = -ENOMEM; ++ goto err_free_wide_mem; ++ } + warn_code = AscInitAsc1000Driver(asc_dvc_varp); + + if (warn_code || asc_dvc_varp->err_code) { +@@ -13840,8 +13846,10 @@ + "warn 0x%x, error 0x%x\n", + asc_dvc_varp->init_state, warn_code, + asc_dvc_varp->err_code); +- if (asc_dvc_varp->err_code) ++ if (asc_dvc_varp->err_code) { + ret = -ENODEV; ++ kfree(asc_dvc_varp->overrun_buf); ++ } + } + } else { + if (advansys_wide_init_chip(shost)) +@@ -13894,6 +13902,7 @@ + dma_unmap_single(board->dev, + board->dvc_var.asc_dvc_var.overrun_dma, + ASC_OVERRUN_BSIZE, DMA_FROM_DEVICE); ++ kfree(board->dvc_var.asc_dvc_var.overrun_buf); + } else { + iounmap(board->ioremap_addr); + advansys_wide_free_mem(board); +diff -Nurd linux-2.6.24/drivers/scsi/aic94xx/aic94xx_scb.c linux-2.6.24-oxe810/drivers/scsi/aic94xx/aic94xx_scb.c +--- linux-2.6.24/drivers/scsi/aic94xx/aic94xx_scb.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/aic94xx/aic94xx_scb.c 2008-06-11 17:50:27.000000000 +0200 +@@ -458,13 +458,19 @@ + tc_abort = le16_to_cpu(tc_abort); + + list_for_each_entry_safe(a, b, &asd_ha->seq.pend_q, list) { +- struct sas_task *task = ascb->uldd_task; ++ struct sas_task *task = a->uldd_task; + +- if (task && a->tc_index == tc_abort) { ++ if (a->tc_index != tc_abort) ++ continue; ++ ++ if (task) { + failed_dev = task->dev; + sas_task_abort(task); +- break; ++ } else { ++ ASD_DPRINTK("R_T_A for non TASK scb 0x%x\n", ++ a->scb->header.opcode); + } ++ break; + } + + if (!failed_dev) { +@@ -478,7 +484,7 @@ + * that the EH will wake up and do something. + */ + list_for_each_entry_safe(a, b, &asd_ha->seq.pend_q, list) { +- struct sas_task *task = ascb->uldd_task; ++ struct sas_task *task = a->uldd_task; + + if (task && + task->dev == failed_dev && +diff -Nurd linux-2.6.24/drivers/scsi/arcmsr/arcmsr_hba.c linux-2.6.24-oxe810/drivers/scsi/arcmsr/arcmsr_hba.c +--- linux-2.6.24/drivers/scsi/arcmsr/arcmsr_hba.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/arcmsr/arcmsr_hba.c 2008-06-11 17:50:28.000000000 +0200 +@@ -1380,17 +1380,16 @@ + switch(controlcode) { + + case ARCMSR_MESSAGE_READ_RQBUFFER: { +- unsigned long *ver_addr; +- dma_addr_t buf_handle; ++ unsigned char *ver_addr; + uint8_t *pQbuffer, *ptmpQbuffer; + int32_t allxfer_len = 0; + +- ver_addr = pci_alloc_consistent(acb->pdev, 1032, &buf_handle); ++ ver_addr = kmalloc(1032, GFP_ATOMIC); + if (!ver_addr) { + retvalue = ARCMSR_MESSAGE_FAIL; + goto message_out; + } +- ptmpQbuffer = (uint8_t *) ver_addr; ++ ptmpQbuffer = ver_addr; + while ((acb->rqbuf_firstindex != acb->rqbuf_lastindex) + && (allxfer_len < 1031)) { + pQbuffer = &acb->rqbuffer[acb->rqbuf_firstindex]; +@@ -1419,25 +1418,24 @@ + } + arcmsr_iop_message_read(acb); + } +- memcpy(pcmdmessagefld->messagedatabuffer, (uint8_t *)ver_addr, allxfer_len); ++ memcpy(pcmdmessagefld->messagedatabuffer, ver_addr, allxfer_len); + pcmdmessagefld->cmdmessage.Length = allxfer_len; + pcmdmessagefld->cmdmessage.ReturnCode = ARCMSR_MESSAGE_RETURNCODE_OK; +- pci_free_consistent(acb->pdev, 1032, ver_addr, buf_handle); ++ kfree(ver_addr); + } + break; + + case ARCMSR_MESSAGE_WRITE_WQBUFFER: { +- unsigned long *ver_addr; +- dma_addr_t buf_handle; ++ unsigned char *ver_addr; + int32_t my_empty_len, user_len, wqbuf_firstindex, wqbuf_lastindex; + uint8_t *pQbuffer, *ptmpuserbuffer; + +- ver_addr = pci_alloc_consistent(acb->pdev, 1032, &buf_handle); ++ ver_addr = kmalloc(1032, GFP_ATOMIC); + if (!ver_addr) { + retvalue = ARCMSR_MESSAGE_FAIL; + goto message_out; + } +- ptmpuserbuffer = (uint8_t *)ver_addr; ++ ptmpuserbuffer = ver_addr; + user_len = pcmdmessagefld->cmdmessage.Length; + memcpy(ptmpuserbuffer, pcmdmessagefld->messagedatabuffer, user_len); + wqbuf_lastindex = acb->wqbuf_lastindex; +@@ -1483,7 +1481,7 @@ + retvalue = ARCMSR_MESSAGE_FAIL; + } + } +- pci_free_consistent(acb->pdev, 1032, ver_addr, buf_handle); ++ kfree(ver_addr); + } + break; + +diff -Nurd linux-2.6.24/drivers/scsi/gdth.c linux-2.6.24-oxe810/drivers/scsi/gdth.c +--- linux-2.6.24/drivers/scsi/gdth.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/gdth.c 2008-06-11 17:50:29.000000000 +0200 +@@ -160,7 +160,7 @@ + static void gdth_clear_events(void); + + static void gdth_copy_internal_data(gdth_ha_str *ha, Scsi_Cmnd *scp, +- char *buffer, ushort count, int to_buffer); ++ char *buffer, ushort count); + static int gdth_internal_cache_cmd(gdth_ha_str *ha, Scsi_Cmnd *scp); + static int gdth_fill_cache_cmd(gdth_ha_str *ha, Scsi_Cmnd *scp, ushort hdrive); + +@@ -183,7 +183,6 @@ + unsigned int cmd, unsigned long arg); + + static void gdth_flush(gdth_ha_str *ha); +-static int gdth_halt(struct notifier_block *nb, ulong event, void *buf); + static int gdth_queuecommand(Scsi_Cmnd *scp,void (*done)(Scsi_Cmnd *)); + static int __gdth_queuecommand(gdth_ha_str *ha, struct scsi_cmnd *scp, + struct gdth_cmndinfo *cmndinfo); +@@ -418,12 +417,6 @@ + #include "gdth_proc.h" + #include "gdth_proc.c" + +-/* notifier block to get a notify on system shutdown/halt/reboot */ +-static struct notifier_block gdth_notifier = { +- gdth_halt, NULL, 0 +-}; +-static int notifier_disabled = 0; +- + static gdth_ha_str *gdth_find_ha(int hanum) + { + gdth_ha_str *ha; +@@ -446,8 +439,8 @@ + for (i=0; i<GDTH_MAXCMDS; ++i) { + if (ha->cmndinfo[i].index == 0) { + priv = &ha->cmndinfo[i]; +- priv->index = i+1; + memset(priv, 0, sizeof(*priv)); ++ priv->index = i+1; + break; + } + } +@@ -494,7 +487,6 @@ + gdth_ha_str *ha = shost_priv(sdev->host); + Scsi_Cmnd *scp; + struct gdth_cmndinfo cmndinfo; +- struct scatterlist one_sg; + DECLARE_COMPLETION_ONSTACK(wait); + int rval; + +@@ -508,13 +500,10 @@ + /* use request field to save the ptr. to completion struct. */ + scp->request = (struct request *)&wait; + scp->timeout_per_command = timeout*HZ; +- sg_init_one(&one_sg, gdtcmd, sizeof(*gdtcmd)); +- gdth_set_sglist(scp, &one_sg); +- gdth_set_sg_count(scp, 1); +- gdth_set_bufflen(scp, sizeof(*gdtcmd)); + scp->cmd_len = 12; + memcpy(scp->cmnd, cmnd, 12); + cmndinfo.priority = IOCTL_PRI; ++ cmndinfo.internal_cmd_str = gdtcmd; + cmndinfo.internal_command = 1; + + TRACE(("__gdth_execute() cmd 0x%x\n", scp->cmnd[0])); +@@ -2355,7 +2344,7 @@ + * buffers, kmap_atomic() as needed. + */ + static void gdth_copy_internal_data(gdth_ha_str *ha, Scsi_Cmnd *scp, +- char *buffer, ushort count, int to_buffer) ++ char *buffer, ushort count) + { + ushort cpcount,i, max_sg = gdth_sg_count(scp); + ushort cpsum,cpnow; +@@ -2381,10 +2370,7 @@ + } + local_irq_save(flags); + address = kmap_atomic(sg_page(sl), KM_BIO_SRC_IRQ) + sl->offset; +- if (to_buffer) +- memcpy(buffer, address, cpnow); +- else +- memcpy(address, buffer, cpnow); ++ memcpy(address, buffer, cpnow); + flush_dcache_page(sg_page(sl)); + kunmap_atomic(address, KM_BIO_SRC_IRQ); + local_irq_restore(flags); +@@ -2438,7 +2424,7 @@ + strcpy(inq.vendor,ha->oem_name); + sprintf(inq.product,"Host Drive #%02d",t); + strcpy(inq.revision," "); +- gdth_copy_internal_data(ha, scp, (char*)&inq, sizeof(gdth_inq_data), 0); ++ gdth_copy_internal_data(ha, scp, (char*)&inq, sizeof(gdth_inq_data)); + break; + + case REQUEST_SENSE: +@@ -2448,7 +2434,7 @@ + sd.key = NO_SENSE; + sd.info = 0; + sd.add_length= 0; +- gdth_copy_internal_data(ha, scp, (char*)&sd, sizeof(gdth_sense_data), 0); ++ gdth_copy_internal_data(ha, scp, (char*)&sd, sizeof(gdth_sense_data)); + break; + + case MODE_SENSE: +@@ -2460,7 +2446,7 @@ + mpd.bd.block_length[0] = (SECTOR_SIZE & 0x00ff0000) >> 16; + mpd.bd.block_length[1] = (SECTOR_SIZE & 0x0000ff00) >> 8; + mpd.bd.block_length[2] = (SECTOR_SIZE & 0x000000ff); +- gdth_copy_internal_data(ha, scp, (char*)&mpd, sizeof(gdth_modep_data), 0); ++ gdth_copy_internal_data(ha, scp, (char*)&mpd, sizeof(gdth_modep_data)); + break; + + case READ_CAPACITY: +@@ -2470,7 +2456,7 @@ + else + rdc.last_block_no = cpu_to_be32(ha->hdr[t].size-1); + rdc.block_length = cpu_to_be32(SECTOR_SIZE); +- gdth_copy_internal_data(ha, scp, (char*)&rdc, sizeof(gdth_rdcap_data), 0); ++ gdth_copy_internal_data(ha, scp, (char*)&rdc, sizeof(gdth_rdcap_data)); + break; + + case SERVICE_ACTION_IN: +@@ -2482,7 +2468,7 @@ + rdc16.last_block_no = cpu_to_be64(ha->hdr[t].size-1); + rdc16.block_length = cpu_to_be32(SECTOR_SIZE); + gdth_copy_internal_data(ha, scp, (char*)&rdc16, +- sizeof(gdth_rdcap16_data), 0); ++ sizeof(gdth_rdcap16_data)); + } else { + scp->result = DID_ABORT << 16; + } +@@ -2852,6 +2838,7 @@ + static int gdth_special_cmd(gdth_ha_str *ha, Scsi_Cmnd *scp) + { + register gdth_cmd_str *cmdp; ++ struct gdth_cmndinfo *cmndinfo = gdth_cmnd_priv(scp); + int cmd_index; + + cmdp= ha->pccb; +@@ -2860,7 +2847,7 @@ + if (ha->type==GDT_EISA && ha->cmd_cnt>0) + return 0; + +- gdth_copy_internal_data(ha, scp, (char *)cmdp, sizeof(gdth_cmd_str), 1); ++ *cmdp = *cmndinfo->internal_cmd_str; + cmdp->RequestBuffer = scp; + + /* search free command index */ +@@ -3793,6 +3780,8 @@ + gdth_ha_str *ha; + ulong flags; + ++ BUG_ON(list_empty(&gdth_instances)); ++ + ha = list_first_entry(&gdth_instances, gdth_ha_str, list); + spin_lock_irqsave(&ha->smp_lock, flags); + +@@ -4668,45 +4657,6 @@ + } + } + +-/* shutdown routine */ +-static int gdth_halt(struct notifier_block *nb, ulong event, void *buf) +-{ +- gdth_ha_str *ha; +-#ifndef __alpha__ +- gdth_cmd_str gdtcmd; +- char cmnd[MAX_COMMAND_SIZE]; +-#endif +- +- if (notifier_disabled) +- return NOTIFY_OK; +- +- TRACE2(("gdth_halt() event %d\n",(int)event)); +- if (event != SYS_RESTART && event != SYS_HALT && event != SYS_POWER_OFF) +- return NOTIFY_DONE; +- +- notifier_disabled = 1; +- printk("GDT-HA: Flushing all host drives .. "); +- list_for_each_entry(ha, &gdth_instances, list) { +- gdth_flush(ha); +- +-#ifndef __alpha__ +- /* controller reset */ +- memset(cmnd, 0xff, MAX_COMMAND_SIZE); +- gdtcmd.BoardNode = LOCALBOARD; +- gdtcmd.Service = CACHESERVICE; +- gdtcmd.OpCode = GDT_RESET; +- TRACE2(("gdth_halt(): reset controller %d\n", ha->hanum)); +- gdth_execute(ha->shost, &gdtcmd, cmnd, 10, NULL); +-#endif +- } +- printk("Done.\n"); +- +-#ifdef GDTH_STATISTICS +- del_timer(&gdth_timer); +-#endif +- return NOTIFY_OK; +-} +- + /* configure lun */ + static int gdth_slave_configure(struct scsi_device *sdev) + { +@@ -4838,6 +4788,9 @@ + if (error) + goto out_free_coal_stat; + list_add_tail(&ha->list, &gdth_instances); ++ ++ scsi_scan_host(shp); ++ + return 0; + + out_free_coal_stat: +@@ -4965,6 +4918,9 @@ + if (error) + goto out_free_coal_stat; + list_add_tail(&ha->list, &gdth_instances); ++ ++ scsi_scan_host(shp); ++ + return 0; + + out_free_ccb_phys: +@@ -5102,6 +5058,9 @@ + if (error) + goto out_free_coal_stat; + list_add_tail(&ha->list, &gdth_instances); ++ ++ scsi_scan_host(shp); ++ + return 0; + + out_free_coal_stat: +@@ -5132,13 +5091,13 @@ + + scsi_remove_host(shp); + ++ gdth_flush(ha); ++ + if (ha->sdev) { + scsi_free_host_dev(ha->sdev); + ha->sdev = NULL; + } + +- gdth_flush(ha); +- + if (shp->irq) + free_irq(shp->irq,ha); + +@@ -5164,6 +5123,24 @@ + scsi_host_put(shp); + } + ++static int gdth_halt(struct notifier_block *nb, ulong event, void *buf) ++{ ++ gdth_ha_str *ha; ++ ++ TRACE2(("gdth_halt() event %d\n", (int)event)); ++ if (event != SYS_RESTART && event != SYS_HALT && event != SYS_POWER_OFF) ++ return NOTIFY_DONE; ++ ++ list_for_each_entry(ha, &gdth_instances, list) ++ gdth_flush(ha); ++ ++ return NOTIFY_OK; ++} ++ ++static struct notifier_block gdth_notifier = { ++ gdth_halt, NULL, 0 ++}; ++ + static int __init gdth_init(void) + { + if (disable) { +@@ -5226,7 +5203,6 @@ + add_timer(&gdth_timer); + #endif + major = register_chrdev(0,"gdth", &gdth_fops); +- notifier_disabled = 0; + register_reboot_notifier(&gdth_notifier); + gdth_polling = FALSE; + return 0; +@@ -5236,14 +5212,15 @@ + { + gdth_ha_str *ha; + +- list_for_each_entry(ha, &gdth_instances, list) +- gdth_remove_one(ha); ++ unregister_chrdev(major, "gdth"); ++ unregister_reboot_notifier(&gdth_notifier); + + #ifdef GDTH_STATISTICS +- del_timer(&gdth_timer); ++ del_timer_sync(&gdth_timer); + #endif +- unregister_chrdev(major,"gdth"); +- unregister_reboot_notifier(&gdth_notifier); ++ ++ list_for_each_entry(ha, &gdth_instances, list) ++ gdth_remove_one(ha); + } + + module_init(gdth_init); +diff -Nurd linux-2.6.24/drivers/scsi/gdth.h linux-2.6.24-oxe810/drivers/scsi/gdth.h +--- linux-2.6.24/drivers/scsi/gdth.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/gdth.h 2008-06-11 17:50:29.000000000 +0200 +@@ -915,6 +915,7 @@ + struct gdth_cmndinfo { /* per-command private info */ + int index; + int internal_command; /* don't call scsi_done */ ++ gdth_cmd_str *internal_cmd_str; /* crier for internal messages*/ + dma_addr_t sense_paddr; /* sense dma-addr */ + unchar priority; + int timeout; +diff -Nurd linux-2.6.24/drivers/scsi/gdth_proc.c linux-2.6.24-oxe810/drivers/scsi/gdth_proc.c +--- linux-2.6.24/drivers/scsi/gdth_proc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/gdth_proc.c 2008-06-11 17:50:29.000000000 +0200 +@@ -694,15 +694,13 @@ + { + ulong flags; + +- spin_lock_irqsave(&ha->smp_lock, flags); +- + if (buf == ha->pscratch) { ++ spin_lock_irqsave(&ha->smp_lock, flags); + ha->scratch_busy = FALSE; ++ spin_unlock_irqrestore(&ha->smp_lock, flags); + } else { + pci_free_consistent(ha->pdev, size, buf, paddr); + } +- +- spin_unlock_irqrestore(&ha->smp_lock, flags); + } + + #ifdef GDTH_IOCTL_PROC +diff -Nurd linux-2.6.24/drivers/scsi/ips.c linux-2.6.24-oxe810/drivers/scsi/ips.c +--- linux-2.6.24/drivers/scsi/ips.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/ips.c 2008-06-11 17:50:29.000000000 +0200 +@@ -1580,7 +1580,7 @@ + METHOD_TRACE("ips_make_passthru", 1); + + scsi_for_each_sg(SC, sg, scsi_sg_count(SC), i) +- length += sg[i].length; ++ length += sg->length; + + if (length < sizeof (ips_passthru_t)) { + /* wrong size */ +@@ -6842,13 +6842,10 @@ + if (request_irq(ha->irq, do_ipsintr, IRQF_SHARED, ips_name, ha)) { + IPS_PRINTK(KERN_WARNING, ha->pcidev, + "Unable to install interrupt handler\n"); +- scsi_host_put(sh); +- return -1; ++ goto err_out_sh; + } + + kfree(oldha); +- ips_sh[index] = sh; +- ips_ha[index] = ha; + + /* Store away needed values for later use */ + sh->io_port = ha->io_addr; +@@ -6867,10 +6864,21 @@ + sh->max_channel = ha->nbus - 1; + sh->can_queue = ha->max_cmds - 1; + +- scsi_add_host(sh, NULL); ++ if (scsi_add_host(sh, &ha->pcidev->dev)) ++ goto err_out; ++ ++ ips_sh[index] = sh; ++ ips_ha[index] = ha; ++ + scsi_scan_host(sh); + + return 0; ++ ++err_out: ++ free_irq(ha->pcidev->irq, ha); ++err_out_sh: ++ scsi_host_put(sh); ++ return -1; + } + + /*---------------------------------------------------------------------------*/ +diff -Nurd linux-2.6.24/drivers/scsi/scsi_lib.c linux-2.6.24-oxe810/drivers/scsi/scsi_lib.c +--- linux-2.6.24/drivers/scsi/scsi_lib.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/scsi_lib.c 2008-06-11 17:50:29.000000000 +0200 +@@ -298,7 +298,6 @@ + page = sg_page(sg); + off = sg->offset; + len = sg->length; +- data_len += len; + + while (len > 0 && data_len > 0) { + /* +diff -Nurd linux-2.6.24/drivers/scsi/sd.c linux-2.6.24-oxe810/drivers/scsi/sd.c +--- linux-2.6.24/drivers/scsi/sd.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/scsi/sd.c 2008-06-11 17:50:29.000000000 +0200 +@@ -907,6 +907,7 @@ + unsigned int xfer_size = SCpnt->request_bufflen; + unsigned int good_bytes = result ? 0 : xfer_size; + u64 start_lba = SCpnt->request->sector; ++ u64 end_lba = SCpnt->request->sector + (xfer_size / 512); + u64 bad_lba; + struct scsi_sense_hdr sshdr; + int sense_valid = 0; +@@ -945,26 +946,23 @@ + goto out; + if (xfer_size <= SCpnt->device->sector_size) + goto out; +- switch (SCpnt->device->sector_size) { +- case 256: ++ if (SCpnt->device->sector_size < 512) { ++ /* only legitimate sector_size here is 256 */ + start_lba <<= 1; +- break; +- case 512: +- break; +- case 1024: +- start_lba >>= 1; +- break; +- case 2048: +- start_lba >>= 2; +- break; +- case 4096: +- start_lba >>= 3; +- break; +- default: +- /* Print something here with limiting frequency. */ +- goto out; +- break; ++ end_lba <<= 1; ++ } else { ++ /* be careful ... don't want any overflows */ ++ u64 factor = SCpnt->device->sector_size / 512; ++ do_div(start_lba, factor); ++ do_div(end_lba, factor); + } ++ ++ if (bad_lba < start_lba || bad_lba >= end_lba) ++ /* the bad lba was reported incorrectly, we have ++ * no idea where the error is ++ */ ++ goto out; ++ + /* This computation should always be done in terms of + * the resolution of the device's medium. + */ +diff -Nurd linux-2.6.24/drivers/serial/8250.c linux-2.6.24-oxe810/drivers/serial/8250.c +--- linux-2.6.24/drivers/serial/8250.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/serial/8250.c 2008-06-11 17:48:56.000000000 +0200 +@@ -2153,7 +2153,37 @@ + serial_outp(up, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */ + } + +- serial_dl_write(up, quot); ++ if ((up->port.type == PORT_16550A) && ++ (serial_in(up, UART_XON_CHAR) == 0x11) && ++ (serial_in(up, UART_XOFF_CHAR) == 0x13)) ++ { ++ /* We should now be dealing with an extended 16550A-type UART from ++ * the Oxsemi 0x800 */ ++ ++ /* Calculate values for DLM,DLL,DLF divisor registers from clock ++ * frequency in Hz and Baud rate in bits per second, and program them ++ * into the UART */ ++ u32 tmp; ++ u8 lcr, dlm, dll, dlf; ++ ++ tmp = port->uartclk / baud; ++ tmp = (tmp + 1) / 2; ++ dlm = tmp >> (8 + 3); ++ dll = (tmp >> 3) & 0xFF; ++ dlf = (tmp & 7) << 5; ++ ++ lcr = serial_in(up, UART_LSR); /* Store LCR */ ++ ++ serial_outp(up, UART_LCR, 0x80); /* Enable access to DLM DLL */ ++ serial_outp(up, UART_DLL, dll); /* LS of divisor */ ++ serial_outp(up, UART_DLM, dlm); /* MS of divisor */ ++ serial_outp(up, UART_DLF, dlf); /* Set non-standard fractional divisor */ ++ serial_outp(up, UART_LCR, lcr); /* Restore LCR */ ++ ++ printk(KERN_INFO "Using fractional divider baud %d, clock %d dlf %02x\n", baud, port->uartclk, dlf); ++ } else { ++ serial_dl_write(up, quot); ++ } + + /* + * LCR DLAB must be set to enable 64-byte FIFO mode. If the FCR +@@ -2519,7 +2549,11 @@ + static int __init serial8250_console_setup(struct console *co, char *options) + { + struct uart_port *port; +- int baud = 9600; ++#if defined (CONFIG_ARCH_HIPOX) ++ int baud = 115200; ++#else ++ int baud = 9600; ++#endif // defined (CONFIG_ARCH_HIPOX) + int bits = 8; + int parity = 'n'; + int flow = 'n'; +diff -Nurd linux-2.6.24/drivers/spi/atmel_spi.c linux-2.6.24-oxe810/drivers/spi/atmel_spi.c +--- linux-2.6.24/drivers/spi/atmel_spi.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/spi/atmel_spi.c 2008-06-11 17:49:13.000000000 +0200 +@@ -85,6 +85,16 @@ + unsigned gpio = (unsigned) spi->controller_data; + unsigned active = spi->mode & SPI_CS_HIGH; + u32 mr; ++ int i; ++ u32 csr; ++ u32 cpol = (spi->mode & SPI_CPOL) ? SPI_BIT(CPOL) : 0; ++ ++ /* Make sure clock polarity is correct */ ++ for (i = 0; i < spi->master->num_chipselect; i++) { ++ csr = spi_readl(as, CSR0 + 4 * i); ++ if ((csr ^ cpol) & SPI_BIT(CPOL)) ++ spi_writel(as, CSR0 + 4 * i, csr ^ SPI_BIT(CPOL)); ++ } + + mr = spi_readl(as, MR); + mr = SPI_BFINS(PCS, ~(1 << spi->chip_select), mr); +diff -Nurd linux-2.6.24/drivers/spi/pxa2xx_spi.c linux-2.6.24-oxe810/drivers/spi/pxa2xx_spi.c +--- linux-2.6.24/drivers/spi/pxa2xx_spi.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/spi/pxa2xx_spi.c 2008-06-11 17:49:13.000000000 +0200 +@@ -48,13 +48,19 @@ + #define RESET_DMA_CHANNEL (DCSR_NODESC | DMA_INT_MASK) + #define IS_DMA_ALIGNED(x) (((u32)(x)&0x07)==0) + +-/* for testing SSCR1 changes that require SSP restart, basically +- * everything except the service and interrupt enables */ +-#define SSCR1_CHANGE_MASK (SSCR1_TTELP | SSCR1_TTE | SSCR1_EBCEI | SSCR1_SCFR \ ++/* ++ * for testing SSCR1 changes that require SSP restart, basically ++ * everything except the service and interrupt enables, the pxa270 developer ++ * manual says only SSCR1_SCFR, SSCR1_SPH, SSCR1_SPO need to be in this ++ * list, but the PXA255 dev man says all bits without really meaning the ++ * service and interrupt enables ++ */ ++#define SSCR1_CHANGE_MASK (SSCR1_TTELP | SSCR1_TTE | SSCR1_SCFR \ + | SSCR1_ECRA | SSCR1_ECRB | SSCR1_SCLKDIR \ +- | SSCR1_RWOT | SSCR1_TRAIL | SSCR1_PINTE \ +- | SSCR1_STRF | SSCR1_EFWR |SSCR1_RFT \ +- | SSCR1_TFT | SSCR1_SPH | SSCR1_SPO | SSCR1_LBM) ++ | SSCR1_SFRMDIR | SSCR1_RWOT | SSCR1_TRAIL \ ++ | SSCR1_IFS | SSCR1_STRF | SSCR1_EFWR \ ++ | SSCR1_RFT | SSCR1_TFT | SSCR1_MWDS \ ++ | SSCR1_SPH | SSCR1_SPO | SSCR1_LBM) + + #define DEFINE_SSP_REG(reg, off) \ + static inline u32 read_##reg(void *p) { return __raw_readl(p + (off)); } \ +@@ -961,9 +967,6 @@ + if (drv_data->ssp_type == PXA25x_SSP) + DCMD(drv_data->tx_channel) |= DCMD_ENDIRQEN; + +- /* Fix me, need to handle cs polarity */ +- drv_data->cs_control(PXA2XX_CS_ASSERT); +- + /* Clear status and start DMA engine */ + cr1 = chip->cr1 | dma_thresh | drv_data->dma_cr1; + write_SSSR(drv_data->clear_sr, reg); +@@ -973,9 +976,6 @@ + /* Ensure we have the correct interrupt handler */ + drv_data->transfer_handler = interrupt_transfer; + +- /* Fix me, need to handle cs polarity */ +- drv_data->cs_control(PXA2XX_CS_ASSERT); +- + /* Clear status */ + cr1 = chip->cr1 | chip->threshold | drv_data->int_cr1; + write_SSSR(drv_data->clear_sr, reg); +@@ -986,16 +986,29 @@ + || (read_SSCR1(reg) & SSCR1_CHANGE_MASK) != + (cr1 & SSCR1_CHANGE_MASK)) { + ++ /* stop the SSP, and update the other bits */ + write_SSCR0(cr0 & ~SSCR0_SSE, reg); + if (drv_data->ssp_type != PXA25x_SSP) + write_SSTO(chip->timeout, reg); +- write_SSCR1(cr1, reg); ++ /* first set CR1 without interrupt and service enables */ ++ write_SSCR1(cr1 & SSCR1_CHANGE_MASK, reg); ++ /* restart the SSP */ + write_SSCR0(cr0, reg); ++ + } else { + if (drv_data->ssp_type != PXA25x_SSP) + write_SSTO(chip->timeout, reg); +- write_SSCR1(cr1, reg); + } ++ ++ /* FIXME, need to handle cs polarity, ++ * this driver uses struct pxa2xx_spi_chip.cs_control to ++ * specify a CS handling function, and it ignores most ++ * struct spi_device.mode[s], including SPI_CS_HIGH */ ++ drv_data->cs_control(PXA2XX_CS_ASSERT); ++ ++ /* after chip select, release the data by enabling service ++ * requests and interrupts, without changing any mode bits */ ++ write_SSCR1(cr1, reg); + } + + static void pump_messages(struct work_struct *work) +diff -Nurd linux-2.6.24/drivers/usb/Kconfig linux-2.6.24-oxe810/drivers/usb/Kconfig +--- linux-2.6.24/drivers/usb/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/Kconfig 2008-06-11 17:50:19.000000000 +0200 +@@ -36,6 +36,7 @@ + default y if ARCH_EP93XX + default y if ARCH_AT91 + default y if ARCH_PNX4008 ++ default y if ARCH_HIPOX + # PPC: + default y if STB03xxx + default y if PPC_MPC52xx +@@ -49,6 +50,7 @@ + boolean + default y if PPC_83xx + default y if SOC_AU1200 ++ default y if ARCH_HIPOX + default PCI + + # ARM SA1111 chips have a non-PCI based "OHCI-compatible" USB host interface. +diff -Nurd linux-2.6.24/drivers/usb/class/usblp.c linux-2.6.24-oxe810/drivers/usb/class/usblp.c +--- linux-2.6.24/drivers/usb/class/usblp.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/class/usblp.c 2008-06-11 17:50:16.000000000 +0200 +@@ -428,6 +428,7 @@ + usblp->rcomplete = 0; + + if (handle_bidir(usblp) < 0) { ++ usb_autopm_put_interface(intf); + usblp->used = 0; + file->private_data = NULL; + retval = -EIO; +diff -Nurd linux-2.6.24/drivers/usb/core/driver.c linux-2.6.24-oxe810/drivers/usb/core/driver.c +--- linux-2.6.24/drivers/usb/core/driver.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/core/driver.c 2008-06-11 17:50:16.000000000 +0200 +@@ -534,8 +534,8 @@ + id->driver_info is the way to create an entry that + indicates that the driver want to examine every + device and interface. */ +- for (; id->idVendor || id->bDeviceClass || id->bInterfaceClass || +- id->driver_info; id++) { ++ for (; id->idVendor || id->idProduct || id->bDeviceClass || ++ id->bInterfaceClass || id->driver_info; id++) { + if (usb_match_one_id(interface, id)) + return id; + } +diff -Nurd linux-2.6.24/drivers/usb/core/hcd.h linux-2.6.24-oxe810/drivers/usb/core/hcd.h +--- linux-2.6.24/drivers/usb/core/hcd.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/core/hcd.h 2008-06-11 17:50:16.000000000 +0200 +@@ -312,7 +312,9 @@ + #define SetHubFeature (0x2000 | USB_REQ_SET_FEATURE) + #define SetPortFeature (0x2300 | USB_REQ_SET_FEATURE) + +- ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++#define ResetHubTT (0x2308) ++#endif + /*-------------------------------------------------------------------------*/ + + /* +@@ -359,6 +361,11 @@ + + /*-------------------------------------------------------------------------*/ + ++extern int usb_register_root_hub (struct usb_device *usb_dev, ++ struct device *parent_dev); ++ ++extern void usb_hcd_release (struct usb_bus *); ++ + extern void usb_set_device_state(struct usb_device *udev, + enum usb_device_state new_state); + +diff -Nurd linux-2.6.24/drivers/usb/core/hub.c linux-2.6.24-oxe810/drivers/usb/core/hub.c +--- linux-2.6.24/drivers/usb/core/hub.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/core/hub.c 2008-06-11 17:50:16.000000000 +0200 +@@ -2946,7 +2946,7 @@ + if (len < le16_to_cpu(udev->config[index].desc.wTotalLength)) + len = le16_to_cpu(udev->config[index].desc.wTotalLength); + } +- buf = kmalloc (len, GFP_KERNEL); ++ buf = kmalloc(len, GFP_NOIO); + if (buf == NULL) { + dev_err(&udev->dev, "no mem to re-read configs after reset\n"); + /* assume the worst */ +diff -Nurd linux-2.6.24/drivers/usb/gadget/fsl_usb2_udc.c linux-2.6.24-oxe810/drivers/usb/gadget/fsl_usb2_udc.c +--- linux-2.6.24/drivers/usb/gadget/fsl_usb2_udc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/gadget/fsl_usb2_udc.c 2008-06-11 17:50:17.000000000 +0200 +@@ -776,7 +776,7 @@ + VDBG("%s, bad params\n", __FUNCTION__); + return -EINVAL; + } +- if (!_ep || (!ep->desc && ep_index(ep))) { ++ if (unlikely(!_ep || !ep->desc)) { + VDBG("%s, bad ep\n", __FUNCTION__); + return -EINVAL; + } +diff -Nurd linux-2.6.24/drivers/usb/host/Kconfig linux-2.6.24-oxe810/drivers/usb/host/Kconfig +--- linux-2.6.24/drivers/usb/host/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/Kconfig 2008-06-11 17:50:19.000000000 +0200 +@@ -41,6 +41,7 @@ + config USB_EHCI_ROOT_HUB_TT + bool "Root Hub Transaction Translators (EXPERIMENTAL)" + depends on USB_EHCI_HCD && EXPERIMENTAL ++ default y if ARCH_HIPOX + ---help--- + Some EHCI chips have vendor-specific extensions to integrate + transaction translators, so that no OHCI or UHCI companion +diff -Nurd linux-2.6.24/drivers/usb/host/Makefile linux-2.6.24-oxe810/drivers/usb/host/Makefile +--- linux-2.6.24/drivers/usb/host/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/Makefile 2008-06-11 17:50:19.000000000 +0200 +@@ -3,7 +3,11 @@ + # + + ifeq ($(CONFIG_USB_DEBUG),y) +- EXTRA_CFLAGS += -DDEBUG ++ EXTRA_CFLAGS += -DDEBUG ++endif ++ ++ifeq ($(CONFIG_EHCI_VERBOSE_DEBUG),y) ++ EXTRA_CFLAGS += -DEHCI_VERBOSE_DEBUG + endif + + obj-$(CONFIG_PCI) += pci-quirks.o +@@ -16,4 +20,3 @@ + obj-$(CONFIG_USB_SL811_CS) += sl811_cs.o + obj-$(CONFIG_USB_U132_HCD) += u132-hcd.o + obj-$(CONFIG_USB_R8A66597_HCD) += r8a66597-hcd.o +- +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-dbg.c linux-2.6.24-oxe810/drivers/usb/host/ehci-dbg.c +--- linux-2.6.24/drivers/usb/host/ehci-dbg.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-dbg.c 2008-06-11 17:50:19.000000000 +0200 +@@ -28,11 +28,11 @@ + dev_warn (ehci_to_hcd(ehci)->self.controller , fmt , ## args ) + + #ifdef EHCI_VERBOSE_DEBUG +-# define vdbg dbg +-# define ehci_vdbg ehci_dbg ++ #define vdbg dbg ++ #define ehci_vdbg ehci_dbg + #else +-# define vdbg(fmt,args...) do { } while (0) +-# define ehci_vdbg(ehci, fmt, args...) do { } while (0) ++ #define vdbg(fmt,args...) do { } while (0) ++ #define ehci_vdbg(ehci, fmt, args...) do { } while (0) + #endif + + #ifdef DEBUG +@@ -242,6 +242,10 @@ + ); + } + ++#define PORT_SPD_HIGH (2 << 26) ++#define PORT_SPD_FULL (1 << 26) ++ ++ + static int + dbg_port_buf (char *buf, unsigned len, const char *label, int port, u32 status) + { +@@ -256,7 +260,7 @@ + } + + return scnprintf (buf, len, +- "%s%sport %d status %06x%s%s sig=%s%s%s%s%s%s%s%s%s%s", ++ "%s%sport %d status %06x%s%s sig=%s %s%s%s%s%s%s%s%s%s %s", + label, label [0] ? " " : "", port, status, + (status & PORT_POWER) ? " POWER" : "", + (status & PORT_OWNER) ? " OWNER" : "", +@@ -269,7 +273,9 @@ + (status & PORT_PEC) ? " PEC" : "", + (status & PORT_PE) ? " PE" : "", + (status & PORT_CSC) ? " CSC" : "", +- (status & PORT_CONNECT) ? " CONNECT" : ""); ++ (status & PORT_CONNECT) ? " CONNECT" : "", ++ (status & PORT_SPD_HIGH) ? ((status & PORT_SPD_FULL) ? "??" : "HIGH" ) : (status & PORT_SPD_FULL) ? "LOW" : "FULL" ++ ); + } + + #else +@@ -783,13 +789,38 @@ + size -= temp; + next += temp; + #endif +- ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++ long unsigned tt_status =readl((u32)ehci->regs +TT_STATUS); ++ temp = scnprintf (next, size, ++ "tt status %08lx \n", ++ tt_status); ++ size -= temp; ++ next += temp; ++#endif + done: + spin_unlock_irqrestore (&ehci->lock, flags); + + return PAGE_SIZE - size; + } + static CLASS_DEVICE_ATTR (registers, S_IRUGO, show_registers, NULL); ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++static ssize_t ++reset_tt (struct class_device *class_dev, const char *buf, size_t len) ++{ ++ struct usb_bus *bus; ++ struct usb_hcd *hcd; ++ struct ehci_hcd *ehci; ++ ++ bus = class_get_devdata(class_dev); ++ hcd = bus->hcpriv; ++ ehci = hcd_to_ehci (hcd); ++ ++ *((u32 *) ((u32)ehci->regs +TT_STATUS)) = 2; ++ return len; ++} ++ ++static CLASS_DEVICE_ATTR (tt_reset, S_IWUGO, NULL, reset_tt ); ++#endif + + static inline void create_debug_files (struct ehci_hcd *ehci) + { +@@ -799,6 +830,9 @@ + retval = class_device_create_file(cldev, &class_device_attr_async); + retval = class_device_create_file(cldev, &class_device_attr_periodic); + retval = class_device_create_file(cldev, &class_device_attr_registers); ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++ class_device_create_file(cldev, &class_device_attr_tt_reset); ++#endif + } + + static inline void remove_debug_files (struct ehci_hcd *ehci) +@@ -808,6 +842,9 @@ + class_device_remove_file(cldev, &class_device_attr_async); + class_device_remove_file(cldev, &class_device_attr_periodic); + class_device_remove_file(cldev, &class_device_attr_registers); ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++ class_device_remove_file(cldev, &class_device_attr_tt_reset); ++#endif + } + + #endif /* STUB_DEBUG_FILES */ +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-hcd.c linux-2.6.24-oxe810/drivers/usb/host/ehci-hcd.c +--- linux-2.6.24/drivers/usb/host/ehci-hcd.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-hcd.c 2008-06-11 17:50:19.000000000 +0200 +@@ -197,7 +197,7 @@ + u32 __iomem *reg_ptr; + u32 tmp; + +- reg_ptr = (u32 __iomem *)(((u8 __iomem *)ehci->regs) + USBMODE); ++ reg_ptr = (u32 __iomem *)&ehci->regs->usbmode; + tmp = ehci_readl(ehci, reg_ptr); + tmp |= USBMODE_CM_HC; + /* The default byte access to MMR space is LE after +@@ -207,6 +207,20 @@ + if (ehci_big_endian_mmio(ehci)) + tmp |= USBMODE_BE; + ehci_writel(ehci, tmp, reg_ptr); ++ ++#ifdef CONFIG_ARCH_HIPOX ++ reg_ptr = (u32 __iomem *)&ehci->regs->txfilltuning; ++ tmp = ehci_readl(ehci, reg_ptr); ++ tmp &= ~0x00ff0000; ++ tmp |= 0x00200000; /* set burst pre load count to 16 */ ++ tmp |= 0x16; /* set sheduler overhead to 3 * 1.267us */ ++ ehci_writel(ehci, tmp, reg_ptr); ++ ++ reg_ptr = (u32 __iomem *)&ehci->regs->txttfilltuning; ++ tmp = readl (reg_ptr); ++ tmp |= 0x2; /* set sheduler overhead to 2 * 6.333us */ ++ writel (tmp, reg_ptr); ++#endif // CONFIG_ARCH_HIPOX + } + + /* reset a non-running (STS_HALT == 1) controller */ +@@ -225,9 +239,17 @@ + + if (retval) + return retval; ++ if (ehci->is_tdi_rh_tt) ++ tdi_reset(ehci); /* set TDI EHCI internal registers */ ++#ifdef CONFIG_ARCH_HIPOX ++ command=readl(&ehci->regs->port_status[1]); ++ command |=0xc0000000; /* force use of serial PHY on 1st full speed port */ ++ writel(command,&ehci->regs->port_status[1]); + +- if (ehci_is_TDI(ehci)) +- tdi_reset (ehci); ++ command=readl(&ehci->regs->port_status[2]); ++ command |=0xc0000000; /* force use of serial PHY on 2nd full speed port */ ++ writel(command,&ehci->regs->port_status[2]); ++#endif // CONFIG_ARCH_HIPOX + + return retval; + } +@@ -939,10 +961,15 @@ + MODULE_AUTHOR (DRIVER_AUTHOR); + MODULE_LICENSE ("GPL"); + ++#ifdef CONFIG_ARCH_HIPOX ++#include "ehci-hipox.c" ++#define PLATFORM_DRIVER ehci_hcd_hipox_driver ++#else // CONFIG_ARCH_HIPOX + #ifdef CONFIG_PCI + #include "ehci-pci.c" + #define PCI_DRIVER ehci_pci_driver +-#endif ++#endif // CONFIG_PCI ++#endif // CONFIG_ARCH_HIPOX + + #ifdef CONFIG_USB_EHCI_FSL + #include "ehci-fsl.c" +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-hub.c linux-2.6.24-oxe810/drivers/usb/host/ehci-hub.c +--- linux-2.6.24/drivers/usb/host/ehci-hub.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-hub.c 2008-06-11 17:50:19.000000000 +0200 +@@ -769,6 +769,11 @@ + dbg_port (ehci, "GetStatus", wIndex + 1, temp); + put_unaligned(cpu_to_le32 (status), (__le32 *) buf); + break; ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++ case ResetHubTT : ++ *((u32 *) ((u32)ehci->regs +TT_STATUS)) = 2; ++ break; ++#endif + case SetHubFeature: + switch (wValue) { + case C_HUB_LOCAL_POWER: +@@ -825,6 +830,23 @@ + temp |= PORT_RESET; + temp &= ~PORT_PE; + ++#if defined(CONFIG_USB_EHCI_ROOT_HUB_TT) & defined (CONFIG_ARCH_HIPOX) & 0 ++ printk(KERN_ERR "port using status raw %lx\n",temp); ++ temp &= 0x0fffffffL; /* remove default data source */ ++ if (temp & (1 << 27 )) ++ { ++ /* set the input to the UTMI input */ ++ temp |= 0x20000000L; ++ printk(KERN_ERR "port using UTMI %d\n",wIndex); ++ } ++ else ++ { ++ /* set the input to the serial PHY input */ ++ temp |= 0xE0000000L; ++ printk(KERN_ERR "port using serial PHY %d\n",wIndex); ++ } ++ writel(temp, &ehci->regs->port_status [wIndex]); ++#endif + /* + * caller must wait, then call GetPortStatus + * usb 2.0 spec says 50 ms resets on root +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-hipox.c linux-2.6.24-oxe810/drivers/usb/host/ehci-hipox.c +--- linux-2.6.24/drivers/usb/host/ehci-hipox.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-hipox.c 2008-06-11 17:50:19.000000000 +0200 +@@ -0,0 +1,307 @@ ++/* ++ * EHCI HCD (Host Controller Driver) for USB. ++ * ++ * (C) Copyright 2005 John Larkworthy <john.larkworthy@oxsemi.com> ++ * ++ * HIPOX Bus Glue ++ * ++ * Written by John Larkworthy ++ * ++ * This file is licenced under the GPL. ++ */ ++ ++#include <linux/platform_device.h> ++#include <asm/hardware.h> ++ ++extern spinlock_t hipox_gpio_spinlock; ++ ++int usb_patch = 1; ++ ++module_param(usb_patch, int, 1); ++MODULE_PARM_DESC (usb_patch, "use usb hw patch"); ++ ++/* called during probe() after chip reset completes */ ++static int ehci_hipox_setup(struct usb_hcd *hcd) ++{ ++ struct ehci_hcd *ehci = hcd_to_ehci(hcd); ++ int temp; ++ int retval; ++ ++ ehci->caps = hcd->regs; ++ ehci->regs = hcd->regs + HC_LENGTH(readl(&ehci->caps->hc_capbase)); ++ dbg_hcs_params(ehci, "reset"); ++ dbg_hcc_params(ehci, "reset"); ++ ++ /* cache this readonly data; minimize chip reads */ ++ ehci->hcs_params = readl(&ehci->caps->hcs_params); ++ ++ retval = ehci_halt(ehci); ++ if (retval) ++ return retval; ++ ++ /* data structure init */ ++ retval = ehci_init(hcd); ++ if (retval) ++ return retval; ++ ++ if (ehci_is_TDI(ehci)) ++ ehci_reset(ehci); ++ ++ /* at least the Genesys GL880S needs fixup here */ ++ temp = HCS_N_CC(ehci->hcs_params) * HCS_N_PCC(ehci->hcs_params); ++ temp &= 0x0f; ++ if (temp && HCS_N_PORTS(ehci->hcs_params) > temp) { ++ ehci_dbg(ehci, "bogus port configuration: " ++ "cc=%d x pcc=%d < ports=%d\n", ++ HCS_N_CC(ehci->hcs_params), ++ HCS_N_PCC(ehci->hcs_params), ++ HCS_N_PORTS(ehci->hcs_params)); ++ } ++ ++ ehci_port_power(ehci, 0); ++ ++ return retval; ++} ++ ++static const struct hc_driver ehci_hipox_driver = { ++ .description = hcd_name, ++ .product_desc = "HIPOX EHCI Host Controller", ++ .hcd_priv_size = sizeof(struct ehci_hcd), ++ ++ /* ++ * generic hardware linkage ++ */ ++ .irq = ehci_irq, ++ .flags = HCD_MEMORY | HCD_USB2, ++ ++ /* ++ * basic lifecycle operations ++ */ ++ .reset = ehci_hipox_setup, ++ .start = ehci_run, ++#ifdef CONFIG_PM ++ .suspend = ehci_suspend, ++ .resume = ehci_resume, ++#endif ++ .stop = ehci_stop, ++ .shutdown = ehci_shutdown, ++ ++ /* ++ * managing i/o requests and associated device resources ++ */ ++ .urb_enqueue = ehci_urb_enqueue, ++ .urb_dequeue = ehci_urb_dequeue, ++ .endpoint_disable = ehci_endpoint_disable, ++ ++ /* ++ * scheduling support ++ */ ++ .get_frame_number = ehci_get_frame, ++ ++ /* ++ * root hub support ++ */ ++ .hub_status_data = ehci_hub_status_data, ++ .hub_control = ehci_hub_control, ++ .bus_suspend = ehci_bus_suspend, ++ .bus_resume = ehci_bus_resume, ++}; ++ ++static int start_hipox_usb_ehci(struct platform_device *dev) ++{ ++ unsigned long flags; ++ unsigned long input_polarity = 0; ++ unsigned long output_polarity = 0; ++ unsigned long power_switch_mask = 0; ++ unsigned long power_monitor_mask = 0; ++ unsigned long power_lines_mask = 0; ++ ++ if (usb_disabled()) ++ return -ENODEV; ++ ++ pr_debug("%s: block sizes: qh %Zd qtd %Zd itd %Zd sitd %Zd\n", ++ hcd_name, ++ sizeof (struct ehci_qh), sizeof (struct ehci_qtd), ++ sizeof (struct ehci_itd), sizeof (struct ehci_sitd)); ++ ++#ifdef CONFIG_HIPOX_USB_PORTA_POWER_CONTROL ++ power_switch_mask |= (1UL << USBA_POWO_GPIO); ++ power_monitor_mask |= (1UL << USBA_OVERI_GPIO); ++#endif // CONFIG_HIPOX_USB_PORTA_POWER_CONTROL ++ ++#ifdef CONFIG_HIPOX_USB_PORTB_POWER_CONTROL ++ power_switch_mask |= (1UL << USBB_POWO_GPIO); ++ power_monitor_mask |= (1UL << USBB_OVERI_GPIO); ++#endif // CONFIG_HIPOX_USB_PORTB_POWER_CONTROL ++ ++#ifdef CONFIG_HIPOX_USB_PORTC_POWER_CONTROL ++ power_switch_mask |= (1UL << USBC_POWO_GPIO); ++ power_monitor_mask |= (1UL << USBC_OVERI_GPIO); ++#endif // CONFIG_HIPOX_USB_PORTC_POWER_CONTROL ++ ++ power_lines_mask = power_switch_mask | power_monitor_mask; ++ ++ // Configure USB power monitoring input and switch output GPIOs ++#ifdef CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE ++ input_polarity = ((1UL << SYS_CTRL_USBHSMPH_IP_POL_A_BIT) | ++ (1UL << SYS_CTRL_USBHSMPH_IP_POL_B_BIT) | ++ (1UL << SYS_CTRL_USBHSMPH_IP_POL_C_BIT)); ++#endif // CONFIG_HIPOX_USB_OVERCURRENT_POLARITY_NEGATIVE ++ ++#ifdef CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE ++ output_polarity = ((1UL << SYS_CTRL_USBHSMPH_OP_POL_A_BIT) | ++ (1UL << SYS_CTRL_USBHSMPH_OP_POL_B_BIT) | ++ (1UL << SYS_CTRL_USBHSMPH_OP_POL_C_BIT)); ++#endif // CONFIG_HIPOX_USB_POWER_SWITCH_POLARITY_NEGATIVE ++ ++ // Enable primary function on USB power monitor and switch lines ++ spin_lock_irqsave(&hipox_gpio_spinlock, flags); ++ writel(readl(SYS_CTRL_GPIO_PRIMSEL_CTRL_0) | power_lines_mask, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_SECSEL_CTRL_0) & ~power_lines_mask, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(readl(SYS_CTRL_GPIO_TERTSEL_CTRL_0) & ~power_lines_mask, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ spin_unlock_irqrestore(&hipox_gpio_spinlock, flags); ++ ++ // Enable GPIO output on USB power switch output GPIOs ++ writel(power_switch_mask, GPIO_A_OUTPUT_ENABLE_SET); ++ ++ // Enable GPIO input on USB power monitoring input GPIOs ++ writel(power_monitor_mask, GPIO_A_OUTPUT_ENABLE_CLEAR); ++ ++ // Set the polarity of the USB power switch output and monitoring ++ // inputs in system control ++ if (usb_patch) { ++ writel(input_polarity | output_polarity| (1<<6) , SYS_CTRL_USBHSMPH_CTRL); ++ } ++ else { ++ writel(input_polarity | output_polarity, SYS_CTRL_USBHSMPH_CTRL); ++ } ++ ++ // Ensure the USB block is properly reset ++ writel(1UL << SYS_CTRL_RSTEN_USBHS_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_USBHS_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_USBHSPHY_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ writel(1UL << SYS_CTRL_RSTEN_USBHSPHY_BIT, SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Force the high speed clock to be generated all the time, via serial ++ // programming of the USB HS PHY ++ writel((2UL << SYS_CTRL_USBHSPHY_TEST_ADD) | ++ (0xe0UL << SYS_CTRL_USBHSPHY_TEST_DIN), SYS_CTRL_USBHSPHY_CTRL); ++ ++ writel((1UL << SYS_CTRL_USBHSPHY_TEST_CLK) | ++ (2UL << SYS_CTRL_USBHSPHY_TEST_ADD) | ++ (0xe0UL << SYS_CTRL_USBHSPHY_TEST_DIN), SYS_CTRL_USBHSPHY_CTRL); ++ ++ writel((0xfUL << SYS_CTRL_USBHSPHY_TEST_ADD) | ++ (0xaaUL << SYS_CTRL_USBHSPHY_TEST_DIN), SYS_CTRL_USBHSPHY_CTRL); ++ ++ writel((1UL << SYS_CTRL_USBHSPHY_TEST_CLK) | ++ (0xfUL << SYS_CTRL_USBHSPHY_TEST_ADD) | ++ (0xaaUL << SYS_CTRL_USBHSPHY_TEST_DIN), SYS_CTRL_USBHSPHY_CTRL); ++ ++ // Enable the clock to the USB block ++ writel(1UL << SYS_CTRL_CKEN_USBHS_BIT, SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Ensure reset and clock operations are complete ++ wmb(); ++ ++ return 0; ++} ++ ++static void stop_hipox_usb_ehci(struct platform_device *dev) ++{ ++ // put usb core into reset ++ writel(1UL << SYS_CTRL_RSTEN_USBHS_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++ ++ // Disable the clock to the USB block ++ writel(1UL << SYS_CTRL_CKEN_USBHS_BIT, SYS_CTRL_CKEN_CLR_CTRL); ++} ++ ++/** ++ * usb_hcd_hipox_probe - initialize HIPOX-based HCD ++ * Context: !in_interrupt() ++ * ++ * Allocates basic resources for this USB host controller. ++ * ++ */ ++static int usb_hcd_hipox_probe(const struct hc_driver *driver, struct platform_device *dev) ++{ ++ int retval; ++ unsigned long ehci_id; ++ struct usb_hcd *hcd = 0; ++ struct ehci_hcd *ehci; ++ ++ if (dev->num_resources != 2) { ++ pr_debug("wrong number of resources %d, expected %d", dev->num_resources, 2); ++ } ++ ++ start_hipox_usb_ehci(dev); ++ ++ if (((ehci_id = readl(USB_BASE)) & 0x2f) != 0x05) { ++ pr_debug("wrong chip ID found %lx", ehci_id); ++ return -ENODEV; ++ } ++ ++ hcd = usb_create_hcd(driver, &dev->dev, "usb"); ++ if (!hcd) { ++ pr_debug("usb_create_hcd() failed"); ++ retval = -ENOMEM; ++ } ++ hcd->regs = (void *)(USB_BASE + 0x100); /* adjust to point at cap length register */ ++ ++ printk(DRIVER_INFO "@%p Device ID register %lx\n", (void *)USB_BASE, *(unsigned long *)USB_BASE); ++ ++ /* HIPOX device has a transaction translator */ ++ ehci = hcd_to_ehci(hcd); ++ ehci->is_tdi_rh_tt = 1; ++ ++ /* Finished initialisation and register */ ++ if ((retval = usb_add_hcd(hcd, dev->resource[1].start, 0))) { ++ pr_debug("usb_add_hcd() failed"); ++ stop_hipox_usb_ehci(dev); ++ usb_put_hcd(hcd); ++ return retval; ++ } ++ return 0; ++} ++ ++/** ++ * usb_hcd_hipox_remove - shutdown processing for HIPOX-based HCD ++ * @dev: USB Host Controller being removed ++ * Context: !in_interrupt() ++ * ++ * Reverses the effect of usb_hcd_hipox_probe(), first invoking ++ * the HCD's stop() method. It is always called from a thread ++ * context, normally "rmmod", "apmd", or something similar. ++ * ++ */ ++static void usb_hcd_hipox_remove(struct usb_hcd *hcd, struct platform_device *dev) ++{ ++ usb_remove_hcd(hcd); ++ usb_put_hcd(hcd); ++ stop_hipox_usb_ehci(dev); ++} ++ ++static int ehci_hcd_hipox_drv_probe(struct platform_device *dev) ++{ ++ if (usb_disabled()) ++ return -ENODEV; ++ ++ return usb_hcd_hipox_probe(&ehci_hipox_driver, dev); ++} ++ ++static int ehci_hcd_hipox_drv_remove(struct platform_device *dev) ++{ ++ usb_hcd_hipox_remove(platform_get_drvdata(dev), dev); ++ return 0; ++} ++ ++MODULE_ALIAS("hipox-ehci"); ++ ++static struct platform_driver ehci_hcd_hipox_driver = { ++ .probe = ehci_hcd_hipox_drv_probe, ++ .remove = ehci_hcd_hipox_drv_remove, ++ .shutdown = usb_hcd_platform_shutdown, ++ .driver = { ++ .name = "hipox-ehci", ++ }, ++}; +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-q.c linux-2.6.24-oxe810/drivers/usb/host/ehci-q.c +--- linux-2.6.24/drivers/usb/host/ehci-q.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-q.c 2008-06-11 17:50:19.000000000 +0200 +@@ -315,10 +315,10 @@ + if (likely (last->urb != urb)) { + ehci_urb_done(ehci, last->urb, last_status); + count++; ++ last_status = -EINPROGRESS; + } + ehci_qtd_free (ehci, last); + last = NULL; +- last_status = -EINPROGRESS; + } + + /* ignore urbs submitted during completions we reported */ +diff -Nurd linux-2.6.24/drivers/usb/host/ehci-sched.c linux-2.6.24-oxe810/drivers/usb/host/ehci-sched.c +--- linux-2.6.24/drivers/usb/host/ehci-sched.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci-sched.c 2008-06-11 17:50:19.000000000 +0200 +@@ -2109,6 +2109,7 @@ + { + unsigned frame, clock, now_uframe, mod; + unsigned modified; ++ u8 uncompleted_td = 0; + + mod = ehci->periodic_size << 3; + +@@ -2188,8 +2189,10 @@ + q = *q_p; + break; + } +- if (uf != 8) ++ if (uf != 8){ ++ uncompleted_td = 1; + break; ++ } + + /* this one's ready ... HC won't cache the + * pointer for much longer, if at all. +@@ -2214,6 +2217,7 @@ + *q_p = q.sitd->sitd_next; + *hw_p = q.sitd->hw_next; + type = Q_NEXT_TYPE(ehci, q.sitd->hw_next); ++ uncompleted_td = 1; + wmb(); + modified = sitd_complete (ehci, q.sitd); + q = *q_p; +@@ -2239,6 +2243,12 @@ + // don't exceed periodic_size msec (default 1.024 sec). + + // FIXME: likewise assumes HC doesn't halt mid-scan ++ ++ /* We must stat the next scan cycle at the first ++ * uncompleted TD so that TDs are not lost. ++ */ ++ if ((!uncompleted_td) && (ehci_to_hcd(ehci)->state == HC_STATE_RUNNING)) ++ ehci->next_uframe = now_uframe; + + if (now_uframe == clock) { + unsigned now; +diff -Nurd linux-2.6.24/drivers/usb/host/ehci.h linux-2.6.24-oxe810/drivers/usb/host/ehci.h +--- linux-2.6.24/drivers/usb/host/ehci.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/host/ehci.h 2008-06-11 17:50:19.000000000 +0200 +@@ -262,14 +262,22 @@ + /* ASYNCLISTADDR: offset 0x18 */ + u32 async_next; /* address of next async queue head */ + +- u32 reserved [9]; ++ u32 ttctrl; ++ u32 burstsize; ++ u32 txfilltuning; ++ u32 txttfilltuning; ++ u32 reserved_1; ++ u32 ulpi_viewport; ++ u32 reserved_2; ++ u32 endpknack; ++ u32 endptnalek; + + /* CONFIGFLAG: offset 0x40 */ + u32 configured_flag; + #define FLAG_CF (1<<0) /* true: we'll support "high speed" */ + + /* PORTSC: offset 0x44 */ +- u32 port_status [0]; /* up to N_PORTS */ ++ u32 port_status [8]; /* up to N_PORTS, max 8 */ + /* 31:23 reserved */ + #define PORT_WKOC_E (1<<22) /* wake on overcurrent (enable) */ + #define PORT_WKDISC_E (1<<21) /* wake on disconnect (enable) */ +@@ -294,14 +302,22 @@ + #define PORT_CSC (1<<1) /* connect status change */ + #define PORT_CONNECT (1<<0) /* device connected */ + #define PORT_RWC_BITS (PORT_CSC | PORT_PEC | PORT_OCC) +-} __attribute__ ((packed)); + +-#define USBMODE 0x68 /* USB Device mode */ ++ u32 otgsc; ++ u32 usbmode; + #define USBMODE_SDIS (1<<3) /* Stream disable */ +-#define USBMODE_BE (1<<2) /* BE/LE endianness select */ ++#define USBMODE_BE (1<<2) /* BE/LE endianness select */ + #define USBMODE_CM_HC (3<<0) /* host controller mode */ + #define USBMODE_CM_IDLE (0<<0) /* idle state */ + ++ u32 endptsetupstack; ++ u32 endptprime; ++ u32 endptflush; ++ u32 endptstat; ++ u32 endptcomplete; ++ u32 endptctrl[8]; ++} __attribute__ ((packed)); ++ + /* Appendix C, Debug port ... intended for use with special "debug devices" + * that can help if there's no serial console. (nonstandard enumeration.) + */ +@@ -682,6 +698,11 @@ + } + return (1<<USB_PORT_FEAT_HIGHSPEED); + } ++#ifdef CONFIG_USB_EHCI_ROOT_HUB_TT ++/* TDI transaction translator status register and busy bit */ ++#define TT_BUSY 0x1 ++#define TT_STATUS (0x15c-0x140) ++#endif + + #else + +diff -Nurd linux-2.6.24/drivers/usb/misc/usbtest.c linux-2.6.24-oxe810/drivers/usb/misc/usbtest.c +--- linux-2.6.24/drivers/usb/misc/usbtest.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/misc/usbtest.c 2008-06-11 17:50:18.000000000 +0200 +@@ -993,6 +993,7 @@ + + u->context = &context; + u->complete = ctrl_complete; ++ u->transfer_flags |= URB_NO_SETUP_DMA_MAP; + } + + /* queue the urbs */ +@@ -1151,6 +1152,7 @@ + dbg ("ep %02x couldn't get halt status, %d", ep, retval); + return retval; + } ++ le16_to_cpus(&status); + if (status != 1) { + dbg ("ep %02x bogus status: %04x != 1", ep, status); + return -EINVAL; +@@ -1207,7 +1209,7 @@ + int retval = 0; + struct urb *urb; + +- urb = simple_alloc_urb (testdev_to_usbdev (dev), 0, 512); ++ urb = simple_alloc_urb (testdev_to_usbdev (dev), 0, 256); + if (urb == NULL) + return -ENOMEM; + +@@ -2100,6 +2102,10 @@ + /* EZ-USB devices which download firmware to replace (or in our + * case augment) the default device implementation. + */ ++ /* generic EZ-USB FX controller */ ++ { USB_DEVICE (0x0547, 0x2131), ++ .driver_info = (unsigned long) &ez1_info, ++ }, + + /* generic EZ-USB FX controller */ + { USB_DEVICE (0x0547, 0x2235), +diff -Nurd linux-2.6.24/drivers/usb/serial/cp2101.c linux-2.6.24-oxe810/drivers/usb/serial/cp2101.c +--- linux-2.6.24/drivers/usb/serial/cp2101.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/cp2101.c 2008-06-11 17:50:15.000000000 +0200 +@@ -59,6 +59,7 @@ + { USB_DEVICE(0x10A6, 0xAA26) }, /* Knock-off DCU-11 cable */ + { USB_DEVICE(0x10AB, 0x10C5) }, /* Siemens MC60 Cable */ + { USB_DEVICE(0x10B5, 0xAC70) }, /* Nokia CA-42 USB */ ++ { USB_DEVICE(0x10C4, 0x800A) }, /* SPORTident BSM7-D-USB main station */ + { USB_DEVICE(0x10C4, 0x803B) }, /* Pololu USB-serial converter */ + { USB_DEVICE(0x10C4, 0x8053) }, /* Enfora EDG1228 */ + { USB_DEVICE(0x10C4, 0x8066) }, /* Argussoft In-System Programmer */ +@@ -76,8 +77,13 @@ + { USB_DEVICE(0x10C4, 0x8218) }, /* Lipowsky Industrie Elektronik GmbH, HARP-1 */ + { USB_DEVICE(0x10C4, 0xEA60) }, /* Silicon Labs factory default */ + { USB_DEVICE(0x10C4, 0xEA61) }, /* Silicon Labs factory default */ ++ { USB_DEVICE(0x10C4, 0xF001) }, /* Elan Digital Systems USBscope50 */ ++ { USB_DEVICE(0x10C4, 0xF002) }, /* Elan Digital Systems USBwave12 */ ++ { USB_DEVICE(0x10C4, 0xF003) }, /* Elan Digital Systems USBpulse100 */ ++ { USB_DEVICE(0x10C4, 0xF004) }, /* Elan Digital Systems USBcount50 */ + { USB_DEVICE(0x10C5, 0xEA61) }, /* Silicon Labs MobiData GPRS USB Modem */ + { USB_DEVICE(0x13AD, 0x9999) }, /* Baltech card reader */ ++ { USB_DEVICE(0x166A, 0x0303) }, /* Clipsal 5500PCU C-Bus USB interface */ + { USB_DEVICE(0x16D6, 0x0001) }, /* Jablotron serial interface */ + { } /* Terminating Entry */ + }; +diff -Nurd linux-2.6.24/drivers/usb/serial/ftdi_sio.c linux-2.6.24-oxe810/drivers/usb/serial/ftdi_sio.c +--- linux-2.6.24/drivers/usb/serial/ftdi_sio.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/ftdi_sio.c 2008-06-11 17:50:15.000000000 +0200 +@@ -310,6 +310,7 @@ + }; + + static int ftdi_olimex_probe (struct usb_serial *serial); ++static int ftdi_mtxorb_hack_setup (struct usb_serial *serial); + static void ftdi_USB_UIRT_setup (struct ftdi_private *priv); + static void ftdi_HE_TIRA1_setup (struct ftdi_private *priv); + +@@ -317,6 +318,10 @@ + .probe = ftdi_olimex_probe, + }; + ++static struct ftdi_sio_quirk ftdi_mtxorb_hack_quirk = { ++ .probe = ftdi_mtxorb_hack_setup, ++}; ++ + static struct ftdi_sio_quirk ftdi_USB_UIRT_quirk = { + .port_probe = ftdi_USB_UIRT_setup, + }; +@@ -379,6 +384,8 @@ + { USB_DEVICE(FTDI_VID, FTDI_MTXORB_4_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_MTXORB_5_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_MTXORB_6_PID) }, ++ { USB_DEVICE(MTXORB_VK_VID, MTXORB_VK_PID), ++ .driver_info = (kernel_ulong_t)&ftdi_mtxorb_hack_quirk }, + { USB_DEVICE(FTDI_VID, FTDI_PERLE_ULTRAPORT_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_PIEGROUP_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_TNC_X_PID) }, +@@ -471,30 +478,29 @@ + { USB_DEVICE(FTDI_VID, FTDI_IBS_PEDO_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_IBS_PROD_PID) }, + /* +- * These will probably use user-space drivers. Uncomment them if +- * you need them or use the user-specified vendor/product module +- * parameters (see ftdi_sio.h for the numbers). Make a fuss if +- * you think the driver should recognize any of them by default. ++ * Due to many user requests for multiple ELV devices we enable ++ * them by default. + */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_CLI7000_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_PPS7330_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_TFM100_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_UDF77_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_UIO88_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_UAD8_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_UDA7_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_USI2_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_T1100_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_PCD200_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_ULA200_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_CSI8_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_EM1000DL_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_PCK100_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_RFP500_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_FS20SIG_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_WS300PC_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_FHZ1300PC_PID) }, */ +- /* { USB_DEVICE(FTDI_VID, FTDI_ELV_WS500_PID) }, */ ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_CLI7000_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_PPS7330_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_TFM100_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_UDF77_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_UIO88_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_UAD8_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_UDA7_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_USI2_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_T1100_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_PCD200_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_ULA200_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_CSI8_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_EM1000DL_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_PCK100_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_RFP500_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_FS20SIG_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_WS300PC_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_FHZ1300PC_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_EM1010PC_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELV_WS500_PID) }, + { USB_DEVICE(FTDI_VID, LINX_SDMUSBQSS_PID) }, + { USB_DEVICE(FTDI_VID, LINX_MASTERDEVEL2_PID) }, + { USB_DEVICE(FTDI_VID, LINX_FUTURE_0_PID) }, +@@ -545,6 +551,7 @@ + { USB_DEVICE(FTDI_VID, FTDI_ATIK_ATK16C_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_ATIK_ATK16HR_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_ATIK_ATK16HRC_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ATIK_ATK16IC_PID) }, + { USB_DEVICE(KOBIL_VID, KOBIL_CONV_B1_PID) }, + { USB_DEVICE(KOBIL_VID, KOBIL_CONV_KAAN_PID) }, + { USB_DEVICE(POSIFLEX_VID, POSIFLEX_PP7000_PID) }, +@@ -569,6 +576,7 @@ + { USB_DEVICE(TELLDUS_VID, TELLDUS_TELLSTICK_PID) }, + { USB_DEVICE(FTDI_VID, FTDI_MAXSTREAM_PID) }, + { USB_DEVICE(TML_VID, TML_USB_SERIAL_PID) }, ++ { USB_DEVICE(FTDI_VID, FTDI_ELSTER_UNICOM_PID) }, + { USB_DEVICE(OLIMEX_VID, OLIMEX_ARM_USB_OCD_PID), + .driver_info = (kernel_ulong_t)&ftdi_olimex_quirk }, + { }, /* Optional parameter entry */ +@@ -1299,6 +1307,23 @@ + } + + return 0; ++} ++ ++/* ++ * The Matrix Orbital VK204-25-USB has an invalid IN endpoint. ++ * We have to correct it if we want to read from it. ++ */ ++static int ftdi_mtxorb_hack_setup(struct usb_serial *serial) ++{ ++ struct usb_host_endpoint *ep = serial->dev->ep_in[1]; ++ struct usb_endpoint_descriptor *ep_desc = &ep->desc; ++ ++ if (ep->enabled && ep_desc->wMaxPacketSize == 0) { ++ ep_desc->wMaxPacketSize = 0x40; ++ info("Fixing invalid wMaxPacketSize on read pipe"); ++ } ++ ++ return 0; + } + + /* ftdi_shutdown is called from usbserial:usb_serial_disconnect +diff -Nurd linux-2.6.24/drivers/usb/serial/ftdi_sio.h linux-2.6.24-oxe810/drivers/usb/serial/ftdi_sio.h +--- linux-2.6.24/drivers/usb/serial/ftdi_sio.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/ftdi_sio.h 2008-06-11 17:50:15.000000000 +0200 +@@ -98,6 +98,13 @@ + #define FTDI_MTXORB_5_PID 0xFA05 /* Matrix Orbital Product Id */ + #define FTDI_MTXORB_6_PID 0xFA06 /* Matrix Orbital Product Id */ + ++/* ++ * The following are the values for the Matrix Orbital VK204-25-USB ++ * display, which use the FT232RL. ++ */ ++#define MTXORB_VK_VID 0x1b3d ++#define MTXORB_VK_PID 0x0158 ++ + /* Interbiometrics USB I/O Board */ + /* Developed for Interbiometrics by Rudolf Gugler */ + #define INTERBIOMETRICS_VID 0x1209 +@@ -245,6 +252,7 @@ + #define FTDI_ELV_WS300PC_PID 0xE0F6 /* PC-Wetterstation (WS 300 PC) */ + #define FTDI_ELV_FHZ1300PC_PID 0xE0E8 /* FHZ 1300 PC */ + #define FTDI_ELV_WS500_PID 0xE0E9 /* PC-Wetterstation (WS 500) */ ++#define FTDI_ELV_EM1010PC_PID 0xE0EF /* Engery monitor EM 1010 PC */ + + /* + * Definitions for ID TECH (www.idt-net.com) devices +@@ -278,6 +286,7 @@ + #define FTDI_ATIK_ATK16C_PID 0xDF32 /* ATIK ATK-16C Colour Camera */ + #define FTDI_ATIK_ATK16HR_PID 0xDF31 /* ATIK ATK-16HR Grayscale Camera */ + #define FTDI_ATIK_ATK16HRC_PID 0xDF33 /* ATIK ATK-16HRC Colour Camera */ ++#define FTDI_ATIK_ATK16IC_PID 0xDF35 /* ATIK ATK-16IC Grayscale Camera */ + + /* + * Protego product ids +@@ -534,6 +543,8 @@ + #define OLIMEX_VID 0x15BA + #define OLIMEX_ARM_USB_OCD_PID 0x0003 + ++/* www.elsterelectricity.com Elster Unicom III Optical Probe */ ++#define FTDI_ELSTER_UNICOM_PID 0xE700 /* Product Id */ + + /* + * The Mobility Lab (TML) +diff -Nurd linux-2.6.24/drivers/usb/serial/keyspan.c linux-2.6.24-oxe810/drivers/usb/serial/keyspan.c +--- linux-2.6.24/drivers/usb/serial/keyspan.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/keyspan.c 2008-06-11 17:50:15.000000000 +0200 +@@ -838,7 +838,7 @@ + + port = (struct usb_serial_port *) urb->context; + tty = port->tty; +- if (urb->actual_length) { ++ if (tty && urb->actual_length) { + /* 0x80 bit is error flag */ + if ((data[0] & 0x80) == 0) { + /* no error on any byte */ +diff -Nurd linux-2.6.24/drivers/usb/serial/kobil_sct.c linux-2.6.24-oxe810/drivers/usb/serial/kobil_sct.c +--- linux-2.6.24/drivers/usb/serial/kobil_sct.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/kobil_sct.c 2008-06-11 17:50:15.000000000 +0200 +@@ -114,6 +114,7 @@ + .usb_driver = &kobil_driver, + .id_table = id_table, + .num_interrupt_in = NUM_DONT_CARE, ++ .num_interrupt_out = NUM_DONT_CARE, + .num_bulk_in = 0, + .num_bulk_out = 0, + .num_ports = 1, +diff -Nurd linux-2.6.24/drivers/usb/serial/option.c linux-2.6.24-oxe810/drivers/usb/serial/option.c +--- linux-2.6.24/drivers/usb/serial/option.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/option.c 2008-06-11 17:50:15.000000000 +0200 +@@ -180,6 +180,7 @@ + { USB_DEVICE(DELL_VENDOR_ID, 0x8117) }, /* Dell Wireless 5700 Mobile Broadband CDMA/EVDO ExpressCard == Novatel Merlin XV620 CDMA/EV-DO */ + { USB_DEVICE(DELL_VENDOR_ID, 0x8118) }, /* Dell Wireless 5510 Mobile Broadband HSDPA ExpressCard == Novatel Merlin XU870 HSDPA/3G */ + { USB_DEVICE(DELL_VENDOR_ID, 0x8128) }, /* Dell Wireless 5700 Mobile Broadband CDMA/EVDO Mini-Card == Novatel Expedite E720 CDMA/EV-DO */ ++ { USB_DEVICE(DELL_VENDOR_ID, 0x8136) }, /* Dell Wireless HSDPA 5520 == Novatel Expedite EU860D */ + { USB_DEVICE(DELL_VENDOR_ID, 0x8137) }, /* Dell Wireless HSDPA 5520 */ + { USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_E100A) }, + { USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_500A) }, +diff -Nurd linux-2.6.24/drivers/usb/serial/pl2303.c linux-2.6.24-oxe810/drivers/usb/serial/pl2303.c +--- linux-2.6.24/drivers/usb/serial/pl2303.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/pl2303.c 2008-06-11 17:50:15.000000000 +0200 +@@ -65,6 +65,7 @@ + { USB_DEVICE(ITEGNO_VENDOR_ID, ITEGNO_PRODUCT_ID_2080) }, + { USB_DEVICE(MA620_VENDOR_ID, MA620_PRODUCT_ID) }, + { USB_DEVICE(RATOC_VENDOR_ID, RATOC_PRODUCT_ID) }, ++ { USB_DEVICE(RATOC_VENDOR_ID, RATOC_PRODUCT_ID_USB60F) }, + { USB_DEVICE(TRIPP_VENDOR_ID, TRIPP_PRODUCT_ID) }, + { USB_DEVICE(RADIOSHACK_VENDOR_ID, RADIOSHACK_PRODUCT_ID) }, + { USB_DEVICE(DCU10_VENDOR_ID, DCU10_PRODUCT_ID) }, +@@ -84,9 +85,10 @@ + { USB_DEVICE(DATAPILOT_U2_VENDOR_ID, DATAPILOT_U2_PRODUCT_ID) }, + { USB_DEVICE(BELKIN_VENDOR_ID, BELKIN_PRODUCT_ID) }, + { USB_DEVICE(ALCOR_VENDOR_ID, ALCOR_PRODUCT_ID) }, +- { USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_ID) }, + { USB_DEVICE(WS002IN_VENDOR_ID, WS002IN_PRODUCT_ID) }, + { USB_DEVICE(COREGA_VENDOR_ID, COREGA_PRODUCT_ID) }, ++ { USB_DEVICE(HL340_VENDOR_ID, HL340_PRODUCT_ID) }, ++ { USB_DEVICE(YCCABLE_VENDOR_ID, YCCABLE_PRODUCT_ID) }, + { } /* Terminating entry */ + }; + +diff -Nurd linux-2.6.24/drivers/usb/serial/pl2303.h linux-2.6.24-oxe810/drivers/usb/serial/pl2303.h +--- linux-2.6.24/drivers/usb/serial/pl2303.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/pl2303.h 2008-06-11 17:50:15.000000000 +0200 +@@ -35,6 +35,7 @@ + + #define RATOC_VENDOR_ID 0x0584 + #define RATOC_PRODUCT_ID 0xb000 ++#define RATOC_PRODUCT_ID_USB60F 0xb020 + + #define TRIPP_VENDOR_ID 0x2478 + #define TRIPP_PRODUCT_ID 0x2008 +@@ -96,10 +97,6 @@ + #define ALCOR_VENDOR_ID 0x058F + #define ALCOR_PRODUCT_ID 0x9720 + +-/* Huawei E620 UMTS/HSDPA card (ID: 12d1:1001) */ +-#define HUAWEI_VENDOR_ID 0x12d1 +-#define HUAWEI_PRODUCT_ID 0x1001 +- + /* Willcom WS002IN Data Driver (by NetIndex Inc.) */ + #define WS002IN_VENDOR_ID 0x11f6 + #define WS002IN_PRODUCT_ID 0x2001 +@@ -107,3 +104,11 @@ + /* Corega CG-USBRS232R Serial Adapter */ + #define COREGA_VENDOR_ID 0x07aa + #define COREGA_PRODUCT_ID 0x002a ++ ++/* HL HL-340 (ID: 4348:5523) */ ++#define HL340_VENDOR_ID 0x4348 ++#define HL340_PRODUCT_ID 0x5523 ++ ++/* Y.C. Cable U.S.A., Inc - USB to RS-232 */ ++#define YCCABLE_VENDOR_ID 0x05ad ++#define YCCABLE_PRODUCT_ID 0x0fba +diff -Nurd linux-2.6.24/drivers/usb/serial/sierra.c linux-2.6.24-oxe810/drivers/usb/serial/sierra.c +--- linux-2.6.24/drivers/usb/serial/sierra.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/serial/sierra.c 2008-06-11 17:50:15.000000000 +0200 +@@ -104,6 +104,7 @@ + { USB_DEVICE(0x1199, 0x0019) }, /* Sierra Wireless AirCard 595 */ + { USB_DEVICE(0x1199, 0x0021) }, /* Sierra Wireless AirCard 597E */ + { USB_DEVICE(0x1199, 0x0120) }, /* Sierra Wireless USB Dongle 595U */ ++ { USB_DEVICE(0x1199, 0x0023) }, /* Sierra Wireless AirCard */ + + { USB_DEVICE(0x1199, 0x6802) }, /* Sierra Wireless MC8755 */ + { USB_DEVICE(0x1199, 0x6804) }, /* Sierra Wireless MC8755 */ +@@ -117,9 +118,15 @@ + { USB_DEVICE(0x1199, 0x6851) }, /* Sierra Wireless AirCard 881 */ + { USB_DEVICE(0x1199, 0x6852) }, /* Sierra Wireless AirCard 880 E */ + { USB_DEVICE(0x1199, 0x6853) }, /* Sierra Wireless AirCard 881 E */ ++ { USB_DEVICE(0x1199, 0x6855) }, /* Sierra Wireless AirCard 880 U */ ++ { USB_DEVICE(0x1199, 0x6856) }, /* Sierra Wireless AirCard 881 U */ ++ ++ { USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */ ++ { USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */ + + { USB_DEVICE(0x1199, 0x0112), .driver_info = DEVICE_1_PORT }, /* Sierra Wireless AirCard 580 */ + { USB_DEVICE(0x0F3D, 0x0112), .driver_info = DEVICE_1_PORT }, /* Airprime/Sierra PC 5220 */ ++ { USB_DEVICE(0x05C6, 0x6613), .driver_info = DEVICE_1_PORT }, /* Onda H600/ZTE MF330 */ + + { USB_DEVICE(0x1199, 0x0FFF), .driver_info = DEVICE_INSTALLER}, + { } +@@ -129,6 +136,7 @@ + static struct usb_device_id id_table_1port [] = { + { USB_DEVICE(0x1199, 0x0112) }, /* Sierra Wireless AirCard 580 */ + { USB_DEVICE(0x0F3D, 0x0112) }, /* AirPrime/Sierra PC 5220 */ ++ { USB_DEVICE(0x05C6, 0x6613) }, /* Onda H600/ZTE MF330 */ + { } + }; + +@@ -142,6 +150,7 @@ + { USB_DEVICE(0x1199, 0x0019) }, /* Sierra Wireless AirCard 595 */ + { USB_DEVICE(0x1199, 0x0021) }, /* Sierra Wireless AirCard 597E */ + { USB_DEVICE(0x1199, 0x0120) }, /* Sierra Wireless USB Dongle 595U*/ ++ { USB_DEVICE(0x1199, 0x0023) }, /* Sierra Wireless AirCard */ + + { USB_DEVICE(0x1199, 0x6802) }, /* Sierra Wireless MC8755 */ + { USB_DEVICE(0x1199, 0x6804) }, /* Sierra Wireless MC8755 */ +@@ -155,6 +164,10 @@ + { USB_DEVICE(0x1199, 0x6851) }, /* Sierra Wireless AirCard 881 */ + { USB_DEVICE(0x1199, 0x6852) }, /* Sierra Wireless AirCard 880E */ + { USB_DEVICE(0x1199, 0x6853) }, /* Sierra Wireless AirCard 881E */ ++ { USB_DEVICE(0x1199, 0x6855) }, /* Sierra Wireless AirCard 880 U */ ++ { USB_DEVICE(0x1199, 0x6856) }, /* Sierra Wireless AirCard 881U */ ++ { USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */ ++ { USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */ + { } + }; + +diff -Nurd linux-2.6.24/drivers/usb/storage/protocol.c linux-2.6.24-oxe810/drivers/usb/storage/protocol.c +--- linux-2.6.24/drivers/usb/storage/protocol.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/storage/protocol.c 2008-06-11 17:50:16.000000000 +0200 +@@ -194,7 +194,7 @@ + * and the starting offset within the page, and update + * the *offset and *index values for the next loop. */ + cnt = 0; +- while (cnt < buflen) { ++ while (cnt < buflen && sg) { + struct page *page = sg_page(sg) + + ((sg->offset + *offset) >> PAGE_SHIFT); + unsigned int poff = +@@ -249,7 +249,8 @@ + unsigned int offset = 0; + struct scatterlist *sg = NULL; + +- usb_stor_access_xfer_buf(buffer, buflen, srb, &sg, &offset, ++ buflen = min(buflen, srb->request_bufflen); ++ buflen = usb_stor_access_xfer_buf(buffer, buflen, srb, &sg, &offset, + TO_XFER_BUF); + if (buflen < srb->request_bufflen) + srb->resid = srb->request_bufflen - buflen; +diff -Nurd linux-2.6.24/drivers/usb/storage/unusual_devs.h linux-2.6.24-oxe810/drivers/usb/storage/unusual_devs.h +--- linux-2.6.24/drivers/usb/storage/unusual_devs.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/drivers/usb/storage/unusual_devs.h 2008-06-11 17:50:16.000000000 +0200 +@@ -86,6 +86,14 @@ + US_SC_8070, US_PR_USBAT, init_usbat_cd, 0), + #endif + ++/* Reported by Grant Grundler <grundler@parisc-linux.org> ++ * HP r707 camera in "Disk" mode with 2.00.23 or 2.00.24 firmware. ++ */ ++UNUSUAL_DEV( 0x03f0, 0x4002, 0x0001, 0x0001, ++ "HP", ++ "PhotoSmart R707", ++ US_SC_DEVICE, US_PR_DEVICE, NULL, US_FL_FIX_CAPACITY), ++ + /* Reported by Sebastian Kapfer <sebastian_kapfer@gmx.net> + * and Olaf Hering <olh@suse.de> (different bcd's, same vendor/product) + * for USB floppies that need the SINGLE_LUN enforcement. +diff -Nurd linux-2.6.24/fs/adfs/file.c linux-2.6.24-oxe810/fs/adfs/file.c +--- linux-2.6.24/fs/adfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/adfs/file.c 2008-06-11 17:47:02.000000000 +0200 +@@ -33,6 +33,7 @@ + .fsync = file_fsync, + .write = do_sync_write, + .aio_write = generic_file_aio_write, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/affs/file.c linux-2.6.24-oxe810/fs/affs/file.c +--- linux-2.6.24/fs/affs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/affs/file.c 2008-06-11 17:46:52.000000000 +0200 +@@ -35,6 +35,7 @@ + .open = affs_file_open, + .release = affs_file_release, + .fsync = file_fsync, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/afs/file.c linux-2.6.24-oxe810/fs/afs/file.c +--- linux-2.6.24/fs/afs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/afs/file.c 2008-06-11 17:46:51.000000000 +0200 +@@ -32,6 +32,7 @@ + .aio_read = generic_file_aio_read, + .aio_write = afs_file_write, + .mmap = generic_file_readonly_mmap, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + .fsync = afs_fsync, + .lock = afs_lock, +diff -Nurd linux-2.6.24/fs/aio.c linux-2.6.24-oxe810/fs/aio.c +--- linux-2.6.24/fs/aio.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/aio.c 2008-06-11 17:47:10.000000000 +0200 +@@ -997,6 +997,14 @@ + /* everything turned out well, dispose of the aiocb. */ + ret = __aio_put_req(ctx, iocb); + ++ /* ++ * We have to order our ring_info tail store above and test ++ * of the wait list below outside the wait lock. This is ++ * like in wake_up_bit() where clearing a bit has to be ++ * ordered with the unlocked test. ++ */ ++ smp_mb(); ++ + if (waitqueue_active(&ctx->wait)) + wake_up(&ctx->wait); + +diff -Nurd linux-2.6.24/fs/bio.c linux-2.6.24-oxe810/fs/bio.c +--- linux-2.6.24/fs/bio.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/bio.c 2008-06-11 17:47:10.000000000 +0200 +@@ -133,6 +133,7 @@ + memset(bio, 0, sizeof(*bio)); + bio->bi_flags = 1 << BIO_UPTODATE; + atomic_set(&bio->bi_cnt, 1); ++ bio->bi_raid = 0; + } + + /** +@@ -260,6 +261,7 @@ + bio->bi_vcnt = bio_src->bi_vcnt; + bio->bi_size = bio_src->bi_size; + bio->bi_idx = bio_src->bi_idx; ++ bio->bi_raid = bio_src->bi_raid; + bio_phys_segments(q, bio); + bio_hw_segments(q, bio); + } +diff -Nurd linux-2.6.24/fs/coda/file.c linux-2.6.24-oxe810/fs/coda/file.c +--- linux-2.6.24/fs/coda/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/coda/file.c 2008-06-11 17:47:09.000000000 +0200 +@@ -238,6 +238,7 @@ + .open = coda_open, + .release = coda_release, + .fsync = coda_fsync, ++ .sendfile = coda_file_sendfile, + .splice_read = coda_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/ecryptfs/file.c linux-2.6.24-oxe810/fs/ecryptfs/file.c +--- linux-2.6.24/fs/ecryptfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ecryptfs/file.c 2008-06-11 17:46:59.000000000 +0200 +@@ -292,6 +292,7 @@ + .release = ecryptfs_release, + .fsync = ecryptfs_fsync, + .fasync = ecryptfs_fasync, ++ .sendfile = ecryptfs_sendfile, + .splice_read = generic_file_splice_read, + }; + +@@ -309,6 +310,7 @@ + .release = ecryptfs_release, + .fsync = ecryptfs_fsync, + .fasync = ecryptfs_fasync, ++ .sendfile = ecryptfs_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/ecryptfs/mmap.c linux-2.6.24-oxe810/fs/ecryptfs/mmap.c +--- linux-2.6.24/fs/ecryptfs/mmap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ecryptfs/mmap.c 2008-06-11 17:46:59.000000000 +0200 +@@ -263,52 +263,102 @@ + return 0; + } + +-/* This function must zero any hole we create */ ++/** ++ * ecryptfs_prepare_write ++ * @file: The eCryptfs file ++ * @page: The eCryptfs page ++ * @from: The start byte from which we will write ++ * @to: The end byte to which we will write ++ * ++ * This function must zero any hole we create ++ * ++ * Returns zero on success; non-zero otherwise ++ */ + static int ecryptfs_prepare_write(struct file *file, struct page *page, + unsigned from, unsigned to) + { +- int rc = 0; + loff_t prev_page_end_size; ++ int rc = 0; + + if (!PageUptodate(page)) { +- rc = ecryptfs_read_lower_page_segment(page, page->index, 0, +- PAGE_CACHE_SIZE, +- page->mapping->host); +- if (rc) { +- printk(KERN_ERR "%s: Error attemping to read lower " +- "page segment; rc = [%d]\n", __FUNCTION__, rc); +- ClearPageUptodate(page); +- goto out; +- } else ++ struct ecryptfs_crypt_stat *crypt_stat = ++ &ecryptfs_inode_to_private( ++ file->f_path.dentry->d_inode)->crypt_stat; ++ ++ if (!(crypt_stat->flags & ECRYPTFS_ENCRYPTED) ++ || (crypt_stat->flags & ECRYPTFS_NEW_FILE)) { ++ rc = ecryptfs_read_lower_page_segment( ++ page, page->index, 0, PAGE_CACHE_SIZE, ++ page->mapping->host); ++ if (rc) { ++ printk(KERN_ERR "%s: Error attemping to read " ++ "lower page segment; rc = [%d]\n", ++ __FUNCTION__, rc); ++ ClearPageUptodate(page); ++ goto out; ++ } else ++ SetPageUptodate(page); ++ } else if (crypt_stat->flags & ECRYPTFS_VIEW_AS_ENCRYPTED) { ++ if (crypt_stat->flags & ECRYPTFS_METADATA_IN_XATTR) { ++ rc = ecryptfs_copy_up_encrypted_with_header( ++ page, crypt_stat); ++ if (rc) { ++ printk(KERN_ERR "%s: Error attempting " ++ "to copy the encrypted content " ++ "from the lower file whilst " ++ "inserting the metadata from " ++ "the xattr into the header; rc " ++ "= [%d]\n", __FUNCTION__, rc); ++ ClearPageUptodate(page); ++ goto out; ++ } ++ SetPageUptodate(page); ++ } else { ++ rc = ecryptfs_read_lower_page_segment( ++ page, page->index, 0, PAGE_CACHE_SIZE, ++ page->mapping->host); ++ if (rc) { ++ printk(KERN_ERR "%s: Error reading " ++ "page; rc = [%d]\n", ++ __FUNCTION__, rc); ++ ClearPageUptodate(page); ++ goto out; ++ } ++ SetPageUptodate(page); ++ } ++ } else { ++ rc = ecryptfs_decrypt_page(page); ++ if (rc) { ++ printk(KERN_ERR "%s: Error decrypting page " ++ "at index [%ld]; rc = [%d]\n", ++ __FUNCTION__, page->index, rc); ++ ClearPageUptodate(page); ++ goto out; ++ } + SetPageUptodate(page); ++ } + } +- + prev_page_end_size = ((loff_t)page->index << PAGE_CACHE_SHIFT); +- +- /* +- * If creating a page or more of holes, zero them out via truncate. +- * Note, this will increase i_size. +- */ ++ /* If creating a page or more of holes, zero them out via truncate. ++ * Note, this will increase i_size. */ + if (page->index != 0) { + if (prev_page_end_size > i_size_read(page->mapping->host)) { + rc = ecryptfs_truncate(file->f_path.dentry, + prev_page_end_size); + if (rc) { +- printk(KERN_ERR "Error on attempt to " ++ printk(KERN_ERR "%s: Error on attempt to " + "truncate to (higher) offset [%lld];" +- " rc = [%d]\n", prev_page_end_size, rc); ++ " rc = [%d]\n", __FUNCTION__, ++ prev_page_end_size, rc); + goto out; + } + } + } +- /* +- * Writing to a new page, and creating a small hole from start of page? +- * Zero it out. +- */ +- if ((i_size_read(page->mapping->host) == prev_page_end_size) && +- (from != 0)) { ++ /* Writing to a new page, and creating a small hole from start ++ * of page? Zero it out. */ ++ if ((i_size_read(page->mapping->host) == prev_page_end_size) ++ && (from != 0)) + zero_user_page(page, 0, PAGE_CACHE_SIZE, KM_USER0); +- } + out: + return rc; + } +diff -Nurd linux-2.6.24/fs/eventpoll.c linux-2.6.24-oxe810/fs/eventpoll.c +--- linux-2.6.24/fs/eventpoll.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/eventpoll.c 2008-06-11 17:47:10.000000000 +0200 +@@ -353,7 +353,7 @@ + spin_unlock_irqrestore(&psw->lock, flags); + + /* Do really wake up now */ +- wake_up(wq); ++ wake_up_nested(wq, 1 + wake_nests); + + /* Remove the current task from the list */ + spin_lock_irqsave(&psw->lock, flags); +diff -Nurd linux-2.6.24/fs/ext2/file.c linux-2.6.24-oxe810/fs/ext2/file.c +--- linux-2.6.24/fs/ext2/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ext2/file.c 2008-06-11 17:47:06.000000000 +0200 +@@ -56,6 +56,7 @@ + .open = generic_file_open, + .release = ext2_release_file, + .fsync = ext2_sync_file, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + .splice_write = generic_file_splice_write, + }; +@@ -73,6 +74,7 @@ + .open = generic_file_open, + .release = ext2_release_file, + .fsync = ext2_sync_file, ++ .sendfile = xip_file_sendfile, + }; + #endif + +diff -Nurd linux-2.6.24/fs/ext3/file.c linux-2.6.24-oxe810/fs/ext3/file.c +--- linux-2.6.24/fs/ext3/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ext3/file.c 2008-06-11 17:47:06.000000000 +0200 +@@ -120,6 +120,7 @@ + .open = generic_file_open, + .release = ext3_release_file, + .fsync = ext3_sync_file, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + .splice_write = generic_file_splice_write, + }; +diff -Nurd linux-2.6.24/fs/ext3/ialloc.c linux-2.6.24-oxe810/fs/ext3/ialloc.c +--- linux-2.6.24/fs/ext3/ialloc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ext3/ialloc.c 2008-06-11 17:47:06.000000000 +0200 +@@ -543,7 +543,16 @@ + percpu_counter_inc(&sbi->s_dirs_counter); + sb->s_dirt = 1; + ++#ifdef CONFIG_HIPOX_SUID_INHERIT ++ if (dir->i_mode & S_ISUID) { ++ inode->i_uid = dir->i_uid; ++ if (S_ISDIR(mode)) ++ mode |= S_ISUID; ++ } else ++#else // CONFIG_HIPOX_SUID_INHERIT + inode->i_uid = current->fsuid; ++#endif // CONFIG_HIPOX_SUID_INHERIT ++ + if (test_opt (sb, GRPID)) + inode->i_gid = dir->i_gid; + else if (dir->i_mode & S_ISGID) { +diff -Nurd linux-2.6.24/fs/ext4/file.c linux-2.6.24-oxe810/fs/ext4/file.c +--- linux-2.6.24/fs/ext4/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ext4/file.c 2008-06-11 17:47:07.000000000 +0200 +@@ -120,7 +120,8 @@ + .open = generic_file_open, + .release = ext4_release_file, + .fsync = ext4_sync_file, +- .splice_read = generic_file_splice_read, ++ .sendfile = generic_file_sendfile, ++ .splice_read = generic_file_splice_read, + .splice_write = generic_file_splice_write, + }; + +diff -Nurd linux-2.6.24/fs/fat/file.c linux-2.6.24-oxe810/fs/fat/file.c +--- linux-2.6.24/fs/fat/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/fat/file.c 2008-06-11 17:47:05.000000000 +0200 +@@ -134,6 +134,7 @@ + .release = fat_file_release, + .ioctl = fat_generic_ioctl, + .fsync = file_fsync, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/fuse/dir.c linux-2.6.24-oxe810/fs/fuse/dir.c +--- linux-2.6.24/fs/fuse/dir.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/fuse/dir.c 2008-06-11 17:47:00.000000000 +0200 +@@ -905,7 +905,7 @@ + } + + if (fc->flags & FUSE_DEFAULT_PERMISSIONS) { +- int err = generic_permission(inode, mask, NULL); ++ err = generic_permission(inode, mask, NULL); + + /* If permission is denied, try to refresh file + attributes. This is also needed, because the root +diff -Nurd linux-2.6.24/fs/fuse/file.c linux-2.6.24-oxe810/fs/fuse/file.c +--- linux-2.6.24/fs/fuse/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/fuse/file.c 2008-06-11 17:47:00.000000000 +0200 +@@ -920,6 +920,7 @@ + .fsync = fuse_fsync, + .lock = fuse_file_lock, + .flock = fuse_file_flock, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/gfs2/ops_file.c linux-2.6.24-oxe810/fs/gfs2/ops_file.c +--- linux-2.6.24/fs/gfs2/ops_file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/gfs2/ops_file.c 2008-06-11 17:47:09.000000000 +0200 +@@ -662,6 +662,7 @@ + .release = gfs2_close, + .fsync = gfs2_fsync, + .lock = gfs2_lock, ++ .sendfile = generic_file_sendfile, + .flock = gfs2_flock, + .splice_read = generic_file_splice_read, + .splice_write = generic_file_splice_write, +diff -Nurd linux-2.6.24/fs/hpfs/file.c linux-2.6.24-oxe810/fs/hpfs/file.c +--- linux-2.6.24/fs/hpfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/hpfs/file.c 2008-06-11 17:46:57.000000000 +0200 +@@ -137,6 +137,7 @@ + .mmap = generic_file_mmap, + .release = hpfs_file_release, + .fsync = hpfs_file_fsync, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/inotify_user.c linux-2.6.24-oxe810/fs/inotify_user.c +--- linux-2.6.24/fs/inotify_user.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/inotify_user.c 2008-06-11 17:47:10.000000000 +0200 +@@ -269,7 +269,7 @@ + /* we can safely put the watch as we don't reference it while + * generating the event + */ +- if (mask & IN_IGNORED || mask & IN_ONESHOT) ++ if (mask & IN_IGNORED || w->mask & IN_ONESHOT) + put_inotify_watch(w); /* final put */ + + /* coalescing: drop this event if it is a dupe of the previous */ +diff -Nurd linux-2.6.24/fs/isofs/compress.c linux-2.6.24-oxe810/fs/isofs/compress.c +--- linux-2.6.24/fs/isofs/compress.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/isofs/compress.c 2008-06-11 17:46:52.000000000 +0200 +@@ -72,6 +72,17 @@ + offset = index & ~zisofs_block_page_mask; + blockindex = offset >> zisofs_block_page_shift; + maxpage = (inode->i_size + PAGE_CACHE_SIZE - 1) >> PAGE_CACHE_SHIFT; ++ ++ /* ++ * If this page is wholly outside i_size we just return zero; ++ * do_generic_file_read() will handle this for us ++ */ ++ if (page->index >= maxpage) { ++ SetPageUptodate(page); ++ unlock_page(page); ++ return 0; ++ } ++ + maxpage = min(zisofs_block_pages, maxpage-offset); + + for ( i = 0 ; i < maxpage ; i++, offset++ ) { +diff -Nurd linux-2.6.24/fs/jbd/recovery.c linux-2.6.24-oxe810/fs/jbd/recovery.c +--- linux-2.6.24/fs/jbd/recovery.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/jbd/recovery.c 2008-06-11 17:47:07.000000000 +0200 +@@ -478,7 +478,7 @@ + memcpy(nbh->b_data, obh->b_data, + journal->j_blocksize); + if (flags & JFS_FLAG_ESCAPE) { +- *((__be32 *)bh->b_data) = ++ *((__be32 *)nbh->b_data) = + cpu_to_be32(JFS_MAGIC_NUMBER); + } + +diff -Nurd linux-2.6.24/fs/jbd2/recovery.c linux-2.6.24-oxe810/fs/jbd2/recovery.c +--- linux-2.6.24/fs/jbd2/recovery.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/jbd2/recovery.c 2008-06-11 17:46:49.000000000 +0200 +@@ -488,7 +488,7 @@ + memcpy(nbh->b_data, obh->b_data, + journal->j_blocksize); + if (flags & JBD2_FLAG_ESCAPE) { +- *((__be32 *)bh->b_data) = ++ *((__be32 *)nbh->b_data) = + cpu_to_be32(JBD2_MAGIC_NUMBER); + } + +diff -Nurd linux-2.6.24/fs/jffs2/file.c linux-2.6.24-oxe810/fs/jffs2/file.c +--- linux-2.6.24/fs/jffs2/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/jffs2/file.c 2008-06-11 17:47:10.000000000 +0200 +@@ -49,7 +49,8 @@ + .ioctl = jffs2_ioctl, + .mmap = generic_file_readonly_mmap, + .fsync = jffs2_fsync, +- .splice_read = generic_file_splice_read, ++ .sendfile = generic_file_sendfile, ++ .splice_read = generic_file_splice_read, + }; + + /* jffs2_file_inode_operations */ +diff -Nurd linux-2.6.24/fs/jfs/file.c linux-2.6.24-oxe810/fs/jfs/file.c +--- linux-2.6.24/fs/jfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/jfs/file.c 2008-06-11 17:46:58.000000000 +0200 +@@ -108,6 +108,7 @@ + .aio_read = generic_file_aio_read, + .aio_write = generic_file_aio_write, + .mmap = generic_file_mmap, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + .splice_write = generic_file_splice_write, + .fsync = jfs_fsync, +diff -Nurd linux-2.6.24/fs/minix/file.c linux-2.6.24-oxe810/fs/minix/file.c +--- linux-2.6.24/fs/minix/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/minix/file.c 2008-06-11 17:47:00.000000000 +0200 +@@ -23,6 +23,7 @@ + .aio_write = generic_file_aio_write, + .mmap = generic_file_mmap, + .fsync = minix_sync_file, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/ncpfs/mmap.c linux-2.6.24-oxe810/fs/ncpfs/mmap.c +--- linux-2.6.24/fs/ncpfs/mmap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ncpfs/mmap.c 2008-06-11 17:47:09.000000000 +0200 +@@ -50,10 +50,6 @@ + pos = vmf->pgoff << PAGE_SHIFT; + + count = PAGE_SIZE; +- if ((unsigned long)vmf->virtual_address + PAGE_SIZE > area->vm_end) { +- WARN_ON(1); /* shouldn't happen? */ +- count = area->vm_end - (unsigned long)vmf->virtual_address; +- } + /* what we can read in one go */ + bufsize = NCP_SERVER(inode)->buffer_size; + +diff -Nurd linux-2.6.24/fs/nfs/write.c linux-2.6.24-oxe810/fs/nfs/write.c +--- linux-2.6.24/fs/nfs/write.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/nfs/write.c 2008-06-11 17:46:59.000000000 +0200 +@@ -701,6 +701,17 @@ + } + + /* ++ * If the page cache is marked as unsafe or invalid, then we can't rely on ++ * the PageUptodate() flag. In this case, we will need to turn off ++ * write optimisations that depend on the page contents being correct. ++ */ ++static int nfs_write_pageuptodate(struct page *page, struct inode *inode) ++{ ++ return PageUptodate(page) && ++ !(NFS_I(inode)->cache_validity & (NFS_INO_REVAL_PAGECACHE|NFS_INO_INVALID_DATA)); ++} ++ ++/* + * Update and possibly write a cached page of an NFS file. + * + * XXX: Keep an eye on generic_file_read to make sure it doesn't do bad +@@ -721,10 +732,13 @@ + (long long)(page_offset(page) +offset)); + + /* If we're not using byte range locks, and we know the page +- * is entirely in cache, it may be more efficient to avoid +- * fragmenting write requests. ++ * is up to date, it may be more efficient to extend the write ++ * to cover the entire page in order to avoid fragmentation ++ * inefficiencies. + */ +- if (PageUptodate(page) && inode->i_flock == NULL && !(file->f_mode & O_SYNC)) { ++ if (nfs_write_pageuptodate(page, inode) && ++ inode->i_flock == NULL && ++ !(file->f_mode & O_SYNC)) { + count = max(count + offset, nfs_page_length(page)); + offset = 0; + } +diff -Nurd linux-2.6.24/fs/nfsd/nfsfh.c linux-2.6.24-oxe810/fs/nfsd/nfsfh.c +--- linux-2.6.24/fs/nfsd/nfsfh.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/nfsd/nfsfh.c 2008-06-11 17:47:05.000000000 +0200 +@@ -231,6 +231,7 @@ + fhp->fh_dentry = dentry; + fhp->fh_export = exp; + nfsd_nr_verified++; ++ cache_get(&exp->h); + } else { + /* + * just rechecking permissions +@@ -240,6 +241,7 @@ + dprintk("nfsd: fh_verify - just checking\n"); + dentry = fhp->fh_dentry; + exp = fhp->fh_export; ++ cache_get(&exp->h); + /* + * Set user creds for this exportpoint; necessary even + * in the "just checking" case because this may be a +@@ -251,8 +253,6 @@ + if (error) + goto out; + } +- cache_get(&exp->h); +- + + error = nfsd_mode_check(rqstp, dentry->d_inode->i_mode, type); + if (error) +diff -Nurd linux-2.6.24/fs/ntfs/file.c linux-2.6.24-oxe810/fs/ntfs/file.c +--- linux-2.6.24/fs/ntfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ntfs/file.c 2008-06-11 17:47:01.000000000 +0200 +@@ -2274,16 +2274,11 @@ + mounted filesystem. */ + .mmap = generic_file_mmap, /* Mmap file. */ + .open = ntfs_file_open, /* Open file. */ +- .splice_read = generic_file_splice_read /* Zero-copy data send with ++ .sendfile = generic_file_sendfile, /* Zero-copy data send with + the data source being on + the ntfs partition. We do + not need to care about the + data destination. */ +- /*.sendpage = ,*/ /* Zero-copy data send with +- the data destination being +- on the ntfs partition. We +- do not need to care about +- the data source. */ + }; + + const struct inode_operations ntfs_file_inode_ops = { +diff -Nurd linux-2.6.24/fs/ocfs2/file.c linux-2.6.24-oxe810/fs/ocfs2/file.c +--- linux-2.6.24/fs/ocfs2/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ocfs2/file.c 2008-06-11 17:46:56.000000000 +0200 +@@ -2206,6 +2206,7 @@ + const struct file_operations ocfs2_fops = { + .read = do_sync_read, + .write = do_sync_write, ++ .sendfile = generic_file_sendfile, + .mmap = ocfs2_mmap, + .fsync = ocfs2_sync_file, + .release = ocfs2_file_release, +diff -Nurd linux-2.6.24/fs/qnx4/file.c linux-2.6.24-oxe810/fs/qnx4/file.c +--- linux-2.6.24/fs/qnx4/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/qnx4/file.c 2008-06-11 17:46:56.000000000 +0200 +@@ -25,6 +25,7 @@ + .read = do_sync_read, + .aio_read = generic_file_aio_read, + .mmap = generic_file_mmap, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + #ifdef CONFIG_QNX4FS_RW + .write = do_sync_write, +diff -Nurd linux-2.6.24/fs/read_write.c linux-2.6.24-oxe810/fs/read_write.c +--- linux-2.6.24/fs/read_write.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/read_write.c 2008-06-11 17:47:10.000000000 +0200 +@@ -26,7 +26,8 @@ + .read = do_sync_read, + .aio_read = generic_file_aio_read, + .mmap = generic_file_readonly_mmap, +- .splice_read = generic_file_splice_read, ++ //.splice_read = generic_file_splice_read, ++ .sendfile = generic_file_sendfile, + }; + + EXPORT_SYMBOL(generic_ro_fops); +@@ -709,7 +710,7 @@ + struct inode * in_inode, * out_inode; + loff_t pos; + ssize_t retval; +- int fput_needed_in, fput_needed_out, fl; ++ int fput_needed_in, fput_needed_out; + + /* + * Get input file, and verify that it is ok.. +@@ -724,7 +725,7 @@ + in_inode = in_file->f_path.dentry->d_inode; + if (!in_inode) + goto fput_in; +- if (!in_file->f_op || !in_file->f_op->splice_read) ++ if (!in_file->f_op || !in_file->f_op->sendfile) + goto fput_in; + retval = -ESPIPE; + if (!ppos) +@@ -777,7 +778,6 @@ + count = max - pos; + } + +- fl = 0; + #if 0 + /* + * We need to debate whether we can enable this or not. The +@@ -788,7 +788,7 @@ + if (in_file->f_flags & O_NONBLOCK) + fl = SPLICE_F_NONBLOCK; + #endif +- retval = do_splice_direct(in_file, ppos, out_file, count, fl); ++ retval = in_file->f_op->sendfile(in_file, ppos, count, file_send_actor, out_file); + + if (retval > 0) { + add_rchar(current, retval); +diff -Nurd linux-2.6.24/fs/reiserfs/file.c linux-2.6.24-oxe810/fs/reiserfs/file.c +--- linux-2.6.24/fs/reiserfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/reiserfs/file.c 2008-06-11 17:46:50.000000000 +0200 +@@ -292,6 +292,7 @@ + .open = generic_file_open, + .release = reiserfs_file_release, + .fsync = reiserfs_sync_file, ++ .sendfile = generic_file_sendfile, + .aio_read = generic_file_aio_read, + .aio_write = generic_file_aio_write, + .splice_read = generic_file_splice_read, +diff -Nurd linux-2.6.24/fs/smbfs/file.c linux-2.6.24-oxe810/fs/smbfs/file.c +--- linux-2.6.24/fs/smbfs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/smbfs/file.c 2008-06-11 17:47:00.000000000 +0200 +@@ -283,6 +283,27 @@ + return status; + } + ++static ssize_t ++smb_file_sendfile(struct file *file, loff_t *ppos, ++ size_t count, read_actor_t actor, void *target) ++{ ++ struct dentry *dentry = file->f_path.dentry; ++ ssize_t status; ++ ++ VERBOSE("file %s/%s, pos=%Ld, count=%d\n", ++ DENTRY_PATH(dentry), *ppos, count); ++ ++ status = smb_revalidate_inode(dentry); ++ if (status) { ++ PARANOIA("%s/%s validation failed, error=%Zd\n", ++ DENTRY_PATH(dentry), status); ++ goto out; ++ } ++ status = generic_file_sendfile(file, ppos, count, actor, target); ++out: ++ return status; ++} ++ + /* + * This does the "real" work of the write. The generic routine has + * allocated the page, locked it, done all the page alignment stuff +@@ -434,6 +455,7 @@ + .open = smb_file_open, + .release = smb_file_release, + .fsync = smb_fsync, ++ .sendfile = smb_file_sendfile, + .splice_read = smb_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/splice.c linux-2.6.24-oxe810/fs/splice.c +--- linux-2.6.24/fs/splice.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/splice.c 2008-06-11 17:47:10.000000000 +0200 +@@ -1184,6 +1184,9 @@ + { + int partial; + ++ if (!access_ok(VERIFY_READ, src, n)) ++ return -EFAULT; ++ + pagefault_disable(); + partial = __copy_from_user_inatomic(dst, src, n); + pagefault_enable(); +@@ -1236,7 +1239,7 @@ + if (unlikely(!len)) + break; + error = -EFAULT; +- if (unlikely(!base)) ++ if (!access_ok(VERIFY_READ, base, len)) + break; + + /* +@@ -1391,6 +1394,11 @@ + error = -EFAULT; + break; + } ++ ++ if (unlikely(!access_ok(VERIFY_WRITE, base, len))) { ++ error = -EFAULT; ++ break; ++ } + + sd.len = 0; + sd.total_len = len; +diff -Nurd linux-2.6.24/fs/sysv/file.c linux-2.6.24-oxe810/fs/sysv/file.c +--- linux-2.6.24/fs/sysv/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/sysv/file.c 2008-06-11 17:47:00.000000000 +0200 +@@ -27,6 +27,7 @@ + .aio_write = generic_file_aio_write, + .mmap = generic_file_mmap, + .fsync = sysv_sync_file, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/udf/file.c linux-2.6.24-oxe810/fs/udf/file.c +--- linux-2.6.24/fs/udf/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/udf/file.c 2008-06-11 17:47:10.000000000 +0200 +@@ -246,6 +246,8 @@ + .aio_write = udf_file_aio_write, + .release = udf_release_file, + .fsync = udf_fsync_file, ++ .sendfile = generic_file_sendfile, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; + +diff -Nurd linux-2.6.24/fs/ufs/file.c linux-2.6.24-oxe810/fs/ufs/file.c +--- linux-2.6.24/fs/ufs/file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ufs/file.c 2008-06-11 17:46:54.000000000 +0200 +@@ -63,5 +63,6 @@ + .mmap = generic_file_mmap, + .open = generic_file_open, + .fsync = ufs_sync_file, ++ .sendfile = generic_file_sendfile, + .splice_read = generic_file_splice_read, + }; +diff -Nurd linux-2.6.24/fs/ufs/util.h linux-2.6.24-oxe810/fs/ufs/util.h +--- linux-2.6.24/fs/ufs/util.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/ufs/util.h 2008-06-11 17:46:54.000000000 +0200 +@@ -58,7 +58,7 @@ + { + switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) { + case UFS_ST_SUNOS: +- if (fs32_to_cpu(sb, usb3->fs_postblformat == UFS_42POSTBLFMT)) { ++ if (fs32_to_cpu(sb, usb3->fs_postblformat) == UFS_42POSTBLFMT) { + usb1->fs_u0.fs_sun.fs_state = cpu_to_fs32(sb, value); + break; + } +diff -Nurd linux-2.6.24/fs/xfs/Makefile-linux-2.6 linux-2.6.24-oxe810/fs/xfs/Makefile-linux-2.6 +--- linux-2.6.24/fs/xfs/Makefile-linux-2.6 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/Makefile-linux-2.6 2008-06-11 17:46:48.000000000 +0200 +@@ -15,13 +15,20 @@ + # along with this program; if not, write the Free Software Foundation, + # Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + # ++CONFIG_XFS_DEBUG := n ++CONFIG_XFS_TRACE := n + + EXTRA_CFLAGS += -Ifs/xfs -Ifs/xfs/linux-2.6 -funsigned-char + + XFS_LINUX := linux-2.6 + ++ifeq ($(CONFIG_XFS_TRACE),y) ++ EXTRA_CFLAGS += -DCONFIG_XFS_TRACE ++endif ++ + ifeq ($(CONFIG_XFS_DEBUG),y) + EXTRA_CFLAGS += -g ++ EXTRA_CFLAGS += -DCONFIG_XFS_DEBUG + endif + + obj-$(CONFIG_XFS_FS) += xfs.o +diff -Nurd linux-2.6.24/fs/xfs/linux-2.6/xfs_buf.c linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_buf.c +--- linux-2.6.24/fs/xfs/linux-2.6/xfs_buf.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_buf.c 2008-06-11 17:46:46.000000000 +0200 +@@ -330,20 +330,26 @@ + + ASSERT(list_empty(&bp->b_hash_list)); + +- if (bp->b_flags & (_XBF_PAGE_CACHE|_XBF_PAGES)) { ++ if (bp->b_flags & _XBF_PAGE_CACHE) { + uint i; + + if ((bp->b_flags & XBF_MAPPED) && (bp->b_page_count > 1)) + free_address(bp->b_addr - bp->b_offset); + + for (i = 0; i < bp->b_page_count; i++) { +- struct page *page = bp->b_pages[i]; +- +- if (bp->b_flags & _XBF_PAGE_CACHE) +- ASSERT(!PagePrivate(page)); ++ struct page *page = bp->b_pages[i]; ++ ASSERT(!PagePrivate(page)); + page_cache_release(page); + } + _xfs_buf_free_pages(bp); ++ } else if (bp->b_flags & _XBF_KMEM_ALLOC) { ++ /* ++ * XXX(hch): bp->b_count_desired might be incorrect (see ++ * xfs_buf_associate_memory for details), but fortunately ++ * the Linux version of kmem_free ignores the len argument.. ++ */ ++ kmem_free(bp->b_addr, bp->b_count_desired); ++ _xfs_buf_free_pages(bp); + } + + xfs_buf_deallocate(bp); +@@ -766,44 +772,46 @@ + size_t len, + xfs_buftarg_t *target) + { +- unsigned long page_count = PAGE_ALIGN(len) >> PAGE_SHIFT; +- int error, i; ++ size_t malloc_len = len; + xfs_buf_t *bp; ++ void *data; ++ int error; + + bp = xfs_buf_allocate(0); + if (unlikely(bp == NULL)) + goto fail; + _xfs_buf_initialize(bp, target, 0, len, 0); + +- error = _xfs_buf_get_pages(bp, page_count, 0); +- if (error) ++ try_again: ++ data = kmem_alloc(malloc_len, KM_SLEEP | KM_MAYFAIL | KM_LARGE); ++ if (unlikely(data == NULL)) + goto fail_free_buf; + +- for (i = 0; i < page_count; i++) { +- bp->b_pages[i] = alloc_page(GFP_KERNEL); +- if (!bp->b_pages[i]) +- goto fail_free_mem; ++ /* check whether alignment matches.. */ ++ if ((__psunsigned_t)data != ++ ((__psunsigned_t)data & ~target->bt_smask)) { ++ /* .. else double the size and try again */ ++ kmem_free(data, malloc_len); ++ malloc_len <<= 1; ++ goto try_again; + } +- bp->b_flags |= _XBF_PAGES; + +- error = _xfs_buf_map_pages(bp, XBF_MAPPED); +- if (unlikely(error)) { +- printk(KERN_WARNING "%s: failed to map pages\n", +- __FUNCTION__); ++ /* Clear the memory contents */ ++ memset(data, 0, malloc_len); ++ ++ error = xfs_buf_associate_memory(bp, data, len); ++ if (error) + goto fail_free_mem; +- } ++ bp->b_flags |= _XBF_KMEM_ALLOC; + + xfs_buf_unlock(bp); + +- XB_TRACE(bp, "no_daddr", len); ++ XB_TRACE(bp, "no_daddr", data); + return bp; +- + fail_free_mem: +- while (--i >= 0) +- __free_page(bp->b_pages[i]); +- _xfs_buf_free_pages(bp); ++ kmem_free(data, malloc_len); + fail_free_buf: +- xfs_buf_deallocate(bp); ++ xfs_buf_free(bp); + fail: + return NULL; + } +diff -Nurd linux-2.6.24/fs/xfs/linux-2.6/xfs_buf.h linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_buf.h +--- linux-2.6.24/fs/xfs/linux-2.6/xfs_buf.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_buf.h 2008-06-11 17:46:46.000000000 +0200 +@@ -63,7 +63,7 @@ + + /* flags used only internally */ + _XBF_PAGE_CACHE = (1 << 17),/* backed by pagecache */ +- _XBF_PAGES = (1 << 18), /* backed by refcounted pages */ ++ _XBF_KMEM_ALLOC = (1 << 18),/* backed by kmem_alloc() */ + _XBF_RUN_QUEUES = (1 << 19),/* run block device task queue */ + _XBF_DELWRI_Q = (1 << 21), /* buffer on delwri queue */ + } xfs_buf_flags_t; +diff -Nurd linux-2.6.24/fs/xfs/linux-2.6/xfs_file.c linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_file.c +--- linux-2.6.24/fs/xfs/linux-2.6/xfs_file.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_file.c 2008-06-11 17:46:46.000000000 +0200 +@@ -122,6 +122,28 @@ + } + + STATIC ssize_t ++xfs_file_sendfile( ++ struct file *filp, ++ loff_t *pos, ++ size_t count, ++ read_actor_t actor, ++ void *target) ++{ ++ return xfs_sendfile(XFS_I(filp->f_path.dentry->d_inode), filp, pos, 0, count, actor, target); ++} ++ ++STATIC ssize_t ++xfs_file_sendfile_invis( ++ struct file *filp, ++ loff_t *pos, ++ size_t count, ++ read_actor_t actor, ++ void *target) ++{ ++ return xfs_sendfile(XFS_I(filp->f_path.dentry->d_inode), filp, pos, IO_INVIS, count, actor, target); ++} ++ ++STATIC ssize_t + xfs_file_splice_read( + struct file *infilp, + loff_t *ppos, +@@ -350,8 +372,8 @@ + + size = buf.used; + de = (struct hack_dirent *)buf.dirent; +- curr_offset = de->offset /* & 0x7fffffff */; + while (size > 0) { ++ curr_offset = de->offset /* & 0x7fffffff */; + if (filldir(dirent, de->name, de->namlen, + curr_offset & 0x7fffffff, + de->ino, de->d_type)) { +@@ -362,7 +384,6 @@ + sizeof(u64)); + size -= reclen; + de = (struct hack_dirent *)((char *)de + reclen); +- curr_offset = de->offset /* & 0x7fffffff */; + } + } + +@@ -502,8 +523,11 @@ + .llseek = generic_file_llseek, + .read = do_sync_read, + .write = do_sync_write, ++// .readv = xfs_file_readv, ++// .writev = xfs_file_writev, + .aio_read = xfs_file_aio_read, + .aio_write = xfs_file_aio_write, ++ .sendfile = xfs_file_sendfile, + .splice_read = xfs_file_splice_read, + .splice_write = xfs_file_splice_write, + .unlocked_ioctl = xfs_file_ioctl, +@@ -525,6 +549,7 @@ + .write = do_sync_write, + .aio_read = xfs_file_aio_read_invis, + .aio_write = xfs_file_aio_write_invis, ++ .sendfile = xfs_file_sendfile_invis, + .splice_read = xfs_file_splice_read_invis, + .splice_write = xfs_file_splice_write_invis, + .unlocked_ioctl = xfs_file_ioctl_invis, +diff -Nurd linux-2.6.24/fs/xfs/linux-2.6/xfs_lrw.c linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_lrw.c +--- linux-2.6.24/fs/xfs/linux-2.6/xfs_lrw.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/linux-2.6/xfs_lrw.c 2008-06-11 17:46:46.000000000 +0200 +@@ -271,6 +271,48 @@ + } + + ssize_t ++xfs_sendfile( ++ xfs_inode_t *ip, ++ struct file *filp, ++ loff_t *offset, ++ int ioflags, ++ size_t count, ++ read_actor_t actor, ++ void *target) ++{ ++ bhv_vnode_t *vp = XFS_ITOV(ip); ++ xfs_mount_t *mp = ip->i_mount; ++ ssize_t ret; ++ ++ XFS_STATS_INC(xs_read_calls); ++ if (XFS_FORCED_SHUTDOWN(mp)) ++ return -EIO; ++ ++ xfs_ilock(ip, XFS_IOLOCK_SHARED); ++ ++ if (DM_EVENT_ENABLED(ip, DM_EVENT_READ) && ++ (!(ioflags & IO_INVIS))) { ++ bhv_vrwlock_t locktype = VRWLOCK_READ; ++ int error; ++ ++ error = XFS_SEND_DATA(mp, DM_EVENT_READ, vp,*offset, count, ++ FILP_DELAY_FLAG(filp), &locktype); ++ if (error) { ++ xfs_iunlock(ip, XFS_IOLOCK_SHARED); ++ return -error; ++ } ++ } ++ xfs_rw_enter_trace(XFS_SENDFILE_ENTER, &ip->i_iocore, ++ (void *)(unsigned long)target, count, *offset, ioflags); ++ ret = generic_file_sendfile(filp, offset, count, actor, target); ++ if (ret > 0) ++ XFS_STATS_ADD(xs_read_bytes, ret); ++ ++ xfs_iunlock(ip, XFS_IOLOCK_SHARED); ++ return ret; ++} ++ ++ssize_t + xfs_splice_read( + xfs_inode_t *ip, + struct file *infilp, +diff -Nurd linux-2.6.24/fs/xfs/xfs_alloc.c linux-2.6.24-oxe810/fs/xfs/xfs_alloc.c +--- linux-2.6.24/fs/xfs/xfs_alloc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_alloc.c 2008-06-11 17:46:48.000000000 +0200 +@@ -592,7 +592,7 @@ + if (!(args->wasfromfl)) { + + agf = XFS_BUF_TO_AGF(args->agbp); +- be32_add(&agf->agf_freeblks, -(args->len)); ++ be32_add_cpu(&agf->agf_freeblks, -(args->len)); + xfs_trans_agblocks_delta(args->tp, + -((long)(args->len))); + args->pag->pagf_freeblks -= args->len; +@@ -1720,7 +1720,7 @@ + + agf = XFS_BUF_TO_AGF(agbp); + pag = &mp->m_perag[agno]; +- be32_add(&agf->agf_freeblks, len); ++ be32_add_cpu(&agf->agf_freeblks, len); + xfs_trans_agblocks_delta(tp, len); + pag->pagf_freeblks += len; + XFS_WANT_CORRUPTED_GOTO( +@@ -2008,18 +2008,18 @@ + * Get the block number and update the data structures. + */ + bno = be32_to_cpu(agfl->agfl_bno[be32_to_cpu(agf->agf_flfirst)]); +- be32_add(&agf->agf_flfirst, 1); ++ be32_add_cpu(&agf->agf_flfirst, 1); + xfs_trans_brelse(tp, agflbp); + if (be32_to_cpu(agf->agf_flfirst) == XFS_AGFL_SIZE(mp)) + agf->agf_flfirst = 0; + pag = &mp->m_perag[be32_to_cpu(agf->agf_seqno)]; +- be32_add(&agf->agf_flcount, -1); ++ be32_add_cpu(&agf->agf_flcount, -1); + xfs_trans_agflist_delta(tp, -1); + pag->pagf_flcount--; + + logflags = XFS_AGF_FLFIRST | XFS_AGF_FLCOUNT; + if (btreeblk) { +- be32_add(&agf->agf_btreeblks, 1); ++ be32_add_cpu(&agf->agf_btreeblks, 1); + pag->pagf_btreeblks++; + logflags |= XFS_AGF_BTREEBLKS; + } +@@ -2117,17 +2117,17 @@ + be32_to_cpu(agf->agf_seqno), &agflbp))) + return error; + agfl = XFS_BUF_TO_AGFL(agflbp); +- be32_add(&agf->agf_fllast, 1); ++ be32_add_cpu(&agf->agf_fllast, 1); + if (be32_to_cpu(agf->agf_fllast) == XFS_AGFL_SIZE(mp)) + agf->agf_fllast = 0; + pag = &mp->m_perag[be32_to_cpu(agf->agf_seqno)]; +- be32_add(&agf->agf_flcount, 1); ++ be32_add_cpu(&agf->agf_flcount, 1); + xfs_trans_agflist_delta(tp, 1); + pag->pagf_flcount++; + + logflags = XFS_AGF_FLLAST | XFS_AGF_FLCOUNT; + if (btreeblk) { +- be32_add(&agf->agf_btreeblks, -1); ++ be32_add_cpu(&agf->agf_btreeblks, -1); + pag->pagf_btreeblks--; + logflags |= XFS_AGF_BTREEBLKS; + } +diff -Nurd linux-2.6.24/fs/xfs/xfs_alloc_btree.c linux-2.6.24-oxe810/fs/xfs/xfs_alloc_btree.c +--- linux-2.6.24/fs/xfs/xfs_alloc_btree.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_alloc_btree.c 2008-06-11 17:46:48.000000000 +0200 +@@ -221,7 +221,7 @@ + */ + bno = be32_to_cpu(agf->agf_roots[cur->bc_btnum]); + agf->agf_roots[cur->bc_btnum] = *lpp; +- be32_add(&agf->agf_levels[cur->bc_btnum], -1); ++ be32_add_cpu(&agf->agf_levels[cur->bc_btnum], -1); + mp->m_perag[be32_to_cpu(agf->agf_seqno)].pagf_levels[cur->bc_btnum]--; + /* + * Put this buffer/block on the ag's freelist. +@@ -1256,9 +1256,9 @@ + /* + * Bump and log left's numrecs, decrement and log right's numrecs. + */ +- be16_add(&left->bb_numrecs, 1); ++ be16_add_cpu(&left->bb_numrecs, 1); + xfs_alloc_log_block(cur->bc_tp, lbp, XFS_BB_NUMRECS); +- be16_add(&right->bb_numrecs, -1); ++ be16_add_cpu(&right->bb_numrecs, -1); + xfs_alloc_log_block(cur->bc_tp, rbp, XFS_BB_NUMRECS); + /* + * Slide the contents of right down one entry. +@@ -1346,7 +1346,7 @@ + + agf = XFS_BUF_TO_AGF(cur->bc_private.a.agbp); + agf->agf_roots[cur->bc_btnum] = cpu_to_be32(nbno); +- be32_add(&agf->agf_levels[cur->bc_btnum], 1); ++ be32_add_cpu(&agf->agf_levels[cur->bc_btnum], 1); + seqno = be32_to_cpu(agf->agf_seqno); + mp->m_perag[seqno].pagf_levels[cur->bc_btnum]++; + xfs_alloc_log_agf(cur->bc_tp, cur->bc_private.a.agbp, +@@ -1558,9 +1558,9 @@ + /* + * Decrement and log left's numrecs, bump and log right's numrecs. + */ +- be16_add(&left->bb_numrecs, -1); ++ be16_add_cpu(&left->bb_numrecs, -1); + xfs_alloc_log_block(cur->bc_tp, lbp, XFS_BB_NUMRECS); +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + xfs_alloc_log_block(cur->bc_tp, rbp, XFS_BB_NUMRECS); + /* + * Using a temporary cursor, update the parent key values of the +@@ -1643,7 +1643,7 @@ + */ + if ((be16_to_cpu(left->bb_numrecs) & 1) && + cur->bc_ptrs[level] <= be16_to_cpu(right->bb_numrecs) + 1) +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + i = be16_to_cpu(left->bb_numrecs) - be16_to_cpu(right->bb_numrecs) + 1; + /* + * For non-leaf blocks, copy keys and addresses over to the new block. +@@ -1689,7 +1689,7 @@ + * Adjust numrecs, sibling pointers. + */ + lbno = XFS_DADDR_TO_AGBNO(cur->bc_mp, XFS_BUF_ADDR(lbp)); +- be16_add(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); ++ be16_add_cpu(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); + right->bb_rightsib = left->bb_rightsib; + left->bb_rightsib = cpu_to_be32(rbno); + right->bb_leftsib = cpu_to_be32(lbno); +diff -Nurd linux-2.6.24/fs/xfs/xfs_attr_leaf.c linux-2.6.24-oxe810/fs/xfs/xfs_attr_leaf.c +--- linux-2.6.24/fs/xfs/xfs_attr_leaf.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_attr_leaf.c 2008-06-11 17:46:48.000000000 +0200 +@@ -319,7 +319,7 @@ + memcpy(sfe->nameval, args->name, args->namelen); + memcpy(&sfe->nameval[args->namelen], args->value, args->valuelen); + sf->hdr.count++; +- be16_add(&sf->hdr.totsize, size); ++ be16_add_cpu(&sf->hdr.totsize, size); + xfs_trans_log_inode(args->trans, dp, XFS_ILOG_CORE | XFS_ILOG_ADATA); + + xfs_sbversion_add_attr2(mp, args->trans); +@@ -365,7 +365,7 @@ + if (end != totsize) + memmove(&((char *)sf)[base], &((char *)sf)[end], totsize - end); + sf->hdr.count--; +- be16_add(&sf->hdr.totsize, -size); ++ be16_add_cpu(&sf->hdr.totsize, -size); + + /* + * Fix up the start offset of the attribute fork +@@ -1135,7 +1135,7 @@ + xfs_da_log_buf(args->trans, bp, + XFS_DA_LOGRANGE(leaf, entry, tmp + sizeof(*entry))); + } +- be16_add(&hdr->count, 1); ++ be16_add_cpu(&hdr->count, 1); + + /* + * Allocate space for the new string (at the end of the run). +@@ -1149,7 +1149,7 @@ + mp->m_sb.sb_blocksize, NULL)); + ASSERT(be16_to_cpu(map->size) < XFS_LBSIZE(mp)); + ASSERT((be16_to_cpu(map->size) & 0x3) == 0); +- be16_add(&map->size, ++ be16_add_cpu(&map->size, + -xfs_attr_leaf_newentsize(args->namelen, args->valuelen, + mp->m_sb.sb_blocksize, &tmp)); + entry->nameidx = cpu_to_be16(be16_to_cpu(map->base) + +@@ -1216,12 +1216,12 @@ + map = &hdr->freemap[0]; + for (i = 0; i < XFS_ATTR_LEAF_MAPSIZE; map++, i++) { + if (be16_to_cpu(map->base) == tmp) { +- be16_add(&map->base, sizeof(xfs_attr_leaf_entry_t)); +- be16_add(&map->size, ++ be16_add_cpu(&map->base, sizeof(xfs_attr_leaf_entry_t)); ++ be16_add_cpu(&map->size, + -((int)sizeof(xfs_attr_leaf_entry_t))); + } + } +- be16_add(&hdr->usedbytes, xfs_attr_leaf_entsize(leaf, args->index)); ++ be16_add_cpu(&hdr->usedbytes, xfs_attr_leaf_entsize(leaf, args->index)); + xfs_da_log_buf(args->trans, bp, + XFS_DA_LOGRANGE(leaf, hdr, sizeof(*hdr))); + return(0); +@@ -1729,9 +1729,9 @@ + ASSERT(be16_to_cpu(map->base) < XFS_LBSIZE(mp)); + ASSERT(be16_to_cpu(map->size) < XFS_LBSIZE(mp)); + if (be16_to_cpu(map->base) == tablesize) { +- be16_add(&map->base, ++ be16_add_cpu(&map->base, + -((int)sizeof(xfs_attr_leaf_entry_t))); +- be16_add(&map->size, sizeof(xfs_attr_leaf_entry_t)); ++ be16_add_cpu(&map->size, sizeof(xfs_attr_leaf_entry_t)); + } + + if ((be16_to_cpu(map->base) + be16_to_cpu(map->size)) +@@ -1753,19 +1753,19 @@ + if ((before >= 0) || (after >= 0)) { + if ((before >= 0) && (after >= 0)) { + map = &hdr->freemap[before]; +- be16_add(&map->size, entsize); +- be16_add(&map->size, ++ be16_add_cpu(&map->size, entsize); ++ be16_add_cpu(&map->size, + be16_to_cpu(hdr->freemap[after].size)); + hdr->freemap[after].base = 0; + hdr->freemap[after].size = 0; + } else if (before >= 0) { + map = &hdr->freemap[before]; +- be16_add(&map->size, entsize); ++ be16_add_cpu(&map->size, entsize); + } else { + map = &hdr->freemap[after]; + /* both on-disk, don't endian flip twice */ + map->base = entry->nameidx; +- be16_add(&map->size, entsize); ++ be16_add_cpu(&map->size, entsize); + } + } else { + /* +@@ -1790,7 +1790,7 @@ + * Compress the remaining entries and zero out the removed stuff. + */ + memset(XFS_ATTR_LEAF_NAME(leaf, args->index), 0, entsize); +- be16_add(&hdr->usedbytes, -entsize); ++ be16_add_cpu(&hdr->usedbytes, -entsize); + xfs_da_log_buf(args->trans, bp, + XFS_DA_LOGRANGE(leaf, XFS_ATTR_LEAF_NAME(leaf, args->index), + entsize)); +@@ -1798,7 +1798,7 @@ + tmp = (be16_to_cpu(hdr->count) - args->index) + * sizeof(xfs_attr_leaf_entry_t); + memmove((char *)entry, (char *)(entry+1), tmp); +- be16_add(&hdr->count, -1); ++ be16_add_cpu(&hdr->count, -1); + xfs_da_log_buf(args->trans, bp, + XFS_DA_LOGRANGE(leaf, entry, tmp + sizeof(*entry))); + entry = &leaf->entries[be16_to_cpu(hdr->count)]; +@@ -2184,15 +2184,15 @@ + */ + if (entry_s->flags & XFS_ATTR_INCOMPLETE) { /* skip partials? */ + memset(XFS_ATTR_LEAF_NAME(leaf_s, start_s + i), 0, tmp); +- be16_add(&hdr_s->usedbytes, -tmp); +- be16_add(&hdr_s->count, -1); ++ be16_add_cpu(&hdr_s->usedbytes, -tmp); ++ be16_add_cpu(&hdr_s->count, -1); + entry_d--; /* to compensate for ++ in loop hdr */ + desti--; + if ((start_s + i) < offset) + result++; /* insertion index adjustment */ + } else { + #endif /* GROT */ +- be16_add(&hdr_d->firstused, -tmp); ++ be16_add_cpu(&hdr_d->firstused, -tmp); + /* both on-disk, don't endian flip twice */ + entry_d->hashval = entry_s->hashval; + /* both on-disk, don't endian flip twice */ +@@ -2205,10 +2205,10 @@ + ASSERT(be16_to_cpu(entry_s->nameidx) + tmp + <= XFS_LBSIZE(mp)); + memset(XFS_ATTR_LEAF_NAME(leaf_s, start_s + i), 0, tmp); +- be16_add(&hdr_s->usedbytes, -tmp); +- be16_add(&hdr_d->usedbytes, tmp); +- be16_add(&hdr_s->count, -1); +- be16_add(&hdr_d->count, 1); ++ be16_add_cpu(&hdr_s->usedbytes, -tmp); ++ be16_add_cpu(&hdr_d->usedbytes, tmp); ++ be16_add_cpu(&hdr_s->count, -1); ++ be16_add_cpu(&hdr_d->count, 1); + tmp = be16_to_cpu(hdr_d->count) + * sizeof(xfs_attr_leaf_entry_t) + + sizeof(xfs_attr_leaf_hdr_t); +@@ -2249,7 +2249,7 @@ + * Fill in the freemap information + */ + hdr_d->freemap[0].base = cpu_to_be16(sizeof(xfs_attr_leaf_hdr_t)); +- be16_add(&hdr_d->freemap[0].base, be16_to_cpu(hdr_d->count) * ++ be16_add_cpu(&hdr_d->freemap[0].base, be16_to_cpu(hdr_d->count) * + sizeof(xfs_attr_leaf_entry_t)); + hdr_d->freemap[0].size = cpu_to_be16(be16_to_cpu(hdr_d->firstused) + - be16_to_cpu(hdr_d->freemap[0].base)); +diff -Nurd linux-2.6.24/fs/xfs/xfs_bmap_btree.c linux-2.6.24-oxe810/fs/xfs/xfs_bmap_btree.c +--- linux-2.6.24/fs/xfs/xfs_bmap_btree.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_bmap_btree.c 2008-06-11 17:46:48.000000000 +0200 +@@ -631,7 +631,7 @@ + memcpy(lrp, rrp, numrrecs * sizeof(*lrp)); + xfs_bmbt_log_recs(cur, lbp, numlrecs + 1, numlrecs + numrrecs); + } +- be16_add(&left->bb_numrecs, numrrecs); ++ be16_add_cpu(&left->bb_numrecs, numrrecs); + left->bb_rightsib = right->bb_rightsib; + xfs_bmbt_log_block(cur, lbp, XFS_BB_RIGHTSIB | XFS_BB_NUMRECS); + if (be64_to_cpu(left->bb_rightsib) != NULLDFSBNO) { +@@ -924,7 +924,7 @@ + xfs_iroot_realloc(ip, i, cur->bc_private.b.whichfork); + block = ifp->if_broot; + } +- be16_add(&block->bb_numrecs, i); ++ be16_add_cpu(&block->bb_numrecs, i); + ASSERT(block->bb_numrecs == cblock->bb_numrecs); + kp = XFS_BMAP_KEY_IADDR(block, 1, cur); + ckp = XFS_BMAP_KEY_IADDR(cblock, 1, cur); +@@ -947,7 +947,7 @@ + XFS_TRANS_DQ_BCOUNT, -1L); + xfs_trans_binval(cur->bc_tp, cbp); + cur->bc_bufs[level - 1] = NULL; +- be16_add(&block->bb_level, -1); ++ be16_add_cpu(&block->bb_level, -1); + xfs_trans_log_inode(cur->bc_tp, ip, + XFS_ILOG_CORE | XFS_ILOG_FBROOT(cur->bc_private.b.whichfork)); + cur->bc_nlevels--; +@@ -1401,9 +1401,9 @@ + key.br_startoff = cpu_to_be64(xfs_bmbt_disk_get_startoff(rrp)); + rkp = &key; + } +- be16_add(&left->bb_numrecs, -1); ++ be16_add_cpu(&left->bb_numrecs, -1); + xfs_bmbt_log_block(cur, lbp, XFS_BB_NUMRECS); +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + #ifdef DEBUG + if (level > 0) + xfs_btree_check_key(XFS_BTNUM_BMAP, rkp, rkp + 1); +@@ -1535,7 +1535,7 @@ + right->bb_numrecs = cpu_to_be16(be16_to_cpu(left->bb_numrecs) / 2); + if ((be16_to_cpu(left->bb_numrecs) & 1) && + cur->bc_ptrs[level] <= be16_to_cpu(right->bb_numrecs) + 1) +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + i = be16_to_cpu(left->bb_numrecs) - be16_to_cpu(right->bb_numrecs) + 1; + if (level > 0) { + lkp = XFS_BMAP_KEY_IADDR(left, i, cur); +@@ -1562,7 +1562,7 @@ + xfs_bmbt_log_recs(cur, rbp, 1, be16_to_cpu(right->bb_numrecs)); + *startoff = xfs_bmbt_disk_get_startoff(rrp); + } +- be16_add(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); ++ be16_add_cpu(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); + right->bb_rightsib = left->bb_rightsib; + left->bb_rightsib = cpu_to_be64(args.fsbno); + right->bb_leftsib = cpu_to_be64(lbno); +@@ -2241,7 +2241,7 @@ + bp = xfs_btree_get_bufl(args.mp, cur->bc_tp, args.fsbno, 0); + cblock = XFS_BUF_TO_BMBT_BLOCK(bp); + *cblock = *block; +- be16_add(&block->bb_level, 1); ++ be16_add_cpu(&block->bb_level, 1); + block->bb_numrecs = cpu_to_be16(1); + cur->bc_nlevels++; + cur->bc_ptrs[level + 1] = 1; +diff -Nurd linux-2.6.24/fs/xfs/xfs_da_btree.c linux-2.6.24-oxe810/fs/xfs/xfs_da_btree.c +--- linux-2.6.24/fs/xfs/xfs_da_btree.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_da_btree.c 2008-06-11 17:46:48.000000000 +0200 +@@ -511,12 +511,12 @@ + * Move the req'd B-tree elements from high in node1 to + * low in node2. + */ +- be16_add(&node2->hdr.count, count); ++ be16_add_cpu(&node2->hdr.count, count); + tmp = count * (uint)sizeof(xfs_da_node_entry_t); + btree_s = &node1->btree[be16_to_cpu(node1->hdr.count) - count]; + btree_d = &node2->btree[0]; + memcpy(btree_d, btree_s, tmp); +- be16_add(&node1->hdr.count, -count); ++ be16_add_cpu(&node1->hdr.count, -count); + } else { + /* + * Move the req'd B-tree elements from low in node2 to +@@ -527,7 +527,7 @@ + btree_s = &node2->btree[0]; + btree_d = &node1->btree[be16_to_cpu(node1->hdr.count)]; + memcpy(btree_d, btree_s, tmp); +- be16_add(&node1->hdr.count, count); ++ be16_add_cpu(&node1->hdr.count, count); + xfs_da_log_buf(tp, blk1->bp, + XFS_DA_LOGRANGE(node1, btree_d, tmp)); + +@@ -539,7 +539,7 @@ + btree_s = &node2->btree[count]; + btree_d = &node2->btree[0]; + memmove(btree_d, btree_s, tmp); +- be16_add(&node2->hdr.count, -count); ++ be16_add_cpu(&node2->hdr.count, -count); + } + + /* +@@ -604,7 +604,7 @@ + btree->before = cpu_to_be32(newblk->blkno); + xfs_da_log_buf(state->args->trans, oldblk->bp, + XFS_DA_LOGRANGE(node, btree, tmp + sizeof(*btree))); +- be16_add(&node->hdr.count, 1); ++ be16_add_cpu(&node->hdr.count, 1); + xfs_da_log_buf(state->args->trans, oldblk->bp, + XFS_DA_LOGRANGE(node, &node->hdr, sizeof(node->hdr))); + +@@ -959,7 +959,7 @@ + memset((char *)btree, 0, sizeof(xfs_da_node_entry_t)); + xfs_da_log_buf(state->args->trans, drop_blk->bp, + XFS_DA_LOGRANGE(node, btree, sizeof(*btree))); +- be16_add(&node->hdr.count, -1); ++ be16_add_cpu(&node->hdr.count, -1); + xfs_da_log_buf(state->args->trans, drop_blk->bp, + XFS_DA_LOGRANGE(node, &node->hdr, sizeof(node->hdr))); + +@@ -1018,7 +1018,7 @@ + */ + tmp = be16_to_cpu(drop_node->hdr.count) * (uint)sizeof(xfs_da_node_entry_t); + memcpy(btree, &drop_node->btree[0], tmp); +- be16_add(&save_node->hdr.count, be16_to_cpu(drop_node->hdr.count)); ++ be16_add_cpu(&save_node->hdr.count, be16_to_cpu(drop_node->hdr.count)); + + xfs_da_log_buf(tp, save_blk->bp, + XFS_DA_LOGRANGE(save_node, &save_node->hdr, +diff -Nurd linux-2.6.24/fs/xfs/xfs_dir2_block.c linux-2.6.24-oxe810/fs/xfs/xfs_dir2_block.c +--- linux-2.6.24/fs/xfs/xfs_dir2_block.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_dir2_block.c 2008-06-11 17:46:48.000000000 +0200 +@@ -271,7 +271,7 @@ + } + lfloglow = toidx + 1 - (be32_to_cpu(btp->stale) - 1); + lfloghigh -= be32_to_cpu(btp->stale) - 1; +- be32_add(&btp->count, -(be32_to_cpu(btp->stale) - 1)); ++ be32_add_cpu(&btp->count, -(be32_to_cpu(btp->stale) - 1)); + xfs_dir2_data_make_free(tp, bp, + (xfs_dir2_data_aoff_t)((char *)blp - (char *)block), + (xfs_dir2_data_aoff_t)((be32_to_cpu(btp->stale) - 1) * sizeof(*blp)), +@@ -326,7 +326,7 @@ + /* + * Update the tail (entry count). + */ +- be32_add(&btp->count, 1); ++ be32_add_cpu(&btp->count, 1); + /* + * If we now need to rebuild the bestfree map, do so. + * This needs to happen before the next call to use_free. +@@ -387,7 +387,7 @@ + lfloglow = MIN(mid, lfloglow); + lfloghigh = MAX(highstale, lfloghigh); + } +- be32_add(&btp->stale, -1); ++ be32_add_cpu(&btp->stale, -1); + } + /* + * Point to the new data entry. +@@ -767,7 +767,7 @@ + /* + * Fix up the block tail. + */ +- be32_add(&btp->stale, 1); ++ be32_add_cpu(&btp->stale, 1); + xfs_dir2_block_log_tail(tp, bp); + /* + * Remove the leaf entry by marking it stale. +diff -Nurd linux-2.6.24/fs/xfs/xfs_dir2_data.c linux-2.6.24-oxe810/fs/xfs/xfs_dir2_data.c +--- linux-2.6.24/fs/xfs/xfs_dir2_data.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_dir2_data.c 2008-06-11 17:46:48.000000000 +0200 +@@ -587,7 +587,7 @@ + /* + * Fix up the new big freespace. + */ +- be16_add(&prevdup->length, len + be16_to_cpu(postdup->length)); ++ be16_add_cpu(&prevdup->length, len + be16_to_cpu(postdup->length)); + *xfs_dir2_data_unused_tag_p(prevdup) = + cpu_to_be16((char *)prevdup - (char *)d); + xfs_dir2_data_log_unused(tp, bp, prevdup); +@@ -621,7 +621,7 @@ + */ + else if (prevdup) { + dfp = xfs_dir2_data_freefind(d, prevdup); +- be16_add(&prevdup->length, len); ++ be16_add_cpu(&prevdup->length, len); + *xfs_dir2_data_unused_tag_p(prevdup) = + cpu_to_be16((char *)prevdup - (char *)d); + xfs_dir2_data_log_unused(tp, bp, prevdup); +diff -Nurd linux-2.6.24/fs/xfs/xfs_dir2_leaf.c linux-2.6.24-oxe810/fs/xfs/xfs_dir2_leaf.c +--- linux-2.6.24/fs/xfs/xfs_dir2_leaf.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_dir2_leaf.c 2008-06-11 17:46:48.000000000 +0200 +@@ -359,7 +359,7 @@ + bestsp--; + memmove(&bestsp[0], &bestsp[1], + be32_to_cpu(ltp->bestcount) * sizeof(bestsp[0])); +- be32_add(<p->bestcount, 1); ++ be32_add_cpu(<p->bestcount, 1); + xfs_dir2_leaf_log_tail(tp, lbp); + xfs_dir2_leaf_log_bests(tp, lbp, 0, be32_to_cpu(ltp->bestcount) - 1); + } +@@ -445,7 +445,7 @@ + */ + lfloglow = index; + lfloghigh = be16_to_cpu(leaf->hdr.count); +- be16_add(&leaf->hdr.count, 1); ++ be16_add_cpu(&leaf->hdr.count, 1); + } + /* + * There are stale entries. +@@ -523,7 +523,7 @@ + lfloglow = MIN(index, lfloglow); + lfloghigh = MAX(highstale, lfloghigh); + } +- be16_add(&leaf->hdr.stale, -1); ++ be16_add_cpu(&leaf->hdr.stale, -1); + } + /* + * Fill in the new leaf entry. +@@ -626,7 +626,7 @@ + * Update and log the header, log the leaf entries. + */ + ASSERT(be16_to_cpu(leaf->hdr.stale) == from - to); +- be16_add(&leaf->hdr.count, -(be16_to_cpu(leaf->hdr.stale))); ++ be16_add_cpu(&leaf->hdr.count, -(be16_to_cpu(leaf->hdr.stale))); + leaf->hdr.stale = 0; + xfs_dir2_leaf_log_header(args->trans, bp); + if (loglow != -1) +@@ -728,7 +728,7 @@ + /* + * Adjust the leaf header values. + */ +- be16_add(&leaf->hdr.count, -(from - to)); ++ be16_add_cpu(&leaf->hdr.count, -(from - to)); + leaf->hdr.stale = cpu_to_be16(1); + /* + * Remember the low/high stale value only in the "right" +@@ -1470,7 +1470,7 @@ + /* + * We just mark the leaf entry stale by putting a null in it. + */ +- be16_add(&leaf->hdr.stale, 1); ++ be16_add_cpu(&leaf->hdr.stale, 1); + xfs_dir2_leaf_log_header(tp, lbp); + lep->address = cpu_to_be32(XFS_DIR2_NULL_DATAPTR); + xfs_dir2_leaf_log_ents(tp, lbp, index, index); +@@ -1531,7 +1531,7 @@ + */ + memmove(&bestsp[db - i], bestsp, + (be32_to_cpu(ltp->bestcount) - (db - i)) * sizeof(*bestsp)); +- be32_add(<p->bestcount, -(db - i)); ++ be32_add_cpu(<p->bestcount, -(db - i)); + xfs_dir2_leaf_log_tail(tp, lbp); + xfs_dir2_leaf_log_bests(tp, lbp, 0, be32_to_cpu(ltp->bestcount) - 1); + } else +@@ -1712,7 +1712,7 @@ + * Eliminate the last bests entry from the table. + */ + bestsp = xfs_dir2_leaf_bests_p(ltp); +- be32_add(<p->bestcount, -1); ++ be32_add_cpu(<p->bestcount, -1); + memmove(&bestsp[1], &bestsp[0], be32_to_cpu(ltp->bestcount) * sizeof(*bestsp)); + xfs_dir2_leaf_log_tail(tp, lbp); + xfs_dir2_leaf_log_bests(tp, lbp, 0, be32_to_cpu(ltp->bestcount) - 1); +diff -Nurd linux-2.6.24/fs/xfs/xfs_dir2_node.c linux-2.6.24-oxe810/fs/xfs/xfs_dir2_node.c +--- linux-2.6.24/fs/xfs/xfs_dir2_node.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_dir2_node.c 2008-06-11 17:46:48.000000000 +0200 +@@ -254,7 +254,7 @@ + (be16_to_cpu(leaf->hdr.count) - index) * sizeof(*lep)); + lfloglow = index; + lfloghigh = be16_to_cpu(leaf->hdr.count); +- be16_add(&leaf->hdr.count, 1); ++ be16_add_cpu(&leaf->hdr.count, 1); + } + /* + * There are stale entries. We'll use one for the new entry. +@@ -322,7 +322,7 @@ + lfloglow = MIN(index, lfloglow); + lfloghigh = MAX(highstale, lfloghigh); + } +- be16_add(&leaf->hdr.stale, -1); ++ be16_add_cpu(&leaf->hdr.stale, -1); + } + /* + * Insert the new entry, log everything. +@@ -697,10 +697,10 @@ + /* + * Update the headers and log them. + */ +- be16_add(&leaf_s->hdr.count, -(count)); +- be16_add(&leaf_s->hdr.stale, -(stale)); +- be16_add(&leaf_d->hdr.count, count); +- be16_add(&leaf_d->hdr.stale, stale); ++ be16_add_cpu(&leaf_s->hdr.count, -(count)); ++ be16_add_cpu(&leaf_s->hdr.stale, -(stale)); ++ be16_add_cpu(&leaf_d->hdr.count, count); ++ be16_add_cpu(&leaf_d->hdr.stale, stale); + xfs_dir2_leaf_log_header(tp, bp_s); + xfs_dir2_leaf_log_header(tp, bp_d); + xfs_dir2_leafn_check(args->dp, bp_s); +@@ -885,7 +885,7 @@ + * Kill the leaf entry by marking it stale. + * Log the leaf block changes. + */ +- be16_add(&leaf->hdr.stale, 1); ++ be16_add_cpu(&leaf->hdr.stale, 1); + xfs_dir2_leaf_log_header(tp, bp); + lep->address = cpu_to_be32(XFS_DIR2_NULL_DATAPTR); + xfs_dir2_leaf_log_ents(tp, bp, index, index); +@@ -971,7 +971,7 @@ + /* + * One less used entry in the free table. + */ +- be32_add(&free->hdr.nused, -1); ++ be32_add_cpu(&free->hdr.nused, -1); + xfs_dir2_free_log_header(tp, fbp); + /* + * If this was the last entry in the table, we can +@@ -1642,7 +1642,7 @@ + * (this should always be true) then update the header. + */ + if (be16_to_cpu(free->bests[findex]) == NULLDATAOFF) { +- be32_add(&free->hdr.nused, 1); ++ be32_add_cpu(&free->hdr.nused, 1); + xfs_dir2_free_log_header(tp, fbp); + } + /* +diff -Nurd linux-2.6.24/fs/xfs/xfs_fsops.c linux-2.6.24-oxe810/fs/xfs/xfs_fsops.c +--- linux-2.6.24/fs/xfs/xfs_fsops.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_fsops.c 2008-06-11 17:46:48.000000000 +0200 +@@ -318,7 +318,7 @@ + } + ASSERT(bp); + agi = XFS_BUF_TO_AGI(bp); +- be32_add(&agi->agi_length, new); ++ be32_add_cpu(&agi->agi_length, new); + ASSERT(nagcount == oagcount || + be32_to_cpu(agi->agi_length) == mp->m_sb.sb_agblocks); + xfs_ialloc_log_agi(tp, bp, XFS_AGI_LENGTH); +@@ -331,7 +331,7 @@ + } + ASSERT(bp); + agf = XFS_BUF_TO_AGF(bp); +- be32_add(&agf->agf_length, new); ++ be32_add_cpu(&agf->agf_length, new); + ASSERT(be32_to_cpu(agf->agf_length) == + be32_to_cpu(agi->agi_length)); + xfs_alloc_log_agf(tp, bp, XFS_AGF_LENGTH); +diff -Nurd linux-2.6.24/fs/xfs/xfs_ialloc.c linux-2.6.24-oxe810/fs/xfs/xfs_ialloc.c +--- linux-2.6.24/fs/xfs/xfs_ialloc.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_ialloc.c 2008-06-11 17:46:48.000000000 +0200 +@@ -301,8 +301,8 @@ + } + xfs_trans_inode_alloc_buf(tp, fbuf); + } +- be32_add(&agi->agi_count, newlen); +- be32_add(&agi->agi_freecount, newlen); ++ be32_add_cpu(&agi->agi_count, newlen); ++ be32_add_cpu(&agi->agi_freecount, newlen); + agno = be32_to_cpu(agi->agi_seqno); + down_read(&args.mp->m_peraglock); + args.mp->m_perag[agno].pagi_freecount += newlen; +@@ -885,7 +885,7 @@ + if ((error = xfs_inobt_update(cur, rec.ir_startino, rec.ir_freecount, + rec.ir_free))) + goto error0; +- be32_add(&agi->agi_freecount, -1); ++ be32_add_cpu(&agi->agi_freecount, -1); + xfs_ialloc_log_agi(tp, agbp, XFS_AGI_FREECOUNT); + down_read(&mp->m_peraglock); + mp->m_perag[tagno].pagi_freecount--; +@@ -1065,8 +1065,8 @@ + * to be freed when the transaction is committed. + */ + ilen = XFS_IALLOC_INODES(mp); +- be32_add(&agi->agi_count, -ilen); +- be32_add(&agi->agi_freecount, -(ilen - 1)); ++ be32_add_cpu(&agi->agi_count, -ilen); ++ be32_add_cpu(&agi->agi_freecount, -(ilen - 1)); + xfs_ialloc_log_agi(tp, agbp, XFS_AGI_COUNT | XFS_AGI_FREECOUNT); + down_read(&mp->m_peraglock); + mp->m_perag[agno].pagi_freecount -= ilen - 1; +@@ -1095,7 +1095,7 @@ + /* + * Change the inode free counts and log the ag/sb changes. + */ +- be32_add(&agi->agi_freecount, 1); ++ be32_add_cpu(&agi->agi_freecount, 1); + xfs_ialloc_log_agi(tp, agbp, XFS_AGI_FREECOUNT); + down_read(&mp->m_peraglock); + mp->m_perag[agno].pagi_freecount++; +diff -Nurd linux-2.6.24/fs/xfs/xfs_ialloc_btree.c linux-2.6.24-oxe810/fs/xfs/xfs_ialloc_btree.c +--- linux-2.6.24/fs/xfs/xfs_ialloc_btree.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_ialloc_btree.c 2008-06-11 17:46:48.000000000 +0200 +@@ -189,7 +189,7 @@ + */ + bno = be32_to_cpu(agi->agi_root); + agi->agi_root = *pp; +- be32_add(&agi->agi_level, -1); ++ be32_add_cpu(&agi->agi_level, -1); + /* + * Free the block. + */ +@@ -1132,7 +1132,7 @@ + /* + * Bump and log left's numrecs, decrement and log right's numrecs. + */ +- be16_add(&left->bb_numrecs, 1); ++ be16_add_cpu(&left->bb_numrecs, 1); + xfs_inobt_log_block(cur->bc_tp, lbp, XFS_BB_NUMRECS); + #ifdef DEBUG + if (level > 0) +@@ -1140,7 +1140,7 @@ + else + xfs_btree_check_rec(cur->bc_btnum, lrp - 1, lrp); + #endif +- be16_add(&right->bb_numrecs, -1); ++ be16_add_cpu(&right->bb_numrecs, -1); + xfs_inobt_log_block(cur->bc_tp, rbp, XFS_BB_NUMRECS); + /* + * Slide the contents of right down one entry. +@@ -1232,7 +1232,7 @@ + * Set the root data in the a.g. inode structure. + */ + agi->agi_root = cpu_to_be32(args.agbno); +- be32_add(&agi->agi_level, 1); ++ be32_add_cpu(&agi->agi_level, 1); + xfs_ialloc_log_agi(args.tp, cur->bc_private.i.agbp, + XFS_AGI_ROOT | XFS_AGI_LEVEL); + /* +@@ -1426,9 +1426,9 @@ + /* + * Decrement and log left's numrecs, bump and log right's numrecs. + */ +- be16_add(&left->bb_numrecs, -1); ++ be16_add_cpu(&left->bb_numrecs, -1); + xfs_inobt_log_block(cur->bc_tp, lbp, XFS_BB_NUMRECS); +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + #ifdef DEBUG + if (level > 0) + xfs_btree_check_key(cur->bc_btnum, rkp, rkp + 1); +@@ -1529,7 +1529,7 @@ + */ + if ((be16_to_cpu(left->bb_numrecs) & 1) && + cur->bc_ptrs[level] <= be16_to_cpu(right->bb_numrecs) + 1) +- be16_add(&right->bb_numrecs, 1); ++ be16_add_cpu(&right->bb_numrecs, 1); + i = be16_to_cpu(left->bb_numrecs) - be16_to_cpu(right->bb_numrecs) + 1; + /* + * For non-leaf blocks, copy keys and addresses over to the new block. +@@ -1565,7 +1565,7 @@ + * Find the left block number by looking in the buffer. + * Adjust numrecs, sibling pointers. + */ +- be16_add(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); ++ be16_add_cpu(&left->bb_numrecs, -(be16_to_cpu(right->bb_numrecs))); + right->bb_rightsib = left->bb_rightsib; + left->bb_rightsib = cpu_to_be32(args.agbno); + right->bb_leftsib = cpu_to_be32(lbno); +diff -Nurd linux-2.6.24/fs/xfs/xfs_inode.c linux-2.6.24-oxe810/fs/xfs/xfs_inode.c +--- linux-2.6.24/fs/xfs/xfs_inode.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_inode.c 2008-06-11 17:46:48.000000000 +0200 +@@ -1158,6 +1158,16 @@ + if ((prid != 0) && (ip->i_d.di_version == XFS_DINODE_VERSION_1)) + xfs_bump_ino_vers2(tp, ip); + ++#ifdef CONFIG_HIPOX_SUID_INHERIT ++ /* Modification to propagate SUID down directory hierarchy */ ++ if (pip && XFS_INHERIT_UID(pip)) { ++ ip->i_d.di_uid = pip->i_d.di_uid; ++ if ((pip->i_d.di_mode & S_ISGID) && (mode & S_IFMT) == S_IFDIR) { ++ ip->i_d.di_mode |= S_ISUID; ++ } ++ } ++#endif // CONFIG_HIPOX_SUID_INHERIT ++ + if (pip && XFS_INHERIT_GID(pip)) { + ip->i_d.di_gid = pip->i_d.di_gid; + if ((pip->i_d.di_mode & S_ISGID) && (mode & S_IFMT) == S_IFDIR) { +diff -Nurd linux-2.6.24/fs/xfs/xfs_inode.h linux-2.6.24-oxe810/fs/xfs/xfs_inode.h +--- linux-2.6.24/fs/xfs/xfs_inode.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_inode.h 2008-06-11 17:46:48.000000000 +0200 +@@ -495,6 +495,11 @@ + #define XFS_INHERIT_GID(pip) \ + (((pip)->i_mount->m_flags & XFS_MOUNT_GRPID) || \ + ((pip)->i_d.di_mode & S_ISGID)) ++#ifdef CONFIG_HIPOX_SUID_INHERIT ++/* Modification to propagate SUID down directory hierarchy */ ++#define XFS_INHERIT_UID(pip) \ ++ ((pip)->i_d.di_mode & S_ISUID) ++#endif // CONFIG_HIPOX_SUID_INHERIT + + /* + * Flags for xfs_iget() +diff -Nurd linux-2.6.24/fs/xfs/xfs_log.c linux-2.6.24-oxe810/fs/xfs/xfs_log.c +--- linux-2.6.24/fs/xfs/xfs_log.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_log.c 2008-06-11 17:46:48.000000000 +0200 +@@ -399,10 +399,10 @@ + { + xlog_t *log = mp->m_log; + xlog_in_core_t *iclog = (xlog_in_core_t *)iclog_hndl; +- int abortflg, spl; ++ int abortflg; + + cb->cb_next = NULL; +- spl = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + abortflg = (iclog->ic_state & XLOG_STATE_IOERROR); + if (!abortflg) { + ASSERT_ALWAYS((iclog->ic_state == XLOG_STATE_ACTIVE) || +@@ -411,7 +411,7 @@ + *(iclog->ic_callback_tail) = cb; + iclog->ic_callback_tail = &(cb->cb_next); + } +- LOG_UNLOCK(log, spl); ++ spin_unlock(&log->l_icloglock); + return abortflg; + } /* xfs_log_notify */ + +@@ -503,6 +503,8 @@ + xfs_daddr_t blk_offset, + int num_bblks) + { ++ int error; ++ + if (!(mp->m_flags & XFS_MOUNT_NORECOVERY)) + cmn_err(CE_NOTE, "XFS mounting filesystem %s", mp->m_fsname); + else { +@@ -519,7 +521,7 @@ + * just worked. + */ + if (!(mp->m_flags & XFS_MOUNT_NORECOVERY)) { +- int error, readonly = (mp->m_flags & XFS_MOUNT_RDONLY); ++ int readonly = (mp->m_flags & XFS_MOUNT_RDONLY); + + if (readonly) + mp->m_flags &= ~XFS_MOUNT_RDONLY; +@@ -530,8 +532,8 @@ + mp->m_flags |= XFS_MOUNT_RDONLY; + if (error) { + cmn_err(CE_WARN, "XFS: log mount/recovery failed: error %d", error); +- xlog_dealloc_log(mp->m_log); +- return error; ++ ++ goto error; + } + } + +@@ -540,6 +542,9 @@ + + /* End mounting message in xfs_log_mount_finish */ + return 0; ++error: ++ xfs_log_unmount_dealloc(mp); ++ return error; + } /* xfs_log_mount */ + + /* +@@ -606,7 +611,6 @@ + xfs_log_ticket_t tic = NULL; + xfs_lsn_t lsn; + int error; +- SPLDECL(s); + + /* the data section must be 32 bit size aligned */ + struct { +@@ -659,24 +663,24 @@ + } + + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + iclog = log->l_iclog; + iclog->ic_refcnt++; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + xlog_state_want_sync(log, iclog); + (void) xlog_state_release_iclog(log, iclog); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + if (!(iclog->ic_state == XLOG_STATE_ACTIVE || + iclog->ic_state == XLOG_STATE_DIRTY)) { + if (!XLOG_FORCED_SHUTDOWN(log)) { + sv_wait(&iclog->ic_forcesema, PMEM, + &log->l_icloglock, s); + } else { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + } else { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + if (tic) { + xlog_trace_loggrant(log, tic, "unmount rec"); +@@ -697,15 +701,15 @@ + * a file system that went into forced_shutdown as + * the result of an unmount.. + */ +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + iclog = log->l_iclog; + iclog->ic_refcnt++; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + xlog_state_want_sync(log, iclog); + (void) xlog_state_release_iclog(log, iclog); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + if ( ! ( iclog->ic_state == XLOG_STATE_ACTIVE + || iclog->ic_state == XLOG_STATE_DIRTY +@@ -714,7 +718,7 @@ + sv_wait(&iclog->ic_forcesema, PMEM, + &log->l_icloglock, s); + } else { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + } + +@@ -723,6 +727,9 @@ + + /* + * Deallocate log structures for unmount/relocation. ++ * ++ * We need to stop the aild from running before we destroy ++ * and deallocate the log as the aild references the log. + */ + void + xfs_log_unmount_dealloc(xfs_mount_t *mp) +@@ -762,20 +769,18 @@ + xlog_ticket_t *tic; + xlog_t *log = mp->m_log; + int need_bytes, free_bytes, cycle, bytes; +- SPLDECL(s); + + if (XLOG_FORCED_SHUTDOWN(log)) + return; +- ASSERT(!XFS_FORCED_SHUTDOWN(mp)); + + if (tail_lsn == 0) { + /* needed since sync_lsn is 64 bits */ +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + tail_lsn = log->l_last_sync_lsn; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + + /* Also an invalid lsn. 1 implies that we aren't passing in a valid + * tail_lsn. +@@ -824,7 +829,7 @@ + tic = tic->t_next; + } while (tic != log->l_reserve_headq); + } +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + } /* xfs_log_move_tail */ + + /* +@@ -836,14 +841,13 @@ + int + xfs_log_need_covered(xfs_mount_t *mp) + { +- SPLDECL(s); + int needed = 0, gen; + xlog_t *log = mp->m_log; + + if (!xfs_fs_writable(mp)) + return 0; + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + if (((log->l_covered_state == XLOG_STATE_COVER_NEED) || + (log->l_covered_state == XLOG_STATE_COVER_NEED2)) + && !xfs_trans_first_ail(mp, &gen) +@@ -856,7 +860,7 @@ + } + needed = 1; + } +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return needed; + } + +@@ -881,17 +885,16 @@ + xlog_assign_tail_lsn(xfs_mount_t *mp) + { + xfs_lsn_t tail_lsn; +- SPLDECL(s); + xlog_t *log = mp->m_log; + + tail_lsn = xfs_trans_tail_ail(mp); +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + if (tail_lsn != 0) { + log->l_tail_lsn = tail_lsn; + } else { + tail_lsn = log->l_tail_lsn = log->l_last_sync_lsn; + } +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + + return tail_lsn; + } /* xlog_assign_tail_lsn */ +@@ -911,7 +914,7 @@ + * the tail. The details of this case are described below, but the end + * result is that we return the size of the log as the amount of space left. + */ +-int ++STATIC int + xlog_space_left(xlog_t *log, int cycle, int bytes) + { + int free_bytes; +@@ -1165,7 +1168,7 @@ + log->l_flags |= XLOG_ACTIVE_RECOVERY; + + log->l_prev_block = -1; +- ASSIGN_ANY_LSN_HOST(log->l_tail_lsn, 1, 0); ++ log->l_tail_lsn = xlog_assign_lsn(1, 0); + /* log->l_tail_lsn = 0x100000000LL; cycle = 1; current block = 0 */ + log->l_last_sync_lsn = log->l_tail_lsn; + log->l_curr_cycle = 1; /* 0 is bad since this is initial value */ +@@ -1193,8 +1196,8 @@ + ASSERT(XFS_BUF_VALUSEMA(bp) <= 0); + log->l_xbuf = bp; + +- spinlock_init(&log->l_icloglock, "iclog"); +- spinlock_init(&log->l_grant_lock, "grhead_iclog"); ++ spin_lock_init(&log->l_icloglock); ++ spin_lock_init(&log->l_grant_lock); + initnsema(&log->l_flushsema, 0, "ic-flush"); + xlog_state_ticket_alloc(log); /* wait until after icloglock inited */ + +@@ -1231,12 +1234,12 @@ + + head = &iclog->ic_header; + memset(head, 0, sizeof(xlog_rec_header_t)); +- INT_SET(head->h_magicno, ARCH_CONVERT, XLOG_HEADER_MAGIC_NUM); +- INT_SET(head->h_version, ARCH_CONVERT, ++ head->h_magicno = cpu_to_be32(XLOG_HEADER_MAGIC_NUM); ++ head->h_version = cpu_to_be32( + XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb) ? 2 : 1); +- INT_SET(head->h_size, ARCH_CONVERT, log->l_iclog_size); ++ head->h_size = cpu_to_be32(log->l_iclog_size); + /* new fields */ +- INT_SET(head->h_fmt, ARCH_CONVERT, XLOG_FMT); ++ head->h_fmt = cpu_to_be32(XLOG_FMT); + memcpy(&head->h_fs_uuid, &mp->m_sb.sb_uuid, sizeof(uuid_t)); + + +@@ -1293,7 +1296,7 @@ + * pushes on an lsn which is further along in the log once we reach the high + * water mark. In this manner, we would be creating a low water mark. + */ +-void ++STATIC void + xlog_grant_push_ail(xfs_mount_t *mp, + int need_bytes) + { +@@ -1305,11 +1308,10 @@ + int threshold_block; /* block in lsn we'd like to be at */ + int threshold_cycle; /* lsn cycle we'd like to be at */ + int free_threshold; +- SPLDECL(s); + + ASSERT(BTOBB(need_bytes) < log->l_logBBsize); + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + free_bytes = xlog_space_left(log, + log->l_grant_reserve_cycle, + log->l_grant_reserve_bytes); +@@ -1331,8 +1333,7 @@ + threshold_block -= log->l_logBBsize; + threshold_cycle += 1; + } +- ASSIGN_ANY_LSN_HOST(threshold_lsn, threshold_cycle, +- threshold_block); ++ threshold_lsn = xlog_assign_lsn(threshold_cycle, threshold_block); + + /* Don't pass in an lsn greater than the lsn of the last + * log record known to be on disk. +@@ -1340,7 +1341,7 @@ + if (XFS_LSN_CMP(threshold_lsn, log->l_last_sync_lsn) > 0) + threshold_lsn = log->l_last_sync_lsn; + } +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + + /* + * Get the transaction layer to kick the dirty buffers out to +@@ -1378,19 +1379,18 @@ + * is added immediately before calling bwrite(). + */ + +-int ++STATIC int + xlog_sync(xlog_t *log, + xlog_in_core_t *iclog) + { + xfs_caddr_t dptr; /* pointer to byte sized element */ + xfs_buf_t *bp; +- int i, ops; ++ int i; + uint count; /* byte count of bwrite */ + uint count_init; /* initial count before roundup */ + int roundoff; /* roundoff to BB or stripe */ + int split = 0; /* split write into two regions */ + int error; +- SPLDECL(s); + int v2 = XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb); + + XFS_STATS_INC(xs_log_writes); +@@ -1415,30 +1415,24 @@ + roundoff < BBTOB(1))); + + /* move grant heads by roundoff in sync */ +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + xlog_grant_add_space(log, roundoff); +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + + /* put cycle number in every block */ + xlog_pack_data(log, iclog, roundoff); + + /* real byte length */ + if (v2) { +- INT_SET(iclog->ic_header.h_len, +- ARCH_CONVERT, +- iclog->ic_offset + roundoff); ++ iclog->ic_header.h_len = cpu_to_be32(iclog->ic_offset + roundoff); + } else { +- INT_SET(iclog->ic_header.h_len, ARCH_CONVERT, iclog->ic_offset); ++ iclog->ic_header.h_len = cpu_to_be32(iclog->ic_offset); + } + +- /* put ops count in correct order */ +- ops = iclog->ic_header.h_num_logops; +- INT_SET(iclog->ic_header.h_num_logops, ARCH_CONVERT, ops); +- + bp = iclog->ic_bp; + ASSERT(XFS_BUF_FSPRIVATE2(bp, unsigned long) == (unsigned long)1); + XFS_BUF_SET_FSPRIVATE2(bp, (unsigned long)2); +- XFS_BUF_SET_ADDR(bp, BLOCK_LSN(INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT))); ++ XFS_BUF_SET_ADDR(bp, BLOCK_LSN(be64_to_cpu(iclog->ic_header.h_lsn))); + + XFS_STATS_ADD(xs_log_blocks, BTOBB(count)); + +@@ -1450,11 +1444,13 @@ + } else { + iclog->ic_bwritecnt = 1; + } ++ + XFS_BUF_SET_COUNT(bp, count); + XFS_BUF_SET_FSPRIVATE(bp, iclog); /* save for later */ + XFS_BUF_ZEROFLAGS(bp); + XFS_BUF_BUSY(bp); + XFS_BUF_ASYNC(bp); ++ + /* + * Do an ordered write for the log block. + * Its unnecessary to flush the first split block in the log wrap case. +@@ -1480,6 +1476,7 @@ + XFS_BUF_ADDR(bp)); + return error; + } ++ + if (split) { + bp = iclog->ic_log->l_xbuf; + ASSERT(XFS_BUF_FSPRIVATE2(bp, unsigned long) == +@@ -1501,10 +1498,10 @@ + * a new cycle. Watch out for the header magic number + * case, though. + */ +- for (i=0; i<split; i += BBSIZE) { +- INT_MOD(*(uint *)dptr, ARCH_CONVERT, +1); +- if (INT_GET(*(uint *)dptr, ARCH_CONVERT) == XLOG_HEADER_MAGIC_NUM) +- INT_MOD(*(uint *)dptr, ARCH_CONVERT, +1); ++ for (i = 0; i < split; i += BBSIZE) { ++ be32_add_cpu((__be32 *)dptr, 1); ++ if (be32_to_cpu(*(__be32 *)dptr) == XLOG_HEADER_MAGIC_NUM) ++ be32_add_cpu((__be32 *)dptr, 1); + dptr += BBSIZE; + } + +@@ -1520,6 +1517,7 @@ + return error; + } + } ++ + return 0; + } /* xlog_sync */ + +@@ -1527,7 +1525,7 @@ + /* + * Deallocate a log structure + */ +-void ++STATIC void + xlog_dealloc_log(xlog_t *log) + { + xlog_in_core_t *iclog, *next_iclog; +@@ -1592,14 +1590,12 @@ + int record_cnt, + int copy_bytes) + { +- SPLDECL(s); +- +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + +- iclog->ic_header.h_num_logops += record_cnt; ++ be32_add_cpu(&iclog->ic_header.h_num_logops, record_cnt); + iclog->ic_offset += copy_bytes; + +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } /* xlog_state_finish_copy */ + + +@@ -1752,7 +1748,7 @@ + * we don't update ic_offset until the end when we know exactly how many + * bytes have been written out. + */ +-int ++STATIC int + xlog_write(xfs_mount_t * mp, + xfs_log_iovec_t reg[], + int nentries, +@@ -1823,7 +1819,7 @@ + + /* start_lsn is the first lsn written to. That's all we need. */ + if (! *start_lsn) +- *start_lsn = INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT); ++ *start_lsn = be64_to_cpu(iclog->ic_header.h_lsn); + + /* This loop writes out as many regions as can fit in the amount + * of space which was allocated by xlog_state_get_iclog_space(). +@@ -1839,7 +1835,7 @@ + */ + if (ticket->t_flags & XLOG_TIC_INITED) { + logop_head = (xlog_op_header_t *)ptr; +- INT_SET(logop_head->oh_tid, ARCH_CONVERT, ticket->t_tid); ++ logop_head->oh_tid = cpu_to_be32(ticket->t_tid); + logop_head->oh_clientid = ticket->t_clientid; + logop_head->oh_len = 0; + logop_head->oh_flags = XLOG_START_TRANS; +@@ -1853,7 +1849,7 @@ + + /* Copy log operation header directly into data section */ + logop_head = (xlog_op_header_t *)ptr; +- INT_SET(logop_head->oh_tid, ARCH_CONVERT, ticket->t_tid); ++ logop_head->oh_tid = cpu_to_be32(ticket->t_tid); + logop_head->oh_clientid = ticket->t_clientid; + logop_head->oh_res2 = 0; + +@@ -1888,13 +1884,14 @@ + + copy_off = partial_copy_len; + if (need_copy <= iclog->ic_size - log_offset) { /*complete write */ +- INT_SET(logop_head->oh_len, ARCH_CONVERT, copy_len = need_copy); ++ copy_len = need_copy; ++ logop_head->oh_len = cpu_to_be32(copy_len); + if (partial_copy) + logop_head->oh_flags|= (XLOG_END_TRANS|XLOG_WAS_CONT_TRANS); + partial_copy_len = partial_copy = 0; + } else { /* partial write */ + copy_len = iclog->ic_size - log_offset; +- INT_SET(logop_head->oh_len, ARCH_CONVERT, copy_len); ++ logop_head->oh_len = cpu_to_be32(copy_len); + logop_head->oh_flags |= XLOG_CONTINUE_TRANS; + if (partial_copy) + logop_head->oh_flags |= XLOG_WAS_CONT_TRANS; +@@ -1992,7 +1989,8 @@ + * We don't need to cover the dummy. + */ + if (!changed && +- (INT_GET(iclog->ic_header.h_num_logops, ARCH_CONVERT) == XLOG_COVER_OPS)) { ++ (be32_to_cpu(iclog->ic_header.h_num_logops) == ++ XLOG_COVER_OPS)) { + changed = 1; + } else { + /* +@@ -2060,7 +2058,7 @@ + lowest_lsn = 0; + do { + if (!(lsn_log->ic_state & (XLOG_STATE_ACTIVE|XLOG_STATE_DIRTY))) { +- lsn = INT_GET(lsn_log->ic_header.h_lsn, ARCH_CONVERT); ++ lsn = be64_to_cpu(lsn_log->ic_header.h_lsn); + if ((lsn && !lowest_lsn) || + (XFS_LSN_CMP(lsn, lowest_lsn) < 0)) { + lowest_lsn = lsn; +@@ -2089,9 +2087,8 @@ + int funcdidcallbacks; /* flag: function did callbacks */ + int repeats; /* for issuing console warnings if + * looping too many times */ +- SPLDECL(s); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + first_iclog = iclog = log->l_iclog; + ioerrors = 0; + funcdidcallbacks = 0; +@@ -2162,11 +2159,9 @@ + */ + + lowest_lsn = xlog_get_lowest_lsn(log); +- if (lowest_lsn && ( +- XFS_LSN_CMP( +- lowest_lsn, +- INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT) +- )<0)) { ++ if (lowest_lsn && ++ XFS_LSN_CMP(lowest_lsn, ++ be64_to_cpu(iclog->ic_header.h_lsn)) < 0) { + iclog = iclog->ic_next; + continue; /* Leave this iclog for + * another thread */ +@@ -2174,19 +2169,18 @@ + + iclog->ic_state = XLOG_STATE_CALLBACK; + +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + /* l_last_sync_lsn field protected by + * GRANT_LOCK. Don't worry about iclog's lsn. + * No one else can be here except us. + */ +- s = GRANT_LOCK(log); +- ASSERT(XFS_LSN_CMP( +- log->l_last_sync_lsn, +- INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT) +- )<=0); +- log->l_last_sync_lsn = INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT); +- GRANT_UNLOCK(log, s); ++ spin_lock(&log->l_grant_lock); ++ ASSERT(XFS_LSN_CMP(log->l_last_sync_lsn, ++ be64_to_cpu(iclog->ic_header.h_lsn)) <= 0); ++ log->l_last_sync_lsn = ++ be64_to_cpu(iclog->ic_header.h_lsn); ++ spin_unlock(&log->l_grant_lock); + + /* + * Keep processing entries in the callback list +@@ -2195,7 +2189,7 @@ + * empty and change the state to DIRTY so that + * we don't miss any more callbacks being added. + */ +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + } else { + ioerrors++; + } +@@ -2204,14 +2198,14 @@ + while (cb) { + iclog->ic_callback_tail = &(iclog->ic_callback); + iclog->ic_callback = NULL; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + /* perform callbacks in the order given */ + for (; cb; cb = cb_next) { + cb_next = cb->cb_next; + cb->cb_func(cb->cb_arg, aborted); + } +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + cb = iclog->ic_callback; + } + +@@ -2276,7 +2270,7 @@ + flushcnt = log->l_flushcnt; + log->l_flushcnt = 0; + } +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + while (flushcnt--) + vsema(&log->l_flushsema); + } /* xlog_state_do_callback */ +@@ -2296,15 +2290,14 @@ + * global state machine log lock. Assume that the calls to cvsema won't + * take a long time. At least we know it won't sleep. + */ +-void ++STATIC void + xlog_state_done_syncing( + xlog_in_core_t *iclog, + int aborted) + { + xlog_t *log = iclog->ic_log; +- SPLDECL(s); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + ASSERT(iclog->ic_state == XLOG_STATE_SYNCING || + iclog->ic_state == XLOG_STATE_IOERROR); +@@ -2320,7 +2313,7 @@ + */ + if (iclog->ic_state != XLOG_STATE_IOERROR) { + if (--iclog->ic_bwritecnt == 1) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return; + } + iclog->ic_state = XLOG_STATE_DONE_SYNC; +@@ -2332,7 +2325,7 @@ + * I/O, the others get to wait for the result. + */ + sv_broadcast(&iclog->ic_writesema); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + xlog_state_do_callback(log, aborted, iclog); /* also cleans log */ + } /* xlog_state_done_syncing */ + +@@ -2357,7 +2350,7 @@ + * needs to be incremented, depending on the amount of data which + * is copied. + */ +-int ++STATIC int + xlog_state_get_iclog_space(xlog_t *log, + int len, + xlog_in_core_t **iclogp, +@@ -2365,23 +2358,22 @@ + int *continued_write, + int *logoffsetp) + { +- SPLDECL(s); + int log_offset; + xlog_rec_header_t *head; + xlog_in_core_t *iclog; + int error; + + restart: +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + if (XLOG_FORCED_SHUTDOWN(log)) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + + iclog = log->l_iclog; + if (! (iclog->ic_state == XLOG_STATE_ACTIVE)) { + log->l_flushcnt++; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + xlog_trace_iclog(iclog, XLOG_TRACE_SLEEP_FLUSH); + XFS_STATS_INC(xs_log_noiclogs); + /* Ensure that log writes happen */ +@@ -2404,8 +2396,9 @@ + xlog_tic_add_region(ticket, + log->l_iclog_hsize, + XLOG_REG_TYPE_LRHEADER); +- INT_SET(head->h_cycle, ARCH_CONVERT, log->l_curr_cycle); +- ASSIGN_LSN(head->h_lsn, log); ++ head->h_cycle = cpu_to_be32(log->l_curr_cycle); ++ head->h_lsn = cpu_to_be64( ++ xlog_assign_lsn(log->l_curr_cycle, log->l_curr_block)); + ASSERT(log->l_curr_block >= 0); + } + +@@ -2423,12 +2416,12 @@ + + /* If I'm the only one writing to this iclog, sync it to disk */ + if (iclog->ic_refcnt == 1) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + if ((error = xlog_state_release_iclog(log, iclog))) + return error; + } else { + iclog->ic_refcnt--; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + goto restart; + } +@@ -2449,7 +2442,7 @@ + *iclogp = iclog; + + ASSERT(iclog->ic_offset <= iclog->ic_size); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + *logoffsetp = log_offset; + return 0; +@@ -2467,7 +2460,6 @@ + { + int free_bytes; + int need_bytes; +- SPLDECL(s); + #ifdef DEBUG + xfs_lsn_t tail_lsn; + #endif +@@ -2479,7 +2471,7 @@ + #endif + + /* Is there space or do we need to sleep? */ +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + xlog_trace_loggrant(log, tic, "xlog_grant_log_space: enter"); + + /* something is already sleeping; insert new transaction at end */ +@@ -2502,7 +2494,7 @@ + */ + xlog_trace_loggrant(log, tic, + "xlog_grant_log_space: wake 1"); +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + } + if (tic->t_flags & XFS_LOG_PERM_RESERV) + need_bytes = tic->t_unit_res*tic->t_ocnt; +@@ -2524,14 +2516,14 @@ + sv_wait(&tic->t_sema, PINOD|PLTWAIT, &log->l_grant_lock, s); + + if (XLOG_FORCED_SHUTDOWN(log)) { +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + goto error_return; + } + + xlog_trace_loggrant(log, tic, + "xlog_grant_log_space: wake 2"); + xlog_grant_push_ail(log->l_mp, need_bytes); +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + goto redo; + } else if (tic->t_flags & XLOG_TIC_IN_Q) + xlog_del_ticketq(&log->l_reserve_headq, tic); +@@ -2553,7 +2545,7 @@ + #endif + xlog_trace_loggrant(log, tic, "xlog_grant_log_space: exit"); + xlog_verify_grant_head(log, 1); +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + return 0; + + error_return: +@@ -2567,7 +2559,7 @@ + */ + tic->t_curr_res = 0; + tic->t_cnt = 0; /* ungrant will give back unit_res * t_cnt. */ +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + return XFS_ERROR(EIO); + } /* xlog_grant_log_space */ + +@@ -2581,7 +2573,6 @@ + xlog_regrant_write_log_space(xlog_t *log, + xlog_ticket_t *tic) + { +- SPLDECL(s); + int free_bytes, need_bytes; + xlog_ticket_t *ntic; + #ifdef DEBUG +@@ -2599,7 +2590,7 @@ + panic("regrant Recovery problem"); + #endif + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + xlog_trace_loggrant(log, tic, "xlog_regrant_write_log_space: enter"); + + if (XLOG_FORCED_SHUTDOWN(log)) +@@ -2638,14 +2629,14 @@ + /* If we're shutting down, this tic is already + * off the queue */ + if (XLOG_FORCED_SHUTDOWN(log)) { +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + goto error_return; + } + + xlog_trace_loggrant(log, tic, + "xlog_regrant_write_log_space: wake 1"); + xlog_grant_push_ail(log->l_mp, tic->t_unit_res); +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + } + } + +@@ -2665,14 +2656,14 @@ + + /* If we're shutting down, this tic is already off the queue */ + if (XLOG_FORCED_SHUTDOWN(log)) { +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + goto error_return; + } + + xlog_trace_loggrant(log, tic, + "xlog_regrant_write_log_space: wake 2"); + xlog_grant_push_ail(log->l_mp, need_bytes); +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + goto redo; + } else if (tic->t_flags & XLOG_TIC_IN_Q) + xlog_del_ticketq(&log->l_write_headq, tic); +@@ -2689,7 +2680,7 @@ + + xlog_trace_loggrant(log, tic, "xlog_regrant_write_log_space: exit"); + xlog_verify_grant_head(log, 1); +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + return 0; + + +@@ -2704,7 +2695,7 @@ + */ + tic->t_curr_res = 0; + tic->t_cnt = 0; /* ungrant will give back unit_res * t_cnt. */ +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + return XFS_ERROR(EIO); + } /* xlog_regrant_write_log_space */ + +@@ -2720,14 +2711,12 @@ + xlog_regrant_reserve_log_space(xlog_t *log, + xlog_ticket_t *ticket) + { +- SPLDECL(s); +- + xlog_trace_loggrant(log, ticket, + "xlog_regrant_reserve_log_space: enter"); + if (ticket->t_cnt > 0) + ticket->t_cnt--; + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + xlog_grant_sub_space(log, ticket->t_curr_res); + ticket->t_curr_res = ticket->t_unit_res; + xlog_tic_reset_res(ticket); +@@ -2737,7 +2726,7 @@ + + /* just return if we still have some of the pre-reserved space */ + if (ticket->t_cnt > 0) { +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + return; + } + +@@ -2745,7 +2734,7 @@ + xlog_trace_loggrant(log, ticket, + "xlog_regrant_reserve_log_space: exit"); + xlog_verify_grant_head(log, 0); +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + ticket->t_curr_res = ticket->t_unit_res; + xlog_tic_reset_res(ticket); + } /* xlog_regrant_reserve_log_space */ +@@ -2769,12 +2758,10 @@ + xlog_ungrant_log_space(xlog_t *log, + xlog_ticket_t *ticket) + { +- SPLDECL(s); +- + if (ticket->t_cnt > 0) + ticket->t_cnt--; + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + xlog_trace_loggrant(log, ticket, "xlog_ungrant_log_space: enter"); + + xlog_grant_sub_space(log, ticket->t_curr_res); +@@ -2791,7 +2778,7 @@ + + xlog_trace_loggrant(log, ticket, "xlog_ungrant_log_space: exit"); + xlog_verify_grant_head(log, 1); +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + xfs_log_move_tail(log->l_mp, 1); + } /* xlog_ungrant_log_space */ + +@@ -2799,15 +2786,13 @@ + /* + * Atomically put back used ticket. + */ +-void ++STATIC void + xlog_state_put_ticket(xlog_t *log, + xlog_ticket_t *tic) + { +- unsigned long s; +- +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + xlog_ticket_put(log, tic); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } /* xlog_state_put_ticket */ + + /* +@@ -2819,19 +2804,18 @@ + * + * + */ +-int ++STATIC int + xlog_state_release_iclog(xlog_t *log, + xlog_in_core_t *iclog) + { +- SPLDECL(s); + int sync = 0; /* do we sync? */ + + xlog_assign_tail_lsn(log->l_mp); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + if (iclog->ic_state & XLOG_STATE_IOERROR) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + +@@ -2843,12 +2827,12 @@ + iclog->ic_state == XLOG_STATE_WANT_SYNC) { + sync++; + iclog->ic_state = XLOG_STATE_SYNCING; +- INT_SET(iclog->ic_header.h_tail_lsn, ARCH_CONVERT, log->l_tail_lsn); ++ iclog->ic_header.h_tail_lsn = cpu_to_be64(log->l_tail_lsn); + xlog_verify_tail_lsn(log, iclog, log->l_tail_lsn); + /* cycle incremented when incrementing curr_block */ + } + +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + /* + * We let the log lock go, so it's possible that we hit a log I/O +@@ -2860,6 +2844,7 @@ + if (sync) { + return xlog_sync(log, iclog); + } ++ + return 0; + + } /* xlog_state_release_iclog */ +@@ -2881,7 +2866,7 @@ + if (!eventual_size) + eventual_size = iclog->ic_offset; + iclog->ic_state = XLOG_STATE_WANT_SYNC; +- INT_SET(iclog->ic_header.h_prev_block, ARCH_CONVERT, log->l_prev_block); ++ iclog->ic_header.h_prev_block = cpu_to_be32(log->l_prev_block); + log->l_prev_block = log->l_curr_block; + log->l_prev_cycle = log->l_curr_cycle; + +@@ -2939,13 +2924,12 @@ + { + xlog_in_core_t *iclog; + xfs_lsn_t lsn; +- SPLDECL(s); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + iclog = log->l_iclog; + if (iclog->ic_state & XLOG_STATE_IOERROR) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + +@@ -2978,15 +2962,15 @@ + * the previous sync. + */ + iclog->ic_refcnt++; +- lsn = INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT); ++ lsn = be64_to_cpu(iclog->ic_header.h_lsn); + xlog_state_switch_iclogs(log, iclog, 0); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + if (xlog_state_release_iclog(log, iclog)) + return XFS_ERROR(EIO); + *log_flushed = 1; +- s = LOG_LOCK(log); +- if (INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT) == lsn && ++ spin_lock(&log->l_icloglock); ++ if (be64_to_cpu(iclog->ic_header.h_lsn) == lsn && + iclog->ic_state != XLOG_STATE_DIRTY) + goto maybe_sleep; + else +@@ -3016,7 +3000,7 @@ + * sleep was disturbed by a bad news. + */ + if (iclog->ic_state & XLOG_STATE_IOERROR) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + XFS_STATS_INC(xs_log_force_sleep); +@@ -3033,7 +3017,7 @@ + } else { + + no_sleep: +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + return 0; + } /* xlog_state_sync_all */ +@@ -3051,7 +3035,7 @@ + * If filesystem activity goes to zero, the iclog will get flushed only by + * bdflush(). + */ +-int ++STATIC int + xlog_state_sync(xlog_t *log, + xfs_lsn_t lsn, + uint flags, +@@ -3059,26 +3043,24 @@ + { + xlog_in_core_t *iclog; + int already_slept = 0; +- SPLDECL(s); +- + + try_again: +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + iclog = log->l_iclog; + + if (iclog->ic_state & XLOG_STATE_IOERROR) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + + do { +- if (INT_GET(iclog->ic_header.h_lsn, ARCH_CONVERT) != lsn) { +- iclog = iclog->ic_next; +- continue; ++ if (be64_to_cpu(iclog->ic_header.h_lsn) != lsn) { ++ iclog = iclog->ic_next; ++ continue; + } + + if (iclog->ic_state == XLOG_STATE_DIRTY) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return 0; + } + +@@ -3113,11 +3095,11 @@ + } else { + iclog->ic_refcnt++; + xlog_state_switch_iclogs(log, iclog, 0); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + if (xlog_state_release_iclog(log, iclog)) + return XFS_ERROR(EIO); + *log_flushed = 1; +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + } + } + +@@ -3129,7 +3111,7 @@ + * gotten a log write error. + */ + if (iclog->ic_state & XLOG_STATE_IOERROR) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return XFS_ERROR(EIO); + } + XFS_STATS_INC(xs_log_force_sleep); +@@ -3143,13 +3125,13 @@ + return XFS_ERROR(EIO); + *log_flushed = 1; + } else { /* just return */ +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + return 0; + + } while (iclog != log->l_iclog); + +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + return 0; + } /* xlog_state_sync */ + +@@ -3158,12 +3140,10 @@ + * Called when we want to mark the current iclog as being ready to sync to + * disk. + */ +-void ++STATIC void + xlog_state_want_sync(xlog_t *log, xlog_in_core_t *iclog) + { +- SPLDECL(s); +- +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + if (iclog->ic_state == XLOG_STATE_ACTIVE) { + xlog_state_switch_iclogs(log, iclog, 0); +@@ -3172,7 +3152,7 @@ + (XLOG_STATE_WANT_SYNC|XLOG_STATE_IOERROR)); + } + +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } /* xlog_state_want_sync */ + + +@@ -3194,7 +3174,6 @@ + xlog_ticket_t *next; + xfs_caddr_t buf; + uint i = (NBPP / sizeof(xlog_ticket_t)) - 2; +- SPLDECL(s); + + /* + * The kmem_zalloc may sleep, so we shouldn't be holding the +@@ -3202,7 +3181,7 @@ + */ + buf = (xfs_caddr_t) kmem_zalloc(NBPP, KM_SLEEP); + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + + /* Attach 1st ticket to Q, so we can keep track of allocated memory */ + t_list = (xlog_ticket_t *)buf; +@@ -3231,7 +3210,7 @@ + } + t_list->t_next = NULL; + log->l_tail = t_list; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } /* xlog_state_ticket_alloc */ + + +@@ -3273,7 +3252,7 @@ + /* + * Grab ticket off freelist or allocation some more + */ +-xlog_ticket_t * ++STATIC xlog_ticket_t * + xlog_ticket_get(xlog_t *log, + int unit_bytes, + int cnt, +@@ -3282,15 +3261,14 @@ + { + xlog_ticket_t *tic; + uint num_headers; +- SPLDECL(s); + + alloc: + if (log->l_freelist == NULL) + xlog_state_ticket_alloc(log); /* potentially sleep */ + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + if (log->l_freelist == NULL) { +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + goto alloc; + } + tic = log->l_freelist; +@@ -3298,7 +3276,7 @@ + if (log->l_freelist == NULL) + log->l_tail = NULL; + log->l_ticket_cnt--; +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + /* + * Permanent reservations have up to 'cnt'-1 active log operations +@@ -3476,7 +3454,7 @@ + SPLDECL(s); + + /* check validity of iclog pointers */ +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + icptr = log->l_iclog; + for (i=0; i < log->l_iclog_bufs; i++) { + if (icptr == NULL) +@@ -3485,21 +3463,21 @@ + } + if (icptr != log->l_iclog) + xlog_panic("xlog_verify_iclog: corrupt iclog ring"); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + + /* check log magic numbers */ +- ptr = (xfs_caddr_t) &(iclog->ic_header); +- if (INT_GET(*(uint *)ptr, ARCH_CONVERT) != XLOG_HEADER_MAGIC_NUM) ++ if (be32_to_cpu(iclog->ic_header.h_magicno) != XLOG_HEADER_MAGIC_NUM) + xlog_panic("xlog_verify_iclog: invalid magic num"); + ++ ptr = (xfs_caddr_t) &(iclog->ic_header); + for (ptr += BBSIZE; ptr < ((xfs_caddr_t)&(iclog->ic_header))+count; + ptr += BBSIZE) { +- if (INT_GET(*(uint *)ptr, ARCH_CONVERT) == XLOG_HEADER_MAGIC_NUM) ++ if (be32_to_cpu(*(__be32 *)ptr) == XLOG_HEADER_MAGIC_NUM) + xlog_panic("xlog_verify_iclog: unexpected magic num"); + } + + /* check fields */ +- len = INT_GET(iclog->ic_header.h_num_logops, ARCH_CONVERT); ++ len = be32_to_cpu(iclog->ic_header.h_num_logops); + ptr = iclog->ic_datap; + base_ptr = ptr; + ophead = (xlog_op_header_t *)ptr; +@@ -3517,9 +3495,11 @@ + if (idx >= (XLOG_HEADER_CYCLE_SIZE / BBSIZE)) { + j = idx / (XLOG_HEADER_CYCLE_SIZE / BBSIZE); + k = idx % (XLOG_HEADER_CYCLE_SIZE / BBSIZE); +- clientid = GET_CLIENT_ID(xhdr[j].hic_xheader.xh_cycle_data[k], ARCH_CONVERT); ++ clientid = xlog_get_client_id( ++ xhdr[j].hic_xheader.xh_cycle_data[k]); + } else { +- clientid = GET_CLIENT_ID(iclog->ic_header.h_cycle_data[idx], ARCH_CONVERT); ++ clientid = xlog_get_client_id( ++ iclog->ic_header.h_cycle_data[idx]); + } + } + if (clientid != XFS_TRANSACTION && clientid != XFS_LOG) +@@ -3531,16 +3511,16 @@ + field_offset = (__psint_t) + ((xfs_caddr_t)&(ophead->oh_len) - base_ptr); + if (syncing == B_FALSE || (field_offset & 0x1ff)) { +- op_len = INT_GET(ophead->oh_len, ARCH_CONVERT); ++ op_len = be32_to_cpu(ophead->oh_len); + } else { + idx = BTOBBT((__psint_t)&ophead->oh_len - + (__psint_t)iclog->ic_datap); + if (idx >= (XLOG_HEADER_CYCLE_SIZE / BBSIZE)) { + j = idx / (XLOG_HEADER_CYCLE_SIZE / BBSIZE); + k = idx % (XLOG_HEADER_CYCLE_SIZE / BBSIZE); +- op_len = INT_GET(xhdr[j].hic_xheader.xh_cycle_data[k], ARCH_CONVERT); ++ op_len = be32_to_cpu(xhdr[j].hic_xheader.xh_cycle_data[k]); + } else { +- op_len = INT_GET(iclog->ic_header.h_cycle_data[idx], ARCH_CONVERT); ++ op_len = be32_to_cpu(iclog->ic_header.h_cycle_data[idx]); + } + } + ptr += sizeof(xlog_op_header_t) + op_len; +@@ -3597,8 +3577,6 @@ + xlog_t *log; + int retval; + int dummy; +- SPLDECL(s); +- SPLDECL(s2); + + log = mp->m_log; + +@@ -3627,8 +3605,8 @@ + * before we mark the filesystem SHUTDOWN and wake + * everybody up to tell the bad news. + */ +- s = GRANT_LOCK(log); +- s2 = LOG_LOCK(log); ++ spin_lock(&log->l_grant_lock); ++ spin_lock(&log->l_icloglock); + mp->m_flags |= XFS_MOUNT_FS_SHUTDOWN; + XFS_BUF_DONE(mp->m_sb_bp); + /* +@@ -3644,7 +3622,7 @@ + */ + if (logerror) + retval = xlog_state_ioerror(log); +- LOG_UNLOCK(log, s2); ++ spin_unlock(&log->l_icloglock); + + /* + * We don't want anybody waiting for log reservations +@@ -3667,7 +3645,7 @@ + tic = tic->t_next; + } while (tic != log->l_write_headq); + } +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + + if (! (log->l_iclog->ic_state & XLOG_STATE_IOERROR)) { + ASSERT(!logerror); +@@ -3676,9 +3654,9 @@ + * log down completely. + */ + xlog_state_sync_all(log, XFS_LOG_FORCE|XFS_LOG_SYNC, &dummy); +- s2 = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + retval = xlog_state_ioerror(log); +- LOG_UNLOCK(log, s2); ++ spin_unlock(&log->l_icloglock); + } + /* + * Wake up everybody waiting on xfs_log_force. +@@ -3691,13 +3669,13 @@ + { + xlog_in_core_t *iclog; + +- s = LOG_LOCK(log); ++ spin_lock(&log->l_icloglock); + iclog = log->l_iclog; + do { + ASSERT(iclog->ic_callback == 0); + iclog = iclog->ic_next; + } while (iclog != log->l_iclog); +- LOG_UNLOCK(log, s); ++ spin_unlock(&log->l_icloglock); + } + #endif + /* return non-zero if log IOERROR transition had already happened */ +diff -Nurd linux-2.6.24/fs/xfs/xfs_log.h linux-2.6.24-oxe810/fs/xfs/xfs_log.h +--- linux-2.6.24/fs/xfs/xfs_log.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_log.h 2008-06-11 17:46:48.000000000 +0200 +@@ -23,7 +23,7 @@ + #define CYCLE_LSN(lsn) ((uint)((lsn)>>32)) + #define BLOCK_LSN(lsn) ((uint)(lsn)) + /* this is used in a spot where we might otherwise double-endian-flip */ +-#define CYCLE_LSN_DISK(lsn) (((uint *)&(lsn))[0]) ++#define CYCLE_LSN_DISK(lsn) (((__be32 *)&(lsn))[0]) + + #ifdef __KERNEL__ + /* +diff -Nurd linux-2.6.24/fs/xfs/xfs_log_priv.h linux-2.6.24-oxe810/fs/xfs/xfs_log_priv.h +--- linux-2.6.24/fs/xfs/xfs_log_priv.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_log_priv.h 2008-06-11 17:46:48.000000000 +0200 +@@ -55,29 +55,19 @@ + BTOBB(XLOG_MAX_ICLOGS << (XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb) ? \ + XLOG_MAX_RECORD_BSHIFT : XLOG_BIG_RECORD_BSHIFT)) + +-/* +- * set lsns +- */ +- +-#define ASSIGN_ANY_LSN_HOST(lsn,cycle,block) \ +- { \ +- (lsn) = ((xfs_lsn_t)(cycle)<<32)|(block); \ +- } +-#define ASSIGN_ANY_LSN_DISK(lsn,cycle,block) \ +- { \ +- INT_SET(((uint *)&(lsn))[0], ARCH_CONVERT, (cycle)); \ +- INT_SET(((uint *)&(lsn))[1], ARCH_CONVERT, (block)); \ +- } +-#define ASSIGN_LSN(lsn,log) \ +- ASSIGN_ANY_LSN_DISK(lsn,(log)->l_curr_cycle,(log)->l_curr_block); + +-#define XLOG_SET(f,b) (((f) & (b)) == (b)) ++static inline xfs_lsn_t xlog_assign_lsn(uint cycle, uint block) ++{ ++ return ((xfs_lsn_t)cycle << 32) | block; ++} + +-#define GET_CYCLE(ptr, arch) \ +- (INT_GET(*(uint *)(ptr), arch) == XLOG_HEADER_MAGIC_NUM ? \ +- INT_GET(*((uint *)(ptr)+1), arch) : \ +- INT_GET(*(uint *)(ptr), arch) \ +- ) ++static inline uint xlog_get_cycle(char *ptr) ++{ ++ if (be32_to_cpu(*(__be32 *)ptr) == XLOG_HEADER_MAGIC_NUM) ++ return be32_to_cpu(*((__be32 *)ptr + 1)); ++ else ++ return be32_to_cpu(*(__be32 *)ptr); ++} + + #define BLK_AVG(blk1, blk2) ((blk1+blk2) >> 1) + +@@ -97,18 +87,15 @@ + * this has endian issues, of course. + */ + +-#ifndef XFS_NATIVE_HOST +-#define GET_CLIENT_ID(i,arch) \ +- ((i) & 0xff) +-#else +-#define GET_CLIENT_ID(i,arch) \ +- ((i) >> 24) +-#endif ++static inline uint xlog_get_client_id(__be32 i) ++{ ++ return be32_to_cpu(i) >> 24; ++} + +-#define GRANT_LOCK(log) mutex_spinlock(&(log)->l_grant_lock) +-#define GRANT_UNLOCK(log, s) mutex_spinunlock(&(log)->l_grant_lock, s) +-#define LOG_LOCK(log) mutex_spinlock(&(log)->l_icloglock) +-#define LOG_UNLOCK(log, s) mutex_spinunlock(&(log)->l_icloglock, s) ++//#define GRANT_LOCK(log) mutex_spinlock(&(log)->l_grant_lock) ++//#define GRANT_UNLOCK(log, s) mutex_spinunlock(&(log)->l_grant_lock, s) ++//#define LOG_LOCK(log) mutex_spinlock(&(log)->l_icloglock) ++//#define LOG_UNLOCK(log, s) mutex_spinunlock(&(log)->l_icloglock, s) + + #define xlog_panic(args...) cmn_err(CE_PANIC, ## args) + #define xlog_exit(args...) cmn_err(CE_PANIC, ## args) +@@ -285,11 +272,11 @@ + + + typedef struct xlog_op_header { +- xlog_tid_t oh_tid; /* transaction id of operation : 4 b */ +- int oh_len; /* bytes in data region : 4 b */ +- __uint8_t oh_clientid; /* who sent me this : 1 b */ +- __uint8_t oh_flags; /* : 1 b */ +- ushort oh_res2; /* 32 bit align : 2 b */ ++ __be32 oh_tid; /* transaction id of operation : 4 b */ ++ __be32 oh_len; /* bytes in data region : 4 b */ ++ __u8 oh_clientid; /* who sent me this : 1 b */ ++ __u8 oh_flags; /* : 1 b */ ++ __u16 oh_res2; /* 32 bit align : 2 b */ + } xlog_op_header_t; + + +@@ -307,25 +294,25 @@ + #endif + + typedef struct xlog_rec_header { +- uint h_magicno; /* log record (LR) identifier : 4 */ +- uint h_cycle; /* write cycle of log : 4 */ +- int h_version; /* LR version : 4 */ +- int h_len; /* len in bytes; should be 64-bit aligned: 4 */ +- xfs_lsn_t h_lsn; /* lsn of this LR : 8 */ +- xfs_lsn_t h_tail_lsn; /* lsn of 1st LR w/ buffers not committed: 8 */ +- uint h_chksum; /* may not be used; non-zero if used : 4 */ +- int h_prev_block; /* block number to previous LR : 4 */ +- int h_num_logops; /* number of log operations in this LR : 4 */ +- uint h_cycle_data[XLOG_HEADER_CYCLE_SIZE / BBSIZE]; ++ __be32 h_magicno; /* log record (LR) identifier : 4 */ ++ __be32 h_cycle; /* write cycle of log : 4 */ ++ __be32 h_version; /* LR version : 4 */ ++ __be32 h_len; /* len in bytes; should be 64-bit aligned: 4 */ ++ __be64 h_lsn; /* lsn of this LR : 8 */ ++ __be64 h_tail_lsn; /* lsn of 1st LR w/ buffers not committed: 8 */ ++ __be32 h_chksum; /* may not be used; non-zero if used : 4 */ ++ __be32 h_prev_block; /* block number to previous LR : 4 */ ++ __be32 h_num_logops; /* number of log operations in this LR : 4 */ ++ __be32 h_cycle_data[XLOG_HEADER_CYCLE_SIZE / BBSIZE]; + /* new fields */ +- int h_fmt; /* format of log record : 4 */ +- uuid_t h_fs_uuid; /* uuid of FS : 16 */ +- int h_size; /* iclog size : 4 */ ++ __be32 h_fmt; /* format of log record : 4 */ ++ uuid_t h_fs_uuid; /* uuid of FS : 16 */ ++ __be32 h_size; /* iclog size : 4 */ + } xlog_rec_header_t; + + typedef struct xlog_rec_ext_header { +- uint xh_cycle; /* write cycle of log : 4 */ +- uint xh_cycle_data[XLOG_HEADER_CYCLE_SIZE / BBSIZE]; /* : 256 */ ++ __be32 xh_cycle; /* write cycle of log : 4 */ ++ __be32 xh_cycle_data[XLOG_HEADER_CYCLE_SIZE / BBSIZE]; /* : 256 */ + } xlog_rec_ext_header_t; + + #ifdef __KERNEL__ +@@ -464,12 +451,12 @@ + + #define XLOG_FORCED_SHUTDOWN(log) ((log)->l_flags & XLOG_IO_ERROR) + +- + /* common routines */ + extern xfs_lsn_t xlog_assign_tail_lsn(struct xfs_mount *mp); + extern int xlog_find_tail(xlog_t *log, + xfs_daddr_t *head_blk, + xfs_daddr_t *tail_blk); ++ + extern int xlog_recover(xlog_t *log); + extern int xlog_recover_finish(xlog_t *log, int mfsi_flags); + extern void xlog_pack_data(xlog_t *log, xlog_in_core_t *iclog, int); +diff -Nurd linux-2.6.24/fs/xfs/xfs_log_recover.c linux-2.6.24-oxe810/fs/xfs/xfs_log_recover.c +--- linux-2.6.24/fs/xfs/xfs_log_recover.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_log_recover.c 2008-06-11 17:46:48.000000000 +0200 +@@ -198,7 +198,7 @@ + cmn_err(CE_DEBUG, " log : uuid = "); + for (b = 0; b < 16; b++) + cmn_err(CE_DEBUG, "%02x",((uchar_t *)&head->h_fs_uuid)[b]); +- cmn_err(CE_DEBUG, ", fmt = %d\n", INT_GET(head->h_fmt, ARCH_CONVERT)); ++ cmn_err(CE_DEBUG, ", fmt = %d\n", be32_to_cpu(head->h_fmt)); + } + #else + #define xlog_header_check_dump(mp, head) +@@ -212,14 +212,14 @@ + xfs_mount_t *mp, + xlog_rec_header_t *head) + { +- ASSERT(INT_GET(head->h_magicno, ARCH_CONVERT) == XLOG_HEADER_MAGIC_NUM); ++ ASSERT(be32_to_cpu(head->h_magicno) == XLOG_HEADER_MAGIC_NUM); + + /* + * IRIX doesn't write the h_fmt field and leaves it zeroed + * (XLOG_FMT_UNKNOWN). This stops us from trying to recover + * a dirty log created in IRIX. + */ +- if (unlikely(INT_GET(head->h_fmt, ARCH_CONVERT) != XLOG_FMT)) { ++ if (unlikely(be32_to_cpu(head->h_fmt) != XLOG_FMT)) { + xlog_warn( + "XFS: dirty log written in incompatible format - can't recover"); + xlog_header_check_dump(mp, head); +@@ -245,7 +245,7 @@ + xfs_mount_t *mp, + xlog_rec_header_t *head) + { +- ASSERT(INT_GET(head->h_magicno, ARCH_CONVERT) == XLOG_HEADER_MAGIC_NUM); ++ ASSERT(be32_to_cpu(head->h_magicno) == XLOG_HEADER_MAGIC_NUM); + + if (uuid_is_nil(&head->h_fs_uuid)) { + /* +@@ -311,7 +311,7 @@ + if ((error = xlog_bread(log, mid_blk, 1, bp))) + return error; + offset = xlog_align(log, mid_blk, 1, bp); +- mid_cycle = GET_CYCLE(offset, ARCH_CONVERT); ++ mid_cycle = xlog_get_cycle(offset); + if (mid_cycle == cycle) { + *last_blk = mid_blk; + /* last_half_cycle == mid_cycle */ +@@ -371,7 +371,7 @@ + + buf = xlog_align(log, i, bcount, bp); + for (j = 0; j < bcount; j++) { +- cycle = GET_CYCLE(buf, ARCH_CONVERT); ++ cycle = xlog_get_cycle(buf); + if (cycle == stop_on_cycle_no) { + *new_blk = i+j; + goto out; +@@ -447,8 +447,7 @@ + + head = (xlog_rec_header_t *)offset; + +- if (XLOG_HEADER_MAGIC_NUM == +- INT_GET(head->h_magicno, ARCH_CONVERT)) ++ if (XLOG_HEADER_MAGIC_NUM == be32_to_cpu(head->h_magicno)) + break; + + if (!smallmem) +@@ -480,7 +479,7 @@ + * record do we update last_blk. + */ + if (XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb)) { +- uint h_size = INT_GET(head->h_size, ARCH_CONVERT); ++ uint h_size = be32_to_cpu(head->h_size); + + xhdrs = h_size / XLOG_HEADER_CYCLE_SIZE; + if (h_size % XLOG_HEADER_CYCLE_SIZE) +@@ -489,8 +488,8 @@ + xhdrs = 1; + } + +- if (*last_blk - i + extra_bblks +- != BTOBB(INT_GET(head->h_len, ARCH_CONVERT)) + xhdrs) ++ if (*last_blk - i + extra_bblks != ++ BTOBB(be32_to_cpu(head->h_len)) + xhdrs) + *last_blk = i; + + out: +@@ -550,13 +549,13 @@ + if ((error = xlog_bread(log, 0, 1, bp))) + goto bp_err; + offset = xlog_align(log, 0, 1, bp); +- first_half_cycle = GET_CYCLE(offset, ARCH_CONVERT); ++ first_half_cycle = xlog_get_cycle(offset); + + last_blk = head_blk = log_bbnum - 1; /* get cycle # of last block */ + if ((error = xlog_bread(log, last_blk, 1, bp))) + goto bp_err; + offset = xlog_align(log, last_blk, 1, bp); +- last_half_cycle = GET_CYCLE(offset, ARCH_CONVERT); ++ last_half_cycle = xlog_get_cycle(offset); + ASSERT(last_half_cycle != 0); + + /* +@@ -799,21 +798,27 @@ + * Find previous log record + */ + if ((error = xlog_find_head(log, head_blk))) ++ { ++ xlog_warn("XFS: xlog_find_tail: couldn't find previous log record \n"); + return error; ++ } + + bp = xlog_get_bp(log, 1); + if (!bp) ++ { ++ xlog_warn("XFS: xlog_find_tail: ENOMEM \n"); + return ENOMEM; ++ } + if (*head_blk == 0) { /* special case */ + if ((error = xlog_bread(log, 0, 1, bp))) + goto bread_err; + offset = xlog_align(log, 0, 1, bp); +- if (GET_CYCLE(offset, ARCH_CONVERT) == 0) { ++ if (xlog_get_cycle(offset) == 0) { + *tail_blk = 0; + /* leave all other log inited values alone */ + goto exit; + } +- } ++ } + + /* + * Search backwards looking for log record header block +@@ -823,8 +828,7 @@ + if ((error = xlog_bread(log, i, 1, bp))) + goto bread_err; + offset = xlog_align(log, i, 1, bp); +- if (XLOG_HEADER_MAGIC_NUM == +- INT_GET(*(uint *)offset, ARCH_CONVERT)) { ++ if (XLOG_HEADER_MAGIC_NUM == be32_to_cpu(*(__be32 *)offset)) { + found = 1; + break; + } +@@ -841,7 +845,7 @@ + goto bread_err; + offset = xlog_align(log, i, 1, bp); + if (XLOG_HEADER_MAGIC_NUM == +- INT_GET(*(uint*)offset, ARCH_CONVERT)) { ++ be32_to_cpu(*(__be32 *)offset)) { + found = 2; + break; + } +@@ -855,7 +859,7 @@ + + /* find blk_no of tail of log */ + rhead = (xlog_rec_header_t *)offset; +- *tail_blk = BLOCK_LSN(INT_GET(rhead->h_tail_lsn, ARCH_CONVERT)); ++ *tail_blk = BLOCK_LSN(be64_to_cpu(rhead->h_tail_lsn)); + + /* + * Reset log values according to the state of the log when we +@@ -869,11 +873,11 @@ + */ + log->l_prev_block = i; + log->l_curr_block = (int)*head_blk; +- log->l_curr_cycle = INT_GET(rhead->h_cycle, ARCH_CONVERT); ++ log->l_curr_cycle = be32_to_cpu(rhead->h_cycle); + if (found == 2) + log->l_curr_cycle++; +- log->l_tail_lsn = INT_GET(rhead->h_tail_lsn, ARCH_CONVERT); +- log->l_last_sync_lsn = INT_GET(rhead->h_lsn, ARCH_CONVERT); ++ log->l_tail_lsn = be64_to_cpu(rhead->h_tail_lsn); ++ log->l_last_sync_lsn = be64_to_cpu(rhead->h_lsn); + log->l_grant_reserve_cycle = log->l_curr_cycle; + log->l_grant_reserve_bytes = BBTOB(log->l_curr_block); + log->l_grant_write_cycle = log->l_curr_cycle; +@@ -891,8 +895,8 @@ + * unmount record rather than the block after it. + */ + if (XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb)) { +- int h_size = INT_GET(rhead->h_size, ARCH_CONVERT); +- int h_version = INT_GET(rhead->h_version, ARCH_CONVERT); ++ int h_size = be32_to_cpu(rhead->h_size); ++ int h_version = be32_to_cpu(rhead->h_version); + + if ((h_version & XLOG_VERSION_2) && + (h_size > XLOG_HEADER_CYCLE_SIZE)) { +@@ -905,11 +909,12 @@ + } else { + hblks = 1; + } ++ + after_umount_blk = (i + hblks + (int) +- BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT))) % log->l_logBBsize; ++ BTOBB(be32_to_cpu(rhead->h_len))) % log->l_logBBsize; + tail_lsn = log->l_tail_lsn; + if (*head_blk == after_umount_blk && +- INT_GET(rhead->h_num_logops, ARCH_CONVERT) == 1) { ++ be32_to_cpu(rhead->h_num_logops) == 1) { + umount_data_blk = (i + hblks) % log->l_logBBsize; + if ((error = xlog_bread(log, umount_data_blk, 1, bp))) { + goto bread_err; +@@ -922,10 +927,12 @@ + * log records will point recovery to after the + * current unmount record. + */ +- ASSIGN_ANY_LSN_HOST(log->l_tail_lsn, log->l_curr_cycle, +- after_umount_blk); +- ASSIGN_ANY_LSN_HOST(log->l_last_sync_lsn, log->l_curr_cycle, +- after_umount_blk); ++ log->l_tail_lsn = ++ xlog_assign_lsn(log->l_curr_cycle, ++ after_umount_blk); ++ log->l_last_sync_lsn = ++ xlog_assign_lsn(log->l_curr_cycle, ++ after_umount_blk); + *tail_blk = after_umount_blk; + + /* +@@ -986,7 +993,7 @@ + * -1 => use *blk_no as the first block of the log + * >0 => error has occurred + */ +-int ++STATIC int + xlog_find_zeroed( + xlog_t *log, + xfs_daddr_t *blk_no) +@@ -1007,7 +1014,7 @@ + if ((error = xlog_bread(log, 0, 1, bp))) + goto bp_err; + offset = xlog_align(log, 0, 1, bp); +- first_cycle = GET_CYCLE(offset, ARCH_CONVERT); ++ first_cycle = xlog_get_cycle(offset); + if (first_cycle == 0) { /* completely zeroed log */ + *blk_no = 0; + xlog_put_bp(bp); +@@ -1018,7 +1025,7 @@ + if ((error = xlog_bread(log, log_bbnum-1, 1, bp))) + goto bp_err; + offset = xlog_align(log, log_bbnum-1, 1, bp); +- last_cycle = GET_CYCLE(offset, ARCH_CONVERT); ++ last_cycle = xlog_get_cycle(offset); + if (last_cycle != 0) { /* log completely written to */ + xlog_put_bp(bp); + return 0; +@@ -1098,13 +1105,13 @@ + xlog_rec_header_t *recp = (xlog_rec_header_t *)buf; + + memset(buf, 0, BBSIZE); +- INT_SET(recp->h_magicno, ARCH_CONVERT, XLOG_HEADER_MAGIC_NUM); +- INT_SET(recp->h_cycle, ARCH_CONVERT, cycle); +- INT_SET(recp->h_version, ARCH_CONVERT, ++ recp->h_magicno = cpu_to_be32(XLOG_HEADER_MAGIC_NUM); ++ recp->h_cycle = cpu_to_be32(cycle); ++ recp->h_version = cpu_to_be32( + XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb) ? 2 : 1); +- ASSIGN_ANY_LSN_DISK(recp->h_lsn, cycle, block); +- ASSIGN_ANY_LSN_DISK(recp->h_tail_lsn, tail_cycle, tail_block); +- INT_SET(recp->h_fmt, ARCH_CONVERT, XLOG_FMT); ++ recp->h_lsn = cpu_to_be64(xlog_assign_lsn(cycle, block)); ++ recp->h_tail_lsn = cpu_to_be64(xlog_assign_lsn(tail_cycle, tail_block)); ++ recp->h_fmt = cpu_to_be32(XLOG_FMT); + memcpy(&recp->h_fs_uuid, &log->l_mp->m_sb.sb_uuid, sizeof(uuid_t)); + } + +@@ -1214,6 +1221,11 @@ + head_cycle = log->l_curr_cycle; + head_block = log->l_curr_block; + ++ /* Temp fix - to ensure that the tail cycle and tail blocks both are never 0 ++ */ ++ if ((tail_cycle == 0) && (tail_block == 0)) ++ tail_cycle = head_cycle; ++ + /* + * Figure out the distance between the new head of the log + * and the tail. We want to write over any blocks beyond the +@@ -1231,6 +1243,8 @@ + if (unlikely(head_block < tail_block || head_block >= log->l_logBBsize)) { + XFS_ERROR_REPORT("xlog_clear_stale_blocks(1)", + XFS_ERRLEVEL_LOW, log->l_mp); ++ printk(KERN_INFO "XFS: head_blk %d tail_blk %d head_cycle %d tail_cycle %d \n",\ ++ head_block, tail_block, head_cycle, tail_cycle); + return XFS_ERROR(EFSCORRUPTED); + } + tail_distance = tail_block + (log->l_logBBsize - head_block); +@@ -1243,6 +1257,8 @@ + if (unlikely(head_block >= tail_block || head_cycle != (tail_cycle + 1))){ + XFS_ERROR_REPORT("xlog_clear_stale_blocks(2)", + XFS_ERRLEVEL_LOW, log->l_mp); ++ printk(KERN_INFO "XFS: head_blk %d tail_blk %d head_cycle %d tail_cycle %d \n",\ ++ head_block, tail_block, head_cycle, tail_cycle); + return XFS_ERROR(EFSCORRUPTED); + } + tail_distance = tail_block - head_block; +@@ -2211,7 +2227,7 @@ + * overlap with future reads of those inodes. + */ + if (XFS_DINODE_MAGIC == +- INT_GET(*((__uint16_t *)(xfs_buf_offset(bp, 0))), ARCH_CONVERT) && ++ be16_to_cpu(*((__be16 *)xfs_buf_offset(bp, 0))) && + (XFS_BUF_COUNT(bp) != MAX(log->l_mp->m_sb.sb_blocksize, + (__uint32_t)XFS_INODE_CLUSTER_SIZE(log->l_mp)))) { + XFS_BUF_STALE(bp); +@@ -2581,8 +2597,7 @@ + /* + * This type of quotas was turned off, so ignore this record. + */ +- type = INT_GET(recddq->d_flags, ARCH_CONVERT) & +- (XFS_DQ_USER | XFS_DQ_PROJ | XFS_DQ_GROUP); ++ type = recddq->d_flags & (XFS_DQ_USER | XFS_DQ_PROJ | XFS_DQ_GROUP); + ASSERT(type); + if (log->l_quotaoffs_flag & type) + return (0); +@@ -2736,21 +2751,13 @@ + * AIL lock. + */ + xfs_trans_delete_ail(mp, lip, s); +- break; ++ xfs_efi_item_free(efip); ++ return; + } + } + lip = xfs_trans_next_ail(mp, lip, &gen, NULL); + } +- +- /* +- * If we found it, then free it up. If it wasn't there, it +- * must have been overwritten in the log. Oh well. +- */ +- if (lip != NULL) { +- xfs_efi_item_free(efip); +- } else { +- AIL_UNLOCK(mp, s); +- } ++ AIL_UNLOCK(mp, s); + } + + /* +@@ -2897,8 +2904,8 @@ + unsigned long hash; + uint flags; + +- lp = dp + INT_GET(rhead->h_len, ARCH_CONVERT); +- num_logops = INT_GET(rhead->h_num_logops, ARCH_CONVERT); ++ lp = dp + be32_to_cpu(rhead->h_len); ++ num_logops = be32_to_cpu(rhead->h_num_logops); + + /* check the log format matches our own - else we can't recover */ + if (xlog_header_check_recover(log->l_mp, rhead)) +@@ -2912,18 +2919,28 @@ + ohead->oh_clientid != XFS_LOG) { + xlog_warn( + "XFS: xlog_recover_process_data: bad clientid"); ++ printk(KERN_INFO "Ticket ID - %d\n", ohead->oh_tid); ++ printk(KERN_INFO "Bytes in Data Region - %d\n", ohead->oh_len); ++ printk(KERN_INFO "Client ID - %d\n", ohead->oh_clientid); ++ printk(KERN_INFO "Flags - %d\n", ohead->oh_flags); ++ printk(KERN_INFO "Unused - %d\n", ohead->oh_res2); + ASSERT(0); + return (XFS_ERROR(EIO)); + } +- tid = INT_GET(ohead->oh_tid, ARCH_CONVERT); ++ tid = be32_to_cpu(ohead->oh_tid); + hash = XLOG_RHASH(tid); + trans = xlog_recover_find_tid(rhash[hash], tid); + if (trans == NULL) { /* not found; add new tid */ + if (ohead->oh_flags & XLOG_START_TRANS) + xlog_recover_new_tid(&rhash[hash], tid, +- INT_GET(rhead->h_lsn, ARCH_CONVERT)); ++ be64_to_cpu(rhead->h_lsn)); + } else { +- ASSERT(dp+INT_GET(ohead->oh_len, ARCH_CONVERT) <= lp); ++ if (dp + be32_to_cpu(ohead->oh_len) > lp) { ++ xlog_warn( ++ "XFS: xlog_recover_process_data: bad length"); ++ WARN_ON(1); ++ return (XFS_ERROR(EIO)); ++ } + flags = ohead->oh_flags & ~XLOG_END_TRANS; + if (flags & XLOG_WAS_CONT_TRANS) + flags &= ~XLOG_CONTINUE_TRANS; +@@ -2937,8 +2954,7 @@ + break; + case XLOG_WAS_CONT_TRANS: + error = xlog_recover_add_to_cont_trans(trans, +- dp, INT_GET(ohead->oh_len, +- ARCH_CONVERT)); ++ dp, be32_to_cpu(ohead->oh_len)); + break; + case XLOG_START_TRANS: + xlog_warn( +@@ -2949,8 +2965,7 @@ + case 0: + case XLOG_CONTINUE_TRANS: + error = xlog_recover_add_to_trans(trans, +- dp, INT_GET(ohead->oh_len, +- ARCH_CONVERT)); ++ dp, be32_to_cpu(ohead->oh_len)); + break; + default: + xlog_warn( +@@ -2962,7 +2977,7 @@ + if (error) + return error; + } +- dp += INT_GET(ohead->oh_len, ARCH_CONVERT); ++ dp += be32_to_cpu(ohead->oh_len); + num_logops--; + } + return 0; +@@ -3315,16 +3330,16 @@ + int size) + { + int i; +- uint *up; ++ __be32 *up; + uint chksum = 0; + +- up = (uint *)iclog->ic_datap; ++ up = (__be32 *)iclog->ic_datap; + /* divide length by 4 to get # words */ + for (i = 0; i < (size >> 2); i++) { +- chksum ^= INT_GET(*up, ARCH_CONVERT); ++ chksum ^= be32_to_cpu(*up); + up++; + } +- INT_SET(iclog->ic_header.h_chksum, ARCH_CONVERT, chksum); ++ iclog->ic_header.h_chksum = cpu_to_be32(chksum); + } + #else + #define xlog_pack_data_checksum(log, iclog, size) +@@ -3341,7 +3356,7 @@ + { + int i, j, k; + int size = iclog->ic_offset + roundoff; +- uint cycle_lsn; ++ __be32 cycle_lsn; + xfs_caddr_t dp; + xlog_in_core_2_t *xhdr; + +@@ -3352,8 +3367,8 @@ + dp = iclog->ic_datap; + for (i = 0; i < BTOBB(size) && + i < (XLOG_HEADER_CYCLE_SIZE / BBSIZE); i++) { +- iclog->ic_header.h_cycle_data[i] = *(uint *)dp; +- *(uint *)dp = cycle_lsn; ++ iclog->ic_header.h_cycle_data[i] = *(__be32 *)dp; ++ *(__be32 *)dp = cycle_lsn; + dp += BBSIZE; + } + +@@ -3362,8 +3377,8 @@ + for ( ; i < BTOBB(size); i++) { + j = i / (XLOG_HEADER_CYCLE_SIZE / BBSIZE); + k = i % (XLOG_HEADER_CYCLE_SIZE / BBSIZE); +- xhdr[j].hic_xheader.xh_cycle_data[k] = *(uint *)dp; +- *(uint *)dp = cycle_lsn; ++ xhdr[j].hic_xheader.xh_cycle_data[k] = *(__be32 *)dp; ++ *(__be32 *)dp = cycle_lsn; + dp += BBSIZE; + } + +@@ -3380,21 +3395,21 @@ + xfs_caddr_t dp, + xlog_t *log) + { +- uint *up = (uint *)dp; ++ __be32 *up = (__be32 *)dp; + uint chksum = 0; + int i; + + /* divide length by 4 to get # words */ +- for (i=0; i < INT_GET(rhead->h_len, ARCH_CONVERT) >> 2; i++) { +- chksum ^= INT_GET(*up, ARCH_CONVERT); ++ for (i=0; i < be32_to_cpu(rhead->h_len) >> 2; i++) { ++ chksum ^= be32_to_cpu(*up); + up++; + } +- if (chksum != INT_GET(rhead->h_chksum, ARCH_CONVERT)) { ++ if (chksum != be32_to_cpu(rhead->h_chksum)) { + if (rhead->h_chksum || + ((log->l_flags & XLOG_CHKSUM_MISMATCH) == 0)) { + cmn_err(CE_DEBUG, + "XFS: LogR chksum mismatch: was (0x%x) is (0x%x)\n", +- INT_GET(rhead->h_chksum, ARCH_CONVERT), chksum); ++ be32_to_cpu(rhead->h_chksum), chksum); + cmn_err(CE_DEBUG, + "XFS: Disregard message if filesystem was created with non-DEBUG kernel"); + if (XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb)) { +@@ -3418,18 +3433,18 @@ + int i, j, k; + xlog_in_core_2_t *xhdr; + +- for (i = 0; i < BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT)) && ++ for (i = 0; i < BTOBB(be32_to_cpu(rhead->h_len)) && + i < (XLOG_HEADER_CYCLE_SIZE / BBSIZE); i++) { +- *(uint *)dp = *(uint *)&rhead->h_cycle_data[i]; ++ *(__be32 *)dp = *(__be32 *)&rhead->h_cycle_data[i]; + dp += BBSIZE; + } + + if (XFS_SB_VERSION_HASLOGV2(&log->l_mp->m_sb)) { + xhdr = (xlog_in_core_2_t *)rhead; +- for ( ; i < BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT)); i++) { ++ for ( ; i < BTOBB(be32_to_cpu(rhead->h_len)); i++) { + j = i / (XLOG_HEADER_CYCLE_SIZE / BBSIZE); + k = i % (XLOG_HEADER_CYCLE_SIZE / BBSIZE); +- *(uint *)dp = xhdr[j].hic_xheader.xh_cycle_data[k]; ++ *(__be32 *)dp = xhdr[j].hic_xheader.xh_cycle_data[k]; + dp += BBSIZE; + } + } +@@ -3445,24 +3460,21 @@ + { + int hlen; + +- if (unlikely( +- (INT_GET(rhead->h_magicno, ARCH_CONVERT) != +- XLOG_HEADER_MAGIC_NUM))) { ++ if (unlikely(be32_to_cpu(rhead->h_magicno) != XLOG_HEADER_MAGIC_NUM)) { + XFS_ERROR_REPORT("xlog_valid_rec_header(1)", + XFS_ERRLEVEL_LOW, log->l_mp); + return XFS_ERROR(EFSCORRUPTED); + } + if (unlikely( + (!rhead->h_version || +- (INT_GET(rhead->h_version, ARCH_CONVERT) & +- (~XLOG_VERSION_OKBITS)) != 0))) { ++ (be32_to_cpu(rhead->h_version) & (~XLOG_VERSION_OKBITS))))) { + xlog_warn("XFS: %s: unrecognised log version (%d).", +- __FUNCTION__, INT_GET(rhead->h_version, ARCH_CONVERT)); ++ __FUNCTION__, be32_to_cpu(rhead->h_version)); + return XFS_ERROR(EIO); + } + + /* LR body must have data or it wouldn't have been written */ +- hlen = INT_GET(rhead->h_len, ARCH_CONVERT); ++ hlen = be32_to_cpu(rhead->h_len); + if (unlikely( hlen <= 0 || hlen > INT_MAX )) { + XFS_ERROR_REPORT("xlog_valid_rec_header(2)", + XFS_ERRLEVEL_LOW, log->l_mp); +@@ -3522,9 +3534,8 @@ + error = xlog_valid_rec_header(log, rhead, tail_blk); + if (error) + goto bread_err1; +- h_size = INT_GET(rhead->h_size, ARCH_CONVERT); +- if ((INT_GET(rhead->h_version, ARCH_CONVERT) +- & XLOG_VERSION_2) && ++ h_size = be32_to_cpu(rhead->h_size); ++ if ((be32_to_cpu(rhead->h_version) & XLOG_VERSION_2) && + (h_size > XLOG_HEADER_CYCLE_SIZE)) { + hblks = h_size / XLOG_HEADER_CYCLE_SIZE; + if (h_size % XLOG_HEADER_CYCLE_SIZE) +@@ -3561,7 +3572,7 @@ + goto bread_err2; + + /* blocks in data section */ +- bblks = (int)BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT)); ++ bblks = (int)BTOBB(be32_to_cpu(rhead->h_len)); + error = xlog_bread(log, blk_no + hblks, bblks, dbp); + if (error) + goto bread_err2; +@@ -3636,7 +3647,7 @@ + if (error) + goto bread_err2; + +- bblks = (int)BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT)); ++ bblks = (int)BTOBB(be32_to_cpu(rhead->h_len)); + blk_no += hblks; + + /* Read in data for log record */ +@@ -3707,7 +3718,7 @@ + error = xlog_valid_rec_header(log, rhead, blk_no); + if (error) + goto bread_err2; +- bblks = (int)BTOBB(INT_GET(rhead->h_len, ARCH_CONVERT)); ++ bblks = (int)BTOBB(be32_to_cpu(rhead->h_len)); + if ((error = xlog_bread(log, blk_no+hblks, bblks, dbp))) + goto bread_err2; + offset = xlog_align(log, blk_no+hblks, bblks, dbp); +@@ -3878,7 +3889,12 @@ + + /* find the tail of the log */ + if ((error = xlog_find_tail(log, &head_blk, &tail_blk))) ++ { ++ cmn_err(CE_NOTE, "Log head - 0x%llx Log Tail - 0x%llx \n",\ ++ (unsigned long long)head_blk, \ ++ (unsigned long long)tail_blk); + return error; ++ } + + if (tail_blk != head_blk) { + /* There used to be a comment here: +diff -Nurd linux-2.6.24/fs/xfs/xfs_trans.c linux-2.6.24-oxe810/fs/xfs/xfs_trans.c +--- linux-2.6.24/fs/xfs/xfs_trans.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_trans.c 2008-06-11 17:46:48.000000000 +0200 +@@ -567,26 +567,26 @@ + */ + if (!xfs_sb_version_haslazysbcount(&(tp->t_mountp->m_sb))) { + if (tp->t_icount_delta) +- be64_add(&sbp->sb_icount, tp->t_icount_delta); ++ be64_add_cpu(&sbp->sb_icount, tp->t_icount_delta); + if (tp->t_ifree_delta) +- be64_add(&sbp->sb_ifree, tp->t_ifree_delta); ++ be64_add_cpu(&sbp->sb_ifree, tp->t_ifree_delta); + if (tp->t_fdblocks_delta) +- be64_add(&sbp->sb_fdblocks, tp->t_fdblocks_delta); ++ be64_add_cpu(&sbp->sb_fdblocks, tp->t_fdblocks_delta); + if (tp->t_res_fdblocks_delta) +- be64_add(&sbp->sb_fdblocks, tp->t_res_fdblocks_delta); ++ be64_add_cpu(&sbp->sb_fdblocks, tp->t_res_fdblocks_delta); + } + + if (tp->t_frextents_delta) +- be64_add(&sbp->sb_frextents, tp->t_frextents_delta); ++ be64_add_cpu(&sbp->sb_frextents, tp->t_frextents_delta); + if (tp->t_res_frextents_delta) +- be64_add(&sbp->sb_frextents, tp->t_res_frextents_delta); ++ be64_add_cpu(&sbp->sb_frextents, tp->t_res_frextents_delta); + + if (tp->t_dblocks_delta) { +- be64_add(&sbp->sb_dblocks, tp->t_dblocks_delta); ++ be64_add_cpu(&sbp->sb_dblocks, tp->t_dblocks_delta); + whole = 1; + } + if (tp->t_agcount_delta) { +- be32_add(&sbp->sb_agcount, tp->t_agcount_delta); ++ be32_add_cpu(&sbp->sb_agcount, tp->t_agcount_delta); + whole = 1; + } + if (tp->t_imaxpct_delta) { +@@ -594,19 +594,19 @@ + whole = 1; + } + if (tp->t_rextsize_delta) { +- be32_add(&sbp->sb_rextsize, tp->t_rextsize_delta); ++ be32_add_cpu(&sbp->sb_rextsize, tp->t_rextsize_delta); + whole = 1; + } + if (tp->t_rbmblocks_delta) { +- be32_add(&sbp->sb_rbmblocks, tp->t_rbmblocks_delta); ++ be32_add_cpu(&sbp->sb_rbmblocks, tp->t_rbmblocks_delta); + whole = 1; + } + if (tp->t_rblocks_delta) { +- be64_add(&sbp->sb_rblocks, tp->t_rblocks_delta); ++ be64_add_cpu(&sbp->sb_rblocks, tp->t_rblocks_delta); + whole = 1; + } + if (tp->t_rextents_delta) { +- be64_add(&sbp->sb_rextents, tp->t_rextents_delta); ++ be64_add_cpu(&sbp->sb_rextents, tp->t_rextents_delta); + whole = 1; + } + if (tp->t_rextslog_delta) { +diff -Nurd linux-2.6.24/fs/xfs/xfs_vnodeops.c linux-2.6.24-oxe810/fs/xfs/xfs_vnodeops.c +--- linux-2.6.24/fs/xfs/xfs_vnodeops.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/fs/xfs/xfs_vnodeops.c 2008-06-11 17:46:48.000000000 +0200 +@@ -3558,11 +3558,11 @@ + if (iip && iip->ili_last_lsn) { + xlog_t *log = mp->m_log; + xfs_lsn_t sync_lsn; +- int s, log_flags = XFS_LOG_FORCE; ++ int log_flags = XFS_LOG_FORCE; + +- s = GRANT_LOCK(log); ++ spin_lock(&log->l_grant_lock); + sync_lsn = log->l_last_sync_lsn; +- GRANT_UNLOCK(log, s); ++ spin_unlock(&log->l_grant_lock); + + if ((XFS_LSN_CMP(iip->ili_last_lsn, sync_lsn) > 0)) { + if (flags & FLUSH_SYNC) +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/GPIO_PST_FunctionEnables.inc linux-2.6.24-oxe810/include/asm-arm/arch-hipox/GPIO_PST_FunctionEnables.inc +--- linux-2.6.24/include/asm-arm/arch-hipox/GPIO_PST_FunctionEnables.inc 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/GPIO_PST_FunctionEnables.inc 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,91 @@ ++/** ++ * -- GPIO Function Enable Mappings -- ++ * Auto Generated by asic/chips/nas/root.user/docs/specs/map2CInlude ++ */ ++// GPIO Primary Function Enables ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_GNT_N0 (0) // As Output ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_GNT_N1 (1) // As Output ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_GNT_N2 (2) // As Output ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_GNT_N3 (3) // As Output ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_REQ_N0 (4) // As Input ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_REQ_N1 (5) // As Input ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_REQ_N2 (6) // As Input ++#define PRIMARY_FUNCTION_ENABLE_SYSPCI_REQ_N3 (7) // As Input ++#define PRIMARY_FUNCTION_ENABLE_PCI_CKO (8) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_OE_N (12) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR21 (13) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR20 (14) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR19 (15) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR18 (16) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR17 (17) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_ADDR16 (18) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_CS_N0 (19) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_CS_N1 (20) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_WE_N0 (21) // As Output ++#define PRIMARY_FUNCTION_ENABLE_STATIC_WE_N1 (22) // As Output ++#define PRIMARY_FUNCTION_ENABLE_USBA_PWRO (23) // As Output ++#define PRIMARY_FUNCTION_ENABLE_USBA_OVERI (24) // As Input ++#define PRIMARY_FUNCTION_ENABLE_USBB_PWRO (25) // As Output ++#define PRIMARY_FUNCTION_ENABLE_USBB_OVERI (26) // As Input ++#define PRIMARY_FUNCTION_ENABLE_USBC_PWRO (27) // As Output ++#define PRIMARY_FUNCTION_ENABLE_USBC_OVERI (28) // As Input ++#define PRIMARY_FUNCTION_ENABLE_FAN_TEMP (29) // Is Bidirectional ++#define PRIMARY_FUNCTION_ENABLE_FAN_TACHO (30) // As Input ++#define PRIMARY_FUNCTION_ENABLE_FAN_PWM0 (31) // As Output ++#define PRIMARY_FUNCTION_ENABLE_FAN_PWM1 (32) // As Output ++#define PRIMARY_FUNCTION_ENABLE_IBIW_D (33) // Is Bidirectional ++#define PRIMARY_FUNCTION_ENABLE_IBIW_LED (34) // As Output ++// GPIO Secondary Function Enables ++#define SECONDARY_FUNCTION_ENABLE_SYSPCI_REQ_OUT_N (0) // As Output ++#define SECONDARY_FUNCTION_ENABLE_SYSPCI_GNT_IN_N (1) // As Input ++#define SECONDARY_FUNCTION_ENABLE_PCI_IDSEL (2) // As Input ++#define SECONDARY_FUNCTION_ENABLE_IRRX_IN (3) // As Input ++#define SECONDARY_FUNCTION_ENABLE_FAN_PWM3 (5) // As Output ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TX_BITCK (6) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TXLRCK (7) // As Input ++#define SECONDARY_FUNCTION_ENABLE_FAN_PWM2 (8) // As Output ++#define SECONDARY_FUNCTION_ENABLE_USB_CKO (10) // As Output ++#define SECONDARY_FUNCTION_ENABLE_PCI_CCLKRUN_N (12) // Is Bidirectional ++#define SECONDARY_FUNCTION_ENABLE_PCI_LOCK_N (13) // As Input ++#define SECONDARY_FUNCTION_ENABLE_PCI_PERR_N (14) // Is Bidirectional ++#define SECONDARY_FUNCTION_ENABLE_PCI_SERR_N (15) // As Output ++#define SECONDARY_FUNCTION_ENABLE_MEM_DLLTGL (16) // As Output ++#define SECONDARY_FUNCTION_ENABLE_SATA_OBS_RBC0 (17) // As Output ++#define SECONDARY_FUNCTION_ENABLE_PCI_CINT_N (18) // As Output ++#define SECONDARY_FUNCTION_ENABLE_PCI_CSTSCHG_N (19) // As Output ++#define SECONDARY_FUNCTION_ENABLE_PCI_CKO (23) // As Output ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TXD0 (25) // As Output ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RXD0 (26) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RXLRCK (27) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RX_BITCK (28) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TXD2 (29) // As Output ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RXD2 (30) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TXD3 (31) // As Output ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RXD3 (32) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_RXD1 (33) // As Input ++#define SECONDARY_FUNCTION_ENABLE_AUDIO_TXD1 (34) // As Output ++// GPIO Tertiary Function Enables ++#define TERTIARY_FUNCTION_ENABLE_UART3_RI_N (0) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART3_CD_N (1) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART3_CTS_N (2) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART3_DSR_N (3) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART3_DTR_N (4) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART3_RTS_N (5) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART3_SIN (6) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART3_SOUT (7) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART2_DSR_N (8) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART2_RTS_N (9) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART2_SOUT (20) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART2_SIN (22) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART2_RI_N (23) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART2_CD_N (24) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART2_DTR_N (25) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART2_CTS_N (26) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_RTS_N (27) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART1_CTS_N (28) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_DSR_N (29) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_CD_N (30) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_SOUT (31) // As Output ++#define TERTIARY_FUNCTION_ENABLE_UART1_SIN (32) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_RI_N (33) // As Input ++#define TERTIARY_FUNCTION_ENABLE_UART1_DTR_N (34) // As Output +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/ahb_mon.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/ahb_mon.h +--- linux-2.6.24/include/asm-arm/arch-hipox/ahb_mon.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/ahb_mon.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,27 @@ ++/* linux/include/asm-arm/arch-hipox/ahb_mon.h ++ * ++ * 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. ++ */ ++#ifdef CONFIG_HIPOX_AHB_MON ++ ++#if !defined(__AHB_MON_H__) ++#define __AHB_MON_H__ ++ ++extern void init_ahb_monitors( ++ AHB_MON_HWRITE_T ahb_mon_hwrite, ++ unsigned hburst_mask, ++ unsigned hburst_match, ++ unsigned hprot_mask, ++ unsigned hprot_match); ++extern void restart_ahb_monitors(void); ++extern void read_ahb_monitors(void); ++#else // CONFIG_HIPOX_AHB_MON ++#define init_ahb_monitors(a, b, c, d, e) {} ++#define restart_ahb_monitors(x) {} ++#define read_ahb_monitors(x) {} ++ ++#endif // #if !defined(__AHB_MON_H__) ++#endif // CONFIG_HIPOX_AHB_MON ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/cipher.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/cipher.h +--- linux-2.6.24/include/asm-arm/arch-hipox/cipher.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/cipher.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,139 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/cipher.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ * ++ * Register locations in the cipher core ++ * ++ */ ++ ++#ifndef __ASM_ARCH_CIPHER_H ++#define __ASM_ARCH_CIPHER_H ++ ++#define OX800DPE_CTL_DIRECTION_ENC 0x002 ++#define OX800DPE_CTL_PRIMARY_IS_KEY3 0x004 ++#define OX800DPE_CTL_ENCRYPT_KEY 0x010 ++#define OX800DPE_CTL_ABORT 0x040 ++#define OX800DPE_CTL_MODE_ECB_AES 0x000 ++#define OX800DPE_CTL_MODE_LRW_AES 0x080 ++#define OX800DPE_CTL_MODE_CBC_AES 0x100 ++ ++ ++#define OX800DPE_STAT_IDLE 0x1 ++#define OX800DPE_STAT_RX_SPACE 0x4 ++#define OX800DPE_STAT_TX_NOTEMPTY 0x8 ++ ++ ++#define OX800DPE_KEYSIZE 16 ++typedef volatile u32 hipox_cipher_key_t[4]; ++ ++#define OX800DPE_CONTROL ((DPE_REGS_BASE) + 0x00) ++#define OX800DPE_STATUS ((DPE_REGS_BASE) + 0x04) ++#define OX800DPE_KEY00 ((DPE_REGS_BASE) + 0x10) ++#define OX800DPE_KEY01 ((DPE_REGS_BASE) + 0x14) ++#define OX800DPE_KEY02 ((DPE_REGS_BASE) + 0x18) ++#define OX800DPE_KEY03 ((DPE_REGS_BASE) + 0x1c) ++#define OX800DPE_KEY10 ((DPE_REGS_BASE) + 0x20) ++#define OX800DPE_KEY11 ((DPE_REGS_BASE) + 0x24) ++#define OX800DPE_KEY12 ((DPE_REGS_BASE) + 0x28) ++#define OX800DPE_KEY13 ((DPE_REGS_BASE) + 0x2c) ++#define OX800DPE_KEY20 ((DPE_REGS_BASE) + 0x30) ++#define OX800DPE_KEY21 ((DPE_REGS_BASE) + 0x34) ++#define OX800DPE_KEY22 ((DPE_REGS_BASE) + 0x38) ++#define OX800DPE_KEY23 ((DPE_REGS_BASE) + 0x3c) ++#define OX800DPE_DATA_IN0 ((DPE_REGS_BASE) + 0x40) ++#define OX800DPE_DATA_IN1 ((DPE_REGS_BASE) + 0x44) ++#define OX800DPE_DATA_IN2 ((DPE_REGS_BASE) + 0x48) ++#define OX800DPE_DATA_IN3 ((DPE_REGS_BASE) + 0x4c) ++#define OX800DPE_DATA_OUT0 ((DPE_REGS_BASE) + 0x50) ++#define OX800DPE_DATA_OUT1 ((DPE_REGS_BASE) + 0x54) ++#define OX800DPE_DATA_OUT2 ((DPE_REGS_BASE) + 0x58) ++#define OX800DPE_DATA_OUT3 ((DPE_REGS_BASE) + 0x5c) ++#define OX800DPE_DATA_LRW0 ((DPE_REGS_BASE) + 0x60) ++#define OX800DPE_DATA_LRW1 ((DPE_REGS_BASE) + 0x64) ++#define OX800DPE_DATA_CBC0 ((DPE_REGS_BASE) + 0x68) ++#define OX800DPE_DATA_CBC1 ((DPE_REGS_BASE) + 0x6c) ++ ++ ++#define OX800IBW_STAT_AUTHENTICATED 0x10 ++ ++#define OX800IBW_CONTROL ((IBW_REGS_BASE) + 0x00) ++#define OX800IBW_STATUS ((IBW_REGS_BASE) + 0x04) ++#define OX800IBW_SERIAL_LO ((IBW_REGS_BASE) + 0x08) ++#define OX800IBW_SERIAL_HI ((IBW_REGS_BASE) + 0x0C) ++ ++ ++// IBIW Control register bits ++ ++#define OX800IBW_CTRL_LOAD_AES_KEY 0x00100 ++#define OX800IBW_CTRL_BUFF_WR_SRC 0x00200 ++#define OX800IBW_CTRL_CRC_WR_SRC 0x00400 ++#define OX800IBW_CTRL_RESET 0x00800 ++#define OX800IBW_CTRL_WR 0x01000 ++#define OX800IBW_CTRL_RD 0x02000 ++#define OX800IBW_CTRL_RX_INIT 0x04000 ++#define OX800IBW_CTRL_TX_INIT 0x08000 ++#define OX800IBW_CTRL_DONE 0x10000 ++#define OX800IBW_CTRL_ENABLE 0x20000 ++ ++ ++// IBIW Status register bits ++ ++#define OX800IBW_STATUS_PRESENT 0x0001 ++#define OX800IBW_STATUS_ARRIVAL 0x0002 ++#define OX800IBW_STATUS_DEPARTURE 0x0004 ++#define OX800IBW_STATUS_HOLDOFF 0x0008 ++#define OX800IBW_STATUS_CRC_OK 0x0010 ++#define OX800IBW_STATUS_SERIAL_MATCH 0x0020 ++#define OX800IBW_STATUS_KEY_MATCH 0x0040 ++#define OX800IBW_STATUS_VALID_KEY 0x0080 ++#define OX800IBW_STATUS_AUTHENTICATED 0x0100 ++#define OX800IBW_STATUS_RD_ENABLED 0x0200 ++ ++/*The number of storage fields in a DS1991 iButton */ ++#define DS1991_IBUTTON_FIELDS 4 ++#define DS1991_PASSWORD_SIZE 8 ++#define DS1991_ID_SIZE 8 ++#define DS1991_DATA_SIZE 48 ++#define DS1991_PLAINTEXT_SIZE 64 ++ ++/* DS1991 COMMANDS */ ++#define DS1991_WRITE_SCRATCHPAD 0x96 ++#define DS1991_READ_SCRATCHPAD 0x69 ++#define DS1991_COPY_SCRATCHPAD 0x3c ++#define DS1991_READ_SUBKEY 0x66 ++#define DS1991_WRITE_SUBKEY 0x99 ++#define DS1991_WRITE_PASSWORD 0x5a ++ ++/* prototype */ ++struct scatterlist; ++ ++int ox800_aeslrw_encrypt( struct scatterlist* in, ++ struct scatterlist* out, ++ unsigned int length, ++ u8 iv[], ++ u8 cipher_key[], ++ u8 tweak_key[]); ++ ++int ox800_aeslrw_decrypt( struct scatterlist* in, ++ struct scatterlist* out, ++ unsigned int length, ++ u8 iv[], ++ u8 cipher_key[], ++ u8 tweak_key[]); ++ ++#endif +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/debug-macro.S linux-2.6.24-oxe810/include/asm-arm/arch-hipox/debug-macro.S +--- linux-2.6.24/include/asm-arm/arch-hipox/debug-macro.S 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/debug-macro.S 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,47 @@ ++/* linux/include/asm-arm/arch-hipox/debug-macro.S ++ * ++ * Debugging macro include header ++ * ++ * Copyright (C) 2005 B.H.Clarke ++ * ++ * 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 <asm/arch/hardware.h> ++ ++ .macro addruart,rx ++ mrc p15, 0, \rx, c1, c0 ++ tst \rx, #1 @ MMU enabled? ++#ifdef CONFIG_ARCH_HIPOX_UART1 ++ ldreq \rx, =UART_1_BASE_PA @ physical base address ++ ldrne \rx, =UART_1_BASE @ virtual address ++#elif CONFIG_ARCH_HIPOX_UART2 ++ ldreq \rx, =UART_2_BASE_PA @ physical base address ++ ldrne \rx, =UART_2_BASE @ virtual address ++#elif CONFIG_ARCH_HIPOX_UART3 ++ ldreq \rx, =UART_3_BASE_PA @ physical base address ++ ldrne \rx, =UART_3_BASE @ virtual address ++#else ++ ldreq \rx, =UART_4_BASE_PA @ physical base address ++ ldrne \rx, =UART_4_BASE @ virtual address ++#endif ++ .endm ++ ++ .macro senduart,rd,rx @ Load byte into Tx holding register ++ strb \rd, [\rx, #0] @ THR ++ .endm ++ ++ .macro waituart,rd,rx @ Wait until there is space in the TX FIFO ++1001: ldrb \rd, [\rx, #5] @ LSR ++ tst \rd, #1 << 5 @ THR empty ++ beq 1001b ++ .endm ++ ++ .macro busyuart,rd,rx @ Wait until the TX is idle ++#1001: ldrb \rd, [\rx, #5] @ LSR ++# tst \rd, #1 << 6 @ THR and Tx FIFO empty ++# beq 1001b ++ .endm ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/desc_alloc.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/desc_alloc.h +--- linux-2.6.24/include/asm-arm/arch-hipox/desc_alloc.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/desc_alloc.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,62 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/dma.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ * ++ * ++ * Here we partition the available internal SRAM between the GMAC and generic ++ * DMA descriptors. This requires defining the gmac_dma_desc_t structure here, ++ * rather than in its more natural position within gmac.h ++ */ ++#if !defined(__DESC_ALLOC_H__) ++#define __DESC_ALLOC_H__ ++ ++#include <asm/arch/hardware.h> ++ ++// GMAC DMA in-memory descriptor structures ++typedef struct gmac_dma_desc ++{ ++ /** The encoded status field of the GMAC descriptor */ ++ u32 status; ++ /** The encoded length field of GMAC descriptor */ ++ u32 length; ++ /** Buffer 1 pointer field of GMAC descriptor */ ++ u32 buffer1; ++ /** Buffer 2 pointer or next descriptor pointer field of GMAC descriptor */ ++ u32 buffer2; ++} __attribute ((aligned(4),packed)) gmac_dma_desc_t; ++ ++#define NUM_GMAC_DMA_DESCRIPTORS CONFIG_ARCH_HIPOX_NUM_GMAC_DESCRIPTORS ++ ++#define GMAC_DESC_ALLOC_START (SRAM_BASE) ++#define GMAC_DESC_ALLOC_START_PA (DESCRIPTORS_BASE_PA) ++/** Must be modified to track gmac_dma_desc_t definition above */ ++#define GMAC_DESC_ALLOC_SIZE ((NUM_GMAC_DMA_DESCRIPTORS) * (4*4)) ++ ++#if ((GMAC_DESC_ALLOC_SIZE) > (DESCRIPTORS_SIZE)) ++#error "Too many GMAC descriptors - descriptor SRAM allocation exceeded" ++#endif ++ ++#define DMA_DESC_ALLOC_START ((GMAC_DESC_ALLOC_START) + (GMAC_DESC_ALLOC_SIZE)) ++#define DMA_DESC_ALLOC_START_PA ((GMAC_DESC_ALLOC_START_PA) + (GMAC_DESC_ALLOC_SIZE)) ++#define DMA_DESC_ALLOC_SIZE ((DESCRIPTORS_SIZE) - (GMAC_DESC_ALLOC_SIZE)) ++ ++#define descriptors_virt_to_phys(x) ((x) - (SRAM_BASE) + (DESCRIPTORS_BASE_PA)) ++#define descriptors_phys_to_virt(x) ((x) - (DESCRIPTORS_BASE_PA) + (SRAM_BASE)) ++ ++#endif // #if !defined(__DESC_ALLOC_H__) ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/dma.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/dma.h +--- linux-2.6.24/include/asm-arm/arch-hipox/dma.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/dma.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,299 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/dma.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ * ++ * ++ * We have a generic DMAC that is a two port, memory to memory design, supporting ++ * multiple channels, each of which can transfer between any pair of memory ++ * regions. This DMAC architecture does not sit well with the std. ARM DMA ++ * architecture, thus we define a custom way of acquiring and operating on the ++ * available channels of the DMAC ++ */ ++ ++#ifndef __ASM_ARCH_DMA_H ++#define __ASM_ARCH_DMA_H ++ ++#include <asm/scatterlist.h> ++#include <asm/semaphore.h> ++#include <linux/ata.h> ++#include <linux/interrupt.h> ++#include <linux/spinlock.h> ++ ++/* All memory DMAable */ ++#define MAX_DMA_ADDRESS (~0UL) ++ ++/* Do not want to use the std. ARM DMA architecure */ ++#define MAX_DMA_CHANNELS 0 ++ ++#define MAX_HIPOX_DMA_CHANNELS 5 ++ ++#define MAX_HIPOX_DMA_TRANSFER_LENGTH ((1 << 21) - 1) ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++// Need to set this (unused) high order address bit in the start address of DMA ++// transfers in order for checksum calculation to be performed ++#define HIPOX_DMA_CSUM_ENABLE_ADR_BIT 28 ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++//#define HIPOX_DMA_TEST ++//#define HIPOX_DMA_TEST_ITERATIONS 1 ++//#define HIPOX_DMA_SG_TEST ++//#define HIPOX_DMA_SG_TEST_2 ++//#define HIPOX_DMA_SG_TEST_ITERATIONS 1 ++//#define HIPOX_DMA_SG_TEST2_ITERATIONS 1 ++//#define HIPOX_DMA_SG_TEST_DUMP_BUFFERS ++//#define HIPOX_DMA_SG_TEST_DUMP_DESCRIPTORS ++//#define HIPOX_DMA_TEST_AFTER_SG_ITERATIONS 0 ++//#define HIPOX_DMA_OVERALL_TEST_LOOPS 1 ++ ++// All other error codes are generated by the SG engine - refer to its ++// documentation for details ++typedef enum hipox_dma_callback_status { ++ HIPOX_DMA_ERROR_CODE_NONE ++} hipox_dma_callback_status_t; ++ ++typedef enum hipox_dma_mode { ++ HIPOX_DMA_MODE_FIXED, ++ HIPOX_DMA_MODE_INC ++} hipox_dma_mode_t; ++ ++typedef enum hipox_dma_direction { ++ HIPOX_DMA_TO_DEVICE, ++ HIPOX_DMA_FROM_DEVICE ++} hipox_dma_direction_t; ++ ++struct hipox_dma_channel; ++typedef struct hipox_dma_channel hipox_dma_channel_t; ++ ++#define HIPOX_DMA_CHANNEL_NUL ((hipox_dma_channel_t*)0) ++ ++typedef void* hipox_callback_arg_t; ++ ++#define HIPOX_DMA_CALLBACK_ARG_NUL ((hipox_callback_arg_t)0) ++ ++typedef void (*hipox_dma_callback_t)(hipox_dma_channel_t*, hipox_callback_arg_t, hipox_dma_callback_status_t, u16 checksum, int interrupt_count); ++ ++#define HIPOX_DMA_CALLBACK_NUL ((hipox_dma_callback_t)0) ++ ++typedef enum hipox_dma_eot_type { ++ HIPOX_DMA_EOT_NONE, ++ HIPOX_DMA_EOT_ALL, ++ HIPOX_DMA_EOT_FINAL ++} hipox_dma_eot_type_t; ++ ++// Will be exchanged with SG DMA controller ++typedef struct hipox_dma_sg_entry { ++ dma_addr_t addr_; // The physical address of the buffer described by this descriptor ++ unsigned long length_; // The length of the buffer described by this descriptor ++ dma_addr_t p_next_; // The physical address of the next descriptor ++ struct hipox_dma_sg_entry *v_next_; // The virtual address of the next descriptor ++ dma_addr_t paddr_; // The physical address of this descriptor ++ struct hipox_dma_sg_entry *next_; // To allow insertion into single-linked list ++} __attribute ((aligned(4),packed)) hipox_dma_sg_entry_t; ++ ++// Will be exchanged with SG DMA controller ++typedef struct hipox_dma_sg_info { ++ unsigned long qualifer_; ++ unsigned long control_; ++ dma_addr_t p_srcEntries_; // The physical address of the first source SG descriptor ++ dma_addr_t p_dstEntries_; // The physical address of the first destination SG descriptor ++ hipox_dma_sg_entry_t *v_srcEntries_; // The virtual address of the first source SG descriptor ++ hipox_dma_sg_entry_t *v_dstEntries_; // The virtual address of the first destination SG descriptor ++} __attribute ((aligned(4),packed)) hipox_dma_sg_info_t; ++ ++struct hipox_dma_channel { ++ unsigned channel_number_; ++ hipox_dma_callback_t notification_callback_; ++ hipox_callback_arg_t notification_arg_; ++ dma_addr_t p_sg_info_; // Physical address of sg_info structure ++ hipox_dma_sg_info_t *v_sg_info_; // Virtual address of sg_info structure ++ hipox_dma_callback_status_t error_code_; ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ int checksumming_; ++ u16 checksum_; ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ unsigned rps_interrupt_; ++ struct hipox_dma_channel *next_; ++ struct semaphore default_semaphore_; ++ atomic_t interrupt_count_; ++ atomic_t active_count_; ++ int auto_sg_entries_; ++}; ++ ++typedef struct hipox_dma_controller { ++ hipox_dma_channel_t channels_[MAX_HIPOX_DMA_CHANNELS]; ++ unsigned numberOfChannels_; ++ int version_; ++ atomic_t run_bh_; ++ spinlock_t spinlock_; ++ struct tasklet_struct tasklet_; ++ dma_addr_t p_sg_infos_; // Physical address of the array of sg_info structures ++ hipox_dma_sg_info_t *v_sg_infos_; // Virtual address of the array of sg_info structures ++ struct semaphore csum_engine_sem_; ++ spinlock_t alloc_spinlock_; // Sync. for SG management ++ spinlock_t channel_alloc_spinlock_; // Sync. for channel management ++ hipox_dma_sg_entry_t *sg_entry_head_; // Pointer to head of free list for hipox_dma_sg_entry_t objects ++ struct semaphore sg_entry_sem_; ++ unsigned sg_entry_available_; ++ hipox_dma_channel_t *channel_head_; ++ struct semaphore channel_sem_; ++} hipox_dma_controller_t; ++ ++typedef struct hipox_dma_device_settings { ++ unsigned long address_; ++ unsigned fifo_size_; // Chained transfers must take account of FIFO offset at end of previous transfer ++ unsigned char dreq_; ++ unsigned read_eot_policy_:2; ++ unsigned write_eot_policy_:2; ++ unsigned bus_:1; ++ unsigned width_:2; ++ unsigned transfer_mode_:1; ++ unsigned address_mode_:1; ++ unsigned address_really_fixed_:1; ++} hipox_dma_device_settings_t; ++ ++/* Pre-defined settings for known DMA devices */ ++extern hipox_dma_device_settings_t hipox_pata_dma_settings; ++extern hipox_dma_device_settings_t hipox_sata_dma_settings; ++extern hipox_dma_device_settings_t hipox_dpe_rx_dma_settings; ++extern hipox_dma_device_settings_t hipox_dpe_tx_dma_settings; ++ ++extern void hipox_dma_init(void); ++ ++extern void hipox_dma_shutdown(void); ++ ++extern hipox_dma_channel_t* hipox_dma_request(int block); ++ ++extern void hipox_dma_free(hipox_dma_channel_t*); ++ ++extern int hipox_dma_is_active(hipox_dma_channel_t*); ++ ++extern int hipox_dma_raw_isactive(hipox_dma_channel_t*); ++ ++extern int hipox_dma_raw_sg_isactive(hipox_dma_channel_t*); ++ ++extern int hipox_dma_get_raw_direction(hipox_dma_channel_t*); ++ ++/** ++ * @param do_checksum An int indicating that the checksum engine is required ++ * and causing the HIPOX_DMA_CSUM_ENABLE_ADR_BIT to be set ++ * automatically in the passed src and dst start addresses ++ * @return An int which is zero on success. Non-zero will returned if the length ++ * exceeds that allowed by the hardware ++ */ ++extern int hipox_dma_set( ++ hipox_dma_channel_t *channel, ++ unsigned char *src_adr, // Physical address ++ unsigned long length, ++ unsigned char *dst_adr, // Physical address ++ hipox_dma_mode_t src_mode, ++ hipox_dma_mode_t dst_mode, ++ int do_checksum, ++ int paused); ++ ++/** ++ * @return An int which is zero on success. Non-zero will returned if the length ++ * exceeds that allowed by the hardware ++ */ ++extern int hipox_dma_device_set( ++ hipox_dma_channel_t *channel, ++ hipox_dma_direction_t direction, ++ unsigned char *mem_adr, // Physical address ++ unsigned long length, ++ hipox_dma_device_settings_t *device_settings, ++ hipox_dma_mode_t mem_mode, ++ int paused); ++ ++/** ++ * @return An int which is zero on success. Non-zero will returned if the length ++ * exceeds that allowed by the hardware ++ */ ++extern int hipox_dma_device_pair_set( ++ hipox_dma_channel_t *channel, ++ unsigned long length, ++ hipox_dma_device_settings_t *src_device_settings, ++ hipox_dma_device_settings_t *dst_device_settings, ++ int paused); ++ ++/** ++ * @param do_checksum An int indicating that the checksum engine is required ++ * for this SG transfer. For the individual SG transfer ++ * components to contribute to the checksum result, their ++ * start addresses contained within the scatterlist ++ * structures must have the HIPOX_DMA_CSUM_ENABLE_ADR_BIT ++ * bit set ++ * ++ * NB This function does not have an error return value, but if it is passed ++ * a transfer segment longer than the maximum allowed by the hardware, that ++ * entry will be zeroed in the SG descriptor list and a kernel warning ++ * message generated ++ */ ++extern int hipox_dma_set_sg( ++ hipox_dma_channel_t* channel, ++ struct scatterlist* src_sg, ++ unsigned src_sg_count, ++ struct scatterlist* dst_sg, ++ unsigned dst_sg_count, ++ hipox_dma_mode_t src_mode, ++ hipox_dma_mode_t dst_mode, ++ int do_checksum, ++ int in_atomic); ++ ++/** ++ * NB This function does not have an error return value, but if it is passed ++ * a transfer segment longer than the maximum allowed by the hardware, that ++ * entry will be zeroed in the SG descriptor list and a kernel warning ++ * message generated ++ */ ++extern int hipox_dma_device_set_sg( ++ hipox_dma_channel_t* channel, ++ hipox_dma_direction_t direction, ++ struct scatterlist* mem_sg, ++ unsigned mem_sg_count, ++ hipox_dma_device_settings_t* device_settings, ++ hipox_dma_mode_t mem_mode, ++ int in_atomic); ++ ++extern int hipox_dma_device_set_prd( ++ hipox_dma_channel_t *channel, ++ hipox_dma_direction_t direction, ++ struct ata_prd *prd, ++ hipox_dma_device_settings_t *device_settings, ++ hipox_dma_mode_t mem_mode, ++ hipox_dma_sg_entry_t *sg_entries); ++ ++/** ++ * The callback function should complete quickly and must not sleep ++ */ ++extern void hipox_dma_set_callback( ++ hipox_dma_channel_t*, ++ hipox_dma_callback_t callback, ++ hipox_callback_arg_t callback_arg); ++ ++extern void hipox_dma_abort(hipox_dma_channel_t*, int in_atomic); ++ ++extern void hipox_dma_start(hipox_dma_channel_t*); ++ ++extern void hipox_dma_dump_registers(void); ++ ++extern void hipox_dma_dump_registers_single(int channel_number); ++ ++extern int hipox_dma_alloc_sg_entries(hipox_dma_sg_entry_t** entries, unsigned required, int in_atomic); ++ ++extern void hipox_dma_free_sg_entries(hipox_dma_sg_entry_t* entries); ++#endif // __ASM_ARCH_DMA_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/entry-macro.S linux-2.6.24-oxe810/include/asm-arm/arch-hipox/entry-macro.S +--- linux-2.6.24/include/asm-arm/arch-hipox/entry-macro.S 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/entry-macro.S 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,40 @@ ++/* ++ * include/asm-arm/arch-hipox/entry-macro.S ++ * ++ * Low-level IRQ helper macros for Integrator platforms ++ * ++ * 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 <asm/arch/irqs.h> ++#include <asm/arch/hardware.h> ++ ++ .macro disable_fiq ++ .endm ++ ++ .macro get_irqnr_preamble, base, tmp ++ .endm ++ ++ .macro arch_ret_to_user, tmp1, tmp2 ++ .endm ++ ++ .macro get_irqnr_and_base, irqnr, irqstat, base, tmp ++ ldr \irqstat, =RPS_IRQ_STATUS ++ ldr \irqstat, [\irqstat, #0] ++ ++ mov \irqnr, #0 ++1001: ++ tst \irqstat, #1 ++ bne 1002f ++ add \irqnr, \irqnr, #1 ++ mov \irqstat, \irqstat, lsr #1 ++ cmp \irqnr, #NR_IRQS ++ bcc 1001b ++ ++1002: ++ .endm ++ ++ .macro irq_prio_table ++ .endm ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/hardware.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/hardware.h +--- linux-2.6.24/include/asm-arm/arch-hipox/hardware.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/hardware.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,760 @@ ++/* linux/include/asm-arm/arch-hipox/hardware.h ++ * ++ * 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 __ASM_ARCH_HARDWARE_H ++#define __ASM_ARCH_HARDWARE_H ++ ++#include <asm/page.h> ++#include <asm/memory.h> ++#include <asm/sizes.h> ++#include <asm/arch/vmalloc.h> ++#include <asm/arch/timex.h> ++ ++// The base of virtual address mappings for hardware cores starts directly after ++// the end of the vmalloc mapping region ++#define HIPOX_HW_PA_TO_VA(x) (VMALLOC_END + (x)) ++ ++// Virtual address mapping of hardware cores ++#define APB_BRIDGE_A_BASE HIPOX_HW_PA_TO_VA(0) ++#define STATIC_CONTROL_BASE HIPOX_HW_PA_TO_VA(0x1000000) ++#define CORE_MODULE_BASE HIPOX_HW_PA_TO_VA(0x2000000) ++#define EXTERNAL_UART_BASE HIPOX_HW_PA_TO_VA(0x3000000) ++#define EXTERNAL_UART_2_BASE HIPOX_HW_PA_TO_VA(0x3800000) ++ ++/* 16 Mbyte address range on AMBA bus */ ++#define APB_BRIDGE_BASE_MASK 0x00FFFFFF ++ ++#define APB_BRIDGE_B_BASE HIPOX_HW_PA_TO_VA(0x04000000) ++#define SATA_DATA_BASE HIPOX_HW_PA_TO_VA(0x05000000) ++#define DPE_BASE HIPOX_HW_PA_TO_VA(0x06000000) ++#define USB_BASE HIPOX_HW_PA_TO_VA(0x07000000) ++#define MAC_BASE HIPOX_HW_PA_TO_VA(0x08000000) ++#define PCI_CSRS_BASE HIPOX_HW_PA_TO_VA(0x0A000000) ++#define STATIC_CS0_BASE HIPOX_HW_PA_TO_VA(0x0B000000) ++#define STATIC_CS1_BASE HIPOX_HW_PA_TO_VA(0x0C000000) ++#define STATIC_CS2_BASE HIPOX_HW_PA_TO_VA(0x0D000000) ++#define ROM_BASE HIPOX_HW_PA_TO_VA(0x0E000000) ++#define SDRAM_CTRL_BASE HIPOX_HW_PA_TO_VA(0x0F000000) ++#define LEON_IMAGE_BASE HIPOX_HW_PA_TO_VA(0x10000000) ++#define SRAM_BASE HIPOX_HW_PA_TO_VA(0x11000000) ++ ++#ifdef CONFIG_SUPPORT_LEON ++#define LEON_IMAGE_SIZE (CONFIG_LEON_PAGES * PAGE_SIZE) ++#define LEON_IMAGE_BASE_PA (((SRAM_END) + 1) - (LEON_IMAGE_SIZE)) ++#else // CONFIG_SUPPORT_LEON ++#define LEON_IMAGE_SIZE 0 ++#define LEON_IMAGE_BASE_PA 0 ++#endif // CONFIG_SUPPORT_LEON ++ ++#if (LEON_IMAGE_BASE_PA >= SRAM_PA) && (LEON_IMAGE_BASE_PA <= SRAM_END) ++#define LEON_IMAGE_IN_SRAM ++#endif ++ ++#define DESCRIPTORS_SIZE (CONFIG_DESCRIPTORS_PAGES * PAGE_SIZE) ++ ++#ifdef CONFIG_DESCRIPTORS_PAGES ++#if (CONFIG_DESCRIPTORS_PAGES > CONFIG_SRAM_NUM_PAGES) ++#error "Too many descriptor pages defined - greater than total SRAM pages" ++#endif ++#endif // CONFIG_DESCRIPTORS_PAGES ++ ++#define DESCRIPTORS_BASE_PA (SRAM_PA) ++#define DESCRIPTORS_END_PA (SRAM_PA + DESCRIPTORS_SIZE) ++ ++#ifdef LEON_IMAGE_IN_SRAM ++#if (DESCRIPTORS_END_PA > LEON_IMAGE_BASE_PA) ++#error "Overlapping LEON and Descriptor areas in SRAM" ++#endif ++#endif ++ ++#define CORE_MODULE_BASE_PA 0x10000000 ++ ++#define ROM_BASE_PA 0x40000000 ++#define USB_BASE_PA 0x40200000 ++#define MAC_BASE_PA 0x40400000 ++#define PCI_CSRS_BASE_PA 0x40600000 ++#define PCI_BASE_PA 0x40800000 ++ ++#define STATIC_CS0_BASE_PA 0x41000000 ++#define STATIC_CS1_BASE_PA 0x41400000 ++#define STATIC_CS2_BASE_PA 0x41800000 ++#define STATIC_CONTROL_BASE_PA 0x41C00000 ++ ++#define SATA_DATA_BASE_PA 0x42000000 ++#define DPE_BASE_PA 0x43000000 ++#define APB_BRIDGE_A_BASE_PA 0x44000000 ++#define APB_BRIDGE_B_BASE_PA 0x45000000 ++ ++#define UART_1_BASE_PA (APB_BRIDGE_A_BASE_PA + 0x200000) ++#define UART_2_BASE_PA (APB_BRIDGE_A_BASE_PA + 0x300000) ++#define UART_3_BASE_PA (APB_BRIDGE_A_BASE_PA + 0x900000) ++#define UART_4_BASE_PA (APB_BRIDGE_A_BASE_PA + 0xA00000) ++ ++#define GPIO_A_BASE APB_BRIDGE_A_BASE ++#define GPIO_B_BASE (APB_BRIDGE_A_BASE + 0x100000) ++#define UART_1_BASE (APB_BRIDGE_A_BASE + 0x200000) ++#define UART_2_BASE (APB_BRIDGE_A_BASE + 0x300000) ++#define UART_3_BASE (APB_BRIDGE_A_BASE + 0x900000) ++#define UART_4_BASE (APB_BRIDGE_A_BASE + 0xA00000) ++#define I2C_BASE (APB_BRIDGE_A_BASE + 0x400000) ++#define I2S_BASE (APB_BRIDGE_A_BASE + 0x500000) ++#define FAN_MON_BASE (APB_BRIDGE_A_BASE + 0x600000) ++#define PWM_BASE (APB_BRIDGE_A_BASE + 0x700000) ++#define IRRX_BASE (APB_BRIDGE_A_BASE + 0x800000) ++ ++#define SYS_CONTROL_BASE APB_BRIDGE_B_BASE ++#define CLOCK_CONTROL_BASE (APB_BRIDGE_B_BASE + 0x100000) ++#define RTC_BASE (APB_BRIDGE_B_BASE + 0x200000) ++#define RPS_BASE (APB_BRIDGE_B_BASE + 0x300000) ++#define COPRO_RPS_BASE (APB_BRIDGE_B_BASE + 0x400000) ++#define AHB_MON_BASE (APB_BRIDGE_B_BASE + 0x500000) ++#define DMA_BASE (APB_BRIDGE_B_BASE + 0x600000) ++#define DPE_REGS_BASE (APB_BRIDGE_B_BASE + 0x700000) ++#define IBW_REGS_BASE (APB_BRIDGE_B_BASE + 0x780000) ++#define DDR_REGS_BASE (APB_BRIDGE_B_BASE + 0x800000) ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define SATA0_REGS_BASE (APB_BRIDGE_B_BASE + 0x900000) ++#define SATA0_LINK_REGS_BASE (APB_BRIDGE_B_BASE + 0x940000) ++#define SATA1_REGS_BASE (APB_BRIDGE_B_BASE + 0x980000) ++#define SATA1_LINK_REGS_BASE (APB_BRIDGE_B_BASE + 0x9C0000) ++#elif CONFIG_HIPOX_VERSION_0X810 ++#define SATA_REG_BASE (APB_BRIDGE_B_BASE + 0x900000) ++#define SATA0_REGS_BASE (SATA_REG_BASE) ++#define SATA1_REGS_BASE (SATA_REG_BASE + 0x10000) ++#define SATACORE_REGS_BASE (SATA_REG_BASE + 0xe0000) ++#define SATARAID_REGS_BASE (SATA_REG_BASE + 0xf0000) ++#endif // CONFIG_HIPOX_VERSION_0X8xx ++ ++#define DMA_CHECKSUM_BASE (APB_BRIDGE_B_BASE + 0xA00000) ++#define COPRO_REGS_BASE (APB_BRIDGE_B_BASE + 0xB00000) ++#define DMA_SG_BASE (APB_BRIDGE_B_BASE + 0xC00000) ++ ++/* Interrupt Controller registers */ ++#define RPS_IC_BASE RPS_BASE ++#define RPS_IRQ_STATUS (RPS_IC_BASE) ++#define RPS_IRQ_RAW_STATUS (RPS_IC_BASE + 0x04) ++#define RPS_IRQ_ENABLE (RPS_IC_BASE + 0x08) ++#define RPS_IRQ_DISABLE (RPS_IC_BASE + 0x0C) ++#define RPS_IRQ_SOFT (RPS_IC_BASE + 0x10) ++ ++/* FIQ registers */ ++#define RPS_FIQ_BASE (RPS_IC_BASE + 0x100) ++#define RPS_FIQ_STATUS (RPS_FIQ_BASE + 0x00) ++#define RPS_FIQ_RAW_STATUS (RPS_FIQ_BASE + 0x04) ++#define RPS_FIQ_ENABLE (RPS_FIQ_BASE + 0x08) ++#define RPS_FIQ_DISABLE (RPS_FIQ_BASE + 0x0C) ++ ++/* Timer registers */ ++#define RPS_TIMER_BASE (RPS_BASE + 0x200) ++#define RPS_TIMER1_BASE (RPS_TIMER_BASE) ++#define RPS_TIMER2_BASE (RPS_TIMER_BASE + 0x20) ++ ++#define TIMER1_LOAD (RPS_TIMER1_BASE + 0x0) ++#define TIMER1_VALUE (RPS_TIMER1_BASE + 0x4) ++#define TIMER1_CONTROL (RPS_TIMER1_BASE + 0x8) ++#define TIMER1_CLEAR (RPS_TIMER1_BASE + 0xc) ++ ++#define TIMER2_LOAD (RPS_TIMER2_BASE + 0x0) ++#define TIMER2_VALUE (RPS_TIMER2_BASE + 0x4) ++#define TIMER2_CONTROL (RPS_TIMER2_BASE + 0x8) ++#define TIMER2_CLEAR (RPS_TIMER2_BASE + 0xc) ++ ++#define TIMER_MODE_BIT 6 ++#define TIMER_MODE_FREE_RUNNING 0 ++#define TIMER_MODE_PERIODIC 1 ++#define TIMER_ENABLE_BIT 7 ++#define TIMER_ENABLE_DISABLE 0 ++#define TIMER_ENABLE_ENABLE 1 ++ ++/* System clock frequencies */ ++#ifdef CONFIG_ARCH_HIPOX_FPGA ++/* FPGA CPU clock is entirely independent of rest of SoC */ ++#define NOMINAL_ARMCLK (CONFIG_HIPOX_CORE_CLK) ++#else // CONFIG_ARCH_HIPOX_FPGA ++/* ASIC CPU clock is derived from SoC master clock */ ++#define NOMINAL_ARMCLK (CONFIG_NOMINAL_PLL400_FREQ / 2) ++#endif // CONFIG_ARCH_HIPOX_FPGA ++ ++#define NOMINAL_SYSCLK (CONFIG_NOMINAL_PLL400_FREQ / 4) ++#define NOMINAL_PCICLK 33000000 ++ ++#ifdef CONFIG_ARCH_HIPOX_FPGA ++/* FPGA has no PCI clock divider */ ++#define PCI_CLOCK_DIVIDER 1 ++#else // CONFIG_ARCH_HIPOX_FPGA ++/* ASIC PCI divider divides CONFIG_NOMINAL_PLL400_FREQ by 2(n + 1) to get 33MHz */ ++#define PCI_CLOCK_DIVIDER (((CONFIG_NOMINAL_PLL400_FREQ) / (2 * NOMINAL_PCICLK)) - 1) ++#endif //CONFIG_ARCH_HIPOX_FPGA ++ ++/* RPS timer setup */ ++#define TIMER_1_MODE TIMER_MODE_PERIODIC ++#define TIMER_2_PRESCALE_ENUM TIMER_PRESCALE_256 ++#define TIMER_2_MODE TIMER_MODE_FREE_RUNNING ++ ++/* Useful macros for dealing with sub timer-interrupt intervals - preserve ++ * as much precision as possible without using floating point and minimising ++ * runtime CPU requirement */ ++#define TIMER_1_LOAD_VALUE ((CLOCK_TICK_RATE) / HZ) ++#define TICKS_TO_US_SCALING 1024 ++#define TICKS_TO_US_FACTOR (((2 * TICKS_TO_US_SCALING * 1000000) + CLOCK_TICK_RATE) / (2 * CLOCK_TICK_RATE)) ++#define TICKS_TO_US(ticks) ((((ticks) * TICKS_TO_US_FACTOR * 2) + TICKS_TO_US_SCALING) / (2 * TICKS_TO_US_SCALING)) ++ ++/* Remap and pause */ ++#define RPS_REMAP_AND_PAUSE (RPS_BASE + 0x300) ++ ++/* GPIO */ ++#define GPIO_0 (0x00) ++#define GPIO_1 (0x01) ++#define GPIO_2 (0x02) ++#define GPIO_3 (0x03) ++#define GPIO_4 (0x04) ++#define GPIO_5 (0x05) ++#define GPIO_6 (0x06) ++#define GPIO_7 (0x07) ++#define GPIO_8 (0x08) ++#define GPIO_9 (0x09) ++#define GPIO_10 (0x0a) ++#define GPIO_11 (0x0b) ++#define GPIO_12 (0x0c) ++#define GPIO_13 (0x0d) ++#define GPIO_14 (0x0e) ++#define GPIO_15 (0x0f) ++#define GPIO_16 (0x10) ++#define GPIO_17 (0x11) ++#define GPIO_18 (0x12) ++#define GPIO_19 (0x13) ++#define GPIO_20 (0x14) ++#define GPIO_21 (0x15) ++#define GPIO_22 (0x16) ++#define GPIO_23 (0x17) ++#define GPIO_24 (0x18) ++#define GPIO_25 (0x19) ++#define GPIO_26 (0x1a) ++#define GPIO_27 (0x1b) ++#define GPIO_28 (0x1c) ++#define GPIO_29 (0x1d) ++#define GPIO_30 (0x1e) ++#define GPIO_31 (0x1f) ++#define GPIO_32 (0x00) ++#define GPIO_33 (0x01) ++#define GPIO_34 (0x02) ++ ++/* Symbols for functions mapped onto GPIO lines */ ++#ifdef CONFIG_ARCH_HIPOX_FPGA ++#define PCI_GPIO_INTA_PLANAR 8 ++#define PCI_GPIO_INTA_MINIPCI 9 ++#else // CONFIG_ARCH_HIPOX_FPGA ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define PCI_GPIO_INTA_PLANAR 3 ++#define PCI_GPIO_INTA_MINIPCI 9 ++#elif CONFIG_HIPOX_VERSION_0X810 ++#define PCI_GPIO_INTA_PLANAR 3 ++#define PCI_GPIO_INTA_MINIPCI 9 ++#endif // CONFIG_HIPOX_VERSION_0X8xx ++#endif // CONFIG_ARCH_HIPOX_FPGA ++ ++#define PCI_GPIO_CLKO_0 8 ++#define PCI_GPIO_CLKO_1 9 ++#define PCI_GPIO_CLKO_2 10 ++#define PCI_GPIO_CLKO_3 11 ++#define PCI_GPIO_CLKO_4 23 ++ ++#define PCI_GNT_N0 0 ++#define PCI_GNT_N1 1 ++#define PCI_GNT_N2 2 ++#define PCI_GNT_N3 3 ++#define PCI_REQ_N0 4 ++#define PCI_REQ_N1 5 ++#define PCI_REQ_N2 6 ++#define PCI_REQ_N3 7 ++ ++#define IBW_GPIO_DATA (GPIO_33) ++ ++#define USBA_POWO_GPIO 23 ++#define USBA_OVERI_GPIO 24 ++#define USBB_POWO_GPIO 25 ++#define USBB_OVERI_GPIO 26 ++#define USBC_POWO_GPIO 27 ++#define USBC_OVERI_GPIO 28 ++ ++/* RPS GPIO registers */ ++#define RPS_GPIO_BASE GPIO_1_BASE /*(RPS_BASE + 0x3C0) ??????? */ ++ ++/* GPIO A registers */ ++#define GPIO_A_DATA GPIO_A_BASE ++#define GPIO_A_OUTPUT_ENABLE (GPIO_A_BASE + 0x0004) ++#define GPIO_A_INTERRUPT_ENABLE (GPIO_A_BASE + 0x0008) ++#define GPIO_A_INTERRUPT_EVENT (GPIO_A_BASE + 0x000C) ++#define GPIO_A_OUTPUT_VALUE (GPIO_A_BASE + 0x0010) ++#define GPIO_A_OUTPUT_SET (GPIO_A_BASE + 0x0014) ++#define GPIO_A_OUTPUT_CLEAR (GPIO_A_BASE + 0x0018) ++#define GPIO_A_OUTPUT_ENABLE_SET (GPIO_A_BASE + 0x001C) ++#define GPIO_A_OUTPUT_ENABLE_CLEAR (GPIO_A_BASE + 0x0020) ++#define GPIO_A_INPUT_DEBOUNCE_ENABLE (GPIO_A_BASE + 0x0024) ++#define GPIO_A_RISING_EDGE_ACTIVE_HIGH_ENABLE (GPIO_A_BASE + 0x0028) ++#define GPIO_A_FALLING_EDGE_ACTIVE_LOW_ENABLE (GPIO_A_BASE + 0x002C) ++#define GPIO_A_RISING_EDGE_DETECT (GPIO_A_BASE + 0x0030) ++#define GPIO_A_FALLING_EDGE_DETECT (GPIO_A_BASE + 0x0034) ++#define GPIO_A_LEVEL_INTERRUPT_ENABLE (GPIO_A_BASE + 0x0038) ++#define GPIO_A_INTERRUPT_STATUS_REGISTER (GPIO_A_BASE + 0x003C) ++ ++/* GPIO B registers */ ++#define GPIO_B_DATA GPIO_B_BASE ++#define GPIO_B_OUTPUT_ENABLE (GPIO_B_BASE + 0x0004) ++#define GPIO_B_INTERRUPT_ENABLE (GPIO_B_BASE + 0x0008) ++#define GPIO_B_INTERRUPT_EVENT (GPIO_B_BASE + 0x000C) ++#define GPIO_B_OUTPUT_VALUE (GPIO_B_BASE + 0x0010) ++#define GPIO_B_OUTPUT_SET (GPIO_B_BASE + 0x0014) ++#define GPIO_B_OUTPUT_CLEAR (GPIO_B_BASE + 0x0018) ++#define GPIO_B_OUTPUT_ENABLE_SET (GPIO_B_BASE + 0x001C) ++#define GPIO_B_OUTPUT_ENABLE_CLEAR (GPIO_B_BASE + 0x0020) ++#define GPIO_B_INPUT_DEBOUNCE_ENABLE (GPIO_B_BASE + 0x0024) ++#define GPIO_B_RISING_EDGE_ACTIVE_HIGH_ENABLE (GPIO_B_BASE + 0x0028) ++#define GPIO_B_FALLING_EDGE_ACTIVE_LOW_ENABLE (GPIO_B_BASE + 0x002C) ++#define GPIO_B_RISING_EDGE_DETECT (GPIO_B_BASE + 0x0030) ++#define GPIO_B_FALLING_EDGE_DETECT (GPIO_B_BASE + 0x0034) ++#define GPIO_B_LEVEL_INTERRUPT_ENABLE (GPIO_B_BASE + 0x0038) ++#define GPIO_B_INTERRUPT_STATUS_REGISTER (GPIO_B_BASE + 0x003C) ++ ++/* CoProcessor RPS GPIO registers */ ++#define COPRO_GPIO_A_BASE (COPRO_RPS_BASE + 0x3C0) ++#define COPRO_GPIO_A_DATA COPRO_GPIO_A_BASE ++#define COPRO_GPIO_A_OUTPUT_ENABLE (COPRO_GPIO_A_BASE + 0x04) ++#define COPRO_GPIO_A_INTERRUPT_MASK (COPRO_GPIO_A_BASE + 0x08) ++#define COPRO_GPIO_A_INTERRUPT_EVENT (COPRO_GPIO_A_BASE + 0x0C) ++ ++/* Static bus registers */ ++#define STATIC_CONTROL_VERSION (STATIC_CONTROL_BASE + 0x0) ++#define STATIC_CONTROL_BANK0 (STATIC_CONTROL_BASE + 0x4) ++#define STATIC_CONTROL_BANK1 (STATIC_CONTROL_BASE + 0x8) ++#define STATIC_CONTROL_BANK2 (STATIC_CONTROL_BASE + 0xC) ++ ++/* System Control registers */ ++#define SYS_CTRL_USB11_CTRL (SYS_CONTROL_BASE + 0x00) ++#define SYS_CTRL_PCI_CTRL0 (SYS_CONTROL_BASE + 0x04) ++#define SYS_CTRL_PCI_CTRL1 (SYS_CONTROL_BASE + 0x08) ++#define SYS_CTRL_GPIO_PRIMSEL_CTRL_0 (SYS_CONTROL_BASE + 0x0C) ++#define SYS_CTRL_GPIO_PRIMSEL_CTRL_1 (SYS_CONTROL_BASE + 0x10) ++#define SYS_CTRL_GPIO_SECSEL_CTRL_0 (SYS_CONTROL_BASE + 0x14) ++#define SYS_CTRL_GPIO_SECSEL_CTRL_1 (SYS_CONTROL_BASE + 0x18) ++#define SYS_CTRL_GPIO_TERTSEL_CTRL_0 (SYS_CONTROL_BASE + 0x8C) ++#define SYS_CTRL_GPIO_TERTSEL_CTRL_1 (SYS_CONTROL_BASE + 0x90) ++#define SYS_CTRL_USB11_STAT (SYS_CONTROL_BASE + 0x1c) ++#define SYS_CTRL_PCI_STAT (SYS_CONTROL_BASE + 0x20) ++#define SYS_CTRL_CKEN_CTRL (SYS_CONTROL_BASE + 0x24) ++#define SYS_CTRL_RSTEN_CTRL (SYS_CONTROL_BASE + 0x28) ++#define SYS_CTRL_CKEN_SET_CTRL (SYS_CONTROL_BASE + 0x2C) ++#define SYS_CTRL_CKEN_CLR_CTRL (SYS_CONTROL_BASE + 0x30) ++#define SYS_CTRL_RSTEN_SET_CTRL (SYS_CONTROL_BASE + 0x34) ++#define SYS_CTRL_RSTEN_CLR_CTRL (SYS_CONTROL_BASE + 0x38) ++#define SYS_CTRL_USBHSMPH_CTRL (SYS_CONTROL_BASE + 0x40) ++#define SYS_CTRL_USBHSMPH_STAT (SYS_CONTROL_BASE + 0x44) ++#define SYS_CTRL_PLLSYS_CTRL (SYS_CONTROL_BASE + 0x48) ++#define SYS_CTRL_SEMA_STAT (SYS_CONTROL_BASE + 0x4C) ++#define SYS_CTRL_SEMA_SET_CTRL (SYS_CONTROL_BASE + 0x50) ++#define SYS_CTRL_SEMA_CLR_CTRL (SYS_CONTROL_BASE + 0x54) ++#define SYS_CTRL_SEMA_MASKA_CTRL (SYS_CONTROL_BASE + 0x58) ++#define SYS_CTRL_SEMA_MASKB_CTRL (SYS_CONTROL_BASE + 0x5C) ++#define SYS_CTRL_SEMA_MASKC_CTRL (SYS_CONTROL_BASE + 0x60) ++#define SYS_CTRL_CKCTRL_CTRL (SYS_CONTROL_BASE + 0x64) ++#define SYS_CTRL_COPRO_CTRL (SYS_CONTROL_BASE + 0x68) ++#define SYS_CTRL_PLLSYS_KEY_CTRL (SYS_CONTROL_BASE + 0x6C) ++#define SYS_CTRL_GMAC_CTRL (SYS_CONTROL_BASE + 0x78) ++#define SYS_CTRL_USBHSPHY_CTRL (SYS_CONTROL_BASE + 0x84) ++#define SYS_CTRL_UART_CTRL (SYS_CONTROL_BASE + 0x94) ++#define SYS_CTRL_GPIO_PWMSEL_CTRL_0 (SYS_CONTROL_BASE + 0x9C) ++#define SYS_CTRL_GPIO_PWMSEL_CTRL_1 (SYS_CONTROL_BASE + 0xA0) ++#define SYSCTRL_GPIO_MONSEL_CTRL_0 (SYS_CONTROL_BASE + 0xA4) ++#define SYSCTRL_GPIO_MONSEL_CTRL_1 (SYS_CONTROL_BASE + 0xA8) ++#define SYSCTRL_GPIO_PULLUP_CTRL_0 (SYS_CONTROL_BASE + 0xAC) ++#define SYSCTRL_GPIO_PULLUP_CTRL_1 (SYS_CONTROL_BASE + 0xB0) ++#define SYSCTRL_GPIO_ODRIVEHI_CTRL_0 (SYS_CONTROL_BASE + 0xB4) ++#define SYSCTRL_GPIO_ODRIVEHI_CTRL_1 (SYS_CONTROL_BASE + 0xB8) ++#define SYSCTRL_GPIO_ODRIVELO_CTRL_0 (SYS_CONTROL_BASE + 0xBC) ++#define SYSCTRL_GPIO_ODRIVELO_CTRL_1 (SYS_CONTROL_BASE + 0xC0) ++ ++ ++/* System control register field definitions */ ++#define SYSCTL_CB_CIS_OFFSET_0 SYS_CTRL_PCI_CTRL0 ++ ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO5 19 ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO4 18 ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO3 17 ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO2 16 ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO1 15 ++#define SYSCTL_PCI_CTRL1_PULL_UP_ENABLE_GPIO0 14 ++#define SYSCTL_PCI_CTRL1_ENPU 13 ++#define SYSCTL_PCI_CTRL1_ENCB 12 ++#define SYSCTL_PCI_CTRL1_SYSPCI_STATIC_REQ 11 ++#define SYSCTL_PCI_CTRL1_SS_HOST_E 10 ++#define SYSCTL_PCI_CTRL1_SYSPCI_PAKING_ENABLE 9 ++#define SYSCTL_PCI_CTRL1_SYSPCI_PAKING_MASTE 7 ++#define SYSCTL_PCI_CTRL1_SS_CADBUS_E 6 ++#define SYSCTL_PCI_CTRL1_SS_MINIPCI_ 5 ++#define SYSCTL_PCI_CTRL1_SS_INT_MASK_0 4 ++#define SYSCTL_PCI_CTRL1_INT_STATUS_0 3 ++#define SYSCTL_PCI_CTRL1_APP_EQUIES_NOM_CLK 2 ++#define SYSCTL_PCI_CTRL1_APP_CBUS_INT_N 1 ++#define SYSCTL_PCI_CTRL1_APP_CSTSCHG_N 0 ++ ++#define SYSCTL_PCI_STAT_SYSPCI_CLKCHG_EQ 3 ++#define SYSCTL_PCI_STAT_SYSPCI_STATIC_GNT 2 ++#define SYSCTL_PCI_STAT_INT_DISABLE_0 1 ++#define SYSCTL_PCI_STAT_CLK_CHANGED 0 ++ ++#define SYS_CTRL_CKEN_COPRO_BIT 0 ++#define SYS_CTRL_CKEN_DMA_BIT 1 ++#define SYS_CTRL_CKEN_DPE_BIT 2 ++#define SYS_CTRL_CKEN_DDR_BIT 3 ++#define SYS_CTRL_CKEN_SATA_BIT 4 ++#define SYS_CTRL_CKEN_I2S_BIT 5 ++#define SYS_CTRL_CKEN_USBHS_BIT 6 ++#define SYS_CTRL_CKEN_MAC_BIT 7 ++#define SYS_CTRL_CKEN_PCI_BIT 8 ++#define SYS_CTRL_CKEN_STATIC_BIT 9 ++ ++#define SYS_CTRL_RSTEN_ARM_BIT 0 ++#define SYS_CTRL_RSTEN_COPRO_BIT 1 ++#define SYS_CTRL_RSTEN_USBHS_BIT 4 ++#define SYS_CTRL_RSTEN_USBHSPHY_BIT 5 ++#define SYS_CTRL_RSTEN_MAC_BIT 6 ++#define SYS_CTRL_RSTEN_PCI_BIT 7 ++#define SYS_CTRL_RSTEN_DMA_BIT 8 ++#define SYS_CTRL_RSTEN_DPE_BIT 9 ++#define SYS_CTRL_RSTEN_DDR_BIT 10 ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++ #define SYS_CTRL_RSTEN_SATA_BIT 11 ++ #define SYS_CTRL_RSTEN_SATA_PHY_BIT 12 ++#elif CONFIG_HIPOX_VERSION_0X810 ++ #define SYS_CTRL_RSTEN_SATA_BIT 11 ++ #define SYS_CTRL_RSTEN_SATA_LINK_BIT 12 ++ #define SYS_CTRL_RSTEN_SATA_PHY_BIT 13 ++#endif ++ ++#define SYS_CTRL_RSTEN_STATIC_BIT 15 ++#define SYS_CTRL_RSTEN_GPIO_BIT 16 ++#define SYS_CTRL_RSTEN_UART1_BIT 17 ++#define SYS_CTRL_RSTEN_UART2_BIT 18 ++#define SYS_CTRL_RSTEN_MISC_BIT 19 ++#define SYS_CTRL_RSTEN_I2S_BIT 20 ++#define SYS_CTRL_RSTEN_AHB_MON_BIT 21 ++#define SYS_CTRL_RSTEN_UART3_BIT 22 ++#define SYS_CTRL_RSTEN_UART4_BIT 23 ++#define SYS_CTRL_RSTEN_SGDMA_BIT 24 ++#define SYS_CTRL_RSTEN_BUS_BIT 31 ++ ++#define SYS_CTRL_USBHSMPH_IP_POL_A_BIT 0 ++#define SYS_CTRL_USBHSMPH_IP_POL_B_BIT 1 ++#define SYS_CTRL_USBHSMPH_IP_POL_C_BIT 2 ++#define SYS_CTRL_USBHSMPH_OP_POL_A_BIT 3 ++#define SYS_CTRL_USBHSMPH_OP_POL_B_BIT 4 ++#define SYS_CTRL_USBHSMPH_OP_POL_C_BIT 5 ++ ++#define SYS_CTRL_GMAC_RGMII 2 ++#define SYS_CTRL_GMAC_SIMPLE_MAX 1 ++#define SYS_CTRL_GMAC_CKEN_GTX 0 ++ ++#define SYS_CTRL_CKCTRL_CTRL_PCIDIV_BIT 0 ++#define SYS_CTRL_CKCTRL_CTRL_PCIDIV_NUM_BITS 4 ++ ++#define SYS_CTRL_USBHSPHY_SUSPENDM_MANUAL_ENABLE 16 ++#define SYS_CTRL_USBHSPHY_SUSPENDM_MANUAL_STATE 15 ++#define SYS_CTRL_USBHSPHY_ATE_ESET 14 ++#define SYS_CTRL_USBHSPHY_TEST_DIN 6 ++#define SYS_CTRL_USBHSPHY_TEST_ADD 2 ++#define SYS_CTRL_USBHSPHY_TEST_DOUT_SEL 1 ++#define SYS_CTRL_USBHSPHY_TEST_CLK 0 ++ ++#define SYS_CTRL_UART2_DEQ_EN 0 ++#define SYS_CTRL_UART3_DEQ_EN 1 ++#define SYS_CTRL_UART3_IQ_EN 2 ++#define SYS_CTRL_UART4_IQ_EN 3 ++#define SYS_CTRL_UART4_NOT_PCI_MODE 4 ++ ++/* DDR core registers */ ++#define DDR_CFG_REG (DDR_REGS_BASE + 0x00) ++#define DDR_BLKEN_REG (DDR_REGS_BASE + 0x04) ++#define DDR_STAT_REG (DDR_REGS_BASE + 0x08) ++#define DDR_CMD_REG (DDR_REGS_BASE + 0x0C) ++#define DDR_AHB_REG (DDR_REGS_BASE + 0x10) ++#define DDR_DLL_REG (DDR_REGS_BASE + 0x14) ++#define DDR_MON_REG (DDR_REGS_BASE + 0x18) ++#define DDR_DIAG_REG (DDR_REGS_BASE + 0x1C) ++#define DDR_DIAG2_REG (DDR_REGS_BASE + 0x20) ++#define DDR_IOC_REG (DDR_REGS_BASE + 0x24) ++#define DDR_ARB_REG (DDR_REGS_BASE + 0x28) ++#define DDR_AHB2_REG (DDR_REGS_BASE + 0x2C) ++#define DDR_BUSY_REG (DDR_REGS_BASE + 0x30) ++#define DDR_TIMING0_REG (DDR_REGS_BASE + 0x34) ++#define DDR_TIMING1_REG (DDR_REGS_BASE + 0x38) ++#define DDR_TIMING2_REG (DDR_REGS_BASE + 0x3C) ++#define DDR_AHB3_REG (DDR_REGS_BASE + 0x40) ++#define DDR_AHB4_REG (DDR_REGS_BASE + 0x44) ++#define DDR_PHY0_REG (DDR_REGS_BASE + 0x48) ++#define DDR_PHY1_REG (DDR_REGS_BASE + 0x4C) ++#define DDR_PHY2_REG (DDR_REGS_BASE + 0x50) ++#define DDR_PHY3_REG (DDR_REGS_BASE + 0x54) ++ ++/* DDR core register field definitions */ ++#define DDR_BLKEN_CLIENTS_BIT 0 ++#define DDR_BLKEN_CLIENTS_NUM_BITS 16 ++#define DDR_BLKEN_DDR_BIT 31 ++ ++#define DDR_AHB_FLUSH_RCACHE_BIT 0 ++#define DDR_AHB_FLUSH_RCACHE_NUM_BITS 16 ++ ++#define DDR_AHB_FLUSH_RCACHE_ARMD_BIT 0 ++#define DDR_AHB_FLUSH_RCACHE_ARMI_BIT 1 ++#define DDR_AHB_FLUSH_RCACHE_COPRO_BIT 2 ++#define DDR_AHB_FLUSH_RCACHE_DMAA_BIT 3 ++#define DDR_AHB_FLUSH_RCACHE_DMAB_BIT 4 ++#define DDR_AHB_FLUSH_RCACHE_PCI_BIT 5 ++#define DDR_AHB_FLUSH_RCACHE_GMAC_BIT 6 ++#define DDR_AHB_FLUSH_RCACHE_USB_BIT 7 ++ ++#define DDR_AHB_NO_RCACHE_BIT 16 ++#define DDR_AHB_NO_RCACHE_NUM_BITS 16 ++ ++#define DDR_AHB_NO_RCACHE_ARMD_BIT 16 ++#define DDR_AHB_NO_RCACHE_ARMI_BIT 17 ++#define DDR_AHB_NO_RCACHE_COPRO_BIT 18 ++#define DDR_AHB_NO_RCACHE_DMAA_BIT 19 ++#define DDR_AHB_NO_RCACHE_DMAB_BIT 20 ++#define DDR_AHB_NO_RCACHE_PCI_BIT 21 ++#define DDR_AHB_NO_RCACHE_GMAC_BIT 22 ++#define DDR_AHB_NO_RCACHE_USB_BIT 23 ++ ++#define DDR_MON_CLIENT_BIT 0 ++#define DDR_MON_ALL_BIT 4 ++ ++#define DDR_DIAG_HOLDOFFS_BIT 20 ++#define DDR_DIAG_HOLDOFFS_NUM_BITS 12 ++#define DDR_DIAG_WRITES_BIT 10 ++#define DDR_DIAG_WRITES_NUM_BITS 10 ++#define DDR_DIAG_READS_BIT 0 ++#define DDR_DIAG_READS_NUM_BITS 10 ++ ++#define DDR_DIAG2_DIRCHANGES_BIT 0 ++#define DDR_DIAG2_DIRCHANGES_NUM_BITS 10 ++ ++#define DDR_ARB_DATDIR_NCH_BIT 0 ++#define DDR_ARB_DATDIR_EN_BIT 1 ++#define DDR_ARB_REQAGE_EN_BIT 2 ++#define DDR_ARB_LRUBANK_EN_BIT 3 ++#define DDR_ARB_MIDBUF_BIT 4 ++ ++#define DDR_AHB2_IGNORE_HPROT_BIT 0 ++#define DDR_AHB2_IGNORE_HPROT_NUM_BITS 16 ++ ++#define DDR_AHB2_IGNORE_HPROT_ARMD_BIT 0 ++#define DDR_AHB2_IGNORE_HPROT_ARMI_BIT 1 ++#define DDR_AHB2_IGNORE_HPROT_COPRO_BIT 2 ++#define DDR_AHB2_IGNORE_HPROT_DMAA_BIT 3 ++#define DDR_AHB2_IGNORE_HPROT_DMAB_BIT 4 ++#define DDR_AHB2_IGNORE_HPROT_PCI_BIT 5 ++#define DDR_AHB2_IGNORE_HPROT_GMAC_BIT 6 ++#define DDR_AHB2_IGNORE_HPROT_USB_BIT 7 ++ ++#define DDR_AHB2_IGNORE_WRAP_BIT 16 ++#define DDR_AHB2_IGNORE_WRAP_NUM_BITS 16 ++ ++#define DDR_AHB2_IGNORE_WRAP_ARMD_BIT 16 ++#define DDR_AHB2_IGNORE_WRAP_ARMI_BIT 17 ++#define DDR_AHB2_IGNORE_WRAP_COPRO_BIT 18 ++#define DDR_AHB2_IGNORE_WRAP_DMAA_BIT 19 ++#define DDR_AHB2_IGNORE_WRAP_DMAB_BIT 20 ++#define DDR_AHB2_IGNORE_WRAP_PCI_BIT 21 ++#define DDR_AHB2_IGNORE_WRAP_GMAC_BIT 22 ++#define DDR_AHB2_IGNORE_WRAP_US_BIT 23 ++ ++#define DDR_AHB3_DIS_BURST_BIT 0 ++#define DDR_AHB3_DIS_BURST_NUM_BITS 16 ++ ++#define DDR_AHB3_DIS_BURST_ARMD_BIT 0 ++#define DDR_AHB3_DIS_BURST_ARMI_BIT 1 ++#define DDR_AHB3_DIS_BURST_COPRO_BIT 2 ++#define DDR_AHB3_DIS_BURST_DMAA_BIT 3 ++#define DDR_AHB3_DIS_BURST_DMAB_BIT 4 ++#define DDR_AHB3_DIS_BURST_PCI_BIT 5 ++#define DDR_AHB3_DIS_BURST_GMAC_BIT 6 ++#define DDR_AHB3_DIS_BURST_USB_BIT 7 ++ ++#define DDR_AHB3_DIS_NONCACHE_BIT 16 ++#define DDR_AHB3_DIS_NONCACHE_NUM_BITS 16 ++ ++#define DDR_AHB3_DIS_NONCACHE_ARMD_BIT 16 ++#define DDR_AHB3_DIS_NONCACHE_ARMI_BIT 17 ++#define DDR_AHB3_DIS_NONCACHE_COPRO_BIT 18 ++#define DDR_AHB3_DIS_NONCACHE_DMAA_BIT 19 ++#define DDR_AHB3_DIS_NONCACHE_DMAB_BIT 20 ++#define DDR_AHB3_DIS_NONCACHE_PCI_BIT 21 ++#define DDR_AHB3_DIS_NONCACHE_GMAC_BIT 22 ++#define DDR_AHB3_DIS_NONCACHE_USB_BIT 23 ++ ++#define DDR_AHB4_EN_TIMEOUT_BIT 0 ++#define DDR_AHB4_EN_TIMEOUT_NUM_BITS 16 ++ ++#define DDR_AHB4_EN_TIMEOUT_ARMD_BIT 0 ++#define DDR_AHB4_EN_TIMEOUT_ARMI_BIT 1 ++#define DDR_AHB4_EN_TIMEOUT_COPRO_BIT 2 ++#define DDR_AHB4_EN_TIMEOUT_DMAA_BIT 3 ++#define DDR_AHB4_EN_TIMEOUT_DMAB_BIT 4 ++#define DDR_AHB4_EN_TIMEOUT_PCI_BIT 5 ++#define DDR_AHB4_EN_TIMEOUT_GMAC_BIT 6 ++#define DDR_AHB4_EN_TIMEOUT_USB_BIT 7 ++ ++#define DDR_AHB4_EN_WRBEHIND_BIT 16 ++#define DDR_AHB4_EN_WRBEHIND_NUM_BITS 16 ++ ++#define DDR_AHB4_EN_WRBEHIND_ARMD_BIT 16 ++#define DDR_AHB4_EN_WRBEHIND_ARMI_BIT 17 ++#define DDR_AHB4_EN_WRBEHIND_COPRO_BIT 18 ++#define DDR_AHB4_EN_WRBEHIND_DMAA_BIT 19 ++#define DDR_AHB4_EN_WRBEHIND_DMAB_BIT 20 ++#define DDR_AHB4_EN_WRBEHIND_PCI_BIT 21 ++#define DDR_AHB4_EN_WRBEHIND_GMAC_BIT 22 ++#define DDR_AHB4_EN_WRBEHIND_USB_BIT 23 ++ ++/* AHB monitor base addresses */ ++#define AHB_MON_ARM_D (AHB_MON_BASE + 0x00000) ++#define AHB_MON_ARM_I (AHB_MON_BASE + 0x10000) ++#define AHB_MON_DMA_A (AHB_MON_BASE + 0x20000) ++#define AHB_MON_DMA_B (AHB_MON_BASE + 0x30000) ++#define AHB_MON_LEON (AHB_MON_BASE + 0x40000) ++#define AHB_MON_USB (AHB_MON_BASE + 0x50000) ++#define AHB_MON_MAC (AHB_MON_BASE + 0x60000) ++#define AHB_MON_PCI (AHB_MON_BASE + 0x70000) ++ ++/* AHB write monitor registers */ ++#define AHB_MON_MODE_REG_OFFSET 0x00 ++#define AHB_MON_HWRITE_REG_OFFSET 0x04 ++#define AHB_MON_HADDR_LOW_REG_OFFSET 0x08 ++#define AHB_MON_HADDR_HIGH_REG_OFFSET 0x0C ++#define AHB_MON_HBURST_REG_OFFSET 0x10 ++#define AHB_MON_HPROT_REG_OFFSET 0x14 ++ ++/* AHB monitor write register field definitions */ ++#define AHB_MON_MODE_MODE_BIT 0 ++#define AHB_MON_MODE_MODE_NUM_BITS 2 ++#define AHB_MON_HWRITE_COUNT_BIT 0 ++#define AHB_MON_HWRITE_COUNT_NUM_BITS 2 ++#define AHB_MON_HBURST_MASK_BIT 0 ++#define AHB_MON_HBURST_MASK_NUM_BITS 3 ++#define AHB_MON_HBURST_MATCH_BIT 4 ++#define AHB_MON_HBURST_MATCH_NUM_BITS 3 ++#define AHB_MON_HPROT_MASK_BIT 0 ++#define AHB_MON_HPROT_MASK_NUM_BITS 4 ++#define AHB_MON_HPROT_MATCH_BIT 4 ++#define AHB_MON_HPROT_MATCH_NUM_BITS 4 ++ ++#ifndef __ASSEMBLY__ ++typedef enum AHB_MON_MODES { ++ AHB_MON_MODE_IDLE, ++ AHB_MON_MODE_ACTIVE, ++ AHB_MON_MODE_RESET ++} AHB_MON_MODES_T; ++ ++typedef enum AHB_MON_HWRITE { ++ AHB_MON_HWRITE_INACTIVE, ++ AHB_MON_HWRITE_WRITES, ++ AHB_MON_HWRITE_READS, ++ AHB_MON_HWRITE_READS_AND_WRITES ++} AHB_MON_HWRITE_T; ++ ++typedef enum AHB_MON_HBURST { ++ AHB_MON_HBURST_SINGLE, ++ AHB_MON_HBURST_INCR, ++ AHB_MON_HBURST_WRAP4, ++ AHB_MON_HBURST_INCR4, ++ AHB_MON_HBURST_WRAP8, ++ AHB_MON_HBURST_INCR8, ++ AHB_MON_HBURST_WRAP16, ++ AHB_MON_HBURST_INCR16 ++} AHB_MON_HBURST_T; ++#endif // __ASSEMBLY__ ++ ++/* AHB read monitor registers */ ++#define AHB_MON_CYCLES_REG_OFFSET 0x00 ++#define AHB_MON_TRANSFERS_REG_OFFSET 0x04 ++#define AHB_MON_WAITS_REG_OFFSET 0x08 ++ ++#define STATIC_BUS1_CONTROL_VALUE 0x04010484 /* 200nS rd/wr cycles to allow DMAing to SMC91x on static bus */ ++ ++/* PCI bus definitions */ ++#define pcibios_assign_all_busses() 1 ++#define PCIBIOS_MIN_IO 0x1000 /* used for memory alignememnt guesstimate */ ++#define PCIBIOS_MIN_MEM 0x00100000 /* used for memory alignememnt guesstimate */ ++ ++/* PCI bus commands - see pci spec */ ++#define PCI_BUS_CMD_INTERRUPT_ACKNOWLEDGE 0x00 ++#define PCI_BUS_CMD_SPECIAL_CYCLE 0x01 ++#define PCI_BUS_CMD_IO_READ 0x02 ++#define PCI_BUS_CMD_IO_WRITE 0x03 ++/*#define PCI_BUS_RESERVED 0x04 */ ++/*#define PCI_BUS_RESERVED 0x05 */ ++#define PCI_BUS_CMD_MEMORY_READ 0x06 ++#define PCI_BUS_CMD_MEMORY_WRITE 0x07 ++/*#define PCI_BUS_RESERVED 0x08 */ ++/*#define PCI_BUS_RESERVED 0x09 */ ++#define PCI_BUS_CMD_CONFIGURATION_READ 0x0a ++#define PCI_BUS_CMD_CONFIGURATION_WRITE 0x0b ++#define PCI_BUS_CMD_MEMORY_READ_MULTIPLE 0x0c ++#define PCI_BUS_CMD_DUAL_ADDRESS_CYCLE 0x0d ++#define PCI_BUS_CMD_MEMORY_READ_LINE 0x0e ++#define PCI_BUS_CMD_MEMORY_WRITE_AND_INVALIDATE 0x0f ++ ++/* synopsis PCI core register set */ ++#define PCI_CORE_REG_START PCI_CSRS_BASE ++#define PCI_CRP_CMD_AND_ADDR PCI_CORE_REG_START ++#define PCI_CRP_WRITE_DATA (PCI_CRP_CMD_AND_ADDR + 4) ++#define PCI_CRP_READ_DATA (PCI_CRP_WRITE_DATA + 4) ++#define PCI_CONFIG_IO_CYCLE_ADDR (PCI_CRP_READ_DATA + 4) ++#define PCI_CONFIG_IO_BYTE_CMD (PCI_CONFIG_IO_CYCLE_ADDR + 4) ++#define PCI_CONFIG_IO_WRITE_DATA (PCI_CONFIG_IO_BYTE_CMD + 4) ++#define PCI_CONFIG_IO_READ_DATA (PCI_CONFIG_IO_WRITE_DATA + 4) ++#define PCI_ERROR_MSG (PCI_CONFIG_IO_READ_DATA + 4) ++#define PCI_TRANS_ERROR_START_ADDR (PCI_ERROR_MSG + 4) ++#define PCI_AHB_ERROR_LSB (PCI_TRANS_ERROR_START_ADDR + 4) ++#define PCI_AHB_ERROR_START_ADDR (PCI_AHB_ERROR_LSB + 4) ++#define PCI_FLUSH_FIFO_ON_ERR (PCI_AHB_ERROR_START_ADDR + 4) ++#define PCI_TAR_ID (PCI_FLUSH_FIFO_ON_ERR + 4) ++#define PCI_MAS_ID_IN (PCI_TAR_ID + 4) ++#define PCI_CORE_REG_END (PCI_MAS_ID_IN + 4) ++ ++/* register bit offsets */ ++#define PCI_CRP_ADDRESS_START 0 ++#define PCI_CRP_ADDRESS_END 10 ++#define PCI_CRP_CMD_START 16 ++#define PCI_CRP_CMD_END 19 ++#define PCI_CRP_BYTE_ENABLES_START 20 ++#define PCI_CRP_BYTE_ENABLES_END 23 ++ ++#define PCI_CONFIG_IO_CMD_START 0 ++#define PCI_CONFIG_IO_CMD_END 3 ++#define PCI_CONFIG_IO_BYTE_ENABLES_START 4 ++#define PCI_CONFIG_IO_BYTE_ENABLES_END 7 ++ ++#define PCI_ERR_MESSAGE_START 0 ++#define PCI_ERR_MESSAGE_END 1 ++ ++#define PCI_AHB_ERR_BIT 0 ++ ++#define PCI_FLUSH_FIFO_ON_ERR_BIT 0 ++ ++#define PCI_TAR_ID_START 0 ++#define PCI_TAR_ID_END 2 ++ ++#define PCI_MAS_ID_IN_START 0 ++#define PCI_MAS_ID_IN_END 2 ++ ++/* PWM register definitions */ ++#define PWM_DATA_REGISTER_BASE (PWM_BASE) ++#define PWM_CLOCK_REGISTER (PWM_BASE+0X400) ++ ++#endif // __ASM_ARCH_HARDWARE_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/i2s.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/i2s.h +--- linux-2.6.24/include/asm-arm/arch-hipox/i2s.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/i2s.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,1023 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/i2s.h ++ * ++ * 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 __ASM_ARM_ARCH_I2S_H ++#define __ASM_ARM_ARCH_I2S_H ++ ++#include "hardware.h" ++ ++/* Routines ----------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++ ++extern void DumpI2SRegisters(void); ++ ++ ++ ++/* Registers ---------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++ ++ ++#define TX_CONTROL (0x0000 + I2S_BASE) ++#define TX_SETUP (0x0004 + I2S_BASE) ++#define TX_SETUP1 (0x0008 + I2S_BASE) ++#define TX_STATUS (0x000C + I2S_BASE) ++#define RX_CONTROL (0x0010 + I2S_BASE) ++#define RX_SETUP (0x0014 + I2S_BASE) ++#define RX_SETUP1 (0x0018 + I2S_BASE) ++#define RX_STATUS (0x001C + I2S_BASE) ++#define TX_DEBUG (0x0020 + I2S_BASE) ++#define TX_DEBUG2 (0x0024 + I2S_BASE) ++#define TX_DEBUG3 (0x0028 + I2S_BASE) ++#define RX_DEBUG_ (0x0030 + I2S_BASE) ++#define RX_DEBUG2 (0x0034 + I2S_BASE) ++#define RX_DEBUG3 (0x0038 + I2S_BASE) ++#define TX_BUFFER_LEVEL (0x0040 + I2S_BASE) ++#define TX_BUFFER_INTERRUPT_LEVEL (0x0048 + I2S_BASE) ++#define RX_BUFFER_LEVEL (0x0050 + I2S_BASE) ++#define RX_BUFFER_INTERRUPT_LEVEL (0x0058 + I2S_BASE) ++#define RX_SPDIF_DEBUG (0x0070 + I2S_BASE) ++#define RX_SPDIF_DEBUG2 (0x0074 + I2S_BASE) ++#define INTERRUPT_CONTROL_STATUS (0x0080 + I2S_BASE) ++#define INTERRUPT_MASK (0x0084 + I2S_BASE) ++#define VERSION (0x008C + I2S_BASE) ++#define TX_DATA_IN_FORMAT (0x0100 + I2S_BASE) ++#define TX_CHANNELS_ENABLE (0x0104 + I2S_BASE) ++#define TX_WRITES_TO (0x0108 + I2S_BASE) ++#define RX_DATA_OUT_FORMAT (0x0200 + I2S_BASE) ++#define RX_CHANNELS_ENABLE (0x0204 + I2S_BASE) ++#define RX_READS_FROM (0x0208 + I2S_BASE) ++#define TX_CPU_DATA_WRITES_ALT (0x04FF + I2S_BASE) ++#define RX_CPU_DATA_READS_ALT (0x08FF + I2S_BASE) ++#define TX_CPU_DATA_WRITES (0x1FFF + I2S_BASE) ++#define RX_CPU_DATA_READS (0x2FFF + I2S_BASE) ++ ++ ++ ++/* TX_CONTROL ------------ */ ++#define TX_CONTROL_ENABLE 0 ++ /** ++ * 0 - Audio transmit is disabled ++ * 1 - Audio transmit is enabled. ++ */ ++#define TX_CONTROL_FLUSH 1 ++ /** ++ * 0 - Normal Operation ++ * 1 - Flush TX buffer ++ */ ++#define TX_CONTROL_MUTE 2 ++ /** ++ * 0 - Normal Operation ++ * 1 - Muted operation ++ */ ++#define TX_CONTROL_TRICK 3 ++ /** ++ * (UNTESTED FEATURE) ++ * 0 - Trickplay features disabled ++ * 1 - Trickplay features enabled ++ */ ++#define TX_CONTROL_SPEED 4 ++ /** ++ * (UNTESTED FEATURE) ++ * 00 - Quarter speed playback - DOESN’T WORK ++ * 01 - Half speed playback - DOESN’T WORK ++ * 10 - Double speed playback ++ * 11 - Quadruple speed playback. ++ */ ++ #define QUARTER_SPEED_PLAYBACK 0x00 ++ #define HALF_SPEED_PLAYBACK 0x01 ++ #define DOUBLE_SPEED_PLAYBACK 0x02 ++ #define QUADRUPLE_SPEED_PLAYBACK 0x03 ++#define TX_CONTROL_ABORT_DMA 6 ++ /** ++ * Write a 1 to abort any outstanding DMAs (self-clearing) ++ */ ++#define TX_CONTROL_AHB_ENABLE 8 ++ /** ++ * 0 - AHB disabled (APB only) ++ * 1 - AHB enabled (APB disabled for data plane) ++ */ ++#define TX_CONTROL_QUAD_BURSTS 9 ++ /** ++ * 0 - DMA transfers up to Single Quads ++ * 1 - DMA transfers up to Bursts of 4 Quads ++ */ ++ ++ ++/* TX_SETUP ------------ */ ++/** ++ * In order for the changes made to the fields in bold to propagate to the Tx ++ * audio clock domain, a write must be performed to TX_SETUP1 And the TX_CLK ++ * must be running. ++ */ ++ ++#define TX_SETUP_FORMAT 0 ++ /** ++ * 00 - True/Early-I2S (standard format) ++ * 01 - Late-I2S ++ * 10 - MP3 Valid ++ * 11 - MP3 Start ++ */ ++ #define TRUE_I2S 0x00 ++ #define LATE_I2S 0x01 ++ #define MP3_VALID 0x02 ++ #define MP3_START 0x03 ++#define TX_SETUP_MODE 2 ++ /** ++ * 0 - Slave ++ * 1 - Master ++ */ ++ #define I2S_SLAVE 0x00 ++ #define I2S_MASTER 0x01 ++#define TX_SETUP_FLOW_INVERT 3 ++ /** ++ * 0 - Flow Control is active high ++ * (ie. Audio core is held off when TX_FLOW_CONTROL=’1’) ++ * 1 - Flow Control is active low ++ * (ie. Audio core is held off when TX_FLOW_CONTROL=’0’) ++ */ ++ #define FLOW_CONTROL_ACTIVE_HIGH 0 ++ #define FLOW_CONTROL_ACTIVE_LOW 1 ++#define TX_SETUP_POS_EDGE 4 ++ /** ++ * 0 - Data is output on the negative edge of the TX Audio clock ++ * 1 - Data is output on the positive edge of the TX Audio clock ++ */ ++#define TX_SETUP_CLOCK_STOP 5 ++ /** ++ * 0 - Audio TX clock should not be stopped during flow control hold off ++ * 1 - Audio TX clock should be stopped during flow control hold off ++ */ ++#define TX_SETUP_SPLIT_QUAD 6 ++ /** ++ * 0 - No splitting ++ * 1 - Split quadlet into two 16 bit samples - NOT VALID FOR S/PDIF ++ */ ++#define TX_SETUP_INSPECT_WORD_CLOCK 7 ++ /** ++ * Used when recovering from underrun. This bit is set to look for either ++ * a high or low word clock before the hardware carries on as normal. ++ */ ++#define TX_SETUP_SPDIF_EN 8 ++ /** ++ * 0 - No SPDIF on Channel 0 (disables biphase coding on output) ++ * 1 - SPDIF on Channel 0 (enables the biphase coding even when Tx disabled) ++ */ ++ ++ ++/* TX_SETUP1 ------------ */ ++#define TX_SETUP1_INPUT 0 ++ /** ++ * 00 - Twos Compliment (pass-thru) ++ * 01 - Offset Binary ++ * 10 - Sign Magnitude ++ * 11 - Reserved ++ */ ++ #define TWOS_COMPLIMENT 0x00 ++ #define OFFSET_BINARY 0x01 ++ #define SIGN_MAGNITUDE 0x02 ++ #define RESERVED 0x03 ++#define TX_SETUP1_REVERSE 2 ++ /** ++ * 0 - Normal operation ++ * 1 - Reverse Stereo - DOES NOT WORK FOR NON- SPLIT_QUAD/MP3 ++ */ ++#define TX_SETUP1_INVERT 3 ++ /** ++ * 0 - Normal operation ++ * 1 - Inverted word clock ++ */ ++#define TX_SETUP1_BIG_ENDIAN 4 ++ /** ++ * 0 - System data is in little endian format ++ * 1 - System data is in big endian format ++ */ ++#define TX_SETUP1_QUAD_ENDIAN 5 ++ /** ++ * 0 - System data is 16 bit. ++ * 1 - System data is 32 bit ++ */ ++#define TX_SETUP1_QUAD_SAMPLES 6 ++ /** ++ * 0 - I2S Master word clock uses 16 bit samples - NOT VALID FOR S/PDIF ++ * 1 - I2S Master word clock uses 32 bit samples ++ */ ++#define TX_SETUP1_FLOW_CONTROL 7 ++ /** ++ * 0 - No flow control (MP3 only) ++ * 1 - Flow control (MP3 only) ++ */ ++ ++/* TX_STATUS ------------ */ ++#define TX_STATUS_UNDERRUN 0 ++ /** ++ * 0 - Underrun has not occurred. ++ * 1 - Underrun has occurred. (Note that this bit must be written to with ++ * a ‘1’ to clear) ++ */ ++#define TX_STATUS_OVERRUN 1 ++ /** ++ * 0 - Overrun has not occurred. ++ * 1 - Overrun has occurred. (Note that this bit must be written to with ++ * a ‘1’ to clear) ++ */ ++#define TX_STATUS_FIFO_UNDERRUN 2 ++ ++ /** ++ * 0 - FIFO Underrun has not occurred. ++ * 1 - FIFO Underrun has occurred. (Note that this bit must be written to ++ * with a ‘1’ to clear) ++ */ ++#define TX_STATUS_FIFO_OVERRUN 3 ++ /** ++ * 0 - FIFO Overrun has not occurred. ++ * 1 - FIFO Overrun has occurred. (Note that this bit must be written to ++ * with a ‘1’ to clear) ++ */ ++#define TX_STATUS_HW_READ 8 ++ /** ++ * 0 - H/W Read of FIFO has not occurred. ++ * 1 - H/W Read of FIFO has occurred. (Note that this bit must be written ++ * to with a ‘1’ to clear) ++ */ ++#define TX_STATUS_BUFFER_LEVEL_MET 9 ++ /** ++ * 0 - Fill level of FIFO does not match BUFFER_INTERRUPT_LEVEL. ++ * 1 - Fill level of FIFO matches BUFFER_INTERRUPT_LEVEL ++ */ ++ ++ ++/* RX_CONTROL ------------ */ ++#define RX_CONTROL_ENABLE 0 ++ /** ++ * 0 - Audio receive is disabled ++ * 1 - Audio receive is enabled. ++ */ ++#define RX_CONTROL_FLUSH 1 ++ /** ++ * 0 - Normal Operation ++ * 1 - Flush RX buffer ++ */ ++#define RX_CONTROL_MUTE 2 ++ /** ++ * 0 - Normal Operation ++ * 1 - Muted operation ++ */ ++#define RX_CONTROL_TRICK 3 ++ /** ++ * (UNTESTED FEATURE) ++ * 0 - Trickplay features disabled ++ * 1 - Trickplay features enabled ++ */ ++#define RX_CONTROL_SPEED 4 ++ /** ++ * (UNTESTED FEATURE) ++ * 00 - Quarter speed playback - DOESN’T WORK ++ * 01 - Half speed playback - DOESN’T WORK ++ * 10 - Double speed playback ++ * 11 - Quadruple speed playback. ++ */ ++#define RX_CONTROL_ABORT_DMA 6 ++ /** ++ * Write a 1 to abort any outstanding DMAs (self-clearing) ++ */ ++#define RX_CONTROL_AHB_ENABLE 8 ++ /** ++ * 0 - AHB disabled (APB only) ++ * 1 - AHB enabled (APB disabled for data plane) ++ */ ++#define RX_CONTROL_QUAD_BURSTS 9 ++ /** ++ * 0 - DMA transfers up to Single Quads ++ * 1 - DMA transfers up to Bursts of 4 Quads ++ */ ++ ++ ++/* RX_SETUP ------------ */ ++/** ++ * In order for the changes made to the fields in bold to propagate to the Rx ++ * audio clock domain, a write must be performed to RX_SETUP1 And the RX_CLK ++ * must be running. ++ */ ++ ++#define RX_SETUP_FORMAT 0 ++ /** ++ * 00 - True/Early-I2S (standard format) ++ * 01 - Late-I2S ++ * 10 - MP3 Valid ++ * 11 - MP3 Start ++ */ ++#define RX_SETUP_MODE 2 ++ /** ++ * 0 - Slave ++ * 1 - Master - NOT VALID FOR S/PDIF ++ */ ++#define RX_SETUP_POS_EDGE 4 ++ /** ++ * 0 - Data is output on the negative edge of the RX Audio clock ++ * 1 - Data is output on the positive edge of the RX Audio clock ++ */ ++#define RX_SETUP_COMBINE_QUAD 6 ++ /** ++ * 0 - No combining ++ * 1 - Combine two 16 bit samples into single quadlet - NOT VALID FOR S/PDIF ++ */ ++#define RX_SETUP_INSPECT_WORD_CLOCK 7 ++ /** ++ * Used when recovering from overrun. This bit is set to look for either ++ * a high or low word clock before the hardware carries on as normal. ++ */ ++#define RX_SETUP_SPDIF_EN 8 ++ /** ++ * 0 - No SPDIF on Channel 0 (disables biphase decoding and clk recovery on input) ++ * 1 - SPDIF on Channel 0 (enables the biphase decoding and clk recovery even when Rx disabled) ++ */ ++#define RX_SETUP_SPDIF_DEBUG_EN 9 ++ /** ++ * Provides direct control over RX_SPDIF_OE Output signal ++ */ ++ ++ ++/* RX_SETUP1 ------------ */ ++#define RX_SETUP1_INPUT 0 ++ /** ++ * 00 - Twos Compliment (pass-thru) ++ * 01 - Offset Binary ++ * 10 - Sign Magnitude ++ * 11 - Reserved ++ */ ++#define RX_SETUP1_REVERSE 2 ++ /** ++ * 0 - Normal operation ++ * 1 - Reverse Stereo - DOES NOT WORK FOR NON- SPLIT_QUAD/MP3 ++ */ ++#define RX_SETUP1_INVERT 3 ++ /** ++ * 0 - Normal operation ++ * 1 - Inverted word clock ++ */ ++#define RX_SETUP1_BIG_ENDIAN 4 ++ /** ++ * 0 - System data is in little endian format ++ * 1 - System data is in big endian format ++ */ ++#define RX_SETUP1_QUAD_ENDIAN 5 ++ /** ++ * 0 - System data is 16 bit. ++ * 1 - System data is 32 bit ++ */ ++#define RX_SETUP1_QUAD_SAMPLES 6 ++ /** ++ * 0 - I2S Master word clock uses 16 bit samples - NOT VALID FOR S/PDIF ++ * 1 - I2S Master word clock uses 32 bit samples ++ */ ++ ++ ++/* RX_STATUS ------------ */ ++#define RX_STATUS_UNDERRUN 0 ++ /** ++ * 0 - Underrun has not occurred. ++ * 1 - Underrun has occurred. (Note that this bit must be written to with ++ * a ‘1’ to clear) ++ */ ++#define RX_STATUS_OVERRUN 1 ++ /** ++ * 0 - Overrun has not occurred. ++ * 1 - Overrun has occurred. (Note that this bit must be written to with ++ * a ‘1’ to clear) ++ */ ++#define RX_STATUS_FIFO_UNDERRUN 2 ++ /** ++ * 0 - FIFO Underrun has not occurred. ++ * 1 - FIFO Underrun has occurred. (Note that this bit must be written to ++ * with a ‘1’ to clear) ++ */ ++#define RX_STATUS_FIFO_OVERRUN 3 ++ /** ++ * 0 - FIFO Overrun has not occurred. ++ * 1 - FIFO Overrun has occurred. (Note that this bit must be written to ++ * with a ‘1’ to clear) ++ */ ++#define RX_STATUS_SPDIF_PARITY_ERROR 4 ++ /** ++ * 0 - Rx S/PDIF Parity Error has not occurred. ++ * 1 - Rx S/PDIF Parity Error has occurred. (Note that this bit must be ++ * written to with a ‘1’ to clear) ++ */ ++#define RX_STATUS_SPDIF_PREAMBLE_ERROR 5 ++ /** ++ * 0 - Rx S/PDIF Preamble Error has not occurred. ++ * 1 - Rx S/PDIF Preamble Error has occurred. (Note that this bit must be ++ * written to with a ‘1’ to clear) ++ */ ++#define RX_STATUS_SPDIF_FRAMING_ERROR 6 ++ /** ++ * 0 - Rx S/PDIF Framing Error has not occurred. ++ * 1 - Rx S/PDIF Framing Error has occurred. (Note that this bit must be ++ * written to with a ‘1’ to clear) ++ */ ++#define RX_STATUS_SPDIF_LOCK_EVENT 7 ++ /** ++ * 0 - Rx S/PDIF Lock status has not changed. ++ * 1 - Rx S/PDIF Lock status has changed. (Note that this bit must be ++ * written to with a ‘1’ to clear) ++ */ ++#define RX_STATUS_HW_WRITE 8 ++ /** ++ * 0 - H/W Write of FIFO has not occurred. ++ * 1 - H/W Write of FIFO has occurred. (Note that this bit must be written ++ * to with a ‘1’ to clear) ++ */ ++#define RX_STATUS_BUFFER_LEVEL_MET 9 ++ /** ++ * 0 - Fill level of FIFO does not match BUFFER_INTERRUPT_LEVEL. ++ * 1 - Fill level of FIFO matches BUFFER_INTERRUPT_LEVEL ++ */ ++#define RX_STATUS_SPDIF_LOCK 10 ++ /** ++ * 0 - Rx S/PDIF timing is not locked. ++ * 1 - Rx S/PDIF timing is locked. ++ */ ++ ++ ++/* TX_DEBUG ------------ */ ++#define TX_DEBUG_TX_DMA_STATE 0 ++ /** ++ * 00 - START ++ * 01 - IDLE ++ * 10 - BURST ++ * 11 - NON_ALIGNED ++ */ ++#define TX_DEBUG_WRITE_OFFSET 4 ++ /** ++ * Write Offset Determines the alignment of the writes ++ * (0=quad aligned; 1/3=bytes aligned; 2 doublet aligned) ++ */ ++#define TX_DEBUG_TX_DREQ 31 ++ /** ++ * Set if DMA request for Tx is set ++ */ ++ ++ ++/* TX_DEBUG2 ------------ */ ++#define TX_DEBUG2_TX_CTRL_STATE 0 ++ /** ++ * 000 - WAITING ++ * 001 - WAITING_HALF ++ * 010 - Invalid ++ * 011 - WAIT_LEFT ++ * 100 - READ_FIFO ++ * 101 - WAIT_TILL_DATA_TAKEN ++ * 11x - Invalid ++ */ ++#define TX_DEBUG2_FIFO_READER_2ND_STAGE 3 ++ /** ++ * 0 - First stage (L) of FIFO read ++ * 1 - Second stage (R) of FIFO read ++ */ ++#define TX_DEBUG2_FIFO_READER_CHANNEL 4 ++ /** ++ * Current channel being read from FIFO ++ */ ++#define TX_DEBUG2_NUM_WRITES 8 ++ /** ++ * Number of writes to be performed every interrupt ++ */ ++#define TX_DEBUG2_SAFE_TO_UPDATE_REGS 12 ++ /** ++ * 0 - Changes to registers will be deferred ++ * 1 - Changes to registers will be immediate ++ */ ++#define TX_DEBUG2_WR_DMARQ 13 ++ /** ++ * 0 - No writes being requested ++ * 1 - Writes being requested (=DMA DREQ when using APB) ++ */ ++#define TX_DEBUG2_FIFO_READ_ADDRESS 16 ++ /** ++ * 19 - 16 Current read pointer of FIFO ++ */ ++#define TX_DEBUG2_FIFO_WRITE_ADDRESS 24 ++ /** ++ * 27 - 24 Current write pointer of FIFO ++ */ ++#define TX_DEBUG2_WORD_CLK 31 ++ /** ++ * State of internal safe TX_WORD_CLK ++ */ ++ ++ ++/* TX_DEBUG3 ------------ */ ++/** ++ * This register is a read back of status directly from the TX_CLK domain. ++ * For this reason it may be unstable during operation. Several back-to-back ++ * reads might need to be made to get an accurate reflection of the status ++ * during operation. ++ */ ++ ++#define TX_DEBUG3_TX_STATE 0 ++ /** ++ * 000 - DISABLED ++ * 001 - WAITING ++ * 010 - WAIT_FOR_8 ++ * 011 - SAMPLE_8 ++ * 100 - WAIT_FOR_LEFT ++ * 101 - SAMPLE_LEFT ++ * 110 - WAIT_FOR_RIGHT ++ * 111 - SAMPLE_RIGHT ++ */ ++#define TX_DEBUG3_TX_IN_RESET 31 ++ /** ++ * 0 - Tx domain is out of reset ++ * 1 - Tx domain is in reset ++ */ ++ ++ ++ ++/* RX_DEBUG ------------ */ ++#define RX_DEBUG_RX_DMA_STATE 0 ++ /** ++ * 00 - START ++ * 01 - IDLE ++ * 10 - BURST ++ * 11 - NON_ALIGNED ++ */ ++#define RX_DEBUG_READ_OFFSET 4 ++ /** ++ * 5 - 4 Determines the alignment of the reads ++ * (0=quad aligned; 1/3=bytes aligned; 2 doublet aligned) ++ */ ++#define RX_DEBUG_RX_DREQ 31 ++ /** ++ * Set if DMA request for Rx is set ++ */ ++ ++ ++/* RX_DEBUG2 ------------ */ ++#define RX_DEBUG2_RX_CTRL_STATE 0 ++ /** ++ * 000 - WAITING ++ * 001 - WAITING_HALF ++ * 01x - Invalid ++ * 100 - WRITE_FIFO ++ * 101 - WAIT_TILL_DATA_PUT ++ * 11x - Invalid ++ */ ++#define RX_DEBUG2_FIFO_WRITER_2ND_STAGE 3 ++ /** ++ * 0 - First stage (L) of FIFO write ++ * 1 - Second stage (R) of FIFO write ++ */ ++#define RX_DEBUG2_FIFO_WRITER_CHANNEL 4 ++ /** ++ * 7 - 4 Current channel being written to FIFO ++ */ ++#define RX_DEBUG2_NUM_READS 8 ++ /** ++ * 11 - 8 Number of reads to be performed every interrupt ++ */ ++#define RX_DEBUG2_SAFE_TO_UPDATE_REGS 12 ++ /** ++ * 0 - Changes to registers will be deferred ++ * 1 - Changes to registers will be immediate ++ */ ++#define RX_DEBUG2_RD_DMARQ 13 ++ /** ++ * 0 - No reads being requested ++ * 1 - Reads being requested (=DMA DREQ when using APB) ++ */ ++#define RX_DEBUG2_FIFO_READ_ADDRESS 16 ++ /** ++ * 19 - 16 Current read pointer of FIFO ++ */ ++#define RX_DEBUG2_FIFO_WRITE_ADDRESS 24 ++ /** ++ * 27 - 24 Current write pointer of FIFO ++ */ ++#define RX_DEBUG2_WORD_CLK 31 ++ /** ++ * State of internal safe RX_WORD_CLK ++ */ ++ ++ ++/* RX_DEBUG3 ------------ */ ++/** ++ * This register is a read back of status directly from the RX_CLK domain. ++ * For this reason it may be unstable during operation. Several back-to-back ++ * reads might need to be made to get an accurate reflection of the status ++ * during operation. ++ */ ++ ++#define RX_DEBUG3_RX_STATE 0 ++ /** ++ * 000 - DISABLED ++ * 001 - WAITING ++ * 010 - WAIT_FOR_8 ++ * 011 - SAMPLE_8 ++ * 100 - WAIT_FOR_LEFT ++ * 101 - SAMPLE_LEFT ++ * 110 - WAIT_FOR_RIGHT ++ * 111 - SAMPLE_RIGHT ++ */ ++#define RX_DEBUG3_RX_IN_RESET 31 ++ /** ++ * 0 - Rx domain is out of reset ++ * 1 - Rx domain is in reset ++ */ ++ ++ ++/** ++ * VERSION* ------------ ++ * Refer to VERSION. ?? ++ */ ++ ++ ++/* TX_BUFFER_LEVEL ------------ */ ++/** ++ * When this register is read it returns the current fill level of the buffer ++ * within the audio core, when a ‘1’ is written to the lower bit, the buffer ++ * fill level, read and write pointers are all set to zero. ++ * FT - 0 Buffer Level Fill level of Tx buffer ++ */ ++ ++/** ++ * INTERRUPT_CONTROL* ------------ ++ * Refer to INTERRUPT_CONTROL_STATUS. ?? ++ */ ++ ++/* TX_BUFFER_INTERRUPT_LEVEL ------------ */ ++/** ++ * FT - 0 Interrupt Level Programmable Buffer Level to initiate Interrupt ++ */ ++ ++ ++/* RX_BUFFER_LEVEL ------------ */ ++/** ++ * When this register is read it returns the current fill level of the buffer ++ * within the audio core, when a ‘1’ is written to the lower bit, the buffer ++ * fill level, read and write pointers are all set to zero. ++ * FR - 0 Buffer Level Fill level of Rx buffer ++ */ ++ ++ ++/* RX_BUFFER_INTERRUPT_LEVEL ------------ */ ++/** ++ * FR - 0 Interrupt Level Programmable Buffer Level to initiate Interrupt ++ */ ++ ++ ++/* RX_SPDIF_DEBUG ------------ */ ++#define RX_SPDIF_DEBUG_MAX_PULSE 0 ++ /** ++ * 7 - 0 Number of cycles of RX_SPDIF_OSAMP_CLK in maximum pulse width ++ * detected (=1.5x BIT_CLK) ++ */ ++#define RX_SPDIF_DEBUG_MIN_PULSE 8 ++ /** ++ * 15 - 8 Number of cycles of RX_SPDIF_OSAMP_CLK in minimum pulse width ++ * detected (=0.5x BIT_CLK) ++ */ ++#define RX_SPDIF_DEBUG_VALID 16 ++ /** ++ * 0 - Min Pulse is not valid (<2) for doing recovery ++ * 1 - Min Pulse is valid (?2) and recovery is possible ++ */ ++#define RX_SPDIF_DEBUG_LOCK 17 ++ /** ++ * 0 - Rx S/PDIF timing is not locked. ++ * 1 - Rx S/PDIF timing is locked. ++ */ ++#define RX_SPDIF_DEBUG_NO_PULSE 18 ++ /** ++ * 0 - Pulse detected ++ * 1 - Pulse detection has timed out ++ */ ++#define RX_SPDIF_DEBUG_BLOCK_START 20 ++ /** ++ * 0 - Current frame is not at start of block ++ * 1 - Current frame is at start of block ++ */ ++#define RX_SPDIF_DEBUG_CHAN_A 21 ++ /** ++ * 0 - Current subframe is B ++ * 1 - Current subframe is A ++ */ ++ ++ ++/* RX_SPDIF_DEBUG2 ------------ */ ++#define RX_SPDIF_DEBUG2_FRAME 0 ++ /** ++ * 7 - 0 Current frame counter (0 to 191) ++ */ ++#define RX_SPDIF_DEBUG2_BLOCK_SYNC 8 ++ /** ++ * 0 - Not yet achieved block sync ++ * 1 - Block sync has been achieved (i.e. received a start of block) ++ */ ++ ++ ++/* INTERRUPT_CONTROL_STATUS ------------ */ ++#define INTERRUPT_CONTROL_STATUS_AUDIO_IRQ 0 ++ /** ++ * ** BACKWARDS COMPATIBLE, DO NOT USE ++ * Set if the Audio Core Interrupt is set. Write ‘0’ to clear ++ */ ++#define INTERRUPT_CONTROL_STATUS_AUTO_CLEAR 2 ++ /** ++ * 0 - Auto Clear disabled ++ * 1 - Auto clear of H/W read/write interrupt on next data write/read (Tx/Rx) ++ */ ++#define INTERRUPT_CONTROL_STATUS_TX_IRQ 8 ++ /** ++ * Set if the Audio Core Tx Interrupt is set ++ * Set to ‘1’ to trigger a Normal Interrupt (TX_READ/RX_WRITE IRQ Enable ++ * must be set) ++ */ ++#define INTERRUPT_CONTROL_STATUS_TX_ERR_IRQ 9 ++ /** ++ * Set if the Audio Core Tx Error Interrupt is set ++ * Set to ‘1’ to trigger an Error Interrupt (TX_URUN/RX_ORUN IRQ Enable ++ * must be set) ++ */ ++#define INTERRUPT_CONTROL_STATUS_RX_IRQ 16 ++ /** ++ * Set if the Audio Core Rx Interrupt is set ++ * Set to ‘1’ to trigger a Normal Interrupt (RX_WRITE/TX_READ IRQ Enable ++ * must be set) ++ */ ++#define INTERRUPT_CONTROL_STATUS_RX_ERR_IRQ 17 ++ /** ++ * Set if the Audio Core Rx Error Interrupt is set ++ * Set to ‘1’ to trigger an Error Interrupt (RX_ORUN/TX_URUN IRQ Enable must ++ * be set) ++ */ ++ ++ ++/* INTERRUPT_MASK ------------ */ ++#define INTERRUPT_MASK_TX_READ_IRQ_ENABLE 0 ++ /** ++ * 0 - No Normal Interrupt generated by TX_READ ++ * 1 - Normal Interrupt generated by TX_READ ++ */ ++#define INTERRUPT_MASK_TX_LEVEL_IRQ_ENABLE 1 ++ /** ++ * 0 - No Normal Interrupt generated by TX_BUFFER_LEVEL ++ * 1 - Normal Interrupt generated by TX_BUFFER_LEVEL ++ */ ++#define INTERRUPT_MASK_TX_ERROR_IRQ_ENABLE 2 ++ /** ++ * 0 - No Normal Interrupt generated by TX_ERROR ++ * 1 - Normal Interrupt generated by TX_ERROR ++ */ ++#define INTERRUPT_MASK_RX_WRITE_IRQ_ENABLE 8 ++ /** ++ * 0 - No Normal Interrupt generated by RX_WRITE ++ * 1 - Normal Interrupt generated by RX_WRITE ++ */ ++#define INTERRUPT_MASK_RX_LEVEL_IRQ_ENABLE 9 ++ /** ++ * 0 - No Normal Interrupt generated by RX_BUFFER_LEVEL ++ * 1 - Normal Interrupt generated by RX_BUFFER_LEVEL ++ */ ++#define INTERRUPT_MASK_RX_ERROR_IRQ_ENABLE 10 ++ /** ++ * 0 - No Normal Interrupt generated by RX_ERROR ++ * 1 - Normal Interrupt generated by RX_ERROR ++ */ ++#define INTERRUPT_MASK_TX_URUN_IRQ_ENABLE 16 ++ /** ++ * 0 - No Error Interrupt generated by Tx Underrun ++ * 1 - Error Interrupt generated by Tx Underrun ++ */ ++#define INTERRUPT_MASK_TX_ORUN_IRQ_ENABLE 17 ++ /** ++ * 0 - No Error Interrupt generated by Tx Overrun ++ * 1 - Error Interrupt generated by Tx Overrun ++ */ ++#define INTERRUPT_MASK_TX_FIFO_URUN_ERR_IRQ_ENABLE 18 ++ /** ++ * 0 - No Error Interrupt generated by Tx FIFO Underrun ++ * 1 - Error Interrupt generated by Tx FIFO Underrun ++ */ ++#define INTERRUPT_MASK_TX_FIFO_ORUN_ERR_IRQ_ENABLE 19 ++ /** ++ * 0 - No Error Interrupt generated by Tx FIFO Overrun ++ * 1 - Error Interrupt generated by Tx FIFO Overrun ++ */ ++#define INTERRUPT_MASK_RX_URUN_ERR_IRQ_ENABLE 24 ++ /** ++ * 0 - No Error Interrupt generated by Rx Underrun ++ * 1 - Error Interrupt generated by Rx Underrun ++ */ ++#define INTERRUPT_MASK_RX_ORUN_ERR_IRQ_ENABLE 25 ++ /** ++ * 0 - No Error Interrupt generated by Rx Overrun ++ * 1 - Error Interrupt generated by Rx Overrun ++ */ ++#define INTERRUPT_MASK_RX_FIFO_URUN_ERR_IRQ_ENABLE 26 ++ /** ++ * 0 - No Error Interrupt generated by Rx FIFO Underrun ++ * 1 - Error Interrupt generated by Rx FIFO Underrun ++ */ ++#define INTERRUPT_MASK_RX_FIFO_ORUN_ERR_IRQ_ENABLE 27 ++ /** ++ * 0 - No Error Interrupt generated by Rx FIFO Overrun ++ * 1 - Error Interrupt generated by Rx FIFO Overrun ++ */ ++#define INTERRUPT_MASK_SPDIF_RX_ERROR 28 ++ /** ++ * 0 - No Error Interrupt generated by Rx S/PDIF Error (Parity/Preamble/Framing) ++ * 1 - Error Interrupt generated by Rx S/PDIF Error (Parity/Preamble/ Framing) ++ */ ++#define INTERRUPT_MASK_SPDIF_RX_LOCK 29 ++ /** ++ * 0 - No Error Interrupt generated by Rx S/PDIF Lock event ++ * 1 - Error Interrupt generated by Rx S/PDIF Lock event ++ */ ++ ++ ++/* VERSION ------------ */ ++/** ++ * Returns a 32 bit value that indicates the version and build options of the ++ * audio core being used. See the version list at the end of the document to ++ * find out how they translate. ++ */ ++ ++#define VERSION_NUMBER 0 ++ /** ++ * 0 - 7 Version of the core ++ */ ++#define VERSION_AUX_APB 12 ++ /** ++ * AUX_APB build option ++ */ ++#define VERSION_RX_SPDIF 13 ++ /** ++ * RX_SPDIF build option ++ */ ++#define VERSION_TX_SPDIF 14 ++ /** ++ * TX_SPDIF build option ++ */ ++#define VERSION_AHB_DMA 15 ++ /** ++ * DMA_AHB build option ++ */ ++#define VERSION_RX_FIFO_ADDR_BITS 19 ++ /** ++ * 16 - 19 G_RX_FIFO_A_BITS generic ++ */ ++#define VERSION_RX_CHANS 23 ++ /** ++ * 20 - 23 G_RX_CHANNELS generic ++ */ ++#define VERSION_TX_FIFO_ADDR_BITS 27 ++ /** ++ * 24 - 27 G_TX_FIFO_A_BITS generic ++ */ ++#define VERSION_TX_CHANS 31 ++ /** ++ * 28 - 31 G_TX_CHANNELS generic ++ */ ++ ++ ++ ++/* TX_DATA_IN_FORMAT ------------ */ ++#define TX_DATA_IN_FORMAT_SAMPLE_ORDER 0 ++ /** ++ * 0 - Samples written in as left/right pairs ++ * 1 - All left channels written then all right ++ */ ++#define TX_DATA_IN_FORMAT_24_BIT_SAMPLE 1 ++ /** ++ * Set to ‘1’ to indicate write contains 24 bit data (used in conjunction ++ * with following setting) ++ * ** NOT VALID FOR S/PDIF ++ */ ++#define TX_DATA_IN_FORMAT_PAD_TOP_BYTE 2 ++ /** ++ * 0 - Output data becomes WRITE_DATA(23 downto 0) & “00000000” ++ * 1 - Output data becomes “0000000” & WRITE_DATA(23 downto 0) ++ */ ++#define TX_DATA_IN_FORMAT_WAIT_FOR_HALF 4 ++ /** ++ * 0 - Hardware waits for full number of writes before progressing ++ * 1 - Hardware waits for half the number of writes before progressing ++ */ ++ ++ ++/* TX_CHANNELS_ENABLE ------------ */ ++/** ++ * If a channel is disabled, then no new data is presented to the data line of ++ * that I2S channel ++ * 0 - Tx Channel N disabled ++ * 1 - Tx Channel N enabled ++ */ ++ ++ ++/* TX_WRITES_TO ------------ */ ++/** ++ * Can be used in conjunction with the Tx Channel Enable, whereby if an output ++ * channel is disabled then software can select whether or not it still wishes ++ * to write to this channel or not, effectively reduces its number of writes ++ * per interrupt. If it chooses to still write to this location then the write ++ * data is effectively ignored. ++ * 0 - Tx Channel N not included in data ++ * 1 - Tx Channel N included in data ++ */ ++ ++ ++/* RX_DATA_OUT_FORMAT ------------ */ ++#define RX_DATA_OUT_FORMAT_SAMPLE_ORDER 0 ++ /** ++ * 0 - Samples read in as left/right pairs ++ * 1 - All left channels read then all right ++ */ ++#define RX_DATA_OUT_FORMAT_24_BIT_SAMPLE 1 ++ /** ++ * Set to ‘1’ to indicate read contains 24 bit data (used in conjunction ++ * with following setting) ++ * ** NOT VALID FOR S/PDIF ++ */ ++#define RX_DATA_OUT_FORMAT_PAD_TOP_BYTE 2 ++ /** ++ * 0 - Read data becomes RX_DATA(23 downto 0) & “00000000” ++ * 1 - Read data becomes “0000000” & RX_DATA(23 downto 0) ++ */ ++#define RX_DATA_OUT_FORMAT_WAIT_FOR_HALF 4 ++ /** ++ * 0 - Hardware waits for full number of reads before progressing ++ * 1 - Hardware waits for half the number of reads before progressing ++ */ ++ ++ ++/* RX_CHANNELS_ENABLE ------------ */ ++/** ++ * If a channel is disabled, then no new data is presented to the data line of ++ * that I2S channel ++ * 0 - Rx Channel N disabled ++ * 1 - Rx Channel N enabled ++ */ ++ ++ ++/* RX_READS_FROM ------------ */ ++/** ++ * Can be used in conjunction with the Rx Channel Enable, whereby if an input ++ * channel is disabled then software can select whether or not it still wishes ++ * to read from this channel or not, effectively reduces its number of reads ++ * per interrupt. If it chooses to still read from this location then the read ++ * data is invalid. ++ * 0 - Rx Channel N not included in data ++ * 1 - Rx Channel N included in data ++ */ ++ ++ ++ ++/* TX_CPU_DATA_WRITES_ALT ------------ */ ++/** ++ * See TX_CPU_DATA_WRITES. ++ * This alternative address has been provided as it may be referenced within a ++ * 13 bit immediate address (which may have benefits when being accessed by a ++ * CPU with only a 13 bit immediate offset such as the LEON2 IU). ++ * 0x0400-0x04FF TX_CPU_DATA_WRITES_ALT ++ */ ++ ++ ++/* RX_CPU_DATA_READS_ALT ------------ */ ++/** ++ * See RX_CPU_DATA_READS. This alternative address has been provided as it may ++ * be referenced within a 13 bit immediate address (which may have benefits ++ * when being accessed by a CPU with only a 13 bit immediate offset such as the ++ * LEON2 IU). ++ * 0x0800-0x08FF RX_CPU_DATA_READS_ALT ++ */ ++ ++ ++/* TX_CPU_DATA_WRITES ------------ */ ++/** ++ * Any writes to this location writes a valid sample into the internal buffer ++ * of the audio core. All writes should be the full 32 bits. ++ * This address is WRITE ONLY - any reads will return the previous read value ++ * on the bus. ++ * 0x1000-0x1FFF TX_CPU_DATA_WRITES ++ */ ++ ++ ++/* RX_CPU_DATA_READS ------------ */ ++/** ++ * Any reads from this location read a valid sample from the internal buffer of ++ * the audio core. All reads should be the full 32 bits. ++ * This address is READ ONLY - any writes will be ignored. ++ * 0x2000-0x2FFF RX_CPU_DATA_READS ++ */ ++ ++#endif /* __ASM_ARM_ARCH_I2S_H */ ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/io.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/io.h +--- linux-2.6.24/include/asm-arm/arch-hipox/io.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/io.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,17 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/io.h ++ * ++ * 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 __ASM_ARM_ARCH_IO_H ++#define __ASM_ARM_ARCH_IO_H ++ ++#define IO_SPACE_LIMIT 0xffffffff ++ ++#define __io(a) ((void __iomem*)(a)) ++#define __mem_pci(a) (a) ++ ++#endif //__ASM_ARM_ARCH_IO_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/irqs.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/irqs.h +--- linux-2.6.24/include/asm-arm/arch-hipox/irqs.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/irqs.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,42 @@ ++/* linux/include/asm-arm/arch-hipox/irqs.h ++ * ++ * 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 __ASM_ARCH_IRQS_H ++#define __ASM_ARCH_IRQS_H ++ ++#define FIQ_INTERRUPT 0 ++#define SOFTWARE_INTERRUPT 1 ++#define TIMER_1_INTERRUPT 4 ++#define TIMER_2_INTERRUPT 5 ++#define USB_FS_INTERRUPT 7 ++#define MAC_INTERRUPT 8 ++#define SEM_A_INTERRUPT 10 ++#define SEM_B_INTERRUPT 11 ++#define DMA_INTERRUPT_0 13 ++#define DMA_INTERRUPT_1 14 ++#define DMA_INTERRUPT_2 15 ++#define DMA_INTERRUPT_3 16 ++#define DPE_INTERRUPT 17 ++#define SATA_1_INTERRUPT 18 ++#define SATA_2_INTERRUPT 19 ++#define DMA_INTERRUPT_4 20 ++#define GPIO_1_INTERRUPT 21 ++#define GPIO_2_INTERRUPT 22 ++#define UART_1_INTERRUPT 23 ++#define UART_2_INTERRUPT 24 ++#define I2S_INTERRUPT 25 ++#define SATA_1_ERROR 26 ++#define SATA_2_ERROR 27 ++#define I2C_INTERRUPT 28 ++#define UART_3_INTERRUPT 29 ++#define UART_4_INTERRUPT 30 ++ ++#define PCI_A_INTERRUPT GPIO_1_INTERRUPT ++ ++#define NR_IRQS 32 ++ ++#endif // __ASM_ARCH_IRQ_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/leon-power-button-prog.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon-power-button-prog.h +--- linux-2.6.24/include/asm-arm/arch-hipox/leon-power-button-prog.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon-power-button-prog.h 2008-07-01 09:46:51.000000000 +0200 +@@ -0,0 +1,73 @@ ++static const s8 leon_srec[] = ++"S01400006C656F6E2D706F7765722D627574746F6E1A\n" ++"S3159801E00081D820000326007881984000821020C08C\n" ++"S3159801E010818840008190000003116C008210601481\n" ++"S3159801E020213D4040A014200FE02040001D26007F8E\n" ++"S3159801E0309C13A3F0BC10000E8E1000008C100000EB\n" ++"S30D9801E0404000004501000000B3\n" ++"S3159801E110A7480000A8100001AA100002AC1000033D\n" ++"S3159801E120AE100004A14000009C10001E400000EAB9\n" ++"S3159801E13001000000818400008810001786100016DF\n" ++"S3159801E1408410001582100014818CC00081C440008F\n" ++"S3099801E15081CC80005F\n" ++"S3159801E1549C03BFB8FE23A020BE23BFB8DE23A02408\n" ++"S3159801E164E03BA028E43BA030E823A03803160076C8\n" ++"S3159801E17484102030821063FCC42840002511500075\n" ++"S3159801E18486103FFF8214A00CC62040008414A10C6B\n" ++"S3159801E1940316007FC6208000821063FC4000008924\n" ++"S3159801E1A4E600400090102000921020004000008E56\n" ++"S3159801E1B4941023E88210200083306008821060202E\n" ++"S3159801E1C4A21020FFA3346008A1480000A02C0011D6\n" ++"S3159801E1D4A0140001818C0000A0102010A414A0089A\n" ++"S3159801E1E4E0248000400000950100000009114000D8\n" ++"S3159801E1F49A11200CC203400082087FFEC223400074\n" ++"S3159801E20498112014C203000082087FFEC2230000DD\n" ++"S3159801E2148811208CC201000082087FFEC221000069\n" ++"S3159801E224C40340008408BFEFC4234000C20300001E\n" ++"S3159801E23482087FEFC2230000C40100008408BFEF5F\n" ++"S3159801E244C4210000073F7FFFC20340008610E3FF05\n" ++"S3159801E25482084003C2234000C40300008408800353\n" ++"S3159801E264C4230000C201000082084003C2210000B1\n" ++"S3159801E2741B1100008610200188136014C621000022\n" ++"S3159801E2848213601CC620400084136020E02080001D\n" ++"S3159801E29480A4E0000280003C030080008413601887\n" ++"S3159801E2A4C2208000071100008410E01C030080003E\n" ++"S3159801E2B4C2208000A8100003C2050000808860105F\n" ++"S3159801E2C40280000DA0102000C2050000808860100D\n" ++"S3159801E2D41280000925000009231100004000005E00\n" ++"S3159801E2E49014A310C20440008088601002BFFFFCFA\n" ++"S3159801E2F40100000023000009251100004000005682\n" ++"S3159801E30490146310C20480008088601012800021E2\n" ++"S3159801E31480A42031A004200180A4203104BFFFF8F1\n" ++"S3159801E324031100000500800080A4E0001280000516\n" ++"S3159801E3348210601403110000050080008210601891\n" ++"S3159801E344C420400023000009A01020634000004225\n" ++"S3159801E35490146310A0843FFF1CBFFFFD031600763B\n" ++"S3159801E364821063FC84102031C428400003110000F4\n" ++"S3159801E3748610200182106018C62040001080000083\n" ++"S3159801E38401000000C221000010BFFFC80711000058\n" ++"S3159801E39404BFFFCA0311000010BFFFE40500800003\n" ++"S3159801E3A49C07FFB8FE03A020DE03A024E01BA02847\n" ++"S3159801E3B4E41BA030E803A03881C3E0089C23BFB8C6\n" ++"S3159801E3C4051150008610A20882102044C220C0006C\n" ++"S3159801E3D48410A22882102088C220800081C3E00874\n" ++"S3159801E3E401000000932A601003000061821062A064\n" ++"S3159801E3F493326010925A4001952AA010030005F5AC\n" ++"S3159801E40482106384900A20FF9532A010905A0001D5\n" ++"S3159801E41493326006945AA320900200099532A00972\n" ++"S3159801E424031150009002000A82106200D020400025\n" ++"S3159801E43481C3E00801000000051150008410A20868\n" ++"S3159801E444C200800082106080C220800081C3E008E7\n" ++"S3159801E4540100000003041893821061D380520001CD\n" ++"S3159801E46491400000913220068810000682380008EF\n" ++"S3159801E47480A040041A80000D8401000882020004D9\n" ++"S3159801E484900060018210000680A0400486603FFFD8\n" ++"S3159801E49480A2000184603FFF8090C00212BFFFFAF8\n" ++"S3159801E4A401000000308000098210000680A0400215\n" ++"S3159801E4B41A800006010000008210000680A040021E\n" ++"S3159801E4C40ABFFFFA0100000081C3E00801000000B9\n" ++"S3159801E4D405115000C200800080A060000280000BE4\n" ++"S3159801E4E48610A20C80886010028000040100000046\n" ++"S3159801E4F4C020C0008C01A001C200800080A06000E9\n" ++"S3159801E50412BFFFFA8088601081C3E00801000000F9\n" ++"S7059801E00081\n"; +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/leon-program.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon-program.h +--- linux-2.6.24/include/asm-arm/arch-hipox/leon-program.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon-program.h 2008-07-01 09:46:44.000000000 +0200 +@@ -0,0 +1,404 @@ ++static const s8 leon_srec[] = ++"S00700006C656F6E4A\n" ++"S3159801E00081D820000326007881984000821020C08C\n" ++"S3159801E010818840008190000003116C008210601481\n" ++"S3159801E020213FC040A014200FE02040001D26007F0C\n" ++"S3159801E0309C13A3F0BC10000E8E1000008C100000EB\n" ++"S30D9801E0404000005A010000009E\n" ++"S3159801E050051150008410A208C200800082106080C9\n" ++"S3159801E060C220800081C3E00801000000051150001C\n" ++"S3159801E0708610A20882102044C220C0008410A228CB\n" ++"S3159801E08082102088C220800081C3E0080100000028\n" ++"S3159801E110A7480000A8100001AA100002AC1000033D\n" ++"S3159801E120AE100004A14000009C10001E4000007F24\n" ++"S3159801E13001000000818400008810001786100016DF\n" ++"S3159801E1408410001582100014818CC00081C440008F\n" ++"S3099801E15081CC80005F\n" ++"S3159801E154932A601003000061821062A093326010C2\n" ++"S3159801E164925A4001952AA010030005F582106384FA\n" ++"S3159801E174900A20FF9532A010905A000193326006B6\n" ++"S3159801E184945AA320900200099532A00903115000CC\n" ++"S3159801E1949002000A82106200D020400081C3E008F0\n" ++"S3159801E1A4010000009C03BFB8FE23A020BE23BFB87C\n" ++"S3159801E1B4DE23A024E03BA028E43BA030033D404065\n" ++"S3159801E1C48210600FA610200021116C00A01420144F\n" ++"S3159801E1D4C2240000400001BF2511500086103FFF5C\n" ++"S3159801E1E48214A00CC62040008414A10CC620800079\n" ++"S3159801E1F47FFFFF9E010000009010200092102000DE\n" ++"S3159801E2047FFFFFD4941023E8400001A30100000086\n" ++"S3159801E2148A1000130326007EC60061700926007EC3\n" ++"S3159801E224841061708211219CDA00A004C6206008CA\n" ++"S3159801E234C621219C400001D5DA206004A734E00860\n" ++"S3159801E244A614E020A21020FFA3346008A148000078\n" ++"S3159801E254A02C0011A0140013818C000082102010A8\n" ++"S3159801E264A414A008C224800084102400C424800025\n" ++"S3159801E27482102100C22480004000055C0100000040\n" ++"S3159801E2847FFFFF73010000008210000780A06000E1\n" ++"S3159801E29402BFFFFEA6100001308000071280000F0E\n" ++"S3159801E2A40100000082100007A690600002BFFFF7E4\n" ++"S3159801E2B4010000008E29C013808CE00202BFFFF88A\n" ++"S3159801E2C4808CE0014000020001000000808CE0018E\n" ++"S3159801E2D402BFFFF5010000004000025B0100000047\n" ++"S3159801E2E430BFFFF19C07FFB8FE03A020DE03A024EC\n" ++"S3159801E2F4E01BA028E41BA03081C3E0089C23BFB887\n" ++"S3159801E3049801E6949801E7A09801E7689801E724AB\n" ++"S3159801E3149801E6B49801E8589801E83C9801E7EC25\n" ++"S3159801E3249801E7C49C03BFA0FE23A020BE23BFA0E7\n" ++"S3159801E334DE23A024E03BA028E43BA030E83BA038A8\n" ++"S3159801E34403115000E400400080A4A0000280014A11\n" ++"S3159801E354808CA1000280004E808CA01007101004B6\n" ++"S3159801E364C400E014C200E01C88088001808920104A\n" ++"S3159801E3749A1020009810200002800003841020002F\n" ++"S3159801E3848410201080892080328000028410A08015\n" ++"S3159801E39480892040328000028410A04080A0A00089\n" ++"S3159801E3A40280000603000060C200E01C8228400235\n" ++"S3159801E3B4C220E01C03000060821100010500006080\n" ++"S3159801E3C4C220E014882900028143C000C2000000DB\n" ++"S3159801E3D480892401028000068089202882102002DF\n" ++"S3159801E3E48E11C00188093BFE808920280280000984\n" ++"S3159801E3F480892002821020028E11C001808920080A\n" ++"S3159801E40422800003981020019A1020018089200205\n" ++"S3159801E414128000060310100480A360000280007F16\n" ++"S3159801E42480A3200003101004C40060180700000894\n" ++"S3159801E43484108003C4206018821000058210400459\n" ++"S3159801E4448A100001091140008211204CC400400031\n" ++"S3159801E4548088A1001280000E808CA0100326007E6D\n" ++"S3159801E464C600617884100005C420C0008143C000A9\n" ++"S3159801E474C20000008410210086112050C420C000D7\n" ++"S3159801E484821020008A100001808CA0100280001C42\n" ++"S3159801E494808CA400031150008210620CC0204000A5\n" ++"S3159801E4A48C01A0018210000580A0600002800014EE\n" ++"S3159801E4B4808CA400091140008211204CC4004000AC\n" ++"S3159801E4C48088A1001280000E808CA4000326007E09\n" ++"S3159801E4D4C600617884100005C420C0008143C00039\n" ++"S3159801E4E4C20000008410210086112050C420C00067\n" ++"S3159801E4F4821020008A100001808CA40002800039C1\n" ++"S3159801E50403000400031140008410604CE600800067\n" ++"S3159801E51482106054840CE003C4204000808CE0018E\n" ++"S3159801E5240280002B808CE0022326007EAA07FFF442\n" ++"S3159801E534A007FFF0A807FFEC9A14619C96103FFF79\n" ++"S3159801E544C8036008108000051908000080A2E0003D\n" ++"S3159801E55402800011C4236008C601000080A0E0006F\n" ++"S3159801E564168000178088C00C028000418401200817\n" ++"S3159801E574C2036004C624000080A0800112BFFFF480\n" ++"S3159801E58488100002C803400080A2E00012BFFFF37E\n" ++"S3159801E594C8236008C807FFF080A1200818800024C2\n" ++"S3159801E5A40720000005260078832920028410A304F5\n" ++"S3159801E5B4C600800181C0C0000100000080A2E0006D\n" ++"S3159801E5C402BFFFF5C6240000808CE0020280000594\n" ++"S3159801E5D403000400821020018E11C0010300040077\n" ++"S3159801E5E4808C8001028000080311500003115800A1\n" ++"S3159801E5F482106090C0204000841020048E11C002BD\n" ++"S3159801E60403115000E400400080A4A00012BFFF52F9\n" ++"S3159801E614808CA1003080009802BFFF8803101004F3\n" ++"S3159801E624C020600430BFFF850720000086290003B7\n" ++"S3159801E6349A14619CC807FFF48143C000C200000084\n" ++"S3159801E644C40360088400A008C2036004C6210000BC\n" ++"S3159801E65480A0800102800004C204619C10BFFFB7A8\n" ++"S3159801E664C423600810BFFFB5C22360080507FFFFDE\n" ++"S3159801E6748410A3FF031000008408C0028208C00115\n" ++"S3159801E684C8254000C225000010BFFFC3C42400005A\n" ++"S3159801E6940326007EC40061A880A0A000028000061B\n" ++"S3159801E6A4C207FFEC400000E401000000C807FFF030\n" ++"S3159801E6B4C207FFEC0708000080A0600002BFFFDBD9\n" ++"S3159801E6C486110003C807FFF4032000008410200173\n" ++"S3159801E6D48628C001C42120049A14619C8143C000F0\n" ++"S3159801E6E4C2000000C62100008143C000C200000098\n" ++"S3159801E6F4C40360088800A00803114000C603600497\n" ++"S3159801E7040500004082106050C420400080A1000397\n" ++"S3159801E71402BFFFD5C204619C10BFFF88C823600855\n" ++"S3159801E724C807FFF4C601200405101004C200A01CF2\n" ++"S3159801E7349A284003C207FFECDA20A01C80A0600047\n" ++"S3159801E74402800013C607FFF0030800008610C00173\n" ++"S3159801E754052000008628C002DA21200410BFFFE0B4\n" ++"S3159801E7649A14619CC807FFF4C60120040510100485\n" ++"S3159801E774C200A01C9A104003C207FFECDA20A01C21\n" ++"S3159801E78480A0600012BFFFF1C607FFF003200000C6\n" ++"S3159801E7948628C00110BFFFA99A14619C400000AF56\n" ++"S3159801E7A401000000C207FFEC80A060000280000C03\n" ++"S3159801E7B4C607FFF00308000010BFFFC38610C00107\n" ++"S3159801E7C4821023D005101004C607FFECC220A014AA\n" ++"S3159801E7D480A0E00012BFFFF8C607FFF003200000EF\n" ++"S3159801E7E410BFFF948628C001C807FFF4C20120040C\n" ++"S3159801E7F480A060000280001D05101004C200A018B4\n" ++"S3159801E80482106002C220A018C207FFEC80A06000A3\n" ++"S3159801E81402BFFFDFC607FFF0030800008610C00198\n" ++"S3159801E82405200000821020018628C002C2212004F6\n" ++"S3159801E83410BFFFAB9A14619CC207FFF4D000600421\n" ++"S3159801E8444000003301000000C207FFEC10BFFFD857\n" ++"S3159801E85480A060004000001201000000C207FFEC8E\n" ++"S3159801E86410BFFFD380A06000C200A01810BFFFE6B6\n" ++"S3159801E87482087FFD9C07FFA0FE03A020DE03A02447\n" ++"S3159801E884E01BA028E41BA030E81BA03881C3E0084C\n" ++"S3159801E8949C23BFA081C3E008010000000326007EE3\n" ++"S3159801E8A40526007EC60061988410A17088102009F7\n" ++"S3159801E8B4C200C000C22080008600E00488813FFF20\n" ++"S3159801E8C41CBFFFFC8400A00481C3E008010000007A\n" ++"S3159801E8D49C03BFD0FE23A01CBE23BFD0DE23A02059\n" ++"S3159801E8E40316007F821063FCC60040000526007E4D\n" ++"S3159801E8F47FFFFFEBC620A1989C07FFD0FE03A01CBF\n" ++"S3159801E904DE03A02081C3E0089C23BFD00310100422\n" ++"S3159801E914C6006018050000088428C002C42060183F\n" ++"S3159801E9248610000105001C00C200E014808840028C\n" ++"S3159801E93412BFFFFE80A22000228000090310100056\n" ++"S3159801E94407101000C400C00003000020822880012B\n" ++"S3159801E954C220C0001080000703101004C4004000B0\n" ++"S3159801E9640700002084108003C422000103101004B8\n" ++"S3159801E974C40060180700000884108003C420601836\n" ++"S3159801E98481C3E008010000009C03BFD0FE23A01CAC\n" ++"S3159801E994BE23BFD0DE23A020E023A0240326007E35\n" ++"S3159801E9A4821061701B26007E1926007E841361C429\n" ++"S3159801E9B4C600600C881321B4D60060102126007E07\n" ++"S3159801E9C4D0006014C621200CC02361C4C020A010B5\n" ++"S3159801E9D4C62321B4D6212004C020A004C020A008AF\n" ++"S3159801E9E4C020A00CC6212008400003A9D02421B038\n" ++"S3159801E9F4D02421B0400003BA921020360326007E13\n" ++"S3159801EA04D02421B0C02061A88143C000C20000006F\n" ++"S3159801EA140526007EC020A1ACD00421B09C07FFD066\n" ++"S3159801EA24FE03A01CDE03A020E003A02481C3E00812\n" ++"S3159801EA349C23BFD00526007EC200A1AC80A06000AD\n" ++"S3159801EA441280000482102001C220A1AC8E11C0014B\n" ++"S3159801EA5481C3E008010000009C03BFD0FE23A01CDB\n" ++"S3159801EA64BE23BFD0DE23A0207FFFFFC8010000008C\n" ++"S3159801EA748810201807101004C20100030500000825\n" ++"S3159801EA8482104002C2210003841020010326007ECD\n" ++"S3159801EA94C42061A89C07FFD0FE03A01CDE03A02016\n" ++"S3159801EAA481C3E0089C23BFD0832A2010913060103B\n" ++"S3159801EAB4900A20FF83306018912A200881C3E008C0\n" ++"S3159801EAC4901040089C03BFD8DE23A008F43BA010FD\n" ++"S3159801EAD4F83BA0180326007E3926007E961061D845\n" ++"S3159801EAE4BA1721C43526007EF60061D89010200005\n" ++"S3159801EAF49810000B9210001DC402E008C202E00CA3\n" ++"S3159801EB0480A0800102800032D406A1ECC200800064\n" ++"S3159801EB1480A0600026800047D426A1ECDA03200859\n" ++"S3159801EB2484036010C203200480A080010280003F00\n" ++"S3159801EB348610000CC4232008C200E01080A060004F\n" ++"S3159801EB4432800002C020E010DE034000030000205A\n" ++"S3159801EB54808BC00102800024808BE200028000052C\n" ++"S3159801EB64808BEC00C202600882006001C2226008B0\n" ++"S3159801EB7402800005808BE100C202600C820060016C\n" ++"S3159801EB84C222600C0280000501000000C2026010D6\n" ++"S3159801EB9482006010C2226010C203600C80A06000DB\n" ++"S3159801EBA422800007C402E008C203600CD4206008DE\n" ++"S3159801EBB4C020600494100001C402E008C202E00C6B\n" ++"S3159801EBC480A0800112BFFFD290102001C202E010EA\n" ++"S3159801EBD480A0600012BFFFCE0100000010800015CE\n" ++"S3159801EBE4D426A1ECC8036004C60721C4820927FF69\n" ++"S3159801EBF48600C001051000008089000202BFFFE764\n" ++"S3159801EC04C62721C48333E003C4076004C60760108A\n" ++"S3159801EC14820860078600C0018400A001C4276004A5\n" ++"S3159801EC2410BFFFDEC627601010BFFFC4F623200865\n" ++"S3159801EC34DE03A008F41BA010F81BA01881C3E008F2\n" ++"S3159801EC449C23BFD89C03BF40FE23A020BE23BF406C\n" ++"S3159801EC54DE23A024E03BA028E43BA030E83BA0387F\n" ++"S3159801EC64EC3BA040F03BA048F43BA050F83BA0589D\n" ++"S3159801EC740526007EC200A1A880A0600002800173C7\n" ++"S3159801EC840726007EC200E1AC80A060001280017064\n" ++"S3159801EC94010000003326007EB41661B4C606A008A6\n" ++"S3159801ECA4C210E01A8328601083306010808860024D\n" ++"S3159801ECB41280016680886001028001648800E08C74\n" ++"S3159801ECC4C210E01A82106002C406A00480A1000250\n" ++"S3159801ECD4028001F9C230E01AC826A008AE90E00075\n" ++"S3159801ECE42280015B0726007EC215E01A808860049B\n" ++"S3159801ECF432800028F005E0102326007EC405E0043E\n" ++"S3159801ED04C205E008A21461D8A6208001A0100002C9\n" ++"S3159801ED14E405E00CA8102000B8100011B605E01C13\n" ++"S3159801ED24B005E0641B26007EFA036168AA100013F5\n" ++"S3159801ED34AC100012E6160000E406C000B0062002E4\n" ++"S3159801ED44B606E004A0240015C204601080A06000F1\n" ++"S3159801ED541280000701000000C404600CC200800000\n" ++"S3159801ED6480A06000168000A69A00A0108210000761\n" ++"S3159801ED748288600202BFFFFE010000008E29C0014D\n" ++"S3159801ED847FFFFF510100000010BFFFF1C20460101C\n" ++"S3159801ED94C20E0000C405E00CC427FFB08208600FB8\n" ++"S3159801EDA483286002C80E2009842600028400800103\n" ++"S3159801EDB4860920FF80A0E006BA060001028001C3F5\n" ++"S3159801EDC4C437FFF680A0E011228001BE8400A00812\n" ++"S3159801EDD480A12006C027FFEC028001A0C027FFE886\n" ++"S3159801EDE4C417FFF6DA15E018C215E0168528A0109F\n" ++"S3159801EDF4DA27FFE080A36000C227FFE41280000CA3\n" ++"S3159801EE04C427FFB40326007EC617FFF6C40061889B\n" ++"S3159801EE148728E0108400A00E8330E01084208001B6\n" ++"S3159801EE249A102001C427FFE0DA27FFE4C607FFB446\n" ++"S3159801EE34E205E004C205E0088530E0108224400129\n" ++"S3159801EE4482204002C427FFCCDA07FFB0840340022C\n" ++"S3159801EE54C227FFD0C427FFD47FFFFF14D0162004FE\n" ++"S3159801EE64912A2010C607FFB09132201082102000F3\n" ++"S3159801EE74C407FFE48608E003C027FFBCD037FFC662\n" ++"S3159801EE8480A04002C027FFDCC027FFD816800099CE\n" ++"S3159801EE94C627FFACDA07FFCCA224400DC207FFE0D0\n" ++"S3159801EEA480A4400104800003E227FFB8C227FFB873\n" ++"S3159801EEB4D017FFC6912A20107FFFFEFC91322010AD\n" ++"S3159801EEC4C407FFB8C617FFF68200800382007FF253\n" ++"S3159801EED483286010D03620047FFFFEF491306010A9\n" ++"S3159801EEE4DA17FFC6C20E20099A036001D0362002AA\n" ++"S3159801EEF480A0600602800110DA37FFC680A06011EF\n" ++"S3159801EF0402800145C207FFB8C407FFB8C036200A74\n" ++"S3159801EF14C427FFDCA41000020726007EE200E1EC78\n" ++"S3159801EF2480A460000280002D84102004C204600825\n" ++"S3159801EF34C220E1ECC207FFB49B306010E0044000A4\n" ++"S3159801EF44820C200382208001C607FFAC84208003AB\n" ++"S3159801EF5480A04002DA246004C607FFB0028000CF7D\n" ++"S3159801EF64881000101080000698102000C22900000D\n" ++"S3159801EF74980320018600E0018801200180A3000DF1\n" ++"S3159801EF842ABFFFFBC208C0002726007EA614E1D833\n" ++"S3159801EF94C204E01080A060001280000701000000FE\n" ++"S3159801EFA4C204E00CC400400080A0A0003680014C45\n" ++"S3159801EFB41B26007E821000078288600202BFFFFE2C\n" ++"S3159801EFC4010000008E29C0017FFFFEBF01000000E9\n" ++"S3159801EFD410BFFFF1C204E010821000078288600214\n" ++"S3159801EFE402BFFFFE010000008E29C0017FFFFEB615\n" ++"S3159801EFF40100000010BFFFCA0726007EC20720043D\n" ++"S3159801F0048810000280A34001028001E99810001C2F\n" ++"S3159801F014C20120048208401DC2212004C40120048F\n" ++"S3159801F0248408B800C4212004872D6010C2012004E5\n" ++"S3159801F0348730E01082104003C2212004EC21200875\n" ++"S3159801F044C021200CC6012004031800008228C0019F\n" ++"S3159801F054C4032008C2212004841B400280A0000214\n" ++"S3159801F064C60120040306000084603FFF8228C0017C\n" ++"S3159801F074DA23200CC4232010C221200480A4200062\n" ++"S3159801F0841280000780A52000C20120040510000003\n" ++"S3159801F09482104002C221200480A52000028001BE6C\n" ++"S3159801F0A4010000008143C000C20000000320000053\n" ++"S3159801F0B4C401000084108001C421000080A42000AA\n" ++"S3159801F0C412BFFF1CAA1000138143C000C20000009E\n" ++"S3159801F0D403200000C405000084108001C4250000A3\n" ++"S3159801F0E48143C000C200000005101004C020A0048A\n" ++"S3159801F0F40726007E1B00003FC400E1C49A1363FFF0\n" ++"S3159801F10480A0800D8810E1C4088000048210000252\n" ++"S3159801F1141B26007EC403616C82204002C220E1C48E\n" ++"S3159801F124C425E088C401200480A0A03F0880000378\n" ++"S3159801F134821000028410203F82204002C2212004BA\n" ++"S3159801F1448528A010C205E08882104002C225E0886D\n" ++"S3159801F154C401200880A0A007088000038210000239\n" ++"S3159801F1648410200782204002C22120088528A016EF\n" ++"S3159801F174C205E08882104002C225E088C401200CA9\n" ++"S3159801F18480A0A0070880000382100002841020073B\n" ++"S3159801F19482204002C221200C8528A019C205E08844\n" ++"S3159801F1A482104002C225E088C401201080A0A00FD5\n" ++"S3159801F1B408800003821000028410200F82204002E6\n" ++"S3159801F1C4C2212010C205E0888528A01C821040021D\n" ++"S3159801F1D4C225E0888143C000C20000000326007E50\n" ++"S3159801F1E4881061B4C215E01AC401200C82087FFC08\n" ++"S3159801F1F48400A08CC6012004C235E01A80A080033D\n" ++"S3159801F2042280008B0526007EC421200C8143C000F0\n" ++"S3159801F214C20000000311400005000080821060506E\n" ++"S3159801F224C42040001B26007EC60361A880A0E00086\n" ++"S3159801F234028000060526007EC200A1AC80A060006B\n" ++"S3159801F24422BFFE98C606A0080726007EC200E1AC36\n" ++"S3159801F25480A0600002800159051150008210A00C0B\n" ++"S3159801F2649A102400DA20400009101004C6012018C7\n" ++"S3159801F274030000088228C001C22120188410A0081E\n" ++"S3159801F28403114000DA2080000700010082106050C3\n" ++"S3159801F294C62040003080014980A0A0041280000A4B\n" ++"S3159801F2A4981020001080000C8423400C02BFFF376D\n" ++"S3159801F2B498032001C208C000C22900008600E00113\n" ++"S3159801F2C48801200180A300020ABFFFF980A3000DDB\n" ++"S3159801F2D48423400C8530A0028328A002822340010E\n" ++"S3159801F2E49A20400C1080000698102000C221000034\n" ++"S3159801F2F4980320018600E0048801200480A3000273\n" ++"S3159801F3042ABFFFFBC200C000108000069810200097\n" ++"S3159801F314C2290000980320018600E0018801200192\n" ++"S3159801F32480A3000D2ABFFFFBC208C00010BFFF18B7\n" ++"S3159801F3342726007E0300003FC807600482106300F5\n" ++"S3159801F344860900011B003FC0852920188209000DF2\n" ++"S3159801F3548728E0088410800383306008841080012C\n" ++"S3159801F3648931201888108004C407FFDC80A0A00086\n" ++"S3159801F37422800012DA07FFE80700003F880100029D\n" ++"S3159801F3848610E300840900038528A0088329201898\n" ++"S3159801F394821040028609000D053FC0008730E008B7\n" ++"S3159801F3A484090002821040038530A0188210400215\n" ++"S3159801F3B4C2276004DA07FFE880A1000D1A80001FAE\n" ++"S3159801F3C4C207FFE89023400490023FFF912A201038\n" ++"S3159801F3D47FFFFDB691322010D0376012C407FFEC37\n" ++"S3159801F3E480A0A00002BFFECAC407FFB8C607FFE4FF\n" ++"S3159801F3F48200FFFFDA07FFBC80A0400D32BFFEC52D\n" ++"S3159801F404C036200AC217600C8210610010BFFEBF75\n" ++"S3159801F414C237600C90006008912A20107FFFFDA3E3\n" ++"S3159801F4249132201010BFFEB9D0376004C200A1B43E\n" ++"S3159801F43410BFFF77C221200C80A0600002BFFFE9AC\n" ++"S3159801F444C407FFECC417600C033FFFC882288001E8\n" ++"S3159801F45410BFFFE3C237600CE217600C0300000883\n" ++"S3159801F464808C40010280000E0700003F7FFFFD8FCC\n" ++"S3159801F474D0176012A12A20107FFFFD8CD017600641\n" ++"S3159801F484912A2010A134201091322010A00400084A\n" ++"S3159801F494A0042001E027FFE80700003F8610E2FF59\n" ++"S3159801F4A4820C4003A20C6100C237600C10BFFE4D5A\n" ++"S3159801F4B4E227FFECC20661B410BFFE09C226A00872\n" ++"S3159801F4C410BFFE44C437FFF6C217600C833060023E\n" ++"S3159801F4D48208603C10BFFFFB84008001981361D8B1\n" ++"S3159801F4E4E803200C88052010C203200480A100019A\n" ++"S3159801F4F422800002C80361D8053FF001C2052004A1\n" ++"S3159801F5048410A3FF82084002C2252004C40520045E\n" ++"S3159801F5148408B800C4252004C607FFB4C20520048C\n" ++"S3159801F5248530E01082104002C2252004E025200887\n" ++"S3159801F534E225200CC205200405060000821040022B\n" ++"S3159801F544C2252004C605200403180000C403200814\n" ++"S3159801F5548228C00184190002C2252004DA07FFD83B\n" ++"S3159801F56480A00002C823200CC6052004852B6002BE\n" ++"S3159801F5748803400D030800008610C0019A603FFF76\n" ++"S3159801F5848400801788010017DA232010C6252004E1\n" ++"S3159801F594B800A01CB6012064C207FFD080A48001DC\n" ++"S3159801F5A406800076E207FFD4DA07FFD8C416C000AE\n" ++"S3159801F5B4C60700009A036001A0100001C427FFD072\n" ++"S3159801F5C4C627FFD4DA27FFD8B606E002B80720047F\n" ++"S3159801F5D42726007EA614E1D80726007E80A420005B\n" ++"S3159801F5E4AC1000130280003FEA00E168C204E010FF\n" ++"S3159801F5F480A060001280005501000000C404E00C4C\n" ++"S3159801F604C200800080A06000068000508810000225\n" ++"S3159801F6148400A010C205A00480A080010280005431\n" ++"S3159801F62486100016C200E0088218800180A00001A5\n" ++"S3159801F634C420E00C84603FFFC420E01080A427FF17\n" ++"S3159801F644188000039A1027FF9A100010C20120040B\n" ++"S3159801F65482084015C2212004C40120048408B800F4\n" ++"S3159801F664C4212004872B6010C20120048730E0103E\n" ++"S3159801F67482104003C2212004E2212008C021200CD3\n" ++"S3159801F684C20120040506000082104002C22120040A\n" ++"S3159801F694C40120040318000082288001C221200491\n" ++"S3159801F6A4A4A4800D1280000601000000C201200462\n" ++"S3159801F6B40510000082104002C22120048143C00033\n" ++"S3159801F6C4C200000003200000C401000084108001D8\n" ++"S3159801F6D4C4210000A0A4000D12BFFFC5A204400DC9\n" ++"S3159801F6E480A4A00012BFFFAEC207FFD08143C00019\n" ++"S3159801F6F4C200000003200000C405000084108001A4\n" ++"S3159801F704C42500008143C000C2000000C207FFBCA3\n" ++"S3159801F71482006001C227FFBC03101004C407FFCC02\n" ++"S3159801F724C0206004C607FFB884008003DA07FFBCCB\n" ++"S3159801F734C207FFE480A3400116BFFE6EC427FFCC1F\n" ++"S3159801F74410BFFDD5E205E0048210000782886002A5\n" ++"S3159801F75402BFFFFE010000008E29C0017FFFFCDA7B\n" ++"S3159801F7640100000010BFFFA3C204E0101B26007E0F\n" ++"S3159801F77410BFFFADC40361D8C207FFD082204012DF\n" ++"S3159801F78484044012C227FFD0A010001210BFFF9123\n" ++"S3159801F794C427FFD4C2012004050800008210400240\n" ++"S3159801F7A4C221200410BFFE46A81000040326007E39\n" ++"S3159801F7B410BFFE18DA0061D89C07FF40FE03A0200B\n" ++"S3159801F7C4DE03A024E01BA028E41BA030E81BA03884\n" ++"S3159801F7D4EC1BA040F01BA048F41BA050F81BA058A2\n" ++"S3159801F7E481C3E0089C23BF40031140008410200381\n" ++"S3159801F7F482106060C420400081C3E00801000000C3\n" ++"S3159801F8049C03BFF0DE23A0041F26007E84102000EB\n" ++"S3159801F814C603E1D8092000008328A004C020C001AA\n" ++"S3159801F8248200C001C8206004C02060088400A00139\n" ++"S3159801F834C020600C80A0A03404BFFFF98328A004DB\n" ++"S3159801F844C020E3508600E350C820E004C200E004D7\n" ++"S3159801F8540500800082104002C220E004C020E0081E\n" ++"S3159801F8648213E1D8C020E00CC02060108143C00007\n" ++"S3159801F874C200000003101004C403E1D8C420601028\n" ++"S3159801F884DE03A00481C3E0089C23BFF09C03BFD088\n" ++"S3159801F894FE23A01CBE23BFD0DE23A020E023A024F0\n" ++"S3159801F8A40326007EA01061D884022360D02061D8F3\n" ++"S3159801F8B4D024200CD02420087FFFFFD2C42420040E\n" ++"S3159801F8C4D00420049C07FFD0FE03A01CDE03A020CD\n" ++"S3159801F8D4E003A02481C3E0089C23BFD09C03BFF016\n" ++"S3159801F8E4DE23A0048202400982004009832860022B\n" ++"S3159801F8F4860200010526007E8600E0041926007E0C\n" ++"S3159801F9049A1020000326007ED020A1F4D22061F01B\n" ++"S3159801F9148608FFFC80A340091680000FC02321ECBA\n" ++"S3159801F9249E1020008810200084010008C621000832\n" ++"S3159801F934DE20A0089A036001C020A0048600E04A4C\n" ++"S3159801F9448801200C80A3400906BFFFF89E10000287\n" ++"S3159801F954C42321EC90100003DE03A00481C3E008BC\n" ++"S3099801F9649C23BFF092\n" ++"S30D9801F968FFC007FF0000FFFF35\n" ++"S7059801E00081\n"; +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/leon.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon.h +--- linux-2.6.24/include/asm-arm/arch-hipox/leon.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/leon.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,36 @@ ++/* ++ * linux/arch/arm/mach-hipox/leon.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ */ ++#ifdef CONFIG_SUPPORT_LEON ++ ++#if !defined(__LEON_H__) ++#define __LEON_H__ ++ ++/** ++ * Load the LEON's program image into the memory as defined by the s-records ++ * holding the LEON program image, and begin execution at the start address ++ * defined by the s-records ++ */ ++extern void init_copro(const s8 *srec, unsigned long arg); ++ ++extern void shutdown_copro(void); ++ ++#endif // #if !defined(__LEON_H__) ++#endif // CONFIG_SUPPORT_LEON ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/memory.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/memory.h +--- linux-2.6.24/include/asm-arm/arch-hipox/memory.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/memory.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,107 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/memory.h ++ * ++ * 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 __ASM_ARCH_MEMORY_H ++#define __ASM_ARCH_MEMORY_H ++ ++/* Max. size of each memory node */ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define NODE_MAX_MEM_SHIFT (26) /* 64MB*/ ++#elif defined (CONFIG_HIPOX_VERSION_0X810) ++#define NODE_MAX_MEM_SHIFT (28) /* 256MB */ ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++#ifdef CONFIG_HIPOX_VERSION_0X800 ++#define MEM_MAP_ALIAS_SHIFT 28 ++#elif defined (CONFIG_HIPOX_VERSION_0X810) ++#define MEM_MAP_ALIAS_SHIFT 30 ++#endif // CONFIG_HIPOX_VERSION_0X800 ++ ++/* All current HIPOX versions have two memory nodes; SDRAM followed contiguously ++ * by SRAM */ ++#define SDRAM_PA (0x48000000) ++#define SDRAM_SIZE (1UL << (NODE_MAX_MEM_SHIFT)) ++#define SRAM_PA ((SDRAM_PA) + (SDRAM_SIZE)) ++ ++/* Only a portion of the SRAM may be available for the use of Linux */ ++#define SRAM_SIZE (CONFIG_SRAM_NUM_PAGES * PAGE_SIZE) ++ ++#define SDRAM_END (SDRAM_PA + SDRAM_SIZE - 1) ++#define SRAM_END (SRAM_PA + SRAM_SIZE - 1) ++ ++#define PHYS_OFFSET SDRAM_PA ++#define PAGE_OFFSET 0xC0000000 ++ ++#define __virt_to_phys(x) ((x) - PAGE_OFFSET + PHYS_OFFSET) ++#define __phys_to_virt(x) ((x) - PHYS_OFFSET + PAGE_OFFSET) ++ ++#define __virt_to_bus(x) __virt_to_phys(x) ++#define __bus_to_virt(x) __phys_to_virt(x) ++ ++#ifdef CONFIG_DISCONTIGMEM ++/* ++ * Memory map aliased every 1GByte, i.e. top 2 bits are ignored. ++ * ++ * Currently (0X800) we have: ++ * ++ * Start of physical memory: 0x08000000 ++ * 0x48000000 - alias ++ * 0x88000000 - alias ++ * 0xC8000000 - alias ++ * ++ * Node 0 SDRAM: 0x08000000 - 0x09FFFFFF 32MB populated ++ * : 0x48000000 - alias ++ * : 0x88000000 - alias ++ * : 0xC8000000 - alias ++ * ++ * Node 1 SRAM : 0x0C000000 - 0x00008000 32KB populated ++ * : 0x4C000000 - alias ++ * : 0x8C000000 - alias ++ * : 0xCC000000 - alias ++ * ++ * It will be assumed that no single memory node can be larger than ++ * (1 << NODE_MAX_MEM_SIZE) and that nodes will be contiguous, although ++ * individual nodes may not be fully populated ++ */ ++ ++/* ++ * Given a kernel address, find the home node of the underlying memory. ++ */ ++#define KVADDR_TO_NID(addr) (((unsigned long)(addr) - PAGE_OFFSET) >> NODE_MAX_MEM_SHIFT) ++ ++/* ++ * Given a page frame number, convert it to a node id. ++ */ ++#define PFN_TO_NID(pfn) (((pfn) - PHYS_PFN_OFFSET) >> (NODE_MAX_MEM_SHIFT - PAGE_SHIFT)) ++ ++/* ++ * Given a kaddr, ADDR_TO_MAPBASE finds the owning node of the memory ++ * and return the mem_map of that node. ++ */ ++#define ADDR_TO_MAPBASE(kaddr) NODE_MEM_MAP(KVADDR_TO_NID(kaddr)) ++ ++/* ++ * Given a page frame number, find the owning node of the memory ++ * and return the mem_map of that node. ++ */ ++#define PFN_TO_MAPBASE(pfn) NODE_MEM_MAP(PFN_TO_NID(pfn)) ++ ++/* ++ * Given a kaddr, LOCAL_MAP_NR finds the owning node of the memory ++ * and returns the index corresponding to the appropriate page in the ++ * node's mem_map. ++ */ ++#define LOCAL_MAP_NR(addr) (((unsigned long)(addr) & ((1 << NODE_MAX_MEM_SHIFT) - 1)) >> PAGE_SHIFT) ++ ++#else ++ ++#define PFN_TO_NID(addr) (0) ++ ++#endif ++ ++#endif // __ASM_ARCH_MEMORY_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/ox810sata.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/ox810sata.h +--- linux-2.6.24/include/asm-arm/arch-hipox/ox810sata.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/ox810sata.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,162 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/sata.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ * ++ * Definitions for using the SATA core in the ox800 ++ */ ++ ++#ifndef __ASM_ARCH_SATA_H__ ++#define __ASM_ARCH_SATA_H__ ++ ++/* number of ports per interface */ ++#define OX810SATA_MAX_PORTS 1 ++ ++ ++/** sata host port register offsets */ ++#define OX810SATA_ORB1 (0x00 / sizeof(u32)) ++#define OX810SATA_ORB2 (0x04 / sizeof(u32)) ++#define OX810SATA_ORB3 (0x08 / sizeof(u32)) ++#define OX810SATA_ORB4 (0x0C / sizeof(u32)) ++#define OX810SATA_ORB5 (0x10 / sizeof(u32)) ++ ++#define OX810SATA_MASTER_STATUS (0x10 / sizeof(u32)) ++#define OX810SATA_FIS_CTRL (0x18 / sizeof(u32)) ++#define OX810SATA_FIS_DATA (0x1C / sizeof(u32)) ++ ++#define OX810SATA_INT_STATUS (0x30 / sizeof(u32)) ++#define OX810SATA_INT_CLEAR (0x30 / sizeof(u32)) ++#define OX810SATA_INT_ENABLE (0x34 / sizeof(u32)) ++#define OX810SATA_INT_DISABLE (0x38 / sizeof(u32)) ++#define OX810SATA_VERSION (0x3C / sizeof(u32)) ++#define OX810SATA_SATA_CONTROL (0x5C / sizeof(u32)) ++#define OX810SATA_SATA_COMMAND (0x60 / sizeof(u32)) ++#define OX810SATA_HID_FEATURES (0x64 / sizeof(u32)) ++#define OX810SATA_PORT_CONTROL (0x68 / sizeof(u32)) ++#define OX810SATA_DRIVE_CONTROL (0x6C / sizeof(u32)) ++ ++/** These registers allow access to the link layer registers ++that reside in a different clock domain to the processor bus */ ++#define OX810SATA_LINK_DATA (0x70 / sizeof(u32)) ++#define OX810SATA_LINK_RD_ADDR (0x74 / sizeof(u32)) ++#define OX810SATA_LINK_WR_ADDR (0x78 / sizeof(u32)) ++#define OX810SATA_LINK_CONTROL (0x7C / sizeof(u32)) ++ ++/** Backup registers contain a copy of the command sent to the disk */ ++#define OX810SATA_BACKUP1 (0xB0 / sizeof(u32)) ++#define OX810SATA_BACKUP2 (0xB4 / sizeof(u32)) ++#define OX810SATA_BACKUP3 (0xB8 / sizeof(u32)) ++#define OX810SATA_BACKUP4 (0xBC / sizeof(u32)) ++ ++/** ++ * commands to issue in the master status to tell it to move shadow ++ * registers to the actual device ++ */ ++#define SATA_OPCODE_MASK 0x00000007 ++#define CMD_WRITE_TO_ORB_REGS_NO_COMMAND 0x4 ++#define CMD_WRITE_TO_ORB_REGS 0x2 ++#define CMD_SYNC_ESCAPE 0x7 ++#define CMD_CORE_BUSY (1 << 7) ++ ++/** interrupt bits */ ++#define OX810SATA_INT_END_OF_CMD (1 << 0) ++#define OX810SATA_INT_LINK_SERROR (1 << 1) ++#define OX810SATA_INT_ERROR (1 << 2) ++#define OX810SATA_INT_LINK_IRQ (1 << 3) ++#define OX810SATA_INT_REG_ACCESS_ERR (1 << 7) ++#define OX810SATA_INT_BIST_FIS (1 << 11) ++#define OX810SATA_INT_MASKABLE (OX810SATA_INT_END_OF_CMD |\ ++ OX810SATA_INT_LINK_SERROR |\ ++ OX810SATA_INT_ERROR |\ ++ OX810SATA_INT_LINK_IRQ |\ ++ OX810SATA_INT_REG_ACCESS_ERR |\ ++ OX810SATA_INT_BIST_FIS ) ++ ++#define OX810SATA_INT_WANT (OX810SATA_INT_END_OF_CMD |\ ++ OX810SATA_INT_LINK_SERROR |\ ++ OX810SATA_INT_REG_ACCESS_ERR |\ ++ OX810SATA_INT_ERROR ) ++ ++/** raw interrupt bits, unmaskable, but do not generate interrupts */ ++#define OX810SATA_RAW_END_OF_CMD (OX810SATA_INT_END_OF_CMD << 16) ++#define OX810SATA_RAW_LINK_SERROR (OX810SATA_INT_LINK_SERROR << 16) ++#define OX810SATA_RAW_ERROR (OX810SATA_INT_ERROR << 16) ++#define OX810SATA_RAW_LINK_IRQ (OX810SATA_INT_LINK_IRQ << 16) ++#define OX810SATA_RAW_REG_ACCESS_ERR (OX810SATA_INT_REG_ACCESS_ERR << 16) ++#define OX810SATA_RAW_BIST_FIS (OX810SATA_INT_BIST_FIS << 16) ++ ++/** SATA core register offsets */ ++#define OX810SATA_DM_DEBUG1 ( SATACORE_REGS_BASE + 0x000 ) ++#define OX810SATA_RAID_SET ( SATACORE_REGS_BASE + 0x004 ) ++#define OX810SATA_DM_DEBUG2 ( SATACORE_REGS_BASE + 0x008 ) ++#define OX810SATA_CORE_ISR ( SATACORE_REGS_BASE + 0x030 ) ++#define OX810SATA_CORE_IES ( SATACORE_REGS_BASE + 0x034 ) ++#define OX810SATA_CORE_IEC ( SATACORE_REGS_BASE + 0x038 ) ++#define OX810SATA_DEVICE_CONTROL ( SATACORE_REGS_BASE + 0x068 ) ++#define OX810SATA_EXCESS ( SATACORE_REGS_BASE + 0x06C ) ++#define OX810SATA_IDLE_STATUS ( SATACORE_REGS_BASE + 0x07C ) ++#define OX810SATA_RAID_CONTROL ( SATACORE_REGS_BASE + 0x090 ) ++ ++/** sata core control register bits */ ++#define OX810SATA_SCTL_CLR_ERR (0x00003016) ++ ++/* Interrupts direct from the ports */ ++#define OX810SATA_NORMAL_INTS_WANTED (0x00000003) ++ ++/* Interrupts from the RAID controller only */ ++#define OX810SATA_RAID_INTS_WANTED (0x00008000) ++ ++/* The bits in the OX810SATA_IDLE_STATUS that, when set indicate an idle core */ ++#define OX810SATA_IDLE_CORES ((1 << 18) | (1 << 19)) ++ ++/** Device Control register bits */ ++#define OX810SATA_DEVICE_CONTROL_ABORT (1 << 2) ++#define OX810SATA_DEVICE_CONTROL_PAD (1 << 3) ++#define OX810SATA_DEVICE_CONTROL_PADPAT (1 << 16) ++ ++/** ORB4 register bits */ ++#define OX810SATA_ORB4_SRST (1 << 26) ++ ++/** standard HW raid flags */ ++#define HIPOXSATA_NOTRAID 3 ++#define HIPOXSATA_RAID1 1 ++#define HIPOXSATA_RAID0 0 ++#define HIPOXSATA_RAID_TWODISKS 3 ++ ++/** ++ * variables to write to the device control register to set the current device ++ * ie, master or slave ++ */ ++#define OX810SATA_DR_CON_48 2 ++#define OX810SATA_DR_CON_28 0 ++ ++/** A ficticious device id used for matching device and driver */ ++#define OX810SATA_DEVICEID 0x00100002 ++ ++/** The different Oxsemi SATA core version numbers */ ++#define OX810SATA_CORE_VERSION 0x1f2 ++ ++/** Occasionally we get interrupts, even though there is no outstanding command, ++these can be caused by dodgy SATA cables, this is a divider for reporting these ++interrupts */ ++#define OX810SATA_NO_CMD_ERROR_RPT_COUNT 8 ++ ++extern int hipoxsata_RAID_faults( void ); ++extern int hipoxsata_get_port_no(struct request_queue* ); ++extern int hipoxsata_LBA_schemes_compatible( void ); ++ ++#endif /* #if !defined(__ASM_ARCH_SATA_H__) */ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/sata.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/sata.h +--- linux-2.6.24/include/asm-arm/arch-hipox/sata.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/sata.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,181 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/sata.h ++ * ++ * Copyright (C) 2005 Oxford Semiconductor Ltd ++ * ++ * 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 ++ * ++ * Definitions for using the SATA core in the ox800 ++ */ ++ ++#ifndef __ASM_ARCH_SATA_H__ ++#define __ASM_ARCH_SATA_H__ ++ ++#include <linux/blkdev.h> ++ ++/* number of ports per interface */ ++#define OX800SATA_MAX_PORTS 1 ++ ++ ++/** ata core register offsets */ ++#define OX800SATA_ORB1 (0x00 / sizeof(u32)) ++#define OX800SATA_ORB2 (0x04 / sizeof(u32)) ++#define OX800SATA_ORB3 (0x08 / sizeof(u32)) ++#define OX800SATA_ORB4 (0x0C / sizeof(u32)) ++#define OX800SATA_ORB5 (0x10 / sizeof(u32)) ++ ++#define OX800SATA_MASTER_STATUS (0x10 / sizeof(u32)) ++#define OX800SATA_DEVICE_CTRL (0x18 / sizeof(u32)) ++#define OX800SATA_REG_ACCESS (0x2c / sizeof(u32)) ++#define OX800SATA_INT_STATUS (0x30 / sizeof(u32)) ++#define OX800SATA_INT_CLEAR (0x30 / sizeof(u32)) ++#define OX800SATA_INT_ENABLE (0x34 / sizeof(u32)) ++#define OX800SATA_INT_DISABLE (0x38 / sizeof(u32)) ++#define OX800SATA_VERSION (0x3C / sizeof(u32)) ++#define OX800SATA_SATA_CONTROL (0x5C / sizeof(u32)) ++#define OX800SATA_SATA_COMMAND (0x60 / sizeof(u32)) ++#define OX800SATA_DEVICE_SELECT (0x64 / sizeof(u32)) ++#define OX800SATA_DEVICE_CONTROL (0x68 / sizeof(u32)) ++#define OX800SATA_DRIVE_CONTROL (0x6C / sizeof(u32)) ++ ++/** ata core registers that only work on port 0 */ ++#define OX800SATA_BURST_BUFFER (0x1C / sizeof(u32)) ++#define OX800SATA_BURST_CONTROL (0x48 / sizeof(u32)) ++#define OX800SATA_RAID_CONTROL (0x70 / sizeof(u32)) ++ ++ ++ ++ ++/** These registers allow access to the link layer registers ++that reside in a different clock domain to the processor bus */ ++#define OX800SATA_LINK_DATA (0x00000000) ++#define OX800SATA_LINK_RD_ADDR (0x00000001) ++#define OX800SATA_LINK_WR_ADDR (0x00000002) ++#define OX800SATA_LINK_CONTROL (0x00000003) ++ ++/** ++ * commands to issue in the master status to tell it to move shhadow ++ * registers to the actual device ++ */ ++#define OX800SATA_MASTER_STATUS_WRITEOP 6 | (1 << 31) ++#define OX800SATA_MASTER_STATUS_READOP 5 | (1 << 31) | (1 << 29) ++#define OX800SATA_MASTER_STATUS_ORBWRITEOP 1 | (1 << 31) ++#define OX800SATA_MASTER_STATUS_ORBWRITE_RUN 2 | (1 << 31) | (1 << 29) ++#define OX800SATA_MASTER_STATUS_READY 64 ++#define OX800SATA_MASTER_STATUS_BUSY 128 ++ ++#define OX800SATA_ORB2_SECTORS_MASK (0x0000ffff) ++ ++#define SATA_OPCODE_MASK 0x00000003 ++#define CMD_WRITE_TO_ORB_REGS_NO_COMMAND 0x01 ++#define CMD_WRITE_TO_ORB_REGS 0x02 ++#define CMD_READ_ALL_REGISTERS 0x03 ++#define CMD_READ_STATUS_REG 0x04 ++#define CMD_CORE_BUSY (1 << 7) ++ ++/** interrupt bits */ ++#define OX800SATA_INT_END_OF_CMD (1 << 0) ++#define OX800SATA_INT_END_OF_DATA_CMD (1 << 1) ++#define OX800SATA_INT_ERROR (1 << 2) ++#define OX800SATA_INT_FIFO_EMPTY (1 << 3) ++#define OX800SATA_INT_FIFO_FULL (1 << 4) ++#define OX800SATA_INT_END_OF_TRANSF (1 << 5) ++#define OX800SATA_INT_MASKABLE (OX800SATA_INT_END_OF_CMD |\ ++ OX800SATA_INT_END_OF_DATA_CMD |\ ++ OX800SATA_INT_ERROR |\ ++ OX800SATA_INT_FIFO_EMPTY |\ ++ OX800SATA_INT_FIFO_FULL |\ ++ OX800SATA_INT_END_OF_TRANSF ) ++ ++/** raw interrupt bits, unmaskable, but do not generate interrupts */ ++#define OX800SATA_RAW_END_OF_CMD (1 << 8) ++#define OX800SATA_RAW_END_OF_DATA_CMD (1 << 9) ++#define OX800SATA_RAW_ERROR (1 << 10) ++#define OX800SATA_RAW_FIFO_EMPTY (1 << 11) ++#define OX800SATA_RAW_FIFO_FULL (1 << 12) ++#define OX800SATA_RAW_END_OF_TRANSF (1 << 13) ++ ++/** burst buffer control bits */ ++#define OX800SATA_BBC_FORCE_EOT (1 << 0) ++#define OX800SATA_BBC_DIRECTION (1 << 2) ++#define OX800SATA_BBC_FIFO_DIS (1 << 4) ++#define OX800SATA_BBC_DREQ_DIS (1 << 5) ++#define OX800SATA_BBC_DREQ (1 << 6) ++ ++/** sata control register bits */ ++#define OX800SATA_SCTL_RESET (1 << 0) ++#define OX800SATA_SCTL_ABORT (1 << 2) ++ ++/** Device Control register bits */ ++#define OX800SATA_DEVICE_CONTROL_ABORT (1 << 2) ++ ++/** ORB4 register bits */ ++#define OX800SATA_ORB4_SRST (1 << 26) ++ ++/** SATA control transport state machine mask */ ++#define OX800SATA_SATA_CONTROL_TRANS_MASK (0x0000001e) ++#define OX800SATA_TRANS_CHECKTYPE (0x00000008) ++#define OX800SATA_TRANS_PIOITRANS (0x00000018) ++#define OX800SATA_TRANS_PIOOTRANS (0x0000001C) ++ ++/** RAID control bit definitions */ ++#define OX800SATA_RAID_SPAN_EN (1 << 0) ++#define OX800SATA_RAID_STRI_EN (1 << 1) ++#define OX800SATA_RAID_STRI16 (1 << 2) ++#define OX800SATA_RAID_STRI32 (1 << 3) ++#define OX800SATA_RAID_STRI64 (1 << 4) ++#define OX800SATA_RAID_STRI128 (1 << 5) ++#define OX800SATA_RAID_STRI256 (1 << 6) ++#define OX800SATA_RAID_STRI512 (1 << 7) ++#define OX800SATA_RAID_STRI1M (1 << 8) ++#define OX800SATA_RAID_STRI2M (1 << 9) ++#define OX800SATA_RAID_STRI_TEST (1 << 10) ++#define OX800SATA_RAID_XSOFF2 (0 << 11) ++#define OX800SATA_RAID_XSOFF4 (1 << 11) ++#define OX800SATA_RAID_XSOFF6 (2 << 11) ++#define OX800SATA_RAID_XSOFF8 (3 << 11) ++#define OX800SATA_RAID_LOOP_BK (1 << 12) ++#define OX800SATA_RAID_MIR0 (0 << 13) ++#define OX800SATA_RAID_MIR1 (1 << 13) ++#define OX800SATA_RAID_MIRALT (2 << 13) ++#define OX800SATA_RAID_MIR_EN (1 << 16) ++#define OX800SATA_RAID_OVERLAP (1 << 23) ++ ++/* standard HW raid flags */ ++#define HIPOXSATA_RAID1 (OX800SATA_RAID_MIR0 | OX800SATA_RAID_MIR_EN | OX800SATA_RAID_OVERLAP ) ++#define HIPOXSATA_RAID0 (OX800SATA_RAID_OVERLAP | OX800SATA_RAID_STRI_EN ) ++/** ++ * variables to write to the device control register to set the current device ++ * ie, master or slave ++ */ ++#define OX800SATA_DEVICE_CONTROL_MASTER 0 ++#define OX800SATA_DEVICE_CONTROL_SLAVE 1 ++ ++/** A ficticious device id used for matching device and driver */ ++#define OX800SATA_DEVICEID 0x00100001 ++ ++/** The different Oxsemi SATA core version numbers */ ++#define OX800SATA_CORE_VERSION 0xf0 ++ ++/** Occasionally we get interrupts, even though there is no outstanding command, ++these can be caused by dodgy SATA cables, this is a divider for reporting these ++interrupts */ ++#define OX800SATA_NO_CMD_ERROR_RPT_COUNT 8 ++ ++extern int hipoxsata_RAID_faults( void ); ++extern int hipoxsata_get_port_no(struct request_queue* ); ++extern int hipoxsata_LBA_schemes_compatible( void ); ++ ++#endif /* #if !defined(__ASM_ARCH_SATA_H__) */ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/system.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/system.h +--- linux-2.6.24/include/asm-arm/arch-hipox/system.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/system.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,103 @@ ++/* linux/include/asm-arm/arch-hipox/system.h ++ * ++ * 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 __ASM_ARCH_SYSTEM_H ++#define __ASM_ARCH_SYSTEM_H ++ ++#include <asm/hardware.h> ++#include <asm/io.h> ++ ++extern void sata_power_off(void); ++extern int hipox_global_invert_leds; ++ ++#if defined(CONFIG_LEON_POWER_BUTTON_MONITOR) || defined(CONFIG_LEON_POWER_BUTTON_MONITOR_MODULE) ++#include <asm/arch/leon.h> ++#include <asm/arch/leon-power-button-prog.h> ++#endif // CONFIG_LEON_POWER_BUTTON_MONITOR ++ ++static inline void arch_idle(void) ++{ ++ /* ++ * This should do all the clock switching ++ * and wait for interrupt tricks ++ */ ++ cpu_do_idle(); ++} ++ ++static void disable_gmac(void) ++{ ++ writel((1UL << SYS_CTRL_RSTEN_MAC_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ writel((1UL << SYS_CTRL_CKEN_MAC_BIT), SYS_CTRL_CKEN_CLR_CTRL); ++} ++ ++static void arch_poweroff(void) ++{ ++ disable_gmac(); ++ ++#if defined(CONFIG_LEON_POWER_BUTTON_MONITOR) || defined(CONFIG_LEON_POWER_BUTTON_MONITOR_MODULE) ++ // Load CoPro program and start it running ++ init_copro(leon_srec, hipox_global_invert_leds); ++#endif // CONFIG_LEON_POWER_BUTTON_MONITOR ++ ++ // Turn of power to SATA disk if possible ++ sata_power_off(); ++} ++ ++static void arch_reset(char mode) ++{ ++ // Assert reset to cores as per power on defaults ++ writel((1UL << SYS_CTRL_RSTEN_COPRO_BIT) | ++ (1UL << SYS_CTRL_RSTEN_USBHS_BIT) | ++ (1UL << SYS_CTRL_RSTEN_USBHSPHY_BIT) | ++ (1UL << SYS_CTRL_RSTEN_MAC_BIT) | ++ (1UL << SYS_CTRL_RSTEN_PCI_BIT) | ++ (1UL << SYS_CTRL_RSTEN_DMA_BIT) | ++ (1UL << SYS_CTRL_RSTEN_DPE_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SATA_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SATA_PHY_BIT) | ++ (1UL << SYS_CTRL_RSTEN_STATIC_BIT) | ++ (1UL << SYS_CTRL_RSTEN_UART1_BIT) | ++ (1UL << SYS_CTRL_RSTEN_UART2_BIT) | ++ (1UL << SYS_CTRL_RSTEN_MISC_BIT) | ++ (1UL << SYS_CTRL_RSTEN_I2S_BIT) | ++ (1UL << SYS_CTRL_RSTEN_AHB_MON_BIT) | ++ (1UL << SYS_CTRL_RSTEN_UART3_BIT) | ++ (1UL << SYS_CTRL_RSTEN_UART4_BIT) | ++ (1UL << SYS_CTRL_RSTEN_SGDMA_BIT), SYS_CTRL_RSTEN_SET_CTRL); ++ ++ // Release reset to cores as per power on defaults ++ writel((1UL << SYS_CTRL_RSTEN_GPIO_BIT), SYS_CTRL_RSTEN_CLR_CTRL); ++ ++ // Disable clocks to cores as per power-on defaults ++ writel((1UL << SYS_CTRL_CKEN_COPRO_BIT) | ++ (1UL << SYS_CTRL_CKEN_DMA_BIT) | ++ (1UL << SYS_CTRL_CKEN_DPE_BIT) | ++ (1UL << SYS_CTRL_CKEN_SATA_BIT) | ++ (1UL << SYS_CTRL_CKEN_I2S_BIT) | ++ (1UL << SYS_CTRL_CKEN_USBHS_BIT) | ++ (1UL << SYS_CTRL_CKEN_MAC_BIT) | ++ (1UL << SYS_CTRL_CKEN_STATIC_BIT), SYS_CTRL_CKEN_CLR_CTRL); ++ ++ // Enable clocks to cores as per power-on defaults ++ writel((1UL << SYS_CTRL_CKEN_PCI_BIT), SYS_CTRL_CKEN_SET_CTRL); ++ ++ // Set sys-control pin mux'ing as per power-on defaults ++ writel(0x800UL, SYS_CTRL_GPIO_PRIMSEL_CTRL_0); ++ writel(0x0UL, SYS_CTRL_GPIO_PRIMSEL_CTRL_1); ++ writel(0x0UL, SYS_CTRL_GPIO_SECSEL_CTRL_0); ++ writel(0x0UL, SYS_CTRL_GPIO_SECSEL_CTRL_1); ++ writel(0x0UL, SYS_CTRL_GPIO_TERTSEL_CTRL_0); ++ writel(0x0UL, SYS_CTRL_GPIO_TERTSEL_CTRL_1); ++ ++ // No need to save any state, as the ROM loader can determine whether reset ++ // is due to power cycling or programatic action, just hit the (self- ++ // clearing) CPU reset bit of the block reset register ++ writel(1UL << SYS_CTRL_RSTEN_ARM_BIT, SYS_CTRL_RSTEN_SET_CTRL); ++} ++ ++#endif // __ASM_ARCH_SYSTEM_H ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/taco.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/taco.h +--- linux-2.6.24/include/asm-arm/arch-hipox/taco.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/taco.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,227 @@ ++/* ++ * linux/include/asm-arm/arch-hipox/tacho.h ++ * ++ * 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 __ASM_ARM_ARCH_TACHO_H ++#define __ASM_ARM_ARCH_TACHO_H ++ ++#include "hardware.h" ++ ++/* Routines ----------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++ ++/** ++ * DumpTachoRegisters is a debug function used to inspect hte tacho registers. ++ */ ++extern void DumpTachoRegisters(void); ++ ++ ++/** ++ * GetTemperature will read the thermistor register and convert the value to ++ * kelvin. ++ * @return an int that represents the thermister temperature in Kelvin, or a ++ * negative value in the case of error. ++ */ ++extern int GetTemperature(void); ++ ++ ++/** ++ * GetFanRPM will read the fan tacho register and convert the value to ++ * RPM. ++ * @return an int that represents the fan speed in RPM, or a ++ * negative value in the case of error. ++ */ ++extern int GetFanRPM(void); ++ ++#ifdef CONFIG_HIPOX_VERSION_0X810 ++#define HIPOX_TACHO_Ox810 ++#endif ++ ++ ++#ifndef HIPOX_TACHO_Ox810 ++#define DEGREES_C_0 273 ++#define TACHO_TARGET_THERM_FREQ_HZ 1000000 ++#define TACHO_CORE_THERM_DIVIDER_VALUE (((NOMINAL_SYSCLK / TACHO_TARGET_THERM_FREQ_HZ) - 1)) ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++#define TACHO_TARGET_CORE_FREQ_HZ 128000 ++#define TACHO_CORE_TACHO_DIVIDER_VALUE (((NOMINAL_SYSCLK / TACHO_TARGET_CORE_FREQ_HZ) - 1)) ++ ++#ifndef HIPOX_TACHO_Ox810 ++#define TACHO_FAN_SPEED_DIVIDER (64) ++#endif /*HIPOX_TACHO_Ox810 */ ++ ++#define SECONDARY_FUNCTION_ENABLE_FAN_PWM2 8 ++#define PRIMARY_FUNCTION_ENABLE_FAN_TEMP 29 ++#define PRIMARY_FUNCTION_ENABLE_FAN_TACHO 30 ++ ++#ifdef HIPOX_TACHO_Ox810 ++#define TEMP_TACHO_PULLUP_CTRL_VALUE 0x20000000 ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ ++// 256kHz with 50MHz pclk (reset value) ++#ifdef HIPOX_TACHO_Ox810 ++#define PWM_CORE_CLK_DIVIDER_VALUE (130) ++#else /* HIPOX_TACHO_Ox810 */ ++#define PWM_CORE_CLK_DIVIDER_VALUE (194) ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++/* Registers ---------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++/* -------------------------------------------------------------------------- */ ++ ++/* FAN Speed Counter ----------------------------------- */ ++ ++#ifdef HIPOX_TACHO_Ox810 ++ ++#define TACHO_FAN_SPEED_COUNTER (FAN_MON_BASE + 0x00) ++ // 31:17 - RO - Unused (0x00) ++ // 16 - R0 - Fan Count Valid - used in one shot mode ++ // 15:10 - R0 - Unused ++ // 9:0 - RO - Fan counter value. (See DD for conversion to rpm) ++ #define TACHO_FAN_SPEED_COUNTER_FAN_COUNT 0 ++ #define TACHO_FAN_SPEED_COUNTER_COUNT_VALID 16 ++ ++#else /* HIPOX_TACHO_Ox810 */ ++ ++#define TACHO_FAN_SPEED_COUNTER (FAN_MON_BASE + 0x00) ++ // 31:10 - RO - Unused (0x00) ++ // 9:0 - RO - Fan counter value. (See DD for conversion to rpm) ++ #define TACHO_FAN_SPEED_COUNTER_FAN_COUNT 0 ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++ #define TACHO_FAN_SPEED_COUNTER_MASK 1023 ++ ++/* Thermistor RC Counter ------------------------------- */ ++#define TACHO_THERMISTOR_RC_COUNTER (FAN_MON_BASE + 0x04) ++ // 31:10 - RO - Unused (0x00) ++ // 9:0 - RO - Thermistor counter value (See DD for conversion to temperature) ++ #define TACHO_THERMISTOR_RC_COUNTER_THERM_COUNT 0 ++ ++ #define TACHO_THERMISTOR_RC_COUNTER_MASK 1023 ++ ++ ++/* Thermistor Control ---------------------------------- */ ++#define TACHO_THERMISTOR_CONTROL (FAN_MON_BASE + 0x08) ++ // 31:2 - RO - Unused (0x00) ++ // 1:1 - R0 � THERM_COUNT value is valid ++ // 0:0 - RW - Set to 1 to enable thermistor PWM output ++ #define TACHO_THERMISTOR_CONTROL_THERM_VALID 1 ++ #define TACHO_THERMISTOR_CONTROL_THERM_ENABLE 0 ++ ++ ++/* Clock divider ---------------------------- */ ++#define TACHO_CLOCK_DIVIDER (FAN_MON_BASE + 0x0C) ++ // 31:10 - RO - Unused (0x00) ++ // 0:9 - RW - set PWM effective clock frequency to a division of pclk (0x030C ) ++ // 0000 � pclk divided by 1 (=pclk) ++ // 0001 - pclk divided by 2 ++ // 0780 - ~128kHz with 100MHz pclk (reset value) ++ // 1023 - pclk divided by 1024 ++ #define TACHO_CLOCK_DIVIDER_PWM_DIVIDER 0 ++ #define TACHO_CLOCK_DIVIDER_MASK 1023 ++ ++ ++/* New hardware registers added for 810 */ ++#ifdef HIPOX_TACHO_Ox810 ++ ++/* Fan Speed Control ..........................*/ ++#define TACHO_FAN_SPEED_CONTROL (FAN_MON_BASE + 0x10) ++ // 31:N+16 - R0 - Unused (0x0000) ++ // N+15:16 - RW - Select PWM which controls FAN speed ++ // 15:1 - Unused 0 ++ // 0 - RW - Fan Count mode 0 - Continuous running mode 1 - One shot mode ++ #define TACHO_FAN_SPEED_CONTROL_PWM_ENABLE_BASE 16 ++ #define TACHO_FAN_SPEED_CONTROL_PWM_USED 2 ++ #define TACHO_FAN_SPEED_CONTROL_FAN_COUNT_MODE 0 ++ ++ ++/* Fan One Shot Control .........................*/ ++#define TACHO_FAN_ONE_SHOT_CONTROL (FAN_MON_BASE + 0x14) ++ // 31:1 - R - Unused ++ // 0 - W - Start One-shot - Tacho - Self Clearing bit ++ #define TACHO_FAN_ONE_SHOT_CONTROL_START 0 ++ ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++/* PWM SECTION ------------------------------ */ ++ ++// 0x00 Channel 0 PWM data ++// 7:0 R/W 0x00 ++// 31:8 Unused R 0x00000 Unused ++#define PWM_DATA_0 (PWM_BASE+0x00) ++ // value 0 � Output aways lo ++ // value 1 � hi for 1 clock, lo for 255 ++ // . . . ++ // value 127 � 50:50 hi/lo ++ // . . . ++ // value 255 � hi for 255 clocks, lo for 1 ++ ++// 0x04 Channel 1 PWM data ++// 7:0 R/W 0x00 ++// 31:8 Unused R 0x00000 Unused ++#define PWM_DATA_1 (PWM_BASE+0x04) ++ // value 0 � Output aways lo ++ // value 1 � hi for 1 clock, lo for 255 ++ // . . . ++ // value 127 � 50:50 hi/lo ++ // . . . ++ // value 255 � hi for 255 clocks, lo for 1 ++ ++// 0x08 Channel 2 PWM data ++// 7:0 R/W 0x00 ++// 31:8 Unused R 0x00000 Unused ++#define PWM_DATA_2 (PWM_BASE+0x08) ++ // value 0 � Output aways lo ++ // value 1 � hi for 1 clock, lo for 255 ++ // . . . ++ // value 127 � 50:50 hi/lo ++ // . . . ++ // value 255 � hi for 255 clocks, lo for 1 ++ ++// 0x0C Channel 3 PWM data ++// 7:0 R/W 0x00 ++// 31:8 Unused R 0x00000 Unused ++#define PWM_DATA_3 (PWM_BASE+0x0C) ++ // value 0 � Output aways lo ++ // value 1 � hi for 1 clock, lo for 255 ++ // . . . ++ // value 127 � 50:50 hi/lo ++ // . . . ++ // value 255 � hi for 255 clocks, lo for 1 ++ ++#ifdef HIPOX_TACHO_Ox810 ++//0x400 PWM Clock Divider ++// 15:0 R/W 0x00C2 ++// 31:16 Unused R 0x0000 Unused ++#define PWM_CLOCK_DIVIDER (PWM_BASE+0x400) ++ ++#else /* HIPOX_TACHO_Ox810 */ ++ ++// 0x10 PWM clock divider ++// 15:0 R/W 0x00C2 ++// 31:16 Unused R 0x0000 Unused ++#define PWM_CLOCK_DIVIDER (PWM_BASE+0x10) ++ // set PWM effective clock frequency to a division of pclk ++ // value 0 � pclk divided by 1 (=pclk) ++ // value 1 � pclk divided by 2 ++ // value 194 � 256kHz with 50MHz pclk (reset value) ++ // . . . ++ // value 65535 � pclk divided by 65536 ++ ++#endif /* HIPOX_TACHO_Ox810 */ ++ ++#endif // __ASM_ARM_ARCH_TACHO_H ++ ++/* End oF File */ ++ +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/timex.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/timex.h +--- linux-2.6.24/include/asm-arm/arch-hipox/timex.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/timex.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,23 @@ ++/* linux/include/asm-arm/arch-hipox/timex.h ++ * ++ * 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 __ASM_ARCH_TIMEX_H ++#define __ASM_ARCH_TIMEX_H ++ ++#define TIMER_PRESCALE_BIT 2 ++#define TIMER_PRESCALE_1 0 ++#define TIMER_PRESCALE_16 1 ++#define TIMER_PRESCALE_256 2 ++ ++#define TIMER_INPUT_CLOCK CONFIG_NOMINAL_RPSCLK_FREQ ++#define TIMER_1_PRESCALE_ENUM TIMER_PRESCALE_16 ++#define TIMER_1_PRESCALE_VALUE (1 << (TIMER_1_PRESCALE_ENUM * 4)) ++#define TIMER_1_PRESCALED_CLK (TIMER_INPUT_CLOCK / TIMER_1_PRESCALE_VALUE) ++ ++#define CLOCK_TICK_RATE (TIMER_1_PRESCALED_CLK) ++ ++#endif // __ASM_ARCH_TIMEX_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/uncompress.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/uncompress.h +--- linux-2.6.24/include/asm-arm/arch-hipox/uncompress.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/uncompress.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,43 @@ ++/* linux/include/asm-arm/arch-hipox0/uncompress.h ++ * ++ * 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 __ASM_ARCH_UNCOMPRESS_H ++#define __ASM_ARCH_UNCOMPRESS_H ++ ++#include <asm/arch/hardware.h> ++ ++static inline void putc(int c) ++{ ++#ifdef CONFIG_ARCH_HIPOX_UART1 ++ static volatile unsigned char* uart = (volatile unsigned char*)UART_1_BASE_PA; ++#elif defined(CONFIG_ARCH_HIPOX_UART2) ++ static volatile unsigned char* uart = (volatile unsigned char*)UART_2_BASE_PA; ++#elif defined(CONFIG_ARCH_HIPOX_UART3) ++ static volatile unsigned char* uart = (volatile unsigned char*)UART_3_BASE_PA; ++#elif defined(CONFIG_ARCH_HIPOX_UART4) ++ static volatile unsigned char* uart = (volatile unsigned char*)UART_4_BASE_PA; ++#else ++#define NO_UART ++#endif ++ ++#ifndef NO_UART ++ while (!(uart[5] & 0x20)) { /* LSR reg THR empty bit */ ++ barrier(); ++ } ++ uart[0] = c; /* THR register */ ++#endif // NO_UART ++} ++ ++static inline void flush(void) ++{ ++} ++ ++#define arch_decomp_setup() ++ ++#define arch_decomp_wdog() ++ ++#endif // __ASM_ARCH_UNCOMPRESS_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-hipox/vmalloc.h linux-2.6.24-oxe810/include/asm-arm/arch-hipox/vmalloc.h +--- linux-2.6.24/include/asm-arm/arch-hipox/vmalloc.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-hipox/vmalloc.h 2008-06-11 17:45:12.000000000 +0200 +@@ -0,0 +1,29 @@ ++/* linux/include/asm-arm/arch-hipox/vmalloc.h ++ * ++ * 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 __ASM_ARCH_VMALLOC_H ++#define __ASM_ARCH_VMALLOC_H ++ ++/* ++ * Just any arbitrary offset to the start of the vmalloc VM area: the ++ * current 8MB value just means that there will be a 8MB "hole" after the ++ * physical memory until the kernel virtual memory starts. That means that ++ * any out-of-bounds memory accesses will hopefully be caught. ++ * The vmalloc() routines leaves a hole of 4kB between each vmalloced ++ * area for the same reason. ;) ++ */ ++ ++#define VMALLOC_OFFSET (8*1024*1024) ++/* Fix the VMALLOC start adr from the maximum possible SDRAM adr, so that ++ * it's possible to have Linux use only part of the available SDRAM without ++ * vmalloc/ioremap aliasing with the kernel mapping of the entire SDRAM */ ++#define MAX_SDRAM_ADR (__phys_to_virt(SDRAM_PA) + (SDRAM_SIZE)) ++#define VMALLOC_START (((unsigned long)MAX_SDRAM_ADR + VMALLOC_OFFSET) & ~(VMALLOC_OFFSET-1)) ++#define VMALLOC_VMADDR(x) ((unsigned long)(x)) ++#define VMALLOC_END (0xE0000000) ++ ++#endif // __ASM_ARCH_VMALLOC_H +diff -Nurd linux-2.6.24/include/asm-arm/arch-pxa/pxa-regs.h linux-2.6.24-oxe810/include/asm-arm/arch-pxa/pxa-regs.h +--- linux-2.6.24/include/asm-arm/arch-pxa/pxa-regs.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/arch-pxa/pxa-regs.h 2008-06-11 17:45:03.000000000 +0200 +@@ -1669,6 +1669,7 @@ + #define SSCR1_RSRE (1 << 20) /* Receive Service Request Enable */ + #define SSCR1_TINTE (1 << 19) /* Receiver Time-out Interrupt enable */ + #define SSCR1_PINTE (1 << 18) /* Peripheral Trailing Byte Interupt Enable */ ++#define SSCR1_IFS (1 << 16) /* Invert Frame Signal */ + #define SSCR1_STRF (1 << 15) /* Select FIFO or EFWR */ + #define SSCR1_EFWR (1 << 14) /* Enable FIFO Write/Read */ + +diff -Nurd linux-2.6.24/include/asm-arm/assembler.h linux-2.6.24-oxe810/include/asm-arm/assembler.h +--- linux-2.6.24/include/asm-arm/assembler.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/assembler.h 2008-06-11 17:45:14.000000000 +0200 +@@ -48,8 +48,10 @@ + + /* + * Data preload for architectures that support it ++ * HIPOX altered to >= 6 from >= 5 as 926 supports pld, but implements it as ++ * nop, so wastes instruction cycles to include pld support + */ +-#if __LINUX_ARM_ARCH__ >= 5 ++#if __LINUX_ARM_ARCH__ >= 6 + #define PLD(code...) code + #else + #define PLD(code...) +diff -Nurd linux-2.6.24/include/asm-arm/io.h linux-2.6.24-oxe810/include/asm-arm/io.h +--- linux-2.6.24/include/asm-arm/io.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/io.h 2008-06-11 17:45:14.000000000 +0200 +@@ -108,27 +108,24 @@ + * + * The {in,out}[bwl] macros are for emulating x86-style PCI/ISA IO space. + */ +-#ifdef __io +-#define outb(v,p) __raw_writeb(v,__io(p)) +-#define outw(v,p) __raw_writew((__force __u16) \ +- cpu_to_le16(v),__io(p)) +-#define outl(v,p) __raw_writel((__force __u32) \ +- cpu_to_le32(v),__io(p)) ++extern unsigned int pciio_read( u32 addr, unsigned int size ); ++extern void pciio_write(unsigned int data, u32 addr, unsigned int size ); + +-#define inb(p) ({ __u8 __v = __raw_readb(__io(p)); __v; }) +-#define inw(p) ({ __u16 __v = le16_to_cpu((__force __le16) \ +- __raw_readw(__io(p))); __v; }) +-#define inl(p) ({ __u32 __v = le32_to_cpu((__force __le32) \ +- __raw_readl(__io(p))); __v; }) ++extern void outb(unsigned char v, u32 p); ++extern void outw(unsigned short v, u32 p); ++extern void outl(unsigned long v, u32 p); + +-#define outsb(p,d,l) __raw_writesb(__io(p),d,l) +-#define outsw(p,d,l) __raw_writesw(__io(p),d,l) +-#define outsl(p,d,l) __raw_writesl(__io(p),d,l) ++extern unsigned char inb(u32 p); ++extern unsigned short inw(u32 p); ++extern unsigned long inl(u32 p); + +-#define insb(p,d,l) __raw_readsb(__io(p),d,l) +-#define insw(p,d,l) __raw_readsw(__io(p),d,l) +-#define insl(p,d,l) __raw_readsl(__io(p),d,l) +-#endif ++extern void outsb(u32 p, unsigned char * from, u32 len); ++extern void outsw(u32 p, unsigned short * from, u32 len); ++extern void outsl(u32 p, unsigned long * from, u32 len); ++ ++extern void insb(u32 p, unsigned char * to, u32 len); ++extern void insw(u32 p, unsigned short * to, u32 len); ++extern void insl(u32 p, unsigned long * to, u32 len); + + #define outb_p(val,port) outb((val),(port)) + #define outw_p(val,port) outw((val),(port)) +diff -Nurd linux-2.6.24/include/asm-arm/uaccess.h linux-2.6.24-oxe810/include/asm-arm/uaccess.h +--- linux-2.6.24/include/asm-arm/uaccess.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/uaccess.h 2008-06-11 17:45:14.000000000 +0200 +@@ -383,9 +383,30 @@ + + + #ifdef CONFIG_MMU ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++extern unsigned long __must_check __copy_from_user_alt(void *to, const void __user *from, unsigned long n); ++static inline unsigned long __must_check __copy_from_user(void *to, const void __user *from, unsigned long n) ++{ ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("__copy_from_user() %lu bytes\n", n); ++ return __copy_from_user_alt(to, from , n); ++} ++extern unsigned long __must_check __copy_to_user_alt(void __user *to, const void *from, unsigned long n); ++static inline unsigned long __must_check __copy_to_user(void __user *to, const void *from, unsigned long n) ++{ ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("__copy_to_user() %lu bytes\n", n); ++ return __copy_to_user_alt(to, from , n); ++} ++extern unsigned long __must_check __clear_user_alt(void __user *addr, unsigned long n); ++static inline unsigned long __must_check __clear_user(void __user *addr, unsigned long n) ++{ ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("__clear_user() %lu bytes\n", n); ++ return __clear_user_alt(addr, n); ++} ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + extern unsigned long __must_check __copy_from_user(void *to, const void __user *from, unsigned long n); + extern unsigned long __must_check __copy_to_user(void __user *to, const void *from, unsigned long n); + extern unsigned long __must_check __clear_user(void __user *addr, unsigned long n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + #else + #define __copy_from_user(to,from,n) (memcpy(to, (void __force *)from, n), 0) + #define __copy_to_user(to,from,n) (memcpy((void __force *)to, from, n), 0) +@@ -397,8 +418,15 @@ + + static inline unsigned long __must_check copy_from_user(void *to, const void __user *from, unsigned long n) + { ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("copy_from_user() %lu bytes\n", n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + if (access_ok(VERIFY_READ, from, n)) ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ n = __copy_from_user_alt(to, from, n); ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + n = __copy_from_user(to, from, n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + else /* security hole - plug it */ + memzero(to, n); + return n; +@@ -406,8 +434,15 @@ + + static inline unsigned long __must_check copy_to_user(void __user *to, const void *from, unsigned long n) + { ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("copy_to_user() %lu bytes\n", n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + if (access_ok(VERIFY_WRITE, to, n)) ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ n = __copy_to_user_alt(to, from, n); ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + n = __copy_to_user(to, from, n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + return n; + } + +@@ -416,8 +451,15 @@ + + static inline unsigned long __must_check clear_user(void __user *to, unsigned long n) + { ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ if (n >= CONFIG_HIPOX_INSTRUMENT_COPIES_THRESHOLD) printk("clear_user() %lu bytes\n", n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + if (access_ok(VERIFY_WRITE, to, n)) ++#ifdef CONFIG_HIPOX_INSTRUMENT_COPIES ++ n = __clear_user_alt(to, n); ++#else // CONFIG_HIPOX_INSTRUMENT_COPIES + n = __clear_user(to, n); ++#endif // CONFIG_HIPOX_INSTRUMENT_COPIES + return n; + } + +diff -Nurd linux-2.6.24/include/asm-arm/unaligned.h linux-2.6.24-oxe810/include/asm-arm/unaligned.h +--- linux-2.6.24/include/asm-arm/unaligned.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/unaligned.h 2008-06-11 17:45:14.000000000 +0200 +@@ -40,16 +40,16 @@ + */ + + #define __get_unaligned_2_le(__p) \ +- (__p[0] | __p[1] << 8) ++ (unsigned int)(__p[0] | __p[1] << 8) + + #define __get_unaligned_2_be(__p) \ +- (__p[0] << 8 | __p[1]) ++ (unsigned int)(__p[0] << 8 | __p[1]) + + #define __get_unaligned_4_le(__p) \ +- (__p[0] | __p[1] << 8 | __p[2] << 16 | __p[3] << 24) ++ (unsigned int)(__p[0] | __p[1] << 8 | __p[2] << 16 | __p[3] << 24) + + #define __get_unaligned_4_be(__p) \ +- (__p[0] << 24 | __p[1] << 16 | __p[2] << 8 | __p[3]) ++ (unsigned int)(__p[0] << 24 | __p[1] << 16 | __p[2] << 8 | __p[3]) + + #define __get_unaligned_8_le(__p) \ + ((unsigned long long)__get_unaligned_4_le((__p+4)) << 32 | \ +diff -Nurd linux-2.6.24/include/asm-arm/unistd.h linux-2.6.24-oxe810/include/asm-arm/unistd.h +--- linux-2.6.24/include/asm-arm/unistd.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-arm/unistd.h 2008-06-11 17:45:14.000000000 +0200 +@@ -379,6 +379,7 @@ + #define __NR_timerfd (__NR_SYSCALL_BASE+350) + #define __NR_eventfd (__NR_SYSCALL_BASE+351) + #define __NR_fallocate (__NR_SYSCALL_BASE+352) ++#define __NR_samba_reserve (__NR_SYSCALL_BASE+353) + + /* + * The following SWIs are ARM private. +diff -Nurd linux-2.6.24/include/asm-powerpc/pmac_feature.h linux-2.6.24-oxe810/include/asm-powerpc/pmac_feature.h +--- linux-2.6.24/include/asm-powerpc/pmac_feature.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-powerpc/pmac_feature.h 2008-06-11 17:44:57.000000000 +0200 +@@ -392,6 +392,14 @@ + #define UN_BIS(r,v) (UN_OUT((r), UN_IN(r) | (v))) + #define UN_BIC(r,v) (UN_OUT((r), UN_IN(r) & ~(v))) + ++/* Uninorth variant: ++ * ++ * 0 = not uninorth ++ * 1 = U1.x or U2.x ++ * 3 = U3 ++ * 4 = U4 ++ */ ++extern int pmac_get_uninorth_variant(void); + + #endif /* __ASM_POWERPC_PMAC_FEATURE_H */ + #endif /* __KERNEL__ */ +diff -Nurd linux-2.6.24/include/asm-x86/apic_32.h linux-2.6.24-oxe810/include/asm-x86/apic_32.h +--- linux-2.6.24/include/asm-x86/apic_32.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-x86/apic_32.h 2008-06-11 17:44:30.000000000 +0200 +@@ -109,7 +109,7 @@ + extern void setup_secondary_APIC_clock (void); + extern int APIC_init_uniprocessor (void); + +-extern void enable_NMI_through_LVT0 (void * dummy); ++extern void enable_NMI_through_LVT0(void); + + #define ARCH_APICTIMER_STOPS_ON_C3 1 + +diff -Nurd linux-2.6.24/include/asm-x86/futex_32.h linux-2.6.24-oxe810/include/asm-x86/futex_32.h +--- linux-2.6.24/include/asm-x86/futex_32.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-x86/futex_32.h 2008-06-11 17:44:30.000000000 +0200 +@@ -28,7 +28,7 @@ + "1: movl %2, %0\n\ + movl %0, %3\n" \ + insn "\n" \ +-"2: " LOCK_PREFIX "cmpxchgl %3, %2\n\ ++"2: lock ; cmpxchgl %3, %2\n\ + jnz 1b\n\ + 3: .section .fixup,\"ax\"\n\ + 4: mov %5, %1\n\ +@@ -68,7 +68,7 @@ + #endif + switch (op) { + case FUTEX_OP_ADD: +- __futex_atomic_op1(LOCK_PREFIX "xaddl %0, %2", ret, ++ __futex_atomic_op1("lock ; xaddl %0, %2", ret, + oldval, uaddr, oparg); + break; + case FUTEX_OP_OR: +@@ -111,7 +111,7 @@ + return -EFAULT; + + __asm__ __volatile__( +- "1: " LOCK_PREFIX "cmpxchgl %3, %1 \n" ++ "1: lock ; cmpxchgl %3, %1 \n" + + "2: .section .fixup, \"ax\" \n" + "3: mov %2, %0 \n" +diff -Nurd linux-2.6.24/include/asm-x86/futex_64.h linux-2.6.24-oxe810/include/asm-x86/futex_64.h +--- linux-2.6.24/include/asm-x86/futex_64.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-x86/futex_64.h 2008-06-11 17:44:30.000000000 +0200 +@@ -27,7 +27,7 @@ + "1: movl %2, %0\n\ + movl %0, %3\n" \ + insn "\n" \ +-"2: " LOCK_PREFIX "cmpxchgl %3, %2\n\ ++"2: lock ; cmpxchgl %3, %2\n\ + jnz 1b\n\ + 3: .section .fixup,\"ax\"\n\ + 4: mov %5, %1\n\ +@@ -62,7 +62,7 @@ + __futex_atomic_op1("xchgl %0, %2", ret, oldval, uaddr, oparg); + break; + case FUTEX_OP_ADD: +- __futex_atomic_op1(LOCK_PREFIX "xaddl %0, %2", ret, oldval, ++ __futex_atomic_op1("lock ; xaddl %0, %2", ret, oldval, + uaddr, oparg); + break; + case FUTEX_OP_OR: +@@ -101,7 +101,7 @@ + return -EFAULT; + + __asm__ __volatile__( +- "1: " LOCK_PREFIX "cmpxchgl %3, %1 \n" ++ "1: lock ; cmpxchgl %3, %1 \n" + + "2: .section .fixup, \"ax\" \n" + "3: mov %2, %0 \n" +diff -Nurd linux-2.6.24/include/asm-x86/io_apic_64.h linux-2.6.24-oxe810/include/asm-x86/io_apic_64.h +--- linux-2.6.24/include/asm-x86/io_apic_64.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-x86/io_apic_64.h 2008-06-11 17:44:30.000000000 +0200 +@@ -129,7 +129,7 @@ + + extern int sis_apic_bug; /* dummy */ + +-void enable_NMI_through_LVT0 (void * dummy); ++void enable_NMI_through_LVT0(void); + + extern spinlock_t i8259A_lock; + +diff -Nurd linux-2.6.24/include/asm-x86/processor_32.h linux-2.6.24-oxe810/include/asm-x86/processor_32.h +--- linux-2.6.24/include/asm-x86/processor_32.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/asm-x86/processor_32.h 2008-06-11 17:44:30.000000000 +0200 +@@ -712,9 +712,10 @@ + #define ASM_NOP6 K7_NOP6 + #define ASM_NOP7 K7_NOP7 + #define ASM_NOP8 K7_NOP8 +-#elif defined(CONFIG_M686) || defined(CONFIG_MPENTIUMII) || \ ++#elif (defined(CONFIG_M686) || defined(CONFIG_MPENTIUMII) || \ + defined(CONFIG_MPENTIUMIII) || defined(CONFIG_MPENTIUMM) || \ +- defined(CONFIG_MCORE2) || defined(CONFIG_PENTIUM4) ++ defined(CONFIG_MCORE2) || defined(CONFIG_PENTIUM4)) && \ ++ !defined(CONFIG_X86_GENERIC) + #define ASM_NOP1 P6_NOP1 + #define ASM_NOP2 P6_NOP2 + #define ASM_NOP3 P6_NOP3 +diff -Nurd linux-2.6.24/include/linux/bio.h linux-2.6.24-oxe810/include/linux/bio.h +--- linux-2.6.24/include/linux/bio.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/bio.h 2008-06-11 17:45:39.000000000 +0200 +@@ -114,6 +114,15 @@ + void *bi_private; + + bio_destructor_t *bi_destructor; /* destructor */ ++ ++ /* ++ * The raid settings for the bio, this should only be used by the oxsemi ++ * sata driver to control raid hardware and the request merging code in ++ * ll_rw_blk.c to prevent merging of requests to hwraid and non-hwraid ++ *partitions. ++ */ ++ u32 bi_raid; ++ + }; + + /* +diff -Nurd linux-2.6.24/include/linux/byteorder/generic.h linux-2.6.24-oxe810/include/linux/byteorder/generic.h +--- linux-2.6.24/include/linux/byteorder/generic.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/byteorder/generic.h 2008-06-11 17:45:26.000000000 +0200 +@@ -146,6 +146,36 @@ + #define htons(x) ___htons(x) + #define ntohs(x) ___ntohs(x) + ++static inline void le16_add_cpu(__le16 *var, u16 val) ++{ ++ *var = cpu_to_le16(le16_to_cpu(*var) + val); ++} ++ ++static inline void le32_add_cpu(__le32 *var, u32 val) ++{ ++ *var = cpu_to_le32(le32_to_cpu(*var) + val); ++} ++ ++static inline void le64_add_cpu(__le64 *var, u64 val) ++{ ++ *var = cpu_to_le64(le64_to_cpu(*var) + val); ++} ++ ++static inline void be16_add_cpu(__be16 *var, u16 val) ++{ ++ *var = cpu_to_be16(be16_to_cpu(*var) + val); ++} ++ ++static inline void be32_add_cpu(__be32 *var, u32 val) ++{ ++ *var = cpu_to_be32(be32_to_cpu(*var) + val); ++} ++ ++static inline void be64_add_cpu(__be64 *var, u64 val) ++{ ++ *var = cpu_to_be64(be64_to_cpu(*var) + val); ++} ++ + #endif /* KERNEL */ + + #endif /* _LINUX_BYTEORDER_GENERIC_H */ +diff -Nurd linux-2.6.24/include/linux/byteorder/swab.h linux-2.6.24-oxe810/include/linux/byteorder/swab.h +--- linux-2.6.24/include/linux/byteorder/swab.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/byteorder/swab.h 2008-06-11 17:45:26.000000000 +0200 +@@ -61,26 +61,37 @@ + * how U/UL/ULL map to __u16, __u32, __u64. At least not in a portable way. + */ + +-static __inline__ __attribute_const__ __u16 ___swab16(__u16 x) +-{ +- return x<<8 | x>>8; +-} +-static __inline__ __attribute_const__ __u32 ___swab32(__u32 x) +-{ +- return x<<24 | x>>24 | +- (x & (__u32)0x0000ff00UL)<<8 | +- (x & (__u32)0x00ff0000UL)>>8; +-} +-static __inline__ __attribute_const__ __u64 ___swab64(__u64 x) +-{ +- return x<<56 | x>>56 | +- (x & (__u64)0x000000000000ff00ULL)<<40 | +- (x & (__u64)0x0000000000ff0000ULL)<<24 | +- (x & (__u64)0x00000000ff000000ULL)<< 8 | +- (x & (__u64)0x000000ff00000000ULL)>> 8 | +- (x & (__u64)0x0000ff0000000000ULL)>>24 | +- (x & (__u64)0x00ff000000000000ULL)>>40; +-} ++#define ___swab16(x) \ ++({ \ ++ __u16 __x = (x); \ ++ ((__u16)( \ ++ (((__u16)(__x) & (__u16)0x00ffU) << 8) | \ ++ (((__u16)(__x) & (__u16)0xff00U) >> 8) )); \ ++}) ++ ++#define ___swab32(x) \ ++({ \ ++ __u32 __x = (x); \ ++ ((__u32)( \ ++ (((__u32)(__x) & (__u32)0x000000ffUL) << 24) | \ ++ (((__u32)(__x) & (__u32)0x0000ff00UL) << 8) | \ ++ (((__u32)(__x) & (__u32)0x00ff0000UL) >> 8) | \ ++ (((__u32)(__x) & (__u32)0xff000000UL) >> 24) )); \ ++}) ++ ++#define ___swab64(x) \ ++({ \ ++ __u64 __x = (x); \ ++ ((__u64)( \ ++ (__u64)(((__u64)(__x) & (__u64)0x00000000000000ffULL) << 56) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x000000000000ff00ULL) << 40) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x0000000000ff0000ULL) << 24) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x00000000ff000000ULL) << 8) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x000000ff00000000ULL) >> 8) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x0000ff0000000000ULL) >> 24) | \ ++ (__u64)(((__u64)(__x) & (__u64)0x00ff000000000000ULL) >> 40) | \ ++ (__u64)(((__u64)(__x) & (__u64)0xff00000000000000ULL) >> 56) )); \ ++}) + + #define ___constant_swab16(x) \ + ((__u16)( \ +@@ -103,6 +114,7 @@ + (__u64)(((__u64)(x) & (__u64)0x00ff000000000000ULL) >> 40) | \ + (__u64)(((__u64)(x) & (__u64)0xff00000000000000ULL) >> 56) )) + ++ + /* + * provide defaults when no architecture-specific optimization is detected + */ +diff -Nurd linux-2.6.24/include/linux/dmi.h linux-2.6.24-oxe810/include/linux/dmi.h +--- linux-2.6.24/include/linux/dmi.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/dmi.h 2008-06-11 17:45:39.000000000 +0200 +@@ -79,7 +79,6 @@ + extern int dmi_get_year(int field); + extern int dmi_name_in_vendors(const char *str); + extern int dmi_available; +-extern char *dmi_get_slot(int slot); + + #else + +@@ -90,7 +89,6 @@ + static inline int dmi_get_year(int year) { return 0; } + static inline int dmi_name_in_vendors(const char *s) { return 0; } + #define dmi_available 0 +-static inline char *dmi_get_slot(int slot) { return NULL; } + + #endif + +diff -Nurd linux-2.6.24/include/linux/fs.h linux-2.6.24-oxe810/include/linux/fs.h +--- linux-2.6.24/include/linux/fs.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/fs.h 2008-06-11 17:45:39.000000000 +0200 +@@ -1147,7 +1147,7 @@ + int error; + } read_descriptor_t; + +-typedef int (*read_actor_t)(read_descriptor_t *, struct page *, unsigned long, unsigned long); ++typedef int (*read_actor_t)(read_descriptor_t *, struct page **, unsigned long, unsigned long); + + /* These macros are for out of kernel modules to test that + * the kernel supports the unlocked_ioctl and compat_ioctl +@@ -1180,7 +1180,9 @@ + int (*aio_fsync) (struct kiocb *, int datasync); + int (*fasync) (int, struct file *, int); + int (*lock) (struct file *, int, struct file_lock *); ++ ssize_t (*sendfile) (struct file *, loff_t *, size_t, read_actor_t, void *); + ssize_t (*sendpage) (struct file *, struct page *, int, size_t, loff_t *, int); ++ ssize_t (*sendpages) (struct file *, struct page **, int, size_t, loff_t *, int); + unsigned long (*get_unmapped_area)(struct file *, unsigned long, unsigned long, unsigned long, unsigned long); + int (*check_flags)(int); + int (*dir_notify)(struct file *filp, unsigned long arg); +@@ -1791,7 +1793,8 @@ + + extern int generic_file_mmap(struct file *, struct vm_area_struct *); + extern int generic_file_readonly_mmap(struct file *, struct vm_area_struct *); +-extern int file_read_actor(read_descriptor_t * desc, struct page *page, unsigned long offset, unsigned long size); ++extern int file_read_actor(read_descriptor_t * desc, struct page **page, unsigned long offset, unsigned long size); ++extern int file_send_actor(read_descriptor_t * desc, struct page **page, unsigned long offset, unsigned long size); + int generic_write_checks(struct file *file, loff_t *pos, size_t *count, int isblk); + extern ssize_t generic_file_aio_read(struct kiocb *, const struct iovec *, unsigned long, loff_t); + extern ssize_t generic_file_aio_write(struct kiocb *, const struct iovec *, unsigned long, loff_t); +@@ -1803,12 +1806,14 @@ + unsigned long, loff_t, loff_t *, size_t, ssize_t); + extern ssize_t do_sync_read(struct file *filp, char __user *buf, size_t len, loff_t *ppos); + extern ssize_t do_sync_write(struct file *filp, const char __user *buf, size_t len, loff_t *ppos); ++extern ssize_t generic_file_sendfile(struct file *, loff_t *, size_t, read_actor_t, void *); + extern void do_generic_mapping_read(struct address_space *mapping, + struct file_ra_state *, struct file *, + loff_t *, read_descriptor_t *, read_actor_t); + extern int generic_segment_checks(const struct iovec *iov, + unsigned long *nr_segs, size_t *count, int access_flags); + ++ + /* fs/splice.c */ + extern ssize_t generic_file_splice_read(struct file *, loff_t *, + struct pipe_inode_info *, size_t, unsigned int); +diff -Nurd linux-2.6.24/include/linux/futex.h linux-2.6.24-oxe810/include/linux/futex.h +--- linux-2.6.24/include/linux/futex.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/futex.h 2008-06-11 17:45:38.000000000 +0200 +@@ -153,6 +153,7 @@ + #ifdef CONFIG_FUTEX + extern void exit_robust_list(struct task_struct *curr); + extern void exit_pi_state_list(struct task_struct *curr); ++extern int futex_cmpxchg_enabled; + #else + static inline void exit_robust_list(struct task_struct *curr) + { +diff -Nurd linux-2.6.24/include/linux/hrtimer.h linux-2.6.24-oxe810/include/linux/hrtimer.h +--- linux-2.6.24/include/linux/hrtimer.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/hrtimer.h 2008-06-11 17:45:39.000000000 +0200 +@@ -300,7 +300,7 @@ + + /* Precise sleep: */ + extern long hrtimer_nanosleep(struct timespec *rqtp, +- struct timespec *rmtp, ++ struct timespec __user *rmtp, + const enum hrtimer_mode mode, + const clockid_t clockid); + extern long hrtimer_nanosleep_restart(struct restart_block *restart_block); +diff -Nurd linux-2.6.24/include/linux/hugetlb.h linux-2.6.24-oxe810/include/linux/hugetlb.h +--- linux-2.6.24/include/linux/hugetlb.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/hugetlb.h 2008-06-11 17:45:39.000000000 +0200 +@@ -17,6 +17,7 @@ + } + + int hugetlb_sysctl_handler(struct ctl_table *, int, struct file *, void __user *, size_t *, loff_t *); ++int hugetlb_overcommit_handler(struct ctl_table *, int, struct file *, void __user *, size_t *, loff_t *); + int hugetlb_treat_movable_handler(struct ctl_table *, int, struct file *, void __user *, size_t *, loff_t *); + int copy_hugetlb_page_range(struct mm_struct *, struct mm_struct *, struct vm_area_struct *); + int follow_hugetlb_page(struct mm_struct *, struct vm_area_struct *, struct page **, struct vm_area_struct **, unsigned long *, int *, int, int); +diff -Nurd linux-2.6.24/include/linux/i2c-id.h linux-2.6.24-oxe810/include/linux/i2c-id.h +--- linux-2.6.24/include/linux/i2c-id.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/i2c-id.h 2008-06-11 17:45:39.000000000 +0200 +@@ -203,6 +203,7 @@ + #define I2C_HW_B_CX2341X 0x010020 /* Conexant CX2341X MPEG encoder cards */ + #define I2C_HW_B_INTELFB 0x010021 /* intel framebuffer driver */ + #define I2C_HW_B_CX23885 0x010022 /* conexant 23885 based tv cards (bus1) */ ++#define I2C_HW_B_HIPOX 0x010023 /* Oxford Semiconductor OX800 */ + + /* --- PCF 8584 based algorithms */ + #define I2C_HW_P_LP 0x020000 /* Parallel port interface */ +diff -Nurd linux-2.6.24/include/linux/irq.h linux-2.6.24-oxe810/include/linux/irq.h +--- linux-2.6.24/include/linux/irq.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/irq.h 2008-06-11 17:45:39.000000000 +0200 +@@ -367,6 +367,9 @@ + __set_irq_handler(irq, handle, 1, NULL); + } + ++extern void set_irq_noprobe(unsigned int irq); ++extern void set_irq_probe(unsigned int irq); ++ + /* Handle dynamic irq creation and destruction */ + extern int create_irq(void); + extern void destroy_irq(unsigned int irq); +diff -Nurd linux-2.6.24/include/linux/ktime.h linux-2.6.24-oxe810/include/linux/ktime.h +--- linux-2.6.24/include/linux/ktime.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/ktime.h 2008-06-11 17:45:39.000000000 +0200 +@@ -310,6 +310,8 @@ + return ktime_sub_ns(kt, usec * 1000); + } + ++extern ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs); ++ + /* + * The resolution of the clocks. The resolution value is returned in + * the clock_getres() system call to give application programmers an +diff -Nurd linux-2.6.24/include/linux/leds.h linux-2.6.24-oxe810/include/linux/leds.h +--- linux-2.6.24/include/linux/leds.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/leds.h 2008-06-11 17:45:38.000000000 +0200 +@@ -123,5 +123,11 @@ + struct gpio_led *leds; + }; + ++/* Trigger specific functions */ ++#ifdef CONFIG_WDC_LEDS_TRIGGER_SATA_DISK ++extern void wdc_ledtrig_sata_activity(void); ++#else ++#define wdc_ledtrig_sata_activity() do {} while(0) ++#endif + + #endif /* __LINUX_LEDS_H_INCLUDED */ +diff -Nurd linux-2.6.24/include/linux/libata.h linux-2.6.24-oxe810/include/linux/libata.h +--- linux-2.6.24/include/linux/libata.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/libata.h 2008-06-11 17:45:39.000000000 +0200 +@@ -238,7 +238,7 @@ + /* various lengths of time */ + ATA_TMOUT_BOOT = 30 * HZ, /* heuristic */ + ATA_TMOUT_BOOT_QUICK = 7 * HZ, /* heuristic */ +- ATA_TMOUT_INTERNAL = 30 * HZ, ++ ATA_TMOUT_INTERNAL = 10 * HZ, + ATA_TMOUT_INTERNAL_QUICK = 5 * HZ, + + /* FIXME: GoVault needs 2s but we can't afford that without +@@ -662,7 +662,7 @@ + }; + + struct ata_port_operations { +- void (*dev_config) (struct ata_device *); ++ void (*dev_config) (struct ata_port *, struct ata_device *); + + void (*set_piomode) (struct ata_port *, struct ata_device *); + void (*set_dmamode) (struct ata_port *, struct ata_device *); +@@ -675,6 +675,7 @@ + u8 (*check_status)(struct ata_port *ap); + u8 (*check_altstatus)(struct ata_port *ap); + void (*dev_select)(struct ata_port *ap, unsigned int device); ++ unsigned int (*dev_chk)(struct ata_port *ap, unsigned int device); + + void (*phy_reset) (struct ata_port *ap); /* obsolete */ + int (*set_mode) (struct ata_link *link, struct ata_device **r_failed_dev); +@@ -689,6 +690,8 @@ + void (*data_xfer) (struct ata_device *, unsigned char *, unsigned int, int); + + int (*qc_defer) (struct ata_queued_cmd *qc); ++ struct ata_queued_cmd* (*qc_new)(struct ata_port *ap); ++ void (*qc_free)(struct ata_queued_cmd *qc); + void (*qc_prep) (struct ata_queued_cmd *qc); + unsigned int (*qc_issue) (struct ata_queued_cmd *qc); + +@@ -724,6 +727,7 @@ + + void (*bmdma_stop) (struct ata_queued_cmd *qc); + u8 (*bmdma_status) (struct ata_port *ap); ++ void (*pio_task)(struct work_struct *work); + }; + + struct ata_port_info { +diff -Nurd linux-2.6.24/include/linux/mii.h linux-2.6.24-oxe810/include/linux/mii.h +--- linux-2.6.24/include/linux/mii.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/mii.h 2008-06-11 17:45:39.000000000 +0200 +@@ -21,18 +21,18 @@ + #define MII_EXPANSION 0x06 /* Expansion register */ + #define MII_CTRL1000 0x09 /* 1000BASE-T control */ + #define MII_STAT1000 0x0a /* 1000BASE-T status */ +-#define MII_ESTATUS 0x0f /* Extended Status */ +-#define MII_DCOUNTER 0x12 /* Disconnect counter */ +-#define MII_FCSCOUNTER 0x13 /* False carrier counter */ +-#define MII_NWAYTEST 0x14 /* N-way auto-neg test reg */ +-#define MII_RERRCOUNTER 0x15 /* Receive error counter */ +-#define MII_SREVISION 0x16 /* Silicon revision */ +-#define MII_RESV1 0x17 /* Reserved... */ +-#define MII_LBRERROR 0x18 /* Lpback, rx, bypass error */ +-#define MII_PHYADDR 0x19 /* PHY address */ +-#define MII_RESV2 0x1a /* Reserved... */ +-#define MII_TPISTATUS 0x1b /* TPI status for 10mbps */ +-#define MII_NCONFIG 0x1c /* Network interface config */ ++#define MII_ESTATUS 0x0f /* Extended Status */ ++//#define MII_DCOUNTER 0x12 /* Disconnect counter */ ++//#define MII_FCSCOUNTER 0x13 /* False carrier counter */ ++//#define MII_NWAYTEST 0x14 /* N-way auto-neg test reg */ ++//#define MII_RERRCOUNTER 0x15 /* Receive error counter */ ++//#define MII_SREVISION 0x16 /* Silicon revision */ ++//#define MII_RESV1 0x17 /* Reserved... */ ++//#define MII_LBRERROR 0x18 /* Lpback, rx, bypass error */ ++//#define MII_PHYADDR 0x19 /* PHY address */ ++//#define MII_RESV2 0x1a /* Reserved... */ ++//#define MII_TPISTATUS 0x1b /* TPI status for 10mbps */ ++//#define MII_NCONFIG 0x1c /* Network interface config */ + + /* Basic mode control register. */ + #define BMCR_RESV 0x003f /* Unused... */ +@@ -121,9 +121,9 @@ + #define ESTATUS_1000_THALF 0x1000 /* Can do 1000BT Half */ + + /* N-way test register. */ +-#define NWAYTEST_RESV1 0x00ff /* Unused... */ +-#define NWAYTEST_LOOPBACK 0x0100 /* Enable loopback for N-way */ +-#define NWAYTEST_RESV2 0xfe00 /* Unused... */ ++//#define NWAYTEST_RESV1 0x00ff /* Unused... */ ++//#define NWAYTEST_LOOPBACK 0x0100 /* Enable loopback for N-way */ ++//#define NWAYTEST_RESV2 0xfe00 /* Unused... */ + + /* 1000BASE-T Control register */ + #define ADVERTISE_1000FULL 0x0200 /* Advertise 1000BASE-T full duplex */ +@@ -157,7 +157,9 @@ + + unsigned int full_duplex : 1; /* is full duplex? */ + unsigned int force_media : 1; /* is autoneg. disabled? */ +- unsigned int supports_gmii : 1; /* are GMII registers supported? */ ++ unsigned int using_1000 : 1; /* the PHY is using 1000Mb rate */ ++ unsigned int using_100 : 1; /* the PHY is using 100Mb rate */ ++ unsigned int using_pause : 1; /* the PHY will generate pause frames */ + + struct net_device *dev; + int (*mdio_read) (struct net_device *dev, int phy_id, int location); +@@ -170,9 +172,16 @@ + extern int mii_ethtool_sset(struct mii_if_info *mii, struct ethtool_cmd *ecmd); + extern int mii_check_gmii_support(struct mii_if_info *mii); + extern void mii_check_link (struct mii_if_info *mii); +-extern unsigned int mii_check_media (struct mii_if_info *mii, +- unsigned int ok_to_print, +- unsigned int init_media); ++extern unsigned int mii_check_media(struct mii_if_info *mii, ++ unsigned int ok_to_print, ++ unsigned int init_media); ++extern unsigned int mii_check_media_ex(struct mii_if_info *mii, ++ unsigned int ok_to_print, ++ unsigned int init_media, ++ int *has_gigabit_changed, ++ int *has_pause_changed, ++ void (*link_state_change_callback)(int link_state, void* arg), ++ void *link_state_change_arg); + extern int generic_mii_ioctl(struct mii_if_info *mii_if, + struct mii_ioctl_data *mii_data, int cmd, + unsigned int *duplex_changed); +@@ -216,6 +225,23 @@ + return ret; + } + ++static inline unsigned int mii_nway_result_1000(unsigned int lpa_1000, unsigned int advertised_1000) ++{ ++ int full_negotiated = (lpa_1000 & LPA_1000FULL) && ++ (advertised_1000 & ADVERTISE_1000FULL); ++ ++ int half_negotiated = (lpa_1000 & LPA_1000HALF) && ++ (advertised_1000 & ADVERTISE_1000HALF); ++ ++ if (full_negotiated) { ++ return LPA_1000FULL; ++ } else if (half_negotiated) { ++ return LPA_1000HALF; ++ } else { ++ return 0; ++ } ++} ++ + /** + * mii_duplex + * @duplex_lock: Non-zero if duplex is locked at full +diff -Nurd linux-2.6.24/include/linux/moduleparam.h linux-2.6.24-oxe810/include/linux/moduleparam.h +--- linux-2.6.24/include/linux/moduleparam.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/moduleparam.h 2008-06-11 17:45:39.000000000 +0200 +@@ -62,6 +62,16 @@ + void *elem; + }; + ++/* On alpha, ia64 and ppc64 relocations to global data cannot go into ++ read-only sections (which is part of respective UNIX ABI on these ++ platforms). So 'const' makes no sense and even causes compile failures ++ with some compilers. */ ++#if defined(CONFIG_ALPHA) || defined(CONFIG_IA64) || defined(CONFIG_PPC64) ++#define __moduleparam_const ++#else ++#define __moduleparam_const const ++#endif ++ + /* This is the fundamental function for registering boot/module + parameters. perm sets the visibility in sysfs: 000 means it's + not there, read bits mean it's readable, write bits mean it's +@@ -71,7 +81,7 @@ + static int __param_perm_check_##name __attribute__((unused)) = \ + BUILD_BUG_ON_ZERO((perm) < 0 || (perm) > 0777 || ((perm) & 2)); \ + static const char __param_str_##name[] = prefix #name; \ +- static struct kernel_param const __param_##name \ ++ static struct kernel_param __moduleparam_const __param_##name \ + __attribute_used__ \ + __attribute__ ((unused,__section__ ("__param"),aligned(sizeof(void *)))) \ + = { __param_str_##name, perm, set, get, { arg } } +diff -Nurd linux-2.6.24/include/linux/net.h linux-2.6.24-oxe810/include/linux/net.h +--- linux-2.6.24/include/linux/net.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/net.h 2008-06-11 17:45:39.000000000 +0200 +@@ -172,6 +172,8 @@ + struct vm_area_struct * vma); + ssize_t (*sendpage) (struct socket *sock, struct page *page, + int offset, size_t size, int flags); ++ ssize_t (*sendpages) (struct socket *sock, struct page **page, ++ int offset, size_t size, int flags); + }; + + struct net_proto_family { +diff -Nurd linux-2.6.24/include/linux/raid/raid1.h linux-2.6.24-oxe810/include/linux/raid/raid1.h +--- linux-2.6.24/include/linux/raid/raid1.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/raid/raid1.h 2008-06-11 17:45:26.000000000 +0200 +@@ -61,6 +61,10 @@ + + mempool_t *r1bio_pool; + mempool_t *r1buf_pool; ++ ++ /** This contains flags that can be included with the BIOs generated by ++ writes to set the correct hardware RAID modes */ ++ u32 hw_raid1_settings; + }; + + typedef struct r1_private_data_s conf_t; +diff -Nurd linux-2.6.24/include/linux/serial_reg.h linux-2.6.24-oxe810/include/linux/serial_reg.h +--- linux-2.6.24/include/linux/serial_reg.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/serial_reg.h 2008-06-11 17:45:39.000000000 +0200 +@@ -133,6 +133,15 @@ + + #define UART_SCR 7 /* I/O: Scratch Register */ + ++/* Oxsemi NAS UART extra registers */ ++#define UART_DLF 0x09 /* Oxsemi 16550 fractional divider */ ++#define UART_RX_FILL 0x0a ++#define UART_TX_SPACE 0x0b ++#define UART_WIDE_ACCESS 0x0c ++#define UART_XON_CHAR 0x10 ++#define UART_XOFF_CHAR 0x11 ++#define UART_DMA 0x12 ++ + /* + * DLAB=1 + */ +diff -Nurd linux-2.6.24/include/linux/syscalls.h linux-2.6.24-oxe810/include/linux/syscalls.h +--- linux-2.6.24/include/linux/syscalls.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/syscalls.h 2008-06-11 17:45:39.000000000 +0200 +@@ -611,6 +611,7 @@ + const struct itimerspec __user *utmr); + asmlinkage long sys_eventfd(unsigned int count); + asmlinkage long sys_fallocate(int fd, int mode, loff_t offset, loff_t len); ++asmlinkage long sys_samba_reserve(int fd, void __user *info); + + int kernel_execve(const char *filename, char *const argv[], char *const envp[]); + +diff -Nurd linux-2.6.24/include/linux/trustees.h linux-2.6.24-oxe810/include/linux/trustees.h +--- linux-2.6.24/include/linux/trustees.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/trustees.h 2008-06-11 17:45:39.000000000 +0200 +@@ -0,0 +1,108 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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. ++ * ++ * Structs, defines and function definitions intended for export ++ * ++ */ ++ ++#ifndef _LINUX_TRUSTEE_STRUCT_H ++ ++#define _LINUX_TRUSTEE_STRUCT_H ++#include <linux/types.h> ++ ++#define TRUSTEES_APIVERSION 2 ++#define TRUSTEES_APIVERSION_STR "2" ++ ++#define TRUSTEE_EXECUTE_BIT 0 ++#define TRUSTEE_READ_BIT 1 ++#define TRUSTEE_WRITE_BIT 2 ++#define TRUSTEE_BROWSE_BIT 3 ++#define TRUSTEE_READ_DIR_BIT 4 ++#define TRUSTEE_USE_UNIX_BIT 5 ++#define TRUSTEE_NUM_ACL_BITS (TRUSTEE_USE_UNIX_BIT+1) ++#define TRUSTEE_EXECUTE_MASK (1 << TRUSTEE_EXECUTE_BIT) ++#define TRUSTEE_READ_MASK (1 << TRUSTEE_READ_BIT) ++#define TRUSTEE_WRITE_MASK (1 << TRUSTEE_WRITE_BIT) ++#define TRUSTEE_BROWSE_MASK (1 << TRUSTEE_BROWSE_BIT) ++#define TRUSTEE_READ_DIR_MASK (1 << TRUSTEE_READ_DIR_BIT) ++#define TRUSTEE_USE_UNIX_MASK (1 << TRUSTEE_USE_UNIX_BIT) ++#define TRUSTEE_ACL_MASK ((1 << TRUSTEE_NUM_ACL_BITS)-1) ++ ++#define TRUSTEE_ALLOW_DENY_BIT 7 ++#define TRUSTEE_IS_GROUP_BIT 6 ++#define TRUSTEE_CLEAR_SET_BIT 8 ++#define TRUSTEE_ONE_LEVEL_BIT 9 ++#define TRUSTEE_NOT_BIT 10 ++#define TRUSTEE_ALL_BIT 11 ++#define TRUSTEE_ALLOW_DENY_MASK (1 << TRUSTEE_ALLOW_DENY_BIT) /* set if deny */ ++#define TRUSTEE_IS_GROUP_MASK (1 << TRUSTEE_IS_GROUP_BIT) ++#define TRUSTEE_CLEAR_SET_MASK (1 << TRUSTEE_CLEAR_SET_BIT) /* set if clear */ ++#define TRUSTEE_ONE_LEVEL_MASK (1 << TRUSTEE_ONE_LEVEL_BIT) ++#define TRUSTEE_NOT_MASK (1 << TRUSTEE_NOT_BIT) ++#define TRUSTEE_ALL_MASK (1 << TRUSTEE_ALL_BIT) ++ ++#define trustee_acl __u16 ++#define trustee_default_acl TRUSTEE_USE_UNIX_MASK ++ ++struct trustee_permission { ++ trustee_acl mask; ++ union { ++ __kernel_uid32_t uid; ++ __kernel_gid32_t gid; ++ } u; ++}; ++ ++#ifndef __KERNEL__ ++#ifndef __user ++#define __user ++#endif ++#endif ++ ++struct trustee_command { ++ unsigned command; ++ unsigned numargs; ++}; ++ ++/* Most arguments that any command will take */ ++ ++#define TRUSTEE_MAX_ARGS 6 ++ ++/* Starts a table ++ * No arguments ++ */ ++#define TRUSTEE_COMMAND_TABLE_START 1 ++ ++/* Ends a table successfully. ++ * No arguments ++ */ ++#define TRUSTEE_COMMAND_TABLE_STOP 2 ++ ++/* Adds a trustee ++ * Arguments: ++ * filename (char []) ++ * struct trustee_permission ++ * device-name (char []) ++ * device number (u32) ++ */ ++#define TRUSTEE_COMMAND_ADD 3 ++ ++/* Removes all trustees ++ * No arguments ++ */ ++#define TRUSTEE_COMMAND_REMOVE_ALL 2 ++ ++/* Makes a filesystem ignorecase ++ * Arguments: ++ * device-name (char []) ++ * device number (u32) ++ */ ++#define TRUSTEE_COMMAND_MAKE_IC 5 ++ ++#endif /* _LINUX_TRUSTEE_STRUCT_H */ +diff -Nurd linux-2.6.24/include/linux/wait.h linux-2.6.24-oxe810/include/linux/wait.h +--- linux-2.6.24/include/linux/wait.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/linux/wait.h 2008-06-11 17:45:39.000000000 +0200 +@@ -161,6 +161,22 @@ + #define wake_up_locked(x) __wake_up_locked((x), TASK_UNINTERRUPTIBLE | TASK_INTERRUPTIBLE) + #define wake_up_interruptible_sync(x) __wake_up_sync((x),TASK_INTERRUPTIBLE, 1) + ++#ifdef CONFIG_DEBUG_LOCK_ALLOC ++/* ++ * macro to avoid include hell ++ */ ++#define wake_up_nested(x, s) \ ++do { \ ++ unsigned long flags; \ ++ \ ++ spin_lock_irqsave_nested(&(x)->lock, flags, (s)); \ ++ wake_up_locked(x); \ ++ spin_unlock_irqrestore(&(x)->lock, flags); \ ++} while (0) ++#else ++#define wake_up_nested(x, s) wake_up(x) ++#endif ++ + #define __wait_event(wq, condition) \ + do { \ + DEFINE_WAIT(__wait); \ +diff -Nurd linux-2.6.24/include/net/inet_sock.h linux-2.6.24-oxe810/include/net/inet_sock.h +--- linux-2.6.24/include/net/inet_sock.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/net/inet_sock.h 2008-06-11 17:44:45.000000000 +0200 +@@ -175,7 +175,8 @@ + static inline unsigned int inet_ehashfn(const __be32 laddr, const __u16 lport, + const __be32 faddr, const __be16 fport) + { +- return jhash_2words((__force __u32) laddr ^ (__force __u32) faddr, ++ return jhash_3words((__force __u32) laddr, ++ (__force __u32) faddr, + ((__u32) lport) << 16 | (__force __u32)fport, + inet_ehash_secret); + } +diff -Nurd linux-2.6.24/include/net/sock.h linux-2.6.24-oxe810/include/net/sock.h +--- linux-2.6.24/include/net/sock.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/net/sock.h 2008-06-11 17:44:45.000000000 +0200 +@@ -549,6 +549,8 @@ + int *addr_len); + int (*sendpage)(struct sock *sk, struct page *page, + int offset, size_t size, int flags); ++ int (*sendpages)(struct sock *sk, struct page **page, ++ int offset, size_t size, int flags); + int (*bind)(struct sock *sk, + struct sockaddr *uaddr, int addr_len); + +diff -Nurd linux-2.6.24/include/net/tcp.h linux-2.6.24-oxe810/include/net/tcp.h +--- linux-2.6.24/include/net/tcp.h 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/include/net/tcp.h 2008-06-11 17:44:45.000000000 +0200 +@@ -285,6 +285,7 @@ + extern int tcp_sendmsg(struct kiocb *iocb, struct socket *sock, + struct msghdr *msg, size_t size); + extern ssize_t tcp_sendpage(struct socket *sock, struct page *page, int offset, size_t size, int flags); ++extern ssize_t tcp_sendpages(struct socket *sock, struct page **page, int offset, size_t size, int flags); + + extern int tcp_ioctl(struct sock *sk, + int cmd, +diff -Nurd linux-2.6.24/kernel/audit.c linux-2.6.24-oxe810/kernel/audit.c +--- linux-2.6.24/kernel/audit.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/audit.c 2008-06-11 17:43:47.000000000 +0200 +@@ -1200,13 +1200,17 @@ + static inline int audit_expand(struct audit_buffer *ab, int extra) + { + struct sk_buff *skb = ab->skb; +- int ret = pskb_expand_head(skb, skb_headroom(skb), extra, +- ab->gfp_mask); ++ int oldtail = skb_tailroom(skb); ++ int ret = pskb_expand_head(skb, 0, extra, ab->gfp_mask); ++ int newtail = skb_tailroom(skb); ++ + if (ret < 0) { + audit_log_lost("out of memory in audit_expand"); + return 0; + } +- return skb_tailroom(skb); ++ ++ skb->truesize += newtail - oldtail; ++ return newtail; + } + + /* +diff -Nurd linux-2.6.24/kernel/compat.c linux-2.6.24-oxe810/kernel/compat.c +--- linux-2.6.24/kernel/compat.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/compat.c 2008-06-11 17:43:47.000000000 +0200 +@@ -40,10 +40,36 @@ + __put_user(ts->tv_nsec, &cts->tv_nsec)) ? -EFAULT : 0; + } + ++static long compat_nanosleep_restart(struct restart_block *restart) ++{ ++ struct compat_timespec __user *rmtp; ++ struct timespec rmt; ++ mm_segment_t oldfs; ++ long ret; ++ ++ rmtp = (struct compat_timespec __user *)(restart->arg1); ++ restart->arg1 = (unsigned long)&rmt; ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++ ret = hrtimer_nanosleep_restart(restart); ++ set_fs(oldfs); ++ ++ if (ret) { ++ restart->fn = compat_nanosleep_restart; ++ restart->arg1 = (unsigned long)rmtp; ++ ++ if (rmtp && put_compat_timespec(&rmt, rmtp)) ++ return -EFAULT; ++ } ++ ++ return ret; ++} ++ + asmlinkage long compat_sys_nanosleep(struct compat_timespec __user *rqtp, + struct compat_timespec __user *rmtp) + { + struct timespec tu, rmt; ++ mm_segment_t oldfs; + long ret; + + if (get_compat_timespec(&tu, rqtp)) +@@ -52,11 +78,21 @@ + if (!timespec_valid(&tu)) + return -EINVAL; + +- ret = hrtimer_nanosleep(&tu, rmtp ? &rmt : NULL, HRTIMER_MODE_REL, +- CLOCK_MONOTONIC); ++ oldfs = get_fs(); ++ set_fs(KERNEL_DS); ++ ret = hrtimer_nanosleep(&tu, ++ rmtp ? (struct timespec __user *)&rmt : NULL, ++ HRTIMER_MODE_REL, CLOCK_MONOTONIC); ++ set_fs(oldfs); + +- if (ret && rmtp) { +- if (put_compat_timespec(&rmt, rmtp)) ++ if (ret) { ++ struct restart_block *restart ++ = ¤t_thread_info()->restart_block; ++ ++ restart->fn = compat_nanosleep_restart; ++ restart->arg1 = (unsigned long)rmtp; ++ ++ if (rmtp && put_compat_timespec(&rmt, rmtp)) + return -EFAULT; + } + +diff -Nurd linux-2.6.24/kernel/futex.c linux-2.6.24-oxe810/kernel/futex.c +--- linux-2.6.24/kernel/futex.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/futex.c 2008-06-11 17:43:47.000000000 +0200 +@@ -60,6 +60,8 @@ + + #include "rtmutex_common.h" + ++int __read_mostly futex_cmpxchg_enabled; ++ + #define FUTEX_HASHBITS (CONFIG_BASE_SMALL ? 4 : 8) + + /* +@@ -466,6 +468,8 @@ + struct futex_hash_bucket *hb; + union futex_key key; + ++ if (!futex_cmpxchg_enabled) ++ return; + /* + * We are a ZOMBIE and nobody can enqueue itself on + * pi_state_list anymore, but we have to be careful +@@ -1854,6 +1858,8 @@ + sys_set_robust_list(struct robust_list_head __user *head, + size_t len) + { ++ if (!futex_cmpxchg_enabled) ++ return -ENOSYS; + /* + * The kernel knows only one size for now: + */ +@@ -1878,6 +1884,9 @@ + struct robust_list_head __user *head; + unsigned long ret; + ++ if (!futex_cmpxchg_enabled) ++ return -ENOSYS; ++ + if (!pid) + head = current->robust_list; + else { +@@ -1980,6 +1989,9 @@ + unsigned long futex_offset; + int rc; + ++ if (!futex_cmpxchg_enabled) ++ return; ++ + /* + * Fetch the list head (which was registered earlier, via + * sys_set_robust_list()): +@@ -2034,7 +2046,7 @@ + long do_futex(u32 __user *uaddr, int op, u32 val, ktime_t *timeout, + u32 __user *uaddr2, u32 val2, u32 val3) + { +- int ret; ++ int ret = -ENOSYS; + int cmd = op & FUTEX_CMD_MASK; + struct rw_semaphore *fshared = NULL; + +@@ -2062,13 +2074,16 @@ + ret = futex_wake_op(uaddr, fshared, uaddr2, val, val2, val3); + break; + case FUTEX_LOCK_PI: +- ret = futex_lock_pi(uaddr, fshared, val, timeout, 0); ++ if (futex_cmpxchg_enabled) ++ ret = futex_lock_pi(uaddr, fshared, val, timeout, 0); + break; + case FUTEX_UNLOCK_PI: +- ret = futex_unlock_pi(uaddr, fshared); ++ if (futex_cmpxchg_enabled) ++ ret = futex_unlock_pi(uaddr, fshared); + break; + case FUTEX_TRYLOCK_PI: +- ret = futex_lock_pi(uaddr, fshared, 0, timeout, 1); ++ if (futex_cmpxchg_enabled) ++ ret = futex_lock_pi(uaddr, fshared, 0, timeout, 1); + break; + default: + ret = -ENOSYS; +@@ -2094,7 +2109,7 @@ + + t = timespec_to_ktime(ts); + if (cmd == FUTEX_WAIT) +- t = ktime_add(ktime_get(), t); ++ t = ktime_add_safe(ktime_get(), t); + tp = &t; + } + /* +@@ -2123,8 +2138,29 @@ + + static int __init init(void) + { +- int i = register_filesystem(&futex_fs_type); ++ u32 curval; ++ int i; ++ ++ /* ++ * This will fail and we want it. Some arch implementations do ++ * runtime detection of the futex_atomic_cmpxchg_inatomic() ++ * functionality. We want to know that before we call in any ++ * of the complex code paths. Also we want to prevent ++ * registration of robust lists in that case. NULL is ++ * guaranteed to fault and we get -EFAULT on functional ++ * implementation, the non functional ones will return ++ * -ENOSYS. ++ */ ++ curval = cmpxchg_futex_value_locked(NULL, 0, 0); ++ if (curval == -EFAULT) ++ futex_cmpxchg_enabled = 1; + ++ for (i = 0; i < ARRAY_SIZE(futex_queues); i++) { ++ plist_head_init(&futex_queues[i].chain, &futex_queues[i].lock); ++ spin_lock_init(&futex_queues[i].lock); ++ } ++ ++ i = register_filesystem(&futex_fs_type); + if (i) + return i; + +@@ -2134,10 +2170,6 @@ + return PTR_ERR(futex_mnt); + } + +- for (i = 0; i < ARRAY_SIZE(futex_queues); i++) { +- plist_head_init(&futex_queues[i].chain, &futex_queues[i].lock); +- spin_lock_init(&futex_queues[i].lock); +- } + return 0; + } + __initcall(init); +diff -Nurd linux-2.6.24/kernel/futex_compat.c linux-2.6.24-oxe810/kernel/futex_compat.c +--- linux-2.6.24/kernel/futex_compat.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/futex_compat.c 2008-06-11 17:43:47.000000000 +0200 +@@ -54,6 +54,9 @@ + compat_long_t futex_offset; + int rc; + ++ if (!futex_cmpxchg_enabled) ++ return; ++ + /* + * Fetch the list head (which was registered earlier, via + * sys_set_robust_list()): +@@ -115,6 +118,9 @@ + compat_sys_set_robust_list(struct compat_robust_list_head __user *head, + compat_size_t len) + { ++ if (!futex_cmpxchg_enabled) ++ return -ENOSYS; ++ + if (unlikely(len != sizeof(*head))) + return -EINVAL; + +@@ -130,6 +136,9 @@ + struct compat_robust_list_head __user *head; + unsigned long ret; + ++ if (!futex_cmpxchg_enabled) ++ return -ENOSYS; ++ + if (!pid) + head = current->compat_robust_list; + else { +@@ -175,7 +184,7 @@ + + t = timespec_to_ktime(ts); + if (cmd == FUTEX_WAIT) +- t = ktime_add(ktime_get(), t); ++ t = ktime_add_safe(ktime_get(), t); + tp = &t; + } + if (cmd == FUTEX_REQUEUE || cmd == FUTEX_CMP_REQUEUE) +diff -Nurd linux-2.6.24/kernel/hrtimer.c linux-2.6.24-oxe810/kernel/hrtimer.c +--- linux-2.6.24/kernel/hrtimer.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/hrtimer.c 2008-06-11 17:43:47.000000000 +0200 +@@ -325,6 +325,24 @@ + } + #endif /* BITS_PER_LONG >= 64 */ + ++/* ++ * Add two ktime values and do a safety check for overflow: ++ */ ++ ++ktime_t ktime_add_safe(const ktime_t lhs, const ktime_t rhs) ++{ ++ ktime_t res = ktime_add(lhs, rhs); ++ ++ /* ++ * We use KTIME_SEC_MAX here, the maximum timeout which we can ++ * return to user space in a timespec: ++ */ ++ if (res.tv64 < 0 || res.tv64 < lhs.tv64 || res.tv64 < rhs.tv64) ++ res = ktime_set(KTIME_SEC_MAX, 0); ++ ++ return res; ++} ++ + /* High resolution timer related functions */ + #ifdef CONFIG_HIGH_RES_TIMERS + +@@ -409,6 +427,8 @@ + ktime_t expires = ktime_sub(timer->expires, base->offset); + int res; + ++ WARN_ON_ONCE(timer->expires.tv64 < 0); ++ + /* + * When the callback is running, we do not reprogram the clock event + * device. The timer callback is either running on a different CPU or +@@ -419,6 +439,15 @@ + if (hrtimer_callback_running(timer)) + return 0; + ++ /* ++ * CLOCK_REALTIME timer might be requested with an absolute ++ * expiry time which is less than base->offset. Nothing wrong ++ * about that, just avoid to call into the tick code, which ++ * has now objections against negative expiry values. ++ */ ++ if (expires.tv64 < 0) ++ return -ETIME; ++ + if (expires.tv64 >= expires_next->tv64) + return 0; + +@@ -682,13 +711,7 @@ + */ + orun++; + } +- timer->expires = ktime_add(timer->expires, interval); +- /* +- * Make sure, that the result did not wrap with a very large +- * interval. +- */ +- if (timer->expires.tv64 < 0) +- timer->expires = ktime_set(KTIME_SEC_MAX, 0); ++ timer->expires = ktime_add_safe(timer->expires, interval); + + return orun; + } +@@ -839,7 +862,7 @@ + new_base = switch_hrtimer_base(timer, base); + + if (mode == HRTIMER_MODE_REL) { +- tim = ktime_add(tim, new_base->get_time()); ++ tim = ktime_add_safe(tim, new_base->get_time()); + /* + * CONFIG_TIME_LOW_RES is a temporary way for architectures + * to signal that they simply return xtime in +@@ -848,16 +871,8 @@ + * timeouts. This will go away with the GTOD framework. + */ + #ifdef CONFIG_TIME_LOW_RES +- tim = ktime_add(tim, base->resolution); ++ tim = ktime_add_safe(tim, base->resolution); + #endif +- /* +- * Careful here: User space might have asked for a +- * very long sleep, so the add above might result in a +- * negative number, which enqueues the timer in front +- * of the queue. +- */ +- if (tim.tv64 < 0) +- tim.tv64 = KTIME_MAX; + } + timer->expires = tim; + +@@ -1291,11 +1306,26 @@ + return t->task == NULL; + } + ++static int update_rmtp(struct hrtimer *timer, struct timespec __user *rmtp) ++{ ++ struct timespec rmt; ++ ktime_t rem; ++ ++ rem = ktime_sub(timer->expires, timer->base->get_time()); ++ if (rem.tv64 <= 0) ++ return 0; ++ rmt = ktime_to_timespec(rem); ++ ++ if (copy_to_user(rmtp, &rmt, sizeof(*rmtp))) ++ return -EFAULT; ++ ++ return 1; ++} ++ + long __sched hrtimer_nanosleep_restart(struct restart_block *restart) + { + struct hrtimer_sleeper t; +- struct timespec *rmtp; +- ktime_t time; ++ struct timespec __user *rmtp; + + restart->fn = do_no_restart_syscall; + +@@ -1305,12 +1335,11 @@ + if (do_nanosleep(&t, HRTIMER_MODE_ABS)) + return 0; + +- rmtp = (struct timespec *)restart->arg1; ++ rmtp = (struct timespec __user *)restart->arg1; + if (rmtp) { +- time = ktime_sub(t.timer.expires, t.timer.base->get_time()); +- if (time.tv64 <= 0) +- return 0; +- *rmtp = ktime_to_timespec(time); ++ int ret = update_rmtp(&t.timer, rmtp); ++ if (ret <= 0) ++ return ret; + } + + restart->fn = hrtimer_nanosleep_restart; +@@ -1319,12 +1348,11 @@ + return -ERESTART_RESTARTBLOCK; + } + +-long hrtimer_nanosleep(struct timespec *rqtp, struct timespec *rmtp, ++long hrtimer_nanosleep(struct timespec *rqtp, struct timespec __user *rmtp, + const enum hrtimer_mode mode, const clockid_t clockid) + { + struct restart_block *restart; + struct hrtimer_sleeper t; +- ktime_t rem; + + hrtimer_init(&t.timer, clockid, mode); + t.timer.expires = timespec_to_ktime(*rqtp); +@@ -1336,10 +1364,9 @@ + return -ERESTARTNOHAND; + + if (rmtp) { +- rem = ktime_sub(t.timer.expires, t.timer.base->get_time()); +- if (rem.tv64 <= 0) +- return 0; +- *rmtp = ktime_to_timespec(rem); ++ int ret = update_rmtp(&t.timer, rmtp); ++ if (ret <= 0) ++ return ret; + } + + restart = ¤t_thread_info()->restart_block; +@@ -1355,8 +1382,7 @@ + asmlinkage long + sys_nanosleep(struct timespec __user *rqtp, struct timespec __user *rmtp) + { +- struct timespec tu, rmt; +- int ret; ++ struct timespec tu; + + if (copy_from_user(&tu, rqtp, sizeof(tu))) + return -EFAULT; +@@ -1364,15 +1390,7 @@ + if (!timespec_valid(&tu)) + return -EINVAL; + +- ret = hrtimer_nanosleep(&tu, rmtp ? &rmt : NULL, HRTIMER_MODE_REL, +- CLOCK_MONOTONIC); +- +- if (ret && rmtp) { +- if (copy_to_user(rmtp, &rmt, sizeof(*rmtp))) +- return -EFAULT; +- } +- +- return ret; ++ return hrtimer_nanosleep(&tu, rmtp, HRTIMER_MODE_REL, CLOCK_MONOTONIC); + } + + /* +diff -Nurd linux-2.6.24/kernel/irq/chip.c linux-2.6.24-oxe810/kernel/irq/chip.c +--- linux-2.6.24/kernel/irq/chip.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/irq/chip.c 2008-06-11 17:43:44.000000000 +0200 +@@ -246,6 +246,17 @@ + } + + /* ++ * default shutdown function ++ */ ++static void default_shutdown(unsigned int irq) ++{ ++ struct irq_desc *desc = irq_desc + irq; ++ ++ desc->chip->mask(irq); ++ desc->status |= IRQ_MASKED; ++} ++ ++/* + * Fixup enable/disable function pointers + */ + void irq_chip_set_defaults(struct irq_chip *chip) +@@ -256,8 +267,15 @@ + chip->disable = default_disable; + if (!chip->startup) + chip->startup = default_startup; ++ /* ++ * We use chip->disable, when the user provided its own. When ++ * we have default_disable set for chip->disable, then we need ++ * to use default_shutdown, otherwise the irq line is not ++ * disabled on free_irq(): ++ */ + if (!chip->shutdown) +- chip->shutdown = chip->disable; ++ chip->shutdown = chip->disable != default_disable ? ++ chip->disable : default_shutdown; + if (!chip->name) + chip->name = chip->typename; + if (!chip->end) +@@ -589,3 +607,39 @@ + set_irq_chip(irq, chip); + __set_irq_handler(irq, handle, 0, name); + } ++ ++void __init set_irq_noprobe(unsigned int irq) ++{ ++ struct irq_desc *desc; ++ unsigned long flags; ++ ++ if (irq >= NR_IRQS) { ++ printk(KERN_ERR "Trying to mark IRQ%d non-probeable\n", irq); ++ ++ return; ++ } ++ ++ desc = irq_desc + irq; ++ ++ spin_lock_irqsave(&desc->lock, flags); ++ desc->status |= IRQ_NOPROBE; ++ spin_unlock_irqrestore(&desc->lock, flags); ++} ++ ++void __init set_irq_probe(unsigned int irq) ++{ ++ struct irq_desc *desc; ++ unsigned long flags; ++ ++ if (irq >= NR_IRQS) { ++ printk(KERN_ERR "Trying to mark IRQ%d probeable\n", irq); ++ ++ return; ++ } ++ ++ desc = irq_desc + irq; ++ ++ spin_lock_irqsave(&desc->lock, flags); ++ desc->status &= ~IRQ_NOPROBE; ++ spin_unlock_irqrestore(&desc->lock, flags); ++} +diff -Nurd linux-2.6.24/kernel/posix-timers.c linux-2.6.24-oxe810/kernel/posix-timers.c +--- linux-2.6.24/kernel/posix-timers.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/posix-timers.c 2008-06-11 17:43:47.000000000 +0200 +@@ -766,9 +766,11 @@ + /* SIGEV_NONE timers are not queued ! See common_timer_get */ + if (((timr->it_sigev_notify & ~SIGEV_THREAD_ID) == SIGEV_NONE)) { + /* Setup correct expiry time for relative timers */ +- if (mode == HRTIMER_MODE_REL) +- timer->expires = ktime_add(timer->expires, +- timer->base->get_time()); ++ if (mode == HRTIMER_MODE_REL) { ++ timer->expires = ++ ktime_add_safe(timer->expires, ++ timer->base->get_time()); ++ } + return 0; + } + +@@ -981,20 +983,9 @@ + static int common_nsleep(const clockid_t which_clock, int flags, + struct timespec *tsave, struct timespec __user *rmtp) + { +- struct timespec rmt; +- int ret; +- +- ret = hrtimer_nanosleep(tsave, rmtp ? &rmt : NULL, +- flags & TIMER_ABSTIME ? +- HRTIMER_MODE_ABS : HRTIMER_MODE_REL, +- which_clock); +- +- if (ret && rmtp) { +- if (copy_to_user(rmtp, &rmt, sizeof(*rmtp))) +- return -EFAULT; +- } +- +- return ret; ++ return hrtimer_nanosleep(tsave, rmtp, flags & TIMER_ABSTIME ? ++ HRTIMER_MODE_ABS : HRTIMER_MODE_REL, ++ which_clock); + } + + asmlinkage long +diff -Nurd linux-2.6.24/kernel/printk.c linux-2.6.24-oxe810/kernel/printk.c +--- linux-2.6.24/kernel/printk.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/printk.c 2008-06-11 17:43:47.000000000 +0200 +@@ -625,6 +625,11 @@ + return r; + } + ++#if defined(CONFIG_DEBUG_LL) && defined(CONFIG_HIPOX_EARLY_PRINTK) ++/* Declare the printascii function that is specific to ARM platforms */ ++extern void printascii(const char *); ++#endif ++ + /* cpu currently holding logbuf_lock */ + static volatile unsigned int printk_cpu = UINT_MAX; + +@@ -653,6 +658,11 @@ + /* Emit the output into the temporary buffer */ + printed_len = vscnprintf(printk_buf, sizeof(printk_buf), fmt, args); + ++#if defined(CONFIG_DEBUG_LL) && defined(CONFIG_HIPOX_EARLY_PRINTK) ++ /* Send output down the early UART */ ++ printascii(printk_buf); ++#endif ++ + /* + * Copy the output into log_buf. If the caller didn't provide + * appropriate log level tags, we insert them here +diff -Nurd linux-2.6.24/kernel/relay.c linux-2.6.24-oxe810/kernel/relay.c +--- linux-2.6.24/kernel/relay.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/relay.c 2008-06-11 17:43:47.000000000 +0200 +@@ -92,6 +92,7 @@ + return -EINVAL; + + vma->vm_ops = &relay_file_mmap_ops; ++ vma->vm_flags |= VM_DONTEXPAND; + vma->vm_private_data = buf; + buf->chan->cb->buf_mapped(buf, filp); + +@@ -1071,7 +1072,7 @@ + unsigned int flags, + int *nonpad_ret) + { +- unsigned int pidx, poff, total_len, subbuf_pages, ret; ++ unsigned int pidx, poff, total_len, subbuf_pages, nr_pages, ret; + struct rchan_buf *rbuf = in->private_data; + unsigned int subbuf_size = rbuf->chan->subbuf_size; + uint64_t pos = (uint64_t) *ppos; +@@ -1102,8 +1103,9 @@ + subbuf_pages = rbuf->chan->alloc_size >> PAGE_SHIFT; + pidx = (read_start / PAGE_SIZE) % subbuf_pages; + poff = read_start & ~PAGE_MASK; ++ nr_pages = min_t(unsigned int, subbuf_pages, PIPE_BUFFERS); + +- for (total_len = 0; spd.nr_pages < subbuf_pages; spd.nr_pages++) { ++ for (total_len = 0; spd.nr_pages < nr_pages; spd.nr_pages++) { + unsigned int this_len, this_end, private; + unsigned int cur_pos = read_start + total_len; + +diff -Nurd linux-2.6.24/kernel/sched.c linux-2.6.24-oxe810/kernel/sched.c +--- linux-2.6.24/kernel/sched.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/sched.c 2008-06-11 17:43:47.000000000 +0200 +@@ -4028,11 +4028,10 @@ + oldprio = p->prio; + on_rq = p->se.on_rq; + running = task_current(rq, p); +- if (on_rq) { ++ if (on_rq) + dequeue_task(rq, p, 0); +- if (running) +- p->sched_class->put_prev_task(rq, p); +- } ++ if (running) ++ p->sched_class->put_prev_task(rq, p); + + if (rt_prio(prio)) + p->sched_class = &rt_sched_class; +@@ -4041,9 +4040,9 @@ + + p->prio = prio; + ++ if (running) ++ p->sched_class->set_curr_task(rq); + if (on_rq) { +- if (running) +- p->sched_class->set_curr_task(rq); + enqueue_task(rq, p, 0); + /* + * Reschedule if we are currently running on this runqueue and +@@ -4339,18 +4338,17 @@ + update_rq_clock(rq); + on_rq = p->se.on_rq; + running = task_current(rq, p); +- if (on_rq) { ++ if (on_rq) + deactivate_task(rq, p, 0); +- if (running) +- p->sched_class->put_prev_task(rq, p); +- } ++ if (running) ++ p->sched_class->put_prev_task(rq, p); + + oldprio = p->prio; + __setscheduler(rq, p, policy, param->sched_priority); + ++ if (running) ++ p->sched_class->set_curr_task(rq); + if (on_rq) { +- if (running) +- p->sched_class->set_curr_task(rq); + activate_task(rq, p, 0); + /* + * Reschedule if we are currently running on this runqueue and +@@ -7110,19 +7108,17 @@ + running = task_current(rq, tsk); + on_rq = tsk->se.on_rq; + +- if (on_rq) { ++ if (on_rq) + dequeue_task(rq, tsk, 0); +- if (unlikely(running)) +- tsk->sched_class->put_prev_task(rq, tsk); +- } ++ if (unlikely(running)) ++ tsk->sched_class->put_prev_task(rq, tsk); + + set_task_cfs_rq(tsk, task_cpu(tsk)); + +- if (on_rq) { +- if (unlikely(running)) +- tsk->sched_class->set_curr_task(rq); ++ if (unlikely(running)) ++ tsk->sched_class->set_curr_task(rq); ++ if (on_rq) + enqueue_task(rq, tsk, 0); +- } + + done: + task_rq_unlock(rq, &flags); +diff -Nurd linux-2.6.24/kernel/sched_fair.c linux-2.6.24-oxe810/kernel/sched_fair.c +--- linux-2.6.24/kernel/sched_fair.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/sched_fair.c 2008-06-11 17:43:47.000000000 +0200 +@@ -511,7 +511,7 @@ + + if (!initial) { + /* sleeps upto a single latency don't count. */ +- if (sched_feat(NEW_FAIR_SLEEPERS) && entity_is_task(se)) ++ if (sched_feat(NEW_FAIR_SLEEPERS)) + vruntime -= sysctl_sched_latency; + + /* ensure we never gain time by being placed backwards. */ +@@ -867,7 +867,11 @@ + } + + gran = sysctl_sched_wakeup_granularity; +- if (unlikely(se->load.weight != NICE_0_LOAD)) ++ /* ++ * More easily preempt - nice tasks, while not making ++ * it harder for + nice tasks. ++ */ ++ if (unlikely(se->load.weight > NICE_0_LOAD)) + gran = calc_delta_fair(gran, &se->load); + + if (pse->vruntime + gran < se->vruntime) +diff -Nurd linux-2.6.24/kernel/softirq.c linux-2.6.24-oxe810/kernel/softirq.c +--- linux-2.6.24/kernel/softirq.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/softirq.c 2008-06-11 17:43:47.000000000 +0200 +@@ -72,7 +72,7 @@ + { + unsigned long flags; + +- WARN_ON_ONCE(in_irq()); ++ //WARN_ON_ONCE(in_irq()); + + raw_local_irq_save(flags); + add_preempt_count(SOFTIRQ_OFFSET); +@@ -134,9 +134,9 @@ + #ifdef CONFIG_TRACE_IRQFLAGS + unsigned long flags; + +- WARN_ON_ONCE(in_irq()); ++ //WARN_ON_ONCE(in_irq()); + #endif +- WARN_ON_ONCE(irqs_disabled()); ++ //WARN_ON_ONCE(irqs_disabled()); + + #ifdef CONFIG_TRACE_IRQFLAGS + local_irq_save(flags); +diff -Nurd linux-2.6.24/kernel/sysctl.c linux-2.6.24-oxe810/kernel/sysctl.c +--- linux-2.6.24/kernel/sysctl.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/kernel/sysctl.c 2008-06-11 17:43:47.000000000 +0200 +@@ -306,7 +306,7 @@ + .procname = "sched_nr_migrate", + .data = &sysctl_sched_nr_migrate, + .maxlen = sizeof(unsigned int), +- .mode = 644, ++ .mode = 0644, + .proc_handler = &proc_dointvec, + }, + #endif +@@ -910,7 +910,7 @@ + .data = &nr_overcommit_huge_pages, + .maxlen = sizeof(nr_overcommit_huge_pages), + .mode = 0644, +- .proc_handler = &proc_doulongvec_minmax, ++ .proc_handler = &hugetlb_overcommit_handler, + }, + #endif + { +diff -Nurd linux-2.6.24/mm/filemap.c linux-2.6.24-oxe810/mm/filemap.c +--- linux-2.6.24/mm/filemap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/filemap.c 2008-06-11 17:47:28.000000000 +0200 +@@ -884,12 +884,31 @@ + unsigned int prev_offset; + int error; + +- index = *ppos >> PAGE_CACHE_SHIFT; ++ // Page table mod's ++#define MAX_QUEUED_PAGES (65536/PAGE_CACHE_SIZE) ++ // Create the page table ++ struct page* page_table[MAX_QUEUED_PAGES]; ++ pgoff_t start_index; ++ unsigned long loop_offset; ++ unsigned long transfer_count; ++ unsigned long start_desc_count; ++ unsigned long index_count; ++ unsigned long desc_remaining; ++ ++ ++ index = *ppos >> PAGE_CACHE_SHIFT; + prev_index = ra->prev_pos >> PAGE_CACHE_SHIFT; + prev_offset = ra->prev_pos & (PAGE_CACHE_SIZE-1); + last_index = (*ppos + desc->count + PAGE_CACHE_SIZE-1) >> PAGE_CACHE_SHIFT; + offset = *ppos & ~PAGE_CACHE_MASK; + ++ // Page table mod's ++ start_index = index; ++ index_count = 0; ++ transfer_count = 0; ++ desc_remaining = desc->count; ++ loop_offset = offset; ++ + for (;;) { + struct page *page; + pgoff_t end_index; +@@ -935,12 +954,12 @@ + nr = PAGE_CACHE_SIZE; + if (index == end_index) { + nr = ((isize - 1) & ~PAGE_CACHE_MASK) + 1; +- if (nr <= offset) { ++ if (nr <= loop_offset) { + page_cache_release(page); + goto out; + } + } +- nr = nr - offset; ++ nr = nr - loop_offset; + + /* If users can be writing to this page using arbitrary + * virtual addresses, take care about potential aliasing +@@ -953,30 +972,84 @@ + * When a sequential read accesses a page several times, + * only mark it as accessed the first time. + */ +- if (prev_index != index || offset != prev_offset) ++ if (prev_index != index || loop_offset != prev_offset) + mark_page_accessed(page); + prev_index = index; + + /* + * Ok, we have the page, and it's up-to-date, so +- * now we can copy it to user space... +- * +- * The actor routine returns how many bytes were actually used.. +- * NOTE! This may not be the same as how much of a user buffer +- * we filled up (we may be padding etc), so we can only update +- * "pos" here (the actor routine has to update the user buffer +- * pointers and the remaining count). ++ * now we can mark it for copy it to user space... + */ +- ret = actor(desc, page, offset, nr); +- offset += ret; +- index += offset >> PAGE_CACHE_SHIFT; +- offset &= ~PAGE_CACHE_MASK; +- prev_offset = offset; ++ page_table[index_count] = page; + +- page_cache_release(page); +- if (ret == nr && desc->count) +- continue; +- goto out; ++ index_count++; ++ ++ transfer_count += nr; ++ ++ if (transfer_count >= desc->count) { ++ loop_offset += desc_remaining; ++ index += loop_offset >> PAGE_CACHE_SHIFT; ++ loop_offset &= ~PAGE_CACHE_MASK; ++ desc_remaining = 0; ++ } else { ++ loop_offset = 0; ++ index++; ++ desc_remaining -= nr; ++ } ++ ++ prev_offset = loop_offset; ++ //ra.prev_offset = loop_offset; ++ ++ /** ++ * Do we have enough data in the pages so far, or enough ++ * pages left, to satisfy the count specified in the descriptor ? ++ */ ++ if ((transfer_count < desc->count) && (index <= end_index) && (index_count < MAX_QUEUED_PAGES)) { ++ continue; ++ } ++ ++ /* ++ * The actor routine returns how many bytes were actually used.. ++ * NOTE! This may not be the same as how much of a user buffer ++ * we filled up (we may be padding etc), so we can only update ++ * "pos" here (the actor routine has to update the user buffer ++ * pointers and the remaining count). ++ */ ++ ++ start_desc_count = desc->count; ++ ++ ret = actor(desc, page_table, offset, transfer_count); ++ ++ /* ++ * Some debug to test if our assumptions about the transfer length are correct ++ * We shouldn't see this message under normal execution ++ */ ++ ++ if ((start_desc_count != ret) && (transfer_count != ret)) { ++ printk("desc_count %#x, ret %#x, transfer_count %#x\n",start_desc_count,ret, transfer_count); ++ } ++ ++ offset += ret; ++ index = start_index + (offset >> PAGE_CACHE_SHIFT); ++ ++ offset &= ~PAGE_CACHE_MASK; ++ //ra.prev_offset = offset; ++ ++ while (index_count) { ++ index_count--; ++ page_cache_release(page_table[index_count]); ++ } ++ ++ if (ret == transfer_count && desc->count) { ++ // should probably think of what to do... ++ index_count = 0; ++ start_index = index; ++ transfer_count = 0; ++ loop_offset = offset; ++ desc_remaining = desc->count; ++ continue; ++ } ++ goto out; + + page_not_up_to_date: + /* Get exclusive access to the page ... */ +@@ -1056,6 +1129,7 @@ + goto readpage; + } + ++ + out: + ra->prev_pos = prev_index; + ra->prev_pos <<= PAGE_CACHE_SHIFT; +@@ -1067,42 +1141,96 @@ + } + EXPORT_SYMBOL(do_generic_mapping_read); + +-int file_read_actor(read_descriptor_t *desc, struct page *page, ++int file_read_actor(read_descriptor_t *desc, struct page **page, + unsigned long offset, unsigned long size) + { + char *kaddr; + unsigned long left, count = desc->count; ++ unsigned char* dst; ++ unsigned long ret_size; ++ + + if (size > count) + size = count; + ++ ret_size = size; ++ ++ dst = desc->arg.buf; ++ + /* + * Faults on the destination of a read are common, so do it before + * taking the kmap. + */ +- if (!fault_in_pages_writeable(desc->arg.buf, size)) { +- kaddr = kmap_atomic(page, KM_USER0); +- left = __copy_to_user_inatomic(desc->arg.buf, +- kaddr + offset, size); +- kunmap_atomic(kaddr, KM_USER0); +- if (left == 0) +- goto success; +- } ++ while (size) { ++ unsigned long psize = PAGE_CACHE_SIZE - offset; ++ struct page *page_it; ++ ++ psize = PAGE_CACHE_SIZE - offset; ++ if (size <= psize) { ++ psize = size; ++ } ++ ++ if (fault_in_pages_writeable(dst, psize)) ++ break; ++ ++ page_it = *page; ++ ++ kaddr = kmap_atomic(page_it, KM_USER0); ++ left = __copy_to_user_inatomic(dst, ++ kaddr + offset, psize); ++ kunmap_atomic(kaddr, KM_USE R0); ++ if (left != 0) ++ break; ++ ++ size -= psize; ++ page++; ++ offset += psize; ++ dst += psize; ++ offset &= (PAGE_CACHE_SIZE - 1); ++ } ++ ++ if (size == 0) ++ goto success; ++ + + /* Do it the slow way */ +- kaddr = kmap(page); +- left = __copy_to_user(desc->arg.buf, kaddr + offset, size); +- kunmap(page); + +- if (left) { +- size -= left; +- desc->error = -EFAULT; +- } ++ ++ while (size) { ++ unsigned long psize; ++ struct page *page_it; ++ ++ psize = PAGE_CACHE_SIZE - offset; ++ if (size <= psize) { ++ psize = size; ++ } ++ ++ ++ page_it = *page; ++ ++ kaddr = kmap(page_it); ++ ++ left = __copy_to_user(dst, kaddr + offset, psize); ++ kunmap(page_it); ++ ++ if (left) { ++ size -= left; ++ desc->error = -EFAULT; ++ break; ++ } ++ page++; ++ offset += psize; ++ dst += psize; ++ offset &= (PAGE_CACHE_SIZE - 1); ++ ++ size -= psize; ++ } ++ + success: +- desc->count = count - size; +- desc->written += size; +- desc->arg.buf += size; +- return size; ++ desc->count = count - ret_size; ++ desc->written += ret_size; ++ desc->arg.buf += ret_size; ++ return ret_size; + } + + /* +@@ -1219,6 +1347,46 @@ + } + EXPORT_SYMBOL(generic_file_aio_read); + ++int file_send_actor(read_descriptor_t * desc, struct page **page, unsigned long offset, unsigned long size) ++{ ++ ssize_t written; ++ unsigned long count = desc->count; ++ struct file *file = desc->arg.data; ++ ++ if (size > count) ++ size = count; ++ ++ written = file->f_op->sendpages(file, page, offset, ++ size, &file->f_pos, size<count); ++ if (written < 0) { ++ desc->error = written; ++ written = 0; ++ } ++ desc->count = count - written; ++ desc->written += written; ++ return written; ++} ++ ++ssize_t generic_file_sendfile(struct file *in_file, loff_t *ppos, ++ size_t count, read_actor_t actor, void *target) ++{ ++ read_descriptor_t desc; ++ ++ if (!count) ++ return 0; ++ ++ desc.written = 0; ++ desc.count = count; ++ desc.arg.data = target; ++ desc.error = 0; ++ ++ do_generic_file_read(in_file, ppos, &desc, actor); ++ if (desc.written) ++ return desc.written; ++ return desc.error; ++} ++EXPORT_SYMBOL(generic_file_sendfile); ++ + static ssize_t + do_readahead(struct address_space *mapping, struct file *filp, + pgoff_t index, unsigned long nr) +@@ -1725,17 +1893,27 @@ + } + EXPORT_SYMBOL(iov_iter_copy_from_user); + +-static void __iov_iter_advance_iov(struct iov_iter *i, size_t bytes) ++void iov_iter_advance(struct iov_iter *i, size_t bytes) + { ++ BUG_ON(i->count < bytes); ++ + if (likely(i->nr_segs == 1)) { + i->iov_offset += bytes; ++ i->count -= bytes; + } else { + const struct iovec *iov = i->iov; + size_t base = i->iov_offset; + +- while (bytes) { +- int copy = min(bytes, iov->iov_len - base); ++ /* ++ * The !iov->iov_len check ensures we skip over unlikely ++ * zero-length segments (without overruning the iovec). ++ */ ++ while (bytes || unlikely(!iov->iov_len && i->count)) { ++ int copy; + ++ copy = min(bytes, iov->iov_len - base); ++ BUG_ON(!i->count || i->count < copy); ++ i->count -= copy; + bytes -= copy; + base += copy; + if (iov->iov_len == base) { +@@ -1747,14 +1925,6 @@ + i->iov_offset = base; + } + } +- +-void iov_iter_advance(struct iov_iter *i, size_t bytes) +-{ +- BUG_ON(i->count < bytes); +- +- __iov_iter_advance_iov(i, bytes); +- i->count -= bytes; +-} + EXPORT_SYMBOL(iov_iter_advance); + + /* +@@ -2251,6 +2421,7 @@ + + cond_resched(); + ++ iov_iter_advance(i, copied); + if (unlikely(copied == 0)) { + /* + * If we were unable to copy any data at all, we must +@@ -2264,7 +2435,6 @@ + iov_iter_single_seg_count(i)); + goto again; + } +- iov_iter_advance(i, copied); + pos += copied; + written += copied; + +diff -Nurd linux-2.6.24/mm/fremap.c linux-2.6.24-oxe810/mm/fremap.c +--- linux-2.6.24/mm/fremap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/fremap.c 2008-06-11 17:47:28.000000000 +0200 +@@ -190,10 +190,13 @@ + */ + if (mapping_cap_account_dirty(mapping)) { + unsigned long addr; ++ struct file *file = vma->vm_file; + + flags &= MAP_NONBLOCK; +- addr = mmap_region(vma->vm_file, start, size, ++ get_file(file); ++ addr = mmap_region(file, start, size, + flags, vma->vm_flags, pgoff, 1); ++ fput(file); + if (IS_ERR_VALUE(addr)) { + err = addr; + } else { +diff -Nurd linux-2.6.24/mm/hugetlb.c linux-2.6.24-oxe810/mm/hugetlb.c +--- linux-2.6.24/mm/hugetlb.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/hugetlb.c 2008-06-11 17:47:28.000000000 +0200 +@@ -119,6 +119,7 @@ + struct address_space *mapping; + + mapping = (struct address_space *) page_private(page); ++ set_page_private(page, 0); + BUG_ON(page_count(page)); + INIT_LIST_HEAD(&page->lru); + +@@ -133,7 +134,6 @@ + spin_unlock(&hugetlb_lock); + if (mapping) + hugetlb_put_quota(mapping, 1); +- set_page_private(page, 0); + } + + /* +@@ -605,6 +605,16 @@ + return 0; + } + ++int hugetlb_overcommit_handler(struct ctl_table *table, int write, ++ struct file *file, void __user *buffer, ++ size_t *length, loff_t *ppos) ++{ ++ spin_lock(&hugetlb_lock); ++ proc_doulongvec_minmax(table, write, file, buffer, length, ppos); ++ spin_unlock(&hugetlb_lock); ++ return 0; ++} ++ + #endif /* CONFIG_SYSCTL */ + + int hugetlb_report_meminfo(char *buf) +diff -Nurd linux-2.6.24/mm/memory.c linux-2.6.24-oxe810/mm/memory.c +--- linux-2.6.24/mm/memory.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/memory.c 2008-06-11 17:47:28.000000000 +0200 +@@ -980,6 +980,8 @@ + int i; + unsigned int vm_flags; + ++ if (len <= 0) ++ return 0; + /* + * Require read or write permissions. + * If 'force' is set, we only require the "MAY" flags. +diff -Nurd linux-2.6.24/mm/mmap.c linux-2.6.24-oxe810/mm/mmap.c +--- linux-2.6.24/mm/mmap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/mmap.c 2008-06-11 17:47:28.000000000 +0200 +@@ -2215,7 +2215,7 @@ + vma->vm_start = addr; + vma->vm_end = addr + len; + +- vma->vm_flags = vm_flags | mm->def_flags; ++ vma->vm_flags = vm_flags | mm->def_flags | VM_DONTEXPAND; + vma->vm_page_prot = vm_get_page_prot(vma->vm_flags); + + vma->vm_ops = &special_mapping_vmops; +diff -Nurd linux-2.6.24/mm/shmem.c linux-2.6.24-oxe810/mm/shmem.c +--- linux-2.6.24/mm/shmem.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/shmem.c 2008-06-11 17:47:28.000000000 +0200 +@@ -1681,7 +1681,7 @@ + * "pos" here (the actor routine has to update the user buffer + * pointers and the remaining count). + */ +- ret = actor(desc, page, offset, nr); ++ ret = actor(desc, &page, offset, nr); + offset += ret; + index += offset >> PAGE_CACHE_SHIFT; + offset &= ~PAGE_CACHE_MASK; +diff -Nurd linux-2.6.24/mm/slab.c linux-2.6.24-oxe810/mm/slab.c +--- linux-2.6.24/mm/slab.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/slab.c 2008-06-11 17:47:28.000000000 +0200 +@@ -304,11 +304,11 @@ + /* + * Need this for bootstrapping a per node allocator. + */ +-#define NUM_INIT_LISTS (2 * MAX_NUMNODES + 1) ++#define NUM_INIT_LISTS (3 * MAX_NUMNODES) + struct kmem_list3 __initdata initkmem_list3[NUM_INIT_LISTS]; + #define CACHE_CACHE 0 +-#define SIZE_AC 1 +-#define SIZE_L3 (1 + MAX_NUMNODES) ++#define SIZE_AC MAX_NUMNODES ++#define SIZE_L3 (2 * MAX_NUMNODES) + + static int drain_freelist(struct kmem_cache *cache, + struct kmem_list3 *l3, int tofree); +@@ -1410,6 +1410,22 @@ + } + + /* ++ * For setting up all the kmem_list3s for cache whose buffer_size is same as ++ * size of kmem_list3. ++ */ ++static void __init set_up_list3s(struct kmem_cache *cachep, int index) ++{ ++ int node; ++ ++ for_each_online_node(node) { ++ cachep->nodelists[node] = &initkmem_list3[index + node]; ++ cachep->nodelists[node]->next_reap = jiffies + ++ REAPTIMEOUT_LIST3 + ++ ((unsigned long)cachep) % REAPTIMEOUT_LIST3; ++ } ++} ++ ++/* + * Initialisation. Called after the page allocator have been initialised and + * before smp_init(). + */ +@@ -1432,6 +1448,7 @@ + if (i < MAX_NUMNODES) + cache_cache.nodelists[i] = NULL; + } ++ set_up_list3s(&cache_cache, CACHE_CACHE); + + /* + * Fragmentation resistance on low memory - only use bigger +@@ -1587,10 +1604,9 @@ + { + int nid; + +- /* Replace the static kmem_list3 structures for the boot cpu */ +- init_list(&cache_cache, &initkmem_list3[CACHE_CACHE], node); +- + for_each_online_node(nid) { ++ init_list(&cache_cache, &initkmem_list3[CACHE_CACHE], nid); ++ + init_list(malloc_sizes[INDEX_AC].cs_cachep, + &initkmem_list3[SIZE_AC + nid], nid); + +@@ -1960,22 +1976,6 @@ + } + } + +-/* +- * For setting up all the kmem_list3s for cache whose buffer_size is same as +- * size of kmem_list3. +- */ +-static void __init set_up_list3s(struct kmem_cache *cachep, int index) +-{ +- int node; +- +- for_each_online_node(node) { +- cachep->nodelists[node] = &initkmem_list3[index + node]; +- cachep->nodelists[node]->next_reap = jiffies + +- REAPTIMEOUT_LIST3 + +- ((unsigned long)cachep) % REAPTIMEOUT_LIST3; +- } +-} +- + static void __kmem_cache_destroy(struct kmem_cache *cachep) + { + int i; +@@ -2099,7 +2099,7 @@ + g_cpucache_up = PARTIAL_L3; + } else { + int node; +- for_each_node_state(node, N_NORMAL_MEMORY) { ++ for_each_online_node(node) { + cachep->nodelists[node] = + kmalloc_node(sizeof(struct kmem_list3), + GFP_KERNEL, node); +@@ -2961,11 +2961,10 @@ + struct array_cache *ac; + int node; + +- node = numa_node_id(); +- ++retry: + check_irq_off(); ++ node = numa_node_id(); + ac = cpu_cache_get(cachep); +-retry: + batchcount = ac->batchcount; + if (!ac->touched && batchcount > BATCHREFILL_LIMIT) { + /* +diff -Nurd linux-2.6.24/mm/slub.c linux-2.6.24-oxe810/mm/slub.c +--- linux-2.6.24/mm/slub.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/mm/slub.c 2008-06-11 17:47:28.000000000 +0200 +@@ -2592,6 +2592,7 @@ + void kfree(const void *x) + { + struct page *page; ++ void *object = (void *)x; + + if (unlikely(ZERO_OR_NULL_PTR(x))) + return; +@@ -2601,7 +2602,7 @@ + put_page(page); + return; + } +- slab_free(page->slab, page, (void *)x, __builtin_return_address(0)); ++ slab_free(page->slab, page, object, __builtin_return_address(0)); + } + EXPORT_SYMBOL(kfree); + +diff -Nurd linux-2.6.24/net/bluetooth/hci_sysfs.c linux-2.6.24-oxe810/net/bluetooth/hci_sysfs.c +--- linux-2.6.24/net/bluetooth/hci_sysfs.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/bluetooth/hci_sysfs.c 2008-06-11 17:46:02.000000000 +0200 +@@ -12,6 +12,8 @@ + #undef BT_DBG + #define BT_DBG(D...) + #endif ++static struct workqueue_struct *btaddconn; ++static struct workqueue_struct *btdelconn; + + static inline char *typetostr(int type) + { +@@ -279,6 +281,8 @@ + struct hci_conn *conn = container_of(work, struct hci_conn, work); + int i; + ++ flush_workqueue(btdelconn); ++ + if (device_add(&conn->dev) < 0) { + BT_ERR("Failed to register connection device"); + return; +@@ -313,7 +317,7 @@ + + INIT_WORK(&conn->work, add_conn); + +- schedule_work(&conn->work); ++ queue_work(btaddconn, &conn->work); + } + + static int __match_tty(struct device *dev, void *data) +@@ -349,7 +353,7 @@ + + INIT_WORK(&conn->work, del_conn); + +- schedule_work(&conn->work); ++ queue_work(btdelconn, &conn->work); + } + + int hci_register_sysfs(struct hci_dev *hdev) +@@ -398,28 +402,54 @@ + { + int err; + ++ btaddconn = create_singlethread_workqueue("btaddconn"); ++ if (!btaddconn) { ++ err = -ENOMEM; ++ goto out; ++ } ++ ++ btdelconn = create_singlethread_workqueue("btdelconn"); ++ if (!btdelconn) { ++ err = -ENOMEM; ++ goto out_del; ++ } ++ + bt_platform = platform_device_register_simple("bluetooth", -1, NULL, 0); +- if (IS_ERR(bt_platform)) +- return PTR_ERR(bt_platform); ++ if (IS_ERR(bt_platform)) { ++ err = PTR_ERR(bt_platform); ++ goto out_platform; ++ } + + err = bus_register(&bt_bus); +- if (err < 0) { +- platform_device_unregister(bt_platform); +- return err; +- } ++ if (err < 0) ++ goto out_bus; + + bt_class = class_create(THIS_MODULE, "bluetooth"); + if (IS_ERR(bt_class)) { +- bus_unregister(&bt_bus); +- platform_device_unregister(bt_platform); +- return PTR_ERR(bt_class); ++ err = PTR_ERR(bt_class); ++ goto out_class; + } + + return 0; ++ ++out_class: ++ bus_unregister(&bt_bus); ++out_bus: ++ platform_device_unregister(bt_platform); ++out_platform: ++ destroy_workqueue(btdelconn); ++out_del: ++ destroy_workqueue(btaddconn); ++out: ++ return err; + } + + void bt_sysfs_cleanup(void) + { ++ destroy_workqueue(btaddconn); ++ ++ destroy_workqueue(btdelconn); ++ + class_destroy(bt_class); + + bus_unregister(&bt_bus); +diff -Nurd linux-2.6.24/net/bridge/netfilter/ebt_dnat.c linux-2.6.24-oxe810/net/bridge/netfilter/ebt_dnat.c +--- linux-2.6.24/net/bridge/netfilter/ebt_dnat.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/bridge/netfilter/ebt_dnat.c 2008-06-11 17:46:12.000000000 +0200 +@@ -20,8 +20,8 @@ + { + struct ebt_nat_info *info = (struct ebt_nat_info *)data; + +- if (skb_make_writable(skb, 0)) +- return NF_DROP; ++ if (!skb_make_writable(skb, 0)) ++ return EBT_DROP; + + memcpy(eth_hdr(skb)->h_dest, info->mac, ETH_ALEN); + return info->target; +diff -Nurd linux-2.6.24/net/bridge/netfilter/ebt_redirect.c linux-2.6.24-oxe810/net/bridge/netfilter/ebt_redirect.c +--- linux-2.6.24/net/bridge/netfilter/ebt_redirect.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/bridge/netfilter/ebt_redirect.c 2008-06-11 17:46:12.000000000 +0200 +@@ -21,8 +21,8 @@ + { + struct ebt_redirect_info *info = (struct ebt_redirect_info *)data; + +- if (skb_make_writable(skb, 0)) +- return NF_DROP; ++ if (!skb_make_writable(skb, 0)) ++ return EBT_DROP; + + if (hooknr != NF_BR_BROUTING) + memcpy(eth_hdr(skb)->h_dest, +diff -Nurd linux-2.6.24/net/bridge/netfilter/ebt_snat.c linux-2.6.24-oxe810/net/bridge/netfilter/ebt_snat.c +--- linux-2.6.24/net/bridge/netfilter/ebt_snat.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/bridge/netfilter/ebt_snat.c 2008-06-11 17:46:12.000000000 +0200 +@@ -22,8 +22,8 @@ + { + struct ebt_nat_info *info = (struct ebt_nat_info *) data; + +- if (skb_make_writable(skb, 0)) +- return NF_DROP; ++ if (!skb_make_writable(skb, 0)) ++ return EBT_DROP; + + memcpy(eth_hdr(skb)->h_source, info->mac, ETH_ALEN); + if (!(info->target & NAT_ARP_BIT) && +diff -Nurd linux-2.6.24/net/core/dev.c linux-2.6.24-oxe810/net/core/dev.c +--- linux-2.6.24/net/core/dev.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/core/dev.c 2008-06-11 17:45:57.000000000 +0200 +@@ -1068,8 +1068,6 @@ + */ + call_netdevice_notifiers(NETDEV_GOING_DOWN, dev); + +- dev_deactivate(dev); +- + clear_bit(__LINK_STATE_START, &dev->state); + + /* Synchronize to scheduled poll. We cannot touch poll list, +@@ -1080,6 +1078,8 @@ + */ + smp_mb__after_clear_bit(); /* Commit netif_running(). */ + ++ dev_deactivate(dev); ++ + /* + * Call the device specific close. This cannot fail. + * Only if device is UP +@@ -2906,7 +2906,7 @@ + } + } + +- da = kmalloc(sizeof(*da), GFP_ATOMIC); ++ da = kzalloc(sizeof(*da), GFP_ATOMIC); + if (da == NULL) + return -ENOMEM; + memcpy(da->da_addr, addr, alen); +diff -Nurd linux-2.6.24/net/ipv4/af_inet.c linux-2.6.24-oxe810/net/ipv4/af_inet.c +--- linux-2.6.24/net/ipv4/af_inet.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/af_inet.c 2008-06-11 17:46:09.000000000 +0200 +@@ -838,6 +838,7 @@ + .recvmsg = sock_common_recvmsg, + .mmap = sock_no_mmap, + .sendpage = tcp_sendpage, ++ .sendpages = tcp_sendpages, + #ifdef CONFIG_COMPAT + .compat_setsockopt = compat_sock_common_setsockopt, + .compat_getsockopt = compat_sock_common_getsockopt, +diff -Nurd linux-2.6.24/net/ipv4/fib_hash.c linux-2.6.24-oxe810/net/ipv4/fib_hash.c +--- linux-2.6.24/net/ipv4/fib_hash.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/fib_hash.c 2008-06-11 17:46:09.000000000 +0200 +@@ -434,19 +434,43 @@ + + if (fa && fa->fa_tos == tos && + fa->fa_info->fib_priority == fi->fib_priority) { +- struct fib_alias *fa_orig; ++ struct fib_alias *fa_first, *fa_match; + + err = -EEXIST; + if (cfg->fc_nlflags & NLM_F_EXCL) + goto out; + ++ /* We have 2 goals: ++ * 1. Find exact match for type, scope, fib_info to avoid ++ * duplicate routes ++ * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it ++ */ ++ fa_match = NULL; ++ fa_first = fa; ++ fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list); ++ list_for_each_entry_continue(fa, &f->fn_alias, fa_list) { ++ if (fa->fa_tos != tos) ++ break; ++ if (fa->fa_info->fib_priority != fi->fib_priority) ++ break; ++ if (fa->fa_type == cfg->fc_type && ++ fa->fa_scope == cfg->fc_scope && ++ fa->fa_info == fi) { ++ fa_match = fa; ++ break; ++ } ++ } ++ + if (cfg->fc_nlflags & NLM_F_REPLACE) { + struct fib_info *fi_drop; + u8 state; + +- if (fi->fib_treeref > 1) ++ fa = fa_first; ++ if (fa_match) { ++ if (fa == fa_match) ++ err = 0; + goto out; +- ++ } + write_lock_bh(&fib_hash_lock); + fi_drop = fa->fa_info; + fa->fa_info = fi; +@@ -469,20 +493,11 @@ + * uses the same scope, type, and nexthop + * information. + */ +- fa_orig = fa; +- fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list); +- list_for_each_entry_continue(fa, &f->fn_alias, fa_list) { +- if (fa->fa_tos != tos) +- break; +- if (fa->fa_info->fib_priority != fi->fib_priority) +- break; +- if (fa->fa_type == cfg->fc_type && +- fa->fa_scope == cfg->fc_scope && +- fa->fa_info == fi) +- goto out; +- } ++ if (fa_match) ++ goto out; ++ + if (!(cfg->fc_nlflags & NLM_F_APPEND)) +- fa = fa_orig; ++ fa = fa_first; + } + + err = -ENOENT; +diff -Nurd linux-2.6.24/net/ipv4/fib_trie.c linux-2.6.24-oxe810/net/ipv4/fib_trie.c +--- linux-2.6.24/net/ipv4/fib_trie.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/fib_trie.c 2008-06-11 17:46:09.000000000 +0200 +@@ -1203,20 +1203,45 @@ + * and we need to allocate a new one of those as well. + */ + +- if (fa && fa->fa_info->fib_priority == fi->fib_priority) { +- struct fib_alias *fa_orig; ++ if (fa && fa->fa_tos == tos && ++ fa->fa_info->fib_priority == fi->fib_priority) { ++ struct fib_alias *fa_first, *fa_match; + + err = -EEXIST; + if (cfg->fc_nlflags & NLM_F_EXCL) + goto out; + ++ /* We have 2 goals: ++ * 1. Find exact match for type, scope, fib_info to avoid ++ * duplicate routes ++ * 2. Find next 'fa' (or head), NLM_F_APPEND inserts before it ++ */ ++ fa_match = NULL; ++ fa_first = fa; ++ fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list); ++ list_for_each_entry_continue(fa, fa_head, fa_list) { ++ if (fa->fa_tos != tos) ++ break; ++ if (fa->fa_info->fib_priority != fi->fib_priority) ++ break; ++ if (fa->fa_type == cfg->fc_type && ++ fa->fa_scope == cfg->fc_scope && ++ fa->fa_info == fi) { ++ fa_match = fa; ++ break; ++ } ++ } ++ + if (cfg->fc_nlflags & NLM_F_REPLACE) { + struct fib_info *fi_drop; + u8 state; + +- if (fi->fib_treeref > 1) ++ fa = fa_first; ++ if (fa_match) { ++ if (fa == fa_match) ++ err = 0; + goto out; +- ++ } + err = -ENOBUFS; + new_fa = kmem_cache_alloc(fn_alias_kmem, GFP_KERNEL); + if (new_fa == NULL) +@@ -1228,7 +1253,7 @@ + new_fa->fa_type = cfg->fc_type; + new_fa->fa_scope = cfg->fc_scope; + state = fa->fa_state; +- new_fa->fa_state &= ~FA_S_ACCESSED; ++ new_fa->fa_state = state & ~FA_S_ACCESSED; + + list_replace_rcu(&fa->fa_list, &new_fa->fa_list); + alias_free_mem_rcu(fa); +@@ -1245,20 +1270,11 @@ + * uses the same scope, type, and nexthop + * information. + */ +- fa_orig = fa; +- list_for_each_entry(fa, fa_orig->fa_list.prev, fa_list) { +- if (fa->fa_tos != tos) +- break; +- if (fa->fa_info->fib_priority != fi->fib_priority) +- break; +- if (fa->fa_type == cfg->fc_type && +- fa->fa_scope == cfg->fc_scope && +- fa->fa_info == fi) { +- goto out; +- } +- } ++ if (fa_match) ++ goto out; ++ + if (!(cfg->fc_nlflags & NLM_F_APPEND)) +- fa = fa_orig; ++ fa = fa_first; + } + err = -ENOENT; + if (!(cfg->fc_nlflags & NLM_F_CREATE)) +@@ -1614,9 +1630,8 @@ + pr_debug("Deleting %08x/%d tos=%d t=%p\n", key, plen, tos, t); + + fa_to_delete = NULL; +- fa_head = fa->fa_list.prev; +- +- list_for_each_entry(fa, fa_head, fa_list) { ++ fa = list_entry(fa->fa_list.prev, struct fib_alias, fa_list); ++ list_for_each_entry_continue(fa, fa_head, fa_list) { + struct fib_info *fi = fa->fa_info; + + if (fa->fa_tos != tos) +diff -Nurd linux-2.6.24/net/ipv4/inet_diag.c linux-2.6.24-oxe810/net/ipv4/inet_diag.c +--- linux-2.6.24/net/ipv4/inet_diag.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/inet_diag.c 2008-06-11 17:46:09.000000000 +0200 +@@ -259,8 +259,10 @@ + const struct inet_diag_handler *handler; + + handler = inet_diag_lock_handler(nlh->nlmsg_type); +- if (!handler) +- return -ENOENT; ++ if (IS_ERR(handler)) { ++ err = PTR_ERR(handler); ++ goto unlock; ++ } + + hashinfo = handler->idiag_hashinfo; + err = -EINVAL; +@@ -708,8 +710,8 @@ + struct inet_hashinfo *hashinfo; + + handler = inet_diag_lock_handler(cb->nlh->nlmsg_type); +- if (!handler) +- goto no_handler; ++ if (IS_ERR(handler)) ++ goto unlock; + + hashinfo = handler->idiag_hashinfo; + +@@ -838,7 +840,6 @@ + cb->args[2] = num; + unlock: + inet_diag_unlock_handler(handler); +-no_handler: + return skb->len; + } + +diff -Nurd linux-2.6.24/net/ipv4/ip_output.c linux-2.6.24-oxe810/net/ipv4/ip_output.c +--- linux-2.6.24/net/ipv4/ip_output.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/ip_output.c 2008-06-11 17:46:09.000000000 +0200 +@@ -462,6 +462,7 @@ + if (skb_shinfo(skb)->frag_list) { + struct sk_buff *frag; + int first_len = skb_pagelen(skb); ++ int truesizes = 0; + + if (first_len - hlen > mtu || + ((first_len - hlen) & 7) || +@@ -485,7 +486,7 @@ + sock_hold(skb->sk); + frag->sk = skb->sk; + frag->destructor = sock_wfree; +- skb->truesize -= frag->truesize; ++ truesizes += frag->truesize; + } + } + +@@ -496,6 +497,7 @@ + frag = skb_shinfo(skb)->frag_list; + skb_shinfo(skb)->frag_list = NULL; + skb->data_len = first_len - skb_headlen(skb); ++ skb->truesize -= truesizes; + skb->len = first_len; + iph->tot_len = htons(first_len); + iph->frag_off = htons(IP_MF); +diff -Nurd linux-2.6.24/net/ipv4/ip_sockglue.c linux-2.6.24-oxe810/net/ipv4/ip_sockglue.c +--- linux-2.6.24/net/ipv4/ip_sockglue.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/ip_sockglue.c 2008-06-11 17:46:09.000000000 +0200 +@@ -514,11 +514,6 @@ + val &= ~3; + val |= inet->tos & 3; + } +- if (IPTOS_PREC(val) >= IPTOS_PREC_CRITIC_ECP && +- !capable(CAP_NET_ADMIN)) { +- err = -EPERM; +- break; +- } + if (inet->tos != val) { + inet->tos = val; + sk->sk_priority = rt_tos2priority(val); +diff -Nurd linux-2.6.24/net/ipv4/ipcomp.c linux-2.6.24-oxe810/net/ipv4/ipcomp.c +--- linux-2.6.24/net/ipv4/ipcomp.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/ipcomp.c 2008-06-11 17:46:09.000000000 +0200 +@@ -74,6 +74,7 @@ + + static int ipcomp_input(struct xfrm_state *x, struct sk_buff *skb) + { ++ int nexthdr; + int err = -ENOMEM; + struct ip_comp_hdr *ipch; + +@@ -84,13 +85,15 @@ + + /* Remove ipcomp header and decompress original payload */ + ipch = (void *)skb->data; ++ nexthdr = ipch->nexthdr; ++ + skb->transport_header = skb->network_header + sizeof(*ipch); + __skb_pull(skb, sizeof(*ipch)); + err = ipcomp_decompress(x, skb); + if (err) + goto out; + +- err = ipch->nexthdr; ++ err = nexthdr; + + out: + return err; +@@ -105,8 +108,11 @@ + const int cpu = get_cpu(); + u8 *scratch = *per_cpu_ptr(ipcomp_scratches, cpu); + struct crypto_comp *tfm = *per_cpu_ptr(ipcd->tfms, cpu); +- int err = crypto_comp_compress(tfm, start, plen, scratch, &dlen); ++ int err; + ++ local_bh_disable(); ++ err = crypto_comp_compress(tfm, start, plen, scratch, &dlen); ++ local_bh_enable(); + if (err) + goto out; + +diff -Nurd linux-2.6.24/net/ipv4/ipconfig.c linux-2.6.24-oxe810/net/ipv4/ipconfig.c +--- linux-2.6.24/net/ipv4/ipconfig.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/ipconfig.c 2008-06-11 17:46:09.000000000 +0200 +@@ -739,9 +739,9 @@ + printk("Unknown ARP type 0x%04x for device %s\n", dev->type, dev->name); + b->htype = dev->type; /* can cause undefined behavior */ + } ++ ++ /* server_ip and your_ip address are both already zero per RFC2131 */ + b->hlen = dev->addr_len; +- b->your_ip = NONE; +- b->server_ip = NONE; + memcpy(b->hw_addr, dev->dev_addr, dev->addr_len); + b->secs = htons(jiffies_diff / HZ); + b->xid = d->xid; +diff -Nurd linux-2.6.24/net/ipv4/netfilter/arpt_mangle.c linux-2.6.24-oxe810/net/ipv4/netfilter/arpt_mangle.c +--- linux-2.6.24/net/ipv4/netfilter/arpt_mangle.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/netfilter/arpt_mangle.c 2008-06-11 17:46:07.000000000 +0200 +@@ -19,7 +19,7 @@ + unsigned char *arpptr; + int pln, hln; + +- if (skb_make_writable(skb, skb->len)) ++ if (!skb_make_writable(skb, skb->len)) + return NF_DROP; + + arp = arp_hdr(skb); +diff -Nurd linux-2.6.24/net/ipv4/netfilter/ip_queue.c linux-2.6.24-oxe810/net/ipv4/netfilter/ip_queue.c +--- linux-2.6.24/net/ipv4/netfilter/ip_queue.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/netfilter/ip_queue.c 2008-06-11 17:46:07.000000000 +0200 +@@ -336,8 +336,8 @@ + ipq_mangle_ipv4(ipq_verdict_msg_t *v, struct ipq_queue_entry *e) + { + int diff; +- int err; + struct iphdr *user_iph = (struct iphdr *)v->payload; ++ struct sk_buff *nskb; + + if (v->data_len < sizeof(*user_iph)) + return 0; +@@ -349,14 +349,16 @@ + if (v->data_len > 0xFFFF) + return -EINVAL; + if (diff > skb_tailroom(e->skb)) { +- err = pskb_expand_head(e->skb, 0, ++ nskb = skb_copy_expand(e->skb, 0, + diff - skb_tailroom(e->skb), + GFP_ATOMIC); +- if (err) { ++ if (!nskb) { + printk(KERN_WARNING "ip_queue: error " +- "in mangle, dropping packet: %d\n", -err); +- return err; ++ "in mangle, dropping packet\n"); ++ return -ENOMEM; + } ++ kfree_skb(e->skb); ++ e->skb = nskb; + } + skb_put(e->skb, diff); + } +diff -Nurd linux-2.6.24/net/ipv4/sysctl_net_ipv4.c linux-2.6.24-oxe810/net/ipv4/sysctl_net_ipv4.c +--- linux-2.6.24/net/ipv4/sysctl_net_ipv4.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/sysctl_net_ipv4.c 2008-06-11 17:46:09.000000000 +0200 +@@ -248,7 +248,7 @@ + + tcp_get_available_congestion_control(tbl.data, tbl.maxlen); + ret = sysctl_string(&tbl, name, nlen, oldval, oldlenp, newval, newlen); +- if (ret == 0 && newval && newlen) ++ if (ret == 1 && newval && newlen) + ret = tcp_set_allowed_congestion_control(tbl.data); + kfree(tbl.data); + +diff -Nurd linux-2.6.24/net/ipv4/tcp.c linux-2.6.24-oxe810/net/ipv4/tcp.c +--- linux-2.6.24/net/ipv4/tcp.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/tcp.c 2008-06-11 17:46:09.000000000 +0200 +@@ -269,6 +269,8 @@ + #include <asm/uaccess.h> + #include <asm/ioctls.h> + ++#include <linux/pagemap.h> ++ + int sysctl_tcp_fin_timeout __read_mostly = TCP_FIN_TIMEOUT; + + DEFINE_SNMP_STAT(struct tcp_mib, tcp_statistics) __read_mostly; +@@ -636,6 +638,48 @@ + return res; + } + ++ssize_t tcp_sendpages(struct socket *sock, struct page **page, int offset, ++ size_t size, int flags) ++{ ++ ssize_t res; ++ struct sock *sk = sock->sk; ++ ++#define TCP_ZC_CSUM_FLAGS (NETIF_F_IP_CSUM | NETIF_F_NO_CSUM | NETIF_F_HW_CSUM) ++ ++ if (!(sk->sk_route_caps & NETIF_F_SG) || ++ !(sk->sk_route_caps & TCP_ZC_CSUM_FLAGS)) { ++ // Iterate through each page ++ ssize_t ret = 0; ++ ++ while (size) { ++ unsigned long psize = PAGE_CACHE_SIZE - offset; ++ struct page *page_it; ++ ++ psize = PAGE_CACHE_SIZE - offset; ++ if (size <= psize) { ++ psize = size; ++ } ++ page_it = *page; ++ ret += sock_no_sendpage(sock, page_it, offset, psize, flags); ++ size -= psize; ++ page++; ++ offset += psize; ++ offset &= (PAGE_CACHE_SIZE - 1); ++ } ++ return ret; ++ } ++ ++#undef TCP_ZC_CSUM_FLAGS ++ ++ lock_sock(sk); ++ TCP_CHECK_TIMER(sk); ++ res = do_tcp_sendpages(sk, page, offset, size, flags); ++ TCP_CHECK_TIMER(sk); ++ ++ release_sock(sk); ++ return res; ++} ++ + #define TCP_PAGE(sk) (sk->sk_sndmsg_page) + #define TCP_OFF(sk) (sk->sk_sndmsg_off) + +diff -Nurd linux-2.6.24/net/ipv4/xfrm4_tunnel.c linux-2.6.24-oxe810/net/ipv4/xfrm4_tunnel.c +--- linux-2.6.24/net/ipv4/xfrm4_tunnel.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv4/xfrm4_tunnel.c 2008-06-11 17:46:09.000000000 +0200 +@@ -50,7 +50,7 @@ + + static int xfrm_tunnel_rcv(struct sk_buff *skb) + { +- return xfrm4_rcv_spi(skb, IPPROTO_IP, ip_hdr(skb)->saddr); ++ return xfrm4_rcv_spi(skb, IPPROTO_IPIP, ip_hdr(skb)->saddr); + } + + static int xfrm_tunnel_err(struct sk_buff *skb, u32 info) +diff -Nurd linux-2.6.24/net/ipv6/ip6_output.c linux-2.6.24-oxe810/net/ipv6/ip6_output.c +--- linux-2.6.24/net/ipv6/ip6_output.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv6/ip6_output.c 2008-06-11 17:46:11.000000000 +0200 +@@ -593,7 +593,7 @@ + * or if the skb it not generated by a local socket. (This last + * check should be redundant, but it's free.) + */ +- if (!np || np->pmtudisc >= IPV6_PMTUDISC_DO) { ++ if (!skb->local_df) { + skb->dev = skb->dst->dev; + icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev); + IP6_INC_STATS(ip6_dst_idev(skb->dst), IPSTATS_MIB_FRAGFAILS); +@@ -609,6 +609,7 @@ + + if (skb_shinfo(skb)->frag_list) { + int first_len = skb_pagelen(skb); ++ int truesizes = 0; + + if (first_len - hlen > mtu || + ((first_len - hlen) & 7) || +@@ -631,7 +632,7 @@ + sock_hold(skb->sk); + frag->sk = skb->sk; + frag->destructor = sock_wfree; +- skb->truesize -= frag->truesize; ++ truesizes += frag->truesize; + } + } + +@@ -662,6 +663,7 @@ + + first_len = skb_pagelen(skb); + skb->data_len = first_len - skb_headlen(skb); ++ skb->truesize -= truesizes; + skb->len = first_len; + ipv6_hdr(skb)->payload_len = htons(first_len - + sizeof(struct ipv6hdr)); +@@ -1387,6 +1389,10 @@ + tmp_skb->sk = NULL; + } + ++ /* Allow local fragmentation. */ ++ if (np->pmtudisc < IPV6_PMTUDISC_DO) ++ skb->local_df = 1; ++ + ipv6_addr_copy(final_dst, &fl->fl6_dst); + __skb_pull(skb, skb_network_header_len(skb)); + if (opt && opt->opt_flen) +diff -Nurd linux-2.6.24/net/ipv6/ip6_tunnel.c linux-2.6.24-oxe810/net/ipv6/ip6_tunnel.c +--- linux-2.6.24/net/ipv6/ip6_tunnel.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv6/ip6_tunnel.c 2008-06-11 17:46:11.000000000 +0200 +@@ -550,6 +550,7 @@ + ip_rt_put(rt); + goto out; + } ++ skb2->dst = (struct dst_entry *)rt; + } else { + ip_rt_put(rt); + if (ip_route_input(skb2, eiph->daddr, eiph->saddr, eiph->tos, +diff -Nurd linux-2.6.24/net/ipv6/ipcomp6.c linux-2.6.24-oxe810/net/ipv6/ipcomp6.c +--- linux-2.6.24/net/ipv6/ipcomp6.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv6/ipcomp6.c 2008-06-11 17:46:11.000000000 +0200 +@@ -64,6 +64,7 @@ + + static int ipcomp6_input(struct xfrm_state *x, struct sk_buff *skb) + { ++ int nexthdr; + int err = -ENOMEM; + struct ip_comp_hdr *ipch; + int plen, dlen; +@@ -79,6 +80,8 @@ + + /* Remove ipcomp header and decompress original payload */ + ipch = (void *)skb->data; ++ nexthdr = ipch->nexthdr; ++ + skb->transport_header = skb->network_header + sizeof(*ipch); + __skb_pull(skb, sizeof(*ipch)); + +@@ -108,7 +111,7 @@ + skb->truesize += dlen - plen; + __skb_put(skb, dlen - plen); + skb_copy_to_linear_data(skb, scratch, dlen); +- err = ipch->nexthdr; ++ err = nexthdr; + + out_put_cpu: + put_cpu(); +@@ -143,7 +146,9 @@ + scratch = *per_cpu_ptr(ipcomp6_scratches, cpu); + tfm = *per_cpu_ptr(ipcd->tfms, cpu); + ++ local_bh_disable(); + err = crypto_comp_compress(tfm, start, plen, scratch, &dlen); ++ local_bh_enable(); + if (err || (dlen + sizeof(*ipch)) >= plen) { + put_cpu(); + goto out_ok; +diff -Nurd linux-2.6.24/net/ipv6/netfilter/ip6_queue.c linux-2.6.24-oxe810/net/ipv6/netfilter/ip6_queue.c +--- linux-2.6.24/net/ipv6/netfilter/ip6_queue.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv6/netfilter/ip6_queue.c 2008-06-11 17:46:10.000000000 +0200 +@@ -333,8 +333,8 @@ + ipq_mangle_ipv6(ipq_verdict_msg_t *v, struct ipq_queue_entry *e) + { + int diff; +- int err; + struct ipv6hdr *user_iph = (struct ipv6hdr *)v->payload; ++ struct sk_buff *nskb; + + if (v->data_len < sizeof(*user_iph)) + return 0; +@@ -346,14 +346,16 @@ + if (v->data_len > 0xFFFF) + return -EINVAL; + if (diff > skb_tailroom(e->skb)) { +- err = pskb_expand_head(e->skb, 0, ++ nskb = skb_copy_expand(e->skb, 0, + diff - skb_tailroom(e->skb), + GFP_ATOMIC); +- if (err) { ++ if (!nskb) { + printk(KERN_WARNING "ip6_queue: OOM " + "in mangle, dropping packet\n"); +- return err; ++ return -ENOMEM; + } ++ kfree_skb(e->skb); ++ e->skb = nskb; + } + skb_put(e->skb, diff); + } +diff -Nurd linux-2.6.24/net/ipv6/xfrm6_output.c linux-2.6.24-oxe810/net/ipv6/xfrm6_output.c +--- linux-2.6.24/net/ipv6/xfrm6_output.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/ipv6/xfrm6_output.c 2008-06-11 17:46:11.000000000 +0200 +@@ -34,7 +34,7 @@ + if (mtu < IPV6_MIN_MTU) + mtu = IPV6_MIN_MTU; + +- if (skb->len > mtu) { ++ if (!skb->local_df && skb->len > mtu) { + skb->dev = dst->dev; + icmpv6_send(skb, ICMPV6_PKT_TOOBIG, 0, mtu, skb->dev); + ret = -EMSGSIZE; +diff -Nurd linux-2.6.24/net/netfilter/nf_conntrack_proto_tcp.c linux-2.6.24-oxe810/net/netfilter/nf_conntrack_proto_tcp.c +--- linux-2.6.24/net/netfilter/nf_conntrack_proto_tcp.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/netfilter/nf_conntrack_proto_tcp.c 2008-06-11 17:46:00.000000000 +0200 +@@ -135,7 +135,7 @@ + * CLOSE_WAIT: ACK seen (after FIN) + * LAST_ACK: FIN seen (after FIN) + * TIME_WAIT: last ACK seen +- * CLOSE: closed connection ++ * CLOSE: closed connection (RST) + * + * LISTEN state is not used. + * +@@ -834,8 +834,21 @@ + case TCP_CONNTRACK_SYN_SENT: + if (old_state < TCP_CONNTRACK_TIME_WAIT) + break; +- if ((conntrack->proto.tcp.seen[!dir].flags & +- IP_CT_TCP_FLAG_CLOSE_INIT) ++ /* RFC 1122: "When a connection is closed actively, ++ * it MUST linger in TIME-WAIT state for a time 2xMSL ++ * (Maximum Segment Lifetime). However, it MAY accept ++ * a new SYN from the remote TCP to reopen the connection ++ * directly from TIME-WAIT state, if..." ++ * We ignore the conditions because we are in the ++ * TIME-WAIT state anyway. ++ * ++ * Handle aborted connections: we and the server ++ * think there is an existing connection but the client ++ * aborts it and starts a new one. ++ */ ++ if (((conntrack->proto.tcp.seen[dir].flags ++ | conntrack->proto.tcp.seen[!dir].flags) ++ & IP_CT_TCP_FLAG_CLOSE_INIT) + || (conntrack->proto.tcp.last_dir == dir + && conntrack->proto.tcp.last_index == TCP_RST_SET)) { + /* Attempt to reopen a closed/aborted connection. +@@ -848,18 +861,25 @@ + } + /* Fall through */ + case TCP_CONNTRACK_IGNORE: +- /* Ignored packets: ++ /* Ignored packets: ++ * ++ * Our connection entry may be out of sync, so ignore ++ * packets which may signal the real connection between ++ * the client and the server. + * + * a) SYN in ORIGINAL + * b) SYN/ACK in REPLY + * c) ACK in reply direction after initial SYN in original. ++ * ++ * If the ignored packet is invalid, the receiver will send ++ * a RST we'll catch below. + */ + if (index == TCP_SYNACK_SET + && conntrack->proto.tcp.last_index == TCP_SYN_SET + && conntrack->proto.tcp.last_dir != dir + && ntohl(th->ack_seq) == + conntrack->proto.tcp.last_end) { +- /* This SYN/ACK acknowledges a SYN that we earlier ++ /* b) This SYN/ACK acknowledges a SYN that we earlier + * ignored as invalid. This means that the client and + * the server are both in sync, while the firewall is + * not. We kill this session and block the SYN/ACK so +@@ -884,7 +904,7 @@ + write_unlock_bh(&tcp_lock); + if (LOG_INVALID(IPPROTO_TCP)) + nf_log_packet(pf, 0, skb, NULL, NULL, NULL, +- "nf_ct_tcp: invalid packed ignored "); ++ "nf_ct_tcp: invalid packet ignored "); + return NF_ACCEPT; + case TCP_CONNTRACK_MAX: + /* Invalid packet */ +@@ -938,8 +958,7 @@ + + conntrack->proto.tcp.state = new_state; + if (old_state != new_state +- && (new_state == TCP_CONNTRACK_FIN_WAIT +- || new_state == TCP_CONNTRACK_CLOSE)) ++ && new_state == TCP_CONNTRACK_FIN_WAIT) + conntrack->proto.tcp.seen[dir].flags |= IP_CT_TCP_FLAG_CLOSE_INIT; + timeout = conntrack->proto.tcp.retrans >= nf_ct_tcp_max_retrans + && *tcp_timeouts[new_state] > nf_ct_tcp_timeout_max_retrans +diff -Nurd linux-2.6.24/net/netfilter/nfnetlink_log.c linux-2.6.24-oxe810/net/netfilter/nfnetlink_log.c +--- linux-2.6.24/net/netfilter/nfnetlink_log.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/netfilter/nfnetlink_log.c 2008-06-11 17:46:00.000000000 +0200 +@@ -594,7 +594,7 @@ + /* FIXME: do we want to make the size calculation conditional based on + * what is actually present? way more branches and checks, but more + * memory efficient... */ +- size = NLMSG_ALIGN(sizeof(struct nfgenmsg)) ++ size = NLMSG_SPACE(sizeof(struct nfgenmsg)) + + nla_total_size(sizeof(struct nfulnl_msg_packet_hdr)) + + nla_total_size(sizeof(u_int32_t)) /* ifindex */ + + nla_total_size(sizeof(u_int32_t)) /* ifindex */ +diff -Nurd linux-2.6.24/net/netfilter/nfnetlink_queue.c linux-2.6.24-oxe810/net/netfilter/nfnetlink_queue.c +--- linux-2.6.24/net/netfilter/nfnetlink_queue.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/netfilter/nfnetlink_queue.c 2008-06-11 17:46:00.000000000 +0200 +@@ -353,7 +353,7 @@ + + QDEBUG("entered\n"); + +- size = NLMSG_ALIGN(sizeof(struct nfgenmsg)) ++ size = NLMSG_SPACE(sizeof(struct nfgenmsg)) + + nla_total_size(sizeof(struct nfqnl_msg_packet_hdr)) + + nla_total_size(sizeof(u_int32_t)) /* ifindex */ + + nla_total_size(sizeof(u_int32_t)) /* ifindex */ +@@ -616,8 +616,8 @@ + static int + nfqnl_mangle(void *data, int data_len, struct nfqnl_queue_entry *e) + { ++ struct sk_buff *nskb; + int diff; +- int err; + + diff = data_len - e->skb->len; + if (diff < 0) { +@@ -627,14 +627,16 @@ + if (data_len > 0xFFFF) + return -EINVAL; + if (diff > skb_tailroom(e->skb)) { +- err = pskb_expand_head(e->skb, 0, ++ nskb = skb_copy_expand(e->skb, 0, + diff - skb_tailroom(e->skb), + GFP_ATOMIC); +- if (err) { ++ if (!nskb) { + printk(KERN_WARNING "nf_queue: OOM " + "in mangle, dropping packet\n"); +- return err; ++ return -ENOMEM; + } ++ kfree_skb(e->skb); ++ e->skb = nskb; + } + skb_put(e->skb, diff); + } +diff -Nurd linux-2.6.24/net/netfilter/xt_time.c linux-2.6.24-oxe810/net/netfilter/xt_time.c +--- linux-2.6.24/net/netfilter/xt_time.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/netfilter/xt_time.c 2008-06-11 17:46:00.000000000 +0200 +@@ -95,8 +95,11 @@ + */ + r->dse = time / 86400; + +- /* 1970-01-01 (w=0) was a Thursday (4). */ +- r->weekday = (4 + r->dse) % 7; ++ /* ++ * 1970-01-01 (w=0) was a Thursday (4). ++ * -1 and +1 map Sunday properly onto 7. ++ */ ++ r->weekday = (4 + r->dse - 1) % 7 + 1; + } + + static void localtime_3(struct xtm *r, time_t time) +diff -Nurd linux-2.6.24/net/sched/em_meta.c linux-2.6.24-oxe810/net/sched/em_meta.c +--- linux-2.6.24/net/sched/em_meta.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/sched/em_meta.c 2008-06-11 17:45:56.000000000 +0200 +@@ -719,11 +719,13 @@ + + static inline void meta_delete(struct meta_match *meta) + { +- struct meta_type_ops *ops = meta_type_ops(&meta->lvalue); ++ if (meta) { ++ struct meta_type_ops *ops = meta_type_ops(&meta->lvalue); + +- if (ops && ops->destroy) { +- ops->destroy(&meta->lvalue); +- ops->destroy(&meta->rvalue); ++ if (ops && ops->destroy) { ++ ops->destroy(&meta->lvalue); ++ ops->destroy(&meta->rvalue); ++ } + } + + kfree(meta); +diff -Nurd linux-2.6.24/net/sched/ematch.c linux-2.6.24-oxe810/net/sched/ematch.c +--- linux-2.6.24/net/sched/ematch.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/sched/ematch.c 2008-06-11 17:45:56.000000000 +0200 +@@ -305,10 +305,9 @@ + struct tcf_ematch_tree_hdr *tree_hdr; + struct tcf_ematch *em; + +- if (!rta) { +- memset(tree, 0, sizeof(*tree)); ++ memset(tree, 0, sizeof(*tree)); ++ if (!rta) + return 0; +- } + + if (rtattr_parse_nested(tb, TCA_EMATCH_TREE_MAX, rta) < 0) + goto errout; +diff -Nurd linux-2.6.24/net/socket.c linux-2.6.24-oxe810/net/socket.c +--- linux-2.6.24/net/socket.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/net/socket.c 2008-06-11 17:46:19.000000000 +0200 +@@ -113,6 +113,9 @@ + static ssize_t sock_sendpage(struct file *file, struct page *page, + int offset, size_t size, loff_t *ppos, int more); + ++static ssize_t sock_sendpages(struct file *file, struct page **page, ++ int offset, size_t size, loff_t *ppos, int more); ++ + /* + * Socket files have a set of 'special' operations as well as the generic file ones. These don't appear + * in the operation structures but are done directly via the socketcall() multiplexor. +@@ -133,6 +136,7 @@ + .release = sock_close, + .fasync = sock_fasync, + .sendpage = sock_sendpage, ++ .sendpages = sock_sendpages, + .splice_write = generic_splice_sendpage, + }; + +@@ -691,6 +695,21 @@ + return sock->ops->sendpage(sock, page, offset, size, flags); + } + ++static ssize_t sock_sendpages(struct file *file, struct page **page, ++ int offset, size_t size, loff_t *ppos, int more) ++{ ++ struct socket *sock; ++ int flags; ++ ++ sock = file->private_data; ++ ++ flags = !(file->f_flags & O_NONBLOCK) ? 0 : MSG_DONTWAIT; ++ if (more) ++ flags |= MSG_MORE; ++ ++ return sock->ops->sendpages(sock, page, offset, size, flags); ++} ++ + static struct sock_iocb *alloc_sock_iocb(struct kiocb *iocb, + struct sock_iocb *siocb) + { +diff -Nurd linux-2.6.24/scripts/mod/file2alias.c linux-2.6.24-oxe810/scripts/mod/file2alias.c +--- linux-2.6.24/scripts/mod/file2alias.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/scripts/mod/file2alias.c 2008-06-11 17:46:20.000000000 +0200 +@@ -155,7 +155,7 @@ + * Some modules (visor) have empty slots as placeholder for + * run-time specification that results in catch-all alias + */ +- if (!(id->idVendor | id->bDeviceClass | id->bInterfaceClass)) ++ if (!(id->idVendor | id->idProduct | id->bDeviceClass | id->bInterfaceClass)) + return; + + /* Convert numeric bcdDevice range into fnmatch-able pattern(s) */ +diff -Nurd linux-2.6.24/security/Kconfig linux-2.6.24-oxe810/security/Kconfig +--- linux-2.6.24/security/Kconfig 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/security/Kconfig 2008-06-11 17:46:44.000000000 +0200 +@@ -103,6 +103,32 @@ + + If you are unsure how to answer this question, answer N. + ++config SECURITY_TRUSTEES ++ bool "Linux Trustees ACLs" ++ depends on SECURITY ++ help ++ Implements a system similar to Netware ACLs. Trustees ++ allows a global configuration of recursive ACLs via a ++ centralized file. ACLs can be added to an entire ++ directory tree and masked out on subdirectories. ++ ++ Trustees allows complex permissions to be enforced ++ system-wide without needing to touch every file or ++ maintain thousands of ugly POSIX ACLs. See ++ http://trustees.sourceforge.net for more information on ++ trustees and the associated user-space tools. ++ ++ If you are unsure how to answer this question, answer N. ++ ++config SECURITY_TRUSTEES_DEBUG ++ bool "Enable debugging code and messages" ++ depends on SECURITY_TRUSTEES ++ help ++ Turns on certain diagnostic messages and debugging code ++ in trustees. ++ ++ If you are unsure how to answer this question, answer N. ++ + source security/selinux/Kconfig + + endmenu +diff -Nurd linux-2.6.24/security/Makefile linux-2.6.24-oxe810/security/Makefile +--- linux-2.6.24/security/Makefile 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/security/Makefile 2008-06-11 17:46:44.000000000 +0200 +@@ -12,6 +12,7 @@ + + # Object file lists + obj-$(CONFIG_SECURITY) += security.o dummy.o inode.o ++obj-$(CONFIG_SECURITY_TRUSTEES) += trustees/ + # Must precede capability.o in order to stack properly. + obj-$(CONFIG_SECURITY_SELINUX) += selinux/built-in.o + obj-$(CONFIG_SECURITY_CAPABILITIES) += commoncap.o capability.o +diff -Nurd linux-2.6.24/security/commoncap.c linux-2.6.24-oxe810/security/commoncap.c +--- linux-2.6.24/security/commoncap.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/security/commoncap.c 2008-06-11 17:46:44.000000000 +0200 +@@ -539,7 +539,7 @@ + * allowed. + * We must preserve legacy signal behavior in this case. + */ +- if (p->euid == 0 && p->uid == current->uid) ++ if (p->uid == current->uid) + return 0; + + /* sigcont is permitted within same session */ +diff -Nurd linux-2.6.24/security/selinux/ss/services.c linux-2.6.24-oxe810/security/selinux/ss/services.c +--- linux-2.6.24/security/selinux/ss/services.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/security/selinux/ss/services.c 2008-06-11 17:46:43.000000000 +0200 +@@ -1744,6 +1744,9 @@ + struct ocontext *c; + int rc = 0, cmp = 0; + ++ while (path[0] == '/' && path[1] == '/') ++ path++; ++ + POLICY_RDLOCK; + + for (genfs = policydb.genfs; genfs; genfs = genfs->next) { +@@ -2626,7 +2629,6 @@ + + netlbl_sid_to_secattr_failure: + POLICY_RDUNLOCK; +- netlbl_secattr_destroy(secattr); + return rc; + } + #endif /* CONFIG_NETLABEL */ +diff -Nurd linux-2.6.24/security/trustees/Makefile linux-2.6.24-oxe810/security/trustees/Makefile +--- linux-2.6.24/security/trustees/Makefile 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/Makefile 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,8 @@ ++ifeq ($(CONFIG_SECURITY_TRUSTEES_DEBUG),y) ++ EXTRA_CFLAGS += -DTRUSTEES_DEBUG ++endif ++ ++obj-$(CONFIG_SECURITY_TRUSTEES) := trustees.o ++trustees-objs := \ ++ security.o fs.o \ ++ init.o funcs.o ../commoncap.o +diff -Nurd linux-2.6.24/security/trustees/fs.c linux-2.6.24-oxe810/security/trustees/fs.c +--- linux-2.6.24/security/trustees/fs.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/fs.c 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,273 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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 code handles the virtual filesystem for trustees. ++ * ++ */ ++ ++#include <linux/init.h> ++#include <linux/module.h> ++#include <linux/fs.h> ++#include <linux/vmalloc.h> ++#include <linux/security.h> ++#include <asm/atomic.h> ++#include <asm/uaccess.h> ++ ++#include "internal.h" ++ ++ ++/* initialization code for the trustees filesystem */ ++ ++/* File operations ++ * ++ * this is all the code for handling the file operations done on the few files ++ * in the trustees filesystem ++ */ ++static int trustees_open(struct inode *inode, struct file *filp); ++static ssize_t trustees_read_bogus(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset); ++static ssize_t trustees_write_bogus(struct file *filp, ++ const char __user * buf, size_t count, ++ loff_t * offset); ++static ssize_t trustees_read_status(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset); ++static ssize_t trustees_read_apiversion(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset); ++static ssize_t trustees_write_trustees(struct file *filp, ++ const char __user * buf, ++ size_t count, loff_t * offset); ++static int trustees_open_trustees(struct inode *inode, struct file *file); ++static int trustees_release_trustees(struct inode *inode, struct file *file); ++ ++/* Various structs ++ */ ++ ++static struct file_operations trustees_ops_apiversion = { ++ .open = trustees_open, ++ .read = trustees_read_apiversion, ++ .write = trustees_write_bogus, ++}; ++ ++static struct file_operations trustees_ops_status = { ++ .open = trustees_open, ++ .read = trustees_read_status, ++ .write = trustees_write_bogus ++}; ++ ++static struct file_operations trustees_ops_trustees = { ++ .open = trustees_open_trustees, ++ .read = trustees_read_bogus, ++ .write = trustees_write_trustees, ++ .release = trustees_release_trustees ++}; ++ ++static struct trustees_file_info { ++ const char *name; ++ struct file_operations *fops; ++ int mode; ++ struct dentry *dentry; ++} trustees_files[] = { ++ {.name = "device", ++ .fops = &trustees_ops_trustees, ++ .mode = S_IWUSR, ++ .dentry = 0 ++ }, ++ {.name = "status", ++ .fops = &trustees_ops_status, ++ .mode = S_IRUSR, ++ .dentry = 0 ++ }, ++ {.name = "apiversion", ++ .fops = &trustees_ops_apiversion, ++ .mode = S_IRUSR | S_IRGRP | S_IROTH, ++ .dentry = 0 ++ }, ++ {"", NULL, 0, 0} ++}; ++ ++struct trustee_command_reader { ++ struct trustee_command command; ++ unsigned curarg; ++ void *arg[TRUSTEE_MAX_ARGS]; ++ size_t argsize[TRUSTEE_MAX_ARGS]; ++}; ++ ++ ++static struct dentry *toplevel = NULL; ++ ++int trustees_init_fs(void) ++{ ++ struct trustees_file_info *iter; ++ toplevel = securityfs_create_dir("trustees", NULL); ++ if (!toplevel) trustees_deinit_fs(); ++ for (iter = trustees_files; iter->fops && toplevel; iter++) { ++ iter->dentry = securityfs_create_file( ++ iter->name, iter->mode, toplevel, NULL, iter->fops); ++ if (!iter->dentry) trustees_deinit_fs(); ++ } ++ return !toplevel; ++} ++ ++void trustees_deinit_fs(void) ++{ ++ struct trustees_file_info *iter; ++ for (iter = trustees_files; iter->fops; iter++) { ++ securityfs_remove(iter->dentry); ++ iter->dentry = NULL; ++ } ++ securityfs_remove(toplevel); ++ toplevel = NULL; ++} ++ ++/* ++ * They're opening the file... ++ */ ++ ++static int trustees_open(struct inode *inode, struct file *filp) ++{ ++ return 0; ++} ++ ++static int trustees_open_trustees(struct inode *inode, struct file *file) ++{ ++ file->private_data = vmalloc(sizeof(struct trustee_command_reader)); ++ if (!file->private_data) ++ return -ENOMEM; ++ ++ memset(file->private_data, 0, sizeof(struct trustee_command_reader)); ++ ++ return 0; ++} ++ ++static int trustees_release_trustees(struct inode *inode, struct file *file) ++{ ++ vfree(file->private_data); ++ return 0; ++} ++ ++/* Do a read on a bogus file. Just return nothing :) */ ++static ssize_t trustees_read_bogus(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset) ++{ ++ return 0; ++} ++ ++/* Similar way to handle writes. Just say we wrote the data and return */ ++static ssize_t trustees_write_bogus(struct file *filp, ++ const char __user * buf, size_t count, ++ loff_t * offset) ++{ ++ return count; ++} ++ ++/* Function for handling reading of the status. */ ++static ssize_t trustees_read_status(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset) ++{ ++ static const char msg[] = "Damnit, it works, OK?!\n"; ++ unsigned long nocopy; ++ ++ if (*offset >= (sizeof(msg) - 1)) { ++ return 0; ++ } ++ ++ if (count > (sizeof(msg) - 1 - *offset)) { ++ count = sizeof(msg) - 1 - *offset; ++ } ++ nocopy = copy_to_user(buf, msg, count); ++ (*offset) += count; ++ (*offset) -= nocopy; ++ ++ return count; ++} ++ ++/* Function for handling reading of the apiversion. */ ++static ssize_t trustees_read_apiversion(struct file *filp, char __user * buf, ++ size_t count, loff_t * offset) ++{ ++ static const char msg[] = TRUSTEES_APIVERSION_STR "\n"; ++ unsigned long nocopy; ++ ++ if (*offset >= (sizeof(msg) - 1)) { ++ return 0; ++ } ++ ++ if (count > (sizeof(msg) - 1 - *offset)) { ++ count = sizeof(msg) - 1 - *offset; ++ } ++ nocopy = copy_to_user(buf, msg, count); ++ (*offset) += count; ++ (*offset) -= nocopy; ++ ++ return count; ++} ++ ++/* Cleanup our reader (deallocate all the allocated memory) */ ++static void cleanup_reader(struct trustee_command_reader *reader) { ++ int z; ++ if (!reader) { ++ TS_ERR_MSG("How does reader disappear on us?\n"); ++ return; ++ } ++ ++ for (z = reader->curarg - 1; z >= 0; z--) { ++ vfree(reader->arg[z]); ++ reader->argsize[z] = 0; ++ } ++ reader->command.command = 0; ++ reader->curarg = 0; ++} ++ ++static ssize_t trustees_write_trustees(struct file *filp, ++ const char __user * buf, ++ size_t count, loff_t * offset) ++{ ++ struct trustee_command_reader *reader = filp->private_data; ++ ++ if (reader->command.command == 0) { ++ reader->curarg = 0; ++ if (count != sizeof(struct trustee_command)) { ++ return -EIO; ++ } ++ if (copy_from_user(&reader->command, buf, count)) { ++ reader->command.command = 0; ++ TS_ERR_MSG("copy_from_user failed on command\n"); ++ return -EIO; ++ } ++ if (reader->command.numargs > TRUSTEE_MAX_ARGS) { ++ TS_ERR_MSG("Too many arguments specified for command %d\n", ++ reader->command.command); ++ return -EIO; ++ } ++ } else { ++ unsigned curarg = reader->curarg; ++ if (!(reader->arg[curarg] = vmalloc(count+1))) { ++ cleanup_reader(reader); ++ return -EIO; ++ } ++ reader->argsize[curarg] = count; ++ ((char *)reader->arg[curarg])[count] = '\0'; ++ reader->curarg++; ++ if (copy_from_user(reader->arg[curarg], buf, count)) { ++ cleanup_reader(reader); ++ TS_ERR_MSG("copy_from_user failed on arg\n"); ++ return -EIO; ++ } ++ } ++ ++ if (reader->command.command && reader->curarg == reader->command.numargs) { ++ int ret = trustees_process_command(reader->command, reader->arg, ++ reader->argsize); ++ cleanup_reader(reader); ++ if (ret) return -EIO; ++ } ++ ++ return count; ++} +diff -Nurd linux-2.6.24/security/trustees/funcs.c linux-2.6.24-oxe810/security/trustees/funcs.c +--- linux-2.6.24/security/trustees/funcs.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/funcs.c 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,810 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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 code contains the functions for handling the actual trustees data ++ * and returning the permissions for a given file, etc. ++ * ++ * ++ */ ++ ++#include <linux/fs.h> ++#include <linux/mount.h> ++#include <linux/dcache.h> ++#include <linux/string.h> ++#include <linux/mm.h> ++#include <linux/slab.h> ++#include <linux/smp_lock.h> ++#include <linux/poll.h> ++#include <linux/sched.h> ++#include <linux/limits.h> ++#include <linux/list.h> ++#include <linux/vmalloc.h> ++#include <linux/ctype.h> ++ ++#include "internal.h" ++ ++/* ++ * This is a hash of all the trustee_names currently added. These values ++ * are hashed on a combination of device/filename. Before reading/writing ++ * be sure to take care of the locking of trustee_hash_lock. ++ */ ++rwlock_t trustee_hash_lock; ++static struct hlist_head *trustee_hash = NULL; ++ ++/* ++ * This is the deepest level trustee. When calculating filenames, we can ++ * skip several of the levels in many case since we know it won't be any ++ * deeper than this. ++ * ++ * Kept up to date by calculate_deepest_level ++ * ++ * / => 0 ++ * /test => 1 ++ * /test/blah => 2 ++ */ ++static int deepest_level = 0; ++ ++/* ++ * A list of filesystems that need to have their case ++ * ignored. This is protected by trustee_hash_lock. ++ */ ++static LIST_HEAD(trustee_ic_list); ++ ++ ++/* The calling method needs to free the buffer created by this function ++ * This method returns the filename for a dentry. This is, of course, ++ * relative to the device. The filename can be truncated to be as deep as ++ * the deepest trustee. The depth returned in d will always be the true ++ * depth, however. ++ * ++ * Args: ++ * dentry: The dentry we are interested in. ++ * d: a pointer to the place where the depth can be stored. ++ * trunc: ok to truncate the name to the longest that needs to be figured out. ++ */ ++ ++#define FN_CHUNK_SIZE 64 ++char *trustees_filename_for_dentry(struct dentry *dentry, int *d, int trunc) ++{ ++ char *buffer = NULL, *tmpbuf = NULL; ++ int bufsize = FN_CHUNK_SIZE; ++ char c; ++ int i, j, k; ++ int depth = 0; ++ struct dentry *temp_dentry; ++ ++ if (dentry->d_parent == NULL) { ++ TS_ERR_MSG("d_parent is null\n"); ++ return NULL; ++ } ++ ++ if (dentry->d_name.name == NULL) { ++ TS_ERR_MSG("name is null\n"); ++ return NULL; ++ } ++ ++ buffer = kmalloc(FN_CHUNK_SIZE, GFP_KERNEL); ++ if (!buffer) { ++ TS_ERR_MSG("could not allocate filename buffer\n"); ++ return NULL; ++ } ++ ++ buffer[0] = '/'; ++ buffer[i = 1] = '\0'; ++ for (temp_dentry = dentry; !IS_ROOT(temp_dentry); temp_dentry = temp_dentry->d_parent) ++ depth++; ++ if (d) *d = depth; ++ if (deepest_level <= 0) return buffer; ++ ++ for (;;) { ++ if (IS_ROOT(dentry)) ++ break; ++ if (depth-- > deepest_level) continue; ++ ++ j = i + strlen(dentry->d_name.name); ++ if ((j + 2) > bufsize) { /* reallocate - won't fit */ ++ bufsize = (((j + 2) / FN_CHUNK_SIZE) + 1) * FN_CHUNK_SIZE; ++ tmpbuf = kmalloc(bufsize, GFP_KERNEL); ++ if (!tmpbuf) { ++ kfree(buffer); ++ TS_ERR_MSG ++ ("Out of memory allocating tmpbuf\n"); ++ return NULL; ++ } ++ memcpy(tmpbuf, buffer, i); ++ kfree(buffer); ++ buffer = tmpbuf; ++ } ++ /* Throw the name in there backward */ ++ for (k = 0; dentry->d_name.name[k]; k++) { ++ buffer[j - 1 - k] = dentry->d_name.name[k]; ++ } ++ i = j; ++ buffer[i++] = '/'; ++ dentry = dentry->d_parent; ++ } ++ buffer[i] = 0; ++ ++ /* buffer is backwards, reverse it */ ++ for (j = 0; j < (i / 2); ++j) { ++ c = buffer[j]; ++ buffer[j] = buffer[i - j - 1]; ++ buffer[i - j - 1] = c; ++ } ++ ++ return buffer; ++} ++ ++/** ++ * Allocate memory using vmalloc and return a duplicate of the passed in string. ++ * Returns NULL if a problem occurs ++ */ ++static char *vmalloc_strdup(const char *str, size_t len) ++{ ++ char *r; ++ ++ if (!str) return NULL; ++ len = strlen(str); ++ r = vmalloc(len + 1); ++ if (!r) return NULL; ++ memcpy(r, str, len + 1); ++ ++ return r; ++} ++ ++/* ++ * Add a filesystem as a ignored-case dev. ++ */ ++static inline void add_ic_dev(u32 dev, char *devname) ++{ ++ char *devname2; ++ struct trustee_ic *ic; ++ size_t dev_len; ++ ++ dev_len = strlen(devname); ++ ++ if (dev_len > PATH_MAX) { ++ TS_ERR_MSG("devname bad, add_ic_dev ignored.\n"); ++ return; ++ } ++ ++ if (!dev_len) { ++ TS_ERR_MSG("No devname specified in add_ic_dev.\n"); ++ return; ++ } ++ ++ devname2 = vmalloc_strdup(devname, dev_len); ++ if (!devname2) { ++ TS_ERR_MSG ++ ("Seems that we have ran out of memory adding ic dev!\n"); ++ return; ++ } ++ ++ ic = vmalloc(sizeof(struct trustee_ic)); ++ if (!ic) { ++ TS_ERR_MSG ++ ("Seems that we ran out of memory allocating ic!\n"); ++ return; ++ } ++ ++ ic->dev = new_decode_dev(dev); ++ ic->devname = devname2; ++ ++ write_lock(&trustee_hash_lock); ++ list_add(&ic->ic_list, &trustee_ic_list); ++ write_unlock(&trustee_hash_lock); ++} ++ ++/* ++ * Remove all ignored-case filesystems. ++ */ ++static inline void remove_ic_devs(void) ++{ ++ struct trustee_ic *ic, *temp_ic; ++ struct list_head temp_ic_list; ++ ++ INIT_LIST_HEAD(&temp_ic_list); ++ list_splice_init(&trustee_ic_list, &temp_ic_list); ++ ++ list_for_each_entry_safe(ic, temp_ic, &temp_ic_list, ic_list) { ++ vfree(ic->devname); ++ vfree(ic); ++ } ++} ++ ++/* ++ * This frees all the capsules in a trustee element. ++ */ ++static inline void free_hash_element_list(struct trustee_hash_element *e) ++{ ++ struct trustee_permission_capsule *capsule, *temp; ++ ++ list_for_each_entry_safe(capsule, temp, &e->perm_list, perm_list) { ++ list_del(&capsule->perm_list); ++ vfree(capsule); ++ } ++} ++ ++/* ++ * Free a trustee name. This frees the devname and the filename ++ */ ++static inline void free_trustee_name(struct trustee_name *name) ++{ ++ vfree(name->filename); ++ vfree(name->devname); ++} ++ ++/* ++ * Frees the capsules, and the filenames for a trustee hash element. ++ * Also marks it as unused in the hash. ++ */ ++static inline void free_hash_element(struct trustee_hash_element *e) ++{ ++ free_hash_element_list(e); ++ free_trustee_name(&e->name); ++ vfree(e); ++} ++ ++/** ++ * Copies from src to dest (duplicating the strings in the ++ * trustee_name structure. Returns zero for unsuccesful. ++ */ ++static int copy_trustee_name(struct trustee_name *dst, struct trustee_name *src) ++{ ++ *dst = *src; ++ if (dst->filename) { ++ dst->filename = vmalloc_strdup(src->filename, strlen(src->filename)); ++ if (!dst->filename) { ++ TS_ERR_MSG("Ran out of memory duplicating src->filename\n"); ++ return 0; ++ } ++ } ++ ++ if (dst->devname) { ++ dst->devname = vmalloc_strdup(src->devname, strlen(src->devname)); ++ if (!dst->devname) { ++ TS_ERR_MSG("Ran out of memory duplicating src->devname\n"); ++ vfree(dst->filename); ++ return 0; ++ } ++ } ++ ++ return 1; ++} ++ ++ ++/* ++ * hashing function researched by Karl Nelson <kenelson @ ece ucdavis edu> ++ * and is used in glib. ++ */ ++static inline unsigned int hash_string(const char *s) ++{ ++ unsigned int v = 0; ++ ++ while (*s) { ++ v = (v << 5) - v + tolower(*s); ++ s++; ++ } ++ ++ return v; ++} ++ ++/* ++ * Return the hash for a device. ++ */ ++static inline unsigned int hash_device(const char *name, dev_t device) ++{ ++ if (MAJOR(device) == 0) { ++ return hash_string(name); ++ } ++ ++ return new_encode_dev(device); ++} ++ ++/* ++ * Return the hash for a file. This is a combination of the ++ * hash of the filename and the hash for the device. ++ */ ++static inline unsigned int hash(const struct trustee_name *name) ++{ ++ return hash_string(name->filename) ^ ++ hash_device(name->devname, name->dev); ++} ++ ++/* ++ * Return the slot in the trustees_hash where a trustee is located ++ */ ++static inline unsigned int hash_slot(const struct trustee_name *name) ++{ ++ return hash(name) % trustee_hash_size; ++} ++ ++/* ++ * Compare two devices. Return 1 if they are equal otherwise return 0 ++ */ ++static inline int trustee_dev_cmp(dev_t dev1, dev_t dev2, char *devname1, ++ char *devname2) ++{ ++ if ((MAJOR(dev1) == 0) && (MAJOR(dev2) == 0)) ++ return (strcmp(devname1, devname2) == 0); ++ else if ((MAJOR(dev1) != 0) && (MAJOR(dev2) != 0)) ++ return (dev1 == dev2); ++ return 0; ++} ++ ++/* ++ * Compare two trustee_name's. Returns 1 if they are are equal ++ * otherwise return 0 ++ */ ++static inline int trustee_name_cmp(const struct trustee_name *n1, ++ const struct trustee_name *n2, ++ unsigned ignore_case) ++{ ++ if (trustee_dev_cmp(n1->dev, n2->dev, n1->devname, n2->devname)) ++ return ignore_case ? ++ (strnicmp(n1->filename, n2->filename, PATH_MAX) == 0) : ++ (strcmp(n1->filename, n2->filename) == 0); ++ return 0; ++} ++ ++/* ++ * Calculate the deepest level. ++ */ ++static inline void calculate_deepest_level(const struct trustee_name *name) ++{ ++ char *fn = name->filename; ++ char *x; ++ int level = 0; ++ ++ for (x = fn; *x; ++x) { ++ if (*x == '/') ++ ++level; ++ } ++ ++ /* If it is the root, it should have ++ * a level of 0. ++ */ ++ if (x == (fn + 1)) level = 0; ++ ++ if (level > deepest_level) deepest_level = level; ++} ++ ++/* ++ * Return the trustee element for a name. ++ * This should be called with a lock on the trustee_hash (which should ++ * not be released until you are done with the returned hash_element)! ++ */ ++static struct trustee_hash_element *get_trustee_for_name(const struct trustee_name *name, ++ unsigned ignore_case) ++{ ++ struct trustee_hash_element *item = NULL; ++ struct hlist_node *iter = NULL; ++ ++ hlist_for_each_entry(item, iter, &trustee_hash[hash_slot(name)], hash_list) { ++ if (trustee_name_cmp(&item->name, name, ignore_case)) ++ return item; ++ } ++ ++ return NULL; ++} ++ ++/** ++ * Add a new blank trustee to the hash. ++ * ++ * If this returns zero, then the adding failed and name should be freed ++ * (assuming must_copy is 0), otherwise assume we used its memory. ++ */ ++static unsigned add_trustee(struct trustee_name *name, int must_copy) { ++ struct trustee_name newname; ++ struct trustee_name rootname; ++ unsigned is_root = 1; ++ unsigned r = 0; ++ struct trustee_hash_element *new; ++ struct trustee_hash_element *root; ++ ++ if (!name->filename || !name->filename[0]) goto err0; ++ ++ if (!copy_trustee_name(&rootname, name)) goto err0; ++ rootname.filename[1] = '\0'; ++ ++ if (strlen(name->filename) > 1 && strcmp(name->filename, "/")) { ++ add_trustee(&rootname, 1); ++ is_root = 0; ++ } ++ ++ if (must_copy) { ++ if (!copy_trustee_name(&newname, name)) goto err1; ++ } else { ++ newname = *name; ++ } ++ ++ new = vmalloc(sizeof(struct trustee_hash_element)); ++ if (!new) goto err2; ++ new->name = newname; ++ INIT_HLIST_NODE(&new->hash_list); ++ INIT_LIST_HEAD(&new->perm_list); ++ INIT_LIST_HEAD(&new->device_list); ++ ++ write_lock(&trustee_hash_lock); ++ if (get_trustee_for_name(&newname, 0)) goto err3; ++ ++ if (is_root) { ++ root = NULL; ++ } else if (!(root = get_trustee_for_name(&rootname, 0))) { ++ TS_ERR_MSG("Root trustee disappeared on us!\n"); ++ goto err3; ++ } ++ hlist_add_head(&new->hash_list, &trustee_hash[hash_slot(name)]); ++ if (!is_root) { ++ list_add_tail(&new->device_list, &root->device_list); ++ } ++ calculate_deepest_level(&newname); ++ TS_DEBUG_MSG("Created '%s' trustee\n", newname.filename); ++ r = 1; ++err3: ++ write_unlock(&trustee_hash_lock); ++ if (!r) vfree(new); ++err2: ++ if (must_copy && !r) free_trustee_name(&newname); ++err1: ++ free_trustee_name(&rootname); ++err0: ++ return r; ++} ++ ++/** ++ * Add a permissions module to the trustee specified by name. ++ */ ++static unsigned add_trustee_perm ++ (struct trustee_name *name, struct trustee_permission acl) ++{ ++ struct trustee_hash_element *r = NULL; ++ struct trustee_permission_capsule *capsule; ++ ++ capsule = vmalloc(sizeof(struct trustee_permission_capsule)); ++ if (!capsule) { ++ TS_ERR_MSG ++ ("Can not allocate memory for trustee capsule\n"); ++ return 0; ++ } ++ capsule->permission = acl; ++ ++ write_lock(&trustee_hash_lock); ++ r = get_trustee_for_name(name, 0); ++ ++ if (r) { ++ list_add_tail(&capsule->perm_list, &r->perm_list); ++ write_unlock(&trustee_hash_lock); ++ TS_DEBUG_MSG("Added permission capsule to '%s' trustee\n", name->filename); ++ return 1; ++ } ++ write_unlock(&trustee_hash_lock); ++ TS_ERR_MSG("trustee disappeared under us while trying to add perms\n"); ++ vfree(capsule); ++ ++ return 0; ++} ++ ++/* ++ * Get the mask for a trustee name. ++ * This should be called with a lock on the trustee_hash (which should ++ * not be released until you are done with the returned hash_element)! ++ */ ++static int get_trustee_mask_for_name(struct trustee_name *name, ++ int oldmask, int height, ++ struct trustee_hash_element **element, ++ unsigned ignore_case) ++{ ++ struct trustee_hash_element *e; ++ int m; ++ struct trustee_permission_capsule *l; ++ int appl; ++ e = get_trustee_for_name(name, ignore_case); ++ if (!e) { ++ return oldmask; ++ } ++ list_for_each_entry(l, &e->perm_list, perm_list) { ++ if ((height < 0) ++ && (l->permission.mask & TRUSTEE_ONE_LEVEL_MASK)) ++ continue; ++ if (element) { ++ *element = e; ++ element = NULL; ++ } ++ appl = ((!(l->permission.mask & TRUSTEE_IS_GROUP_MASK)) ++ && (current->fsuid == l->permission.u.uid)) ++ || (((l->permission.mask & TRUSTEE_IS_GROUP_MASK)) ++ && (in_group_p(l->permission.u.gid))) ++ || (l->permission.mask & TRUSTEE_ALL_MASK); ++ if (l->permission.mask & TRUSTEE_NOT_MASK) ++ appl = !appl; ++ ++ if (!appl) ++ continue; ++ ++ m = l->permission.mask & TRUSTEE_ACL_MASK; ++ ++ if (l->permission.mask & TRUSTEE_ALLOW_DENY_MASK) ++ m <<= TRUSTEE_NUM_ACL_BITS; ++ ++ oldmask = ++ l->permission. ++ mask & TRUSTEE_CLEAR_SET_MASK ? (oldmask & (~m)) ++ : (oldmask | m); ++ } ++ ++ return oldmask; ++} ++ ++/* ++ * Return non-zero if a trustee exists in a subpath. ++ * ++ * WARNING! ++ * This function requires that you lock/unlock the trustees_hash_lock ++ */ ++int trustee_has_child(struct vfsmount *mnt, char *file_name) ++{ ++ struct trustee_name trustee_name; ++ char tempchar; ++ unsigned ignore_case = 0; ++ struct trustee_hash_element *root; ++ size_t len; ++ struct trustee_ic *iter; ++ struct trustee_hash_element *r; ++ ++ if (!file_name || !*file_name) return 0; ++ ++ list_for_each_entry(iter, &trustee_ic_list, ic_list) { ++ if (trustee_dev_cmp ++ (iter->dev, trustee_name.dev, iter->devname, ++ trustee_name.devname)) { ++ ignore_case = 1; ++ break; ++ } ++ } ++ ++ trustee_name.dev = mnt->mnt_sb->s_dev; ++ trustee_name.devname = mnt->mnt_devname; ++ trustee_name.filename = file_name; ++ tempchar = file_name[1]; ++ file_name[1] = '\0'; ++ ++ root = get_trustee_for_name(&trustee_name, ignore_case); ++ if (!root) return 0; ++ ++ file_name[1] = tempchar; ++ ++ len = strlen(file_name); ++ ++ list_for_each_entry(r, &root->device_list, device_list) { ++ size_t this_len = strlen(r->name.filename); ++ if (this_len <= len) continue; ++ if (!strncmp(file_name, r->name.filename, len) && ++ r->name.filename[len] != '\0') ++ return 1; ++ } ++ ++ return 0; ++} ++ ++/* ++ * Return the mask for a file. ++ * ++ * WARNING! ++ * This function requires that you lock/unlock the trustees_hash_lock ++ */ ++int trustee_perm(struct dentry *dentry, struct vfsmount *mnt, ++ char *file_name, int unix_ret, int depth, int is_dir, ++ struct trustee_hash_element **deepest) ++{ ++ static char dbl_nul_slash[3] = { '/', '\0', '\0' }; ++ int oldmask = trustee_default_acl; ++ int height = 0; ++ char *filecount; ++ char c; ++ struct trustee_name trustee_name; ++ struct trustee_ic *iter; ++ unsigned ignore_case = 0; ++ ++ trustee_name.dev = mnt->mnt_sb->s_dev; ++ trustee_name.devname = mnt->mnt_devname; ++ trustee_name.filename = file_name; ++ ++ list_for_each_entry(iter, &trustee_ic_list, ic_list) { ++ if (trustee_dev_cmp ++ (iter->dev, trustee_name.dev, iter->devname, ++ trustee_name.devname)) { ++ ignore_case = 1; ++ break; ++ } ++ } ++ ++ if (deepest) *deepest = NULL; ++ ++ filecount = file_name + 1; ++ /* Try to handle the unlikely case where the string will be '/' ++ * out here to simplify the logic inside the loop. We do this ++ * by giving it a string with two nul byte terminators so that it ++ * will gracefully (and safely) make it through the loop below. ++ */ ++ if (*filecount == '\0') { ++ file_name = dbl_nul_slash; ++ filecount = file_name + 1; ++ } ++ do { ++ c = *filecount; ++ *filecount = 0; ++ oldmask = ++ get_trustee_mask_for_name(&trustee_name, oldmask, ++ height - depth + !is_dir, ++ deepest, ignore_case); ++ height++; ++ *filecount = c; ++ ++filecount; ++ while ((*filecount) && (*filecount != '/')) filecount++; ++ ++ } while(*filecount); ++ ++ return oldmask; ++} ++ ++/* Clear out the hash of trustees and release the hash itself. ++ * Also gets rid of the ignore-case list ++ */ ++static void trustees_clear_all(void) ++{ ++ struct trustee_hash_element *item = NULL; ++ struct hlist_node *iter, *temp = NULL; ++ unsigned i; ++ write_lock(&trustee_hash_lock); ++ ++ for (i = 0; i < trustee_hash_size; i++) { ++ hlist_for_each_entry_safe(item, iter, temp, &trustee_hash[i], hash_list) { ++ free_hash_element(item); ++ } ++ INIT_HLIST_HEAD(&trustee_hash[i]); ++ } ++ ++ deepest_level = 0; ++ ++ remove_ic_devs(); ++ ++ write_unlock(&trustee_hash_lock); ++} ++ ++/* ++ * Initialize globals ++ */ ++int trustees_funcs_init_globals(void) ++{ ++ unsigned int iter; ++ ++ if (trustee_hash_size <= 0) ++ return 1; ++ ++ rwlock_init(&trustee_hash_lock); ++ ++ trustee_hash = vmalloc(sizeof(*trustee_hash) * trustee_hash_size); ++ if (!trustee_hash) ++ return 1; ++ ++ for (iter = 0; iter < trustee_hash_size; iter++) ++ INIT_HLIST_HEAD(trustee_hash + iter); ++ ++ return 0; ++} ++ ++/* ++ * Clear globals ++ */ ++int trustees_funcs_cleanup_globals(void) ++{ ++ trustees_clear_all(); ++ ++ vfree(trustee_hash); ++ ++ return 0; ++} ++ ++/* ++ * Prepare a trustee name from a passed in trustee name. ++ */ ++static int prepare_trustee_name(u32 device, char *devname, char *filename, struct trustee_name *name) ++{ ++ size_t devl, filel; ++ char *devb = NULL, *fileb = NULL; ++ ++ if ((!name)) ++ return 0; ++ ++ filel = strlen(filename); ++ devl = strlen(devname); ++ ++ if (devl > PATH_MAX) { ++ TS_ERR_MSG("device name bad, command ignored.\n"); ++ return 0; ++ } ++ if (filel > PATH_MAX) { ++ TS_ERR_MSG("file name bad, command ignored.\n"); ++ return 0; ++ } ++ ++ devb = vmalloc_strdup(devname, devl); ++ if (!devb) { ++ TS_ERR_MSG("Couldn't allocate mem for devb.\n"); ++ return 0; ++ } ++ ++ fileb = vmalloc_strdup(filename, filel); ++ if (!fileb) { ++ TS_ERR_MSG("Couldn't allocate mem for fileb.\n"); ++ return 0; ++ } ++ ++ name->devname = devb; ++ name->filename = fileb; ++ ++ name->dev = new_decode_dev(device); ++ ++ return 1; ++} ++ ++/* ++ * Process a user command ++ */ ++extern int trustees_process_command(struct trustee_command command, ++ void **arg, ++ size_t *argsize) ++{ ++ int r = -ENOSYS; ++ int must_free = 0; ++ struct trustee_name name; ++ ++ if ((current->euid != 0) && !capable(CAP_SYS_ADMIN)) { ++ r = -EACCES; ++ return r; ++ } ++ ++ switch (command.command) { ++ case TRUSTEE_COMMAND_MAKE_IC: ++ if (command.numargs != 2 || ++ argsize[1] != sizeof(u32)) goto unlk; ++ add_ic_dev(*(u32 *)arg[1], arg[0]); ++ r = 0; ++ break; ++ case TRUSTEE_COMMAND_REMOVE_ALL: ++ if (command.numargs != 0) goto unlk; ++ trustees_clear_all(); ++ r = 0; ++ break; ++ case TRUSTEE_COMMAND_ADD: ++ if (command.numargs != 4 || ++ argsize[3] != sizeof(u32) || ++ argsize[1] != sizeof(struct trustee_permission)) ++ goto unlk; ++ if (!prepare_trustee_name(*(u32 *)arg[3], arg[2], arg[0], &name)) { ++ r = -ENOMEM; ++ goto unlk; ++ } ++ if (!add_trustee(&name, 0)) { ++ must_free = 1; ++ } ++ if (!add_trustee_perm(&name, *(struct trustee_permission *)arg[1])) ++ r = -ENOMEM; ++ else ++ r = 0; ++ ++ if (must_free) free_trustee_name(&name); ++ break; ++ } ++ unlk: ++ ++ return r; ++} +diff -Nurd linux-2.6.24/security/trustees/init.c linux-2.6.24-oxe810/security/trustees/init.c +--- linux-2.6.24/security/trustees/init.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/init.c 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,57 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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. ++ * ++ * Module initialization and cleanup ++ * ++ * History: ++ * 2002-12-16 trustees 2.10 released by Vyacheslav Zavadsky ++ * ++ */ ++ ++#include <linux/init.h> ++#include <linux/module.h> ++#include <linux/kernel.h> ++#include <linux/security.h> ++#include <linux/capability.h> ++ ++#include "internal.h" ++ ++unsigned int trustee_hash_size = 256; ++ ++MODULE_LICENSE("GPL"); ++MODULE_DESCRIPTION("Trustees ACL System"); ++MODULE_AUTHOR("Vyacheslav Zavadsky and Andrew E. Ruder <aeruder@ksu.edu>"); ++MODULE_VERSION("2.11"); ++ ++MODULE_PARM_DESC(hash_size, "Trustees hash size"); ++module_param_named(hash_size, trustee_hash_size, uint, 0444); ++ ++ ++static int __init trustees_init(void) ++{ ++ if (trustees_funcs_init_globals() != 0) { ++ return -EINVAL; ++ } ++ ++ if (trustees_init_fs() != 0) { ++ trustees_funcs_cleanup_globals(); ++ return -EINVAL; ++ } ++ ++ if (trustees_init_security() != 0) { ++ trustees_deinit_fs(); ++ trustees_funcs_cleanup_globals(); ++ return -EINVAL; ++ } ++ ++ return 0; ++} ++ ++fs_initcall(trustees_init); +diff -Nurd linux-2.6.24/security/trustees/internal.h linux-2.6.24-oxe810/security/trustees/internal.h +--- linux-2.6.24/security/trustees/internal.h 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/internal.h 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,100 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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. ++ * ++ * Private methods and definitions used only within the module. ++ * ++ */ ++ ++#ifndef _LINUX_TRUSTEES_H ++#define _LINUX_TRUSTEES_H ++#include <linux/types.h> ++#include <linux/dcache.h> ++#include <linux/kdev_t.h> ++#include <linux/list.h> ++#include <linux/version.h> ++#include <linux/trustees.h> ++ ++#define TRUSTEE_DEFAULT_MASK TRUSTEE_USE_UNIX_MASK ++ ++struct trustee_ic { ++ dev_t dev; ++ char *devname; /* ONLY if MAJOR(dev)==0 */ ++ struct list_head ic_list; ++}; ++ ++struct trustee_name { ++ dev_t dev; ++ char *filename; ++ char *devname; /* ONLY if MAJOR(dev)==0 */ ++}; ++ ++struct trustee_permission_capsule { ++ struct list_head perm_list; ++ struct trustee_permission permission; ++}; ++ ++/* For the usage field */ ++#define TRUSTEE_HASH_ELEMENT_USED 2 ++#define TRUSTEE_HASH_ELEMENT_DELETED 1 ++#define TRUSTEE_HASH_ELEMENT_NOTUSED 0 ++ ++struct trustee_hash_element { ++ struct trustee_name name; ++ struct list_head perm_list; ++ struct hlist_node hash_list; ++ struct list_head device_list; ++}; ++ ++extern char *trustees_filename_for_dentry(struct dentry *dentry, int *d, int trunc); ++ ++extern int trustees_funcs_init_globals(void); ++extern int trustees_funcs_cleanup_globals(void); ++ ++int trustee_has_child(struct vfsmount *mnt, char *file_name); ++int trustee_perm(struct dentry *dentry, struct vfsmount *mnt, ++ char *file_name, int unix_ret, int depth, int is_dir, ++ struct trustee_hash_element **deepest); ++ ++extern int trustees_process_command(struct trustee_command command, ++ void **arg, size_t *argsize); ++ ++extern unsigned int trustee_hash_size; ++extern rwlock_t trustee_hash_lock; ++ ++#define TRUSTEE_INITIAL_NAME_BUFFER 256 ++#define TRUSTEE_HASDEVNAME(TNAME) (MAJOR((TNAME).dev)==0) ++ ++#define TS_ERR_MSG(...) printk(KERN_ERR "Trustees: " __VA_ARGS__) ++ ++#ifdef TRUSTEES_DEBUG ++#define TS_DEBUG_MSG(...) printk(KERN_ERR "Trustees: " __VA_ARGS__) ++#else ++#define TS_DEBUG_MSG(...) ++#endif ++ ++#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,15) ++#define NAMESPACE_SEM(_ns) (namespace_sem) ++#else ++#define NAMESPACE_SEM(_ns) ((_ns)->sem) ++#endif ++ ++/* ++ * Magic number! ++ * ++ * FIXME: Do I just make this up or is there some system for coming ++ * up with magic numbers? ++ */ ++#define TRUSTEES_MAGIC 0x32236975 ++ ++int trustees_init_fs(void); ++void trustees_deinit_fs(void); ++ ++int trustees_init_security(void); ++#endif /* _LINUX_TRUSTEES_H */ +diff -Nurd linux-2.6.24/security/trustees/security.c linux-2.6.24-oxe810/security/trustees/security.c +--- linux-2.6.24/security/trustees/security.c 1970-01-01 01:00:00.000000000 +0100 ++++ linux-2.6.24-oxe810/security/trustees/security.c 2008-06-11 17:46:44.000000000 +0200 +@@ -0,0 +1,423 @@ ++/* ++ * Trustees ACL Project ++ * ++ * Copyright (c) 1999-2000 Vyacheslav Zavadsky ++ * Copyright (c) 2004 Andrew Ruder (aeruder@ksu.edu) ++ * ++ * 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. ++ * ++ * The security module (LSM API) component of the trustees system ++ * ++ * One quick note: generally security modules with the LSM are supposed ++ * to be solely restrictive modules. Unless the trustees module were to ++ * require that people set all files rwx by all, it could not function ++ * as it is meant to function as a solely restrictive module. ++ * ++ * To compensate, every process is given the capability CAP_DAC_OVERRIDE. ++ * In other words, every process is first given full rights to the filesystem. ++ * This is the only non-restricting portion of this module, since it -does- ++ * in fact give additional permissions. However, in the inode_permission hook, ++ * any rights the user should not have are taken away. ++ * ++ * Side effects: Posix ACLs or other filesystem-specific permissions are not ++ * honored. Trustees ACLs can (and do) take into account the standard unix ++ * permissions, but any permissions further than that are difficult, to say ++ * the least, to take into account. I, personally, do not find this to ++ * be a problem since if you are using Trustees ACLs, why also require the use ++ * of another ACL system? ++ */ ++ ++#include <linux/security.h> ++#include <linux/capability.h> ++#include <linux/mount.h> ++#include <linux/namei.h> ++#include <linux/fs.h> ++#include <linux/slab.h> ++#include <linux/smp_lock.h> ++#include <linux/nsproxy.h> ++#include <linux/mnt_namespace.h> ++ ++#include "internal.h" ++ ++static int trustees_capable(struct task_struct *tsk, int cap); ++static int trustees_inode_permission(struct inode *inode, ++ int mask, struct nameidata *nd); ++ ++/* Checks if user has access to the inode due to root status ++ */ ++static inline int has_root_perm(struct inode *inode, int mask) ++{ ++ umode_t mode = inode->i_mode; ++ ++ if (!(mask & MAY_EXEC) || (mode & S_IXUGO) || S_ISDIR(mode)) ++ if (current->fsuid == 0) ++ return 0; ++ ++ return -EACCES; ++} ++ ++/* The logic for this was mostly stolen from vfs_permission. The security API ++ * doesn't give a good way to use the actual vfs_permission for this since our ++ * CAP_DAC_OVERRIDE causes it to always return 0. But if we didn't return ++ * CAP_DAC_OVERRIDE, we'd never get to handle permissions! Since we don't need ++ * to handle capabilities and dealing with ACLs with trustees loaded isn't an ++ * issue for me, the function ends up being pretty simple. ++ */ ++ ++static inline int has_unix_perm(struct inode *inode, int mask) ++{ ++ umode_t mode = inode->i_mode; ++ mask &= ~MAY_APPEND; ++ ++ if (current->fsuid == inode->i_uid) ++ mode >>= 6; ++ else if (in_group_p(inode->i_gid)) ++ mode >>= 3; ++ ++ if (((mode & mask & (MAY_READ | MAY_WRITE | MAY_EXEC)) == mask)) ++ return 0; ++ ++ return -EACCES; ++} ++ ++/* Find a vfsmount given an inode */ ++static inline struct vfsmount *find_inode_mnt(struct inode *inode, ++ struct nameidata *nd) ++{ ++ struct mnt_namespace *ns = NULL; ++ struct vfsmount *mnt = NULL; ++ ++ if (likely(nd)) ++ return mntget(nd->mnt); ++ ++ /* Okay, we need to find the vfsmount by looking ++ * at the namespace now. ++ */ ++ task_lock(current); ++ if (current->nsproxy) { ++ ns = current->nsproxy->mnt_ns; ++ if (ns) ++ get_mnt_ns(ns); ++ } ++ task_unlock(current); ++ ++ if (!ns) return NULL; ++ ++ list_for_each_entry(mnt, &ns->list, mnt_list) { ++ if (mnt->mnt_sb == inode->i_sb) { ++ mntget(mnt); ++ goto out; ++ } ++ } ++ ++ out: ++ put_mnt_ns(ns); ++ ++ return mnt; ++} ++ ++/* Find a dentry given an inode */ ++static inline struct dentry *find_inode_dentry(struct inode *inode, ++ struct nameidata *nd) ++{ ++ struct dentry *dentry; ++ ++ if (likely(nd)) ++ return dget(nd->dentry); ++ ++ dentry = d_find_alias(inode); ++ ++ return dentry; ++} ++ ++/* ++ * Return 1 if they are under the same set of trustees ++ * otherwise return 0. In the case that we are handling ++ * a directory, we also check to see if there are subdirectories ++ * with trustees. ++ */ ++static inline int have_same_trustees(struct dentry *old_dentry, ++ struct dentry *new_dentry) ++{ ++ struct vfsmount *mnt; ++ char *old_file_name, *new_file_name; ++ int old_depth, new_depth; ++ struct trustee_hash_element *old_deep, *new_deep; ++ int is_dir; ++ int ret = 0; ++ ++ mnt = find_inode_mnt(old_dentry->d_inode, NULL); ++ if (unlikely(!mnt)) { ++ TS_ERR_MSG("inode does not have a mnt!\n"); ++ return 0; ++ } ++ ++ old_file_name = trustees_filename_for_dentry(old_dentry, &old_depth, 1); ++ if (!old_file_name) { ++ TS_ERR_MSG("Couldn't allocate filename\n"); ++ goto out_old_dentry; ++ } ++ ++ new_file_name = trustees_filename_for_dentry(new_dentry, &new_depth, 1); ++ if (!new_file_name) { ++ TS_ERR_MSG("Couldn't allocate filename\n"); ++ goto out_new_dentry; ++ } ++ ++ is_dir = S_ISDIR(old_dentry->d_inode->i_mode); ++ ++ read_lock(&trustee_hash_lock); ++ trustee_perm(old_dentry, mnt, old_file_name, ret, old_depth, is_dir, ++ &old_deep); ++ trustee_perm(new_dentry, mnt, new_file_name, ret, new_depth, is_dir, ++ &new_deep); ++ if (old_deep == new_deep) { ++ ret = 1; ++ if (is_dir) { ++ if (trustee_has_child(mnt, old_file_name) || ++ trustee_has_child(mnt, new_file_name)) ret = 0; ++ } ++ } ++ read_unlock(&trustee_hash_lock); ++ ++ kfree(new_file_name); ++out_new_dentry: ++ kfree(old_file_name); ++out_old_dentry: ++ mntput(mnt); ++ ++ return ret; ++} ++ ++ ++static int trustees_inode_rename(struct inode *old_dir, ++ struct dentry *old_dentry, ++ struct inode *new_dir, ++ struct dentry *new_dentry); ++static int trustees_inode_link(struct dentry *old_dentry, ++ struct inode *dir, ++ struct dentry *new_dentry); ++ ++/* Structure where we fill in the various hooks we are implementing in this module ++ */ ++struct security_operations trustees_security_ops = { ++ .capable = trustees_capable, ++ .inode_permission = trustees_inode_permission, ++ .inode_link = trustees_inode_link, ++ .inode_rename = trustees_inode_rename, ++ ++ .ptrace = cap_ptrace, ++ .capget = cap_capget, ++ .capset_check = cap_capset_check, ++ .capset_set = cap_capset_set, ++ .settime = cap_settime, ++ .netlink_send = cap_netlink_send, ++ .netlink_recv = cap_netlink_recv, ++ ++ .bprm_apply_creds = cap_bprm_apply_creds, ++ .bprm_set_security = cap_bprm_set_security, ++ .bprm_secureexec = cap_bprm_secureexec, ++ ++ .inode_setxattr = cap_inode_setxattr, ++ .inode_removexattr = cap_inode_removexattr, ++ ++ .task_post_setuid = cap_task_post_setuid, ++ .task_reparent_to_init = cap_task_reparent_to_init, ++ ++ .syslog = cap_syslog, ++ ++ .vm_enough_memory = cap_vm_enough_memory ++}; ++ ++#define ALL_MAYS (MAY_WRITE | MAY_EXEC | MAY_READ) ++/* Converts a trustee_mask to a normal unix mask ++ */ ++static int inline trustee_mask_to_normal_mask(int mask, int isdir) ++{ ++ int r = 0; ++ if ((mask & TRUSTEE_READ_MASK) && !isdir) ++ r |= MAY_READ; ++ if ((mask & TRUSTEE_READ_DIR_MASK) && isdir) ++ r |= MAY_READ; ++ if (mask & TRUSTEE_WRITE_MASK) ++ r |= MAY_WRITE; ++ if ((mask & TRUSTEE_BROWSE_MASK) && isdir) ++ r |= MAY_EXEC; ++ if ((mask & TRUSTEE_EXECUTE_MASK) && !isdir) ++ r |= MAY_EXEC; ++ return r; ++} ++ ++/* This is the meat of the permissions checking. First it checks for root, ++ * otherwise it first checks for any errors finding the dentry/vfsmount for ++ * the inode, and then it looks up the dentry in the trustees hash. ++ */ ++static int trustees_inode_permission(struct inode *inode, ++ int mask, struct nameidata *nd) ++{ ++ struct dentry *dentry; ++ struct vfsmount *mnt; ++ char *file_name; ++ int is_dir; ++ int ret; ++ int depth; ++ int amask; ++ int dmask; ++ umode_t mode = inode->i_mode; ++ ++ if (has_root_perm(inode, mask) == 0) ++ return 0; ++ ++ ret = has_unix_perm(inode, mask); ++ ++ mnt = find_inode_mnt(inode, nd); ++ if (unlikely(!mnt)) { ++ TS_ERR_MSG("inode does not have a mnt!\n"); ++ return -EACCES; /* has_unix_perm(inode, mask); */ ++ } ++ ++ dentry = find_inode_dentry(inode, nd); ++ if (unlikely(!dentry)) { ++ /* Most of the time when this happens, it is the / ++ * If it is not, we need to dump as much information ++ * as possible on it and dump it to logs, because ++ * I'm really not sure how it happens. ++ */ ++ if (inode == mnt->mnt_root->d_inode) { ++ dentry = dget(mnt->mnt_root); ++ } else { ++ /* I have seen this happen once but I did not have any ++ * way to see what caused it. I am gonna dump_stack ++ * until I have that happen again to see if the cause ++ * is something that I need to worry about. ++ */ ++ dump_stack(); /* DEBUG FIXME */ ++ TS_ERR_MSG("Inode number: %ld\n", inode->i_ino); ++ TS_ERR_MSG("dentry does not exist!\n"); ++ goto out_mnt; ++ } ++ } ++ file_name = trustees_filename_for_dentry(dentry, &depth, 1); ++ if (!file_name) { ++ TS_ERR_MSG("Couldn't allocate filename\n"); ++ ret = -EACCES; ++ goto out_dentry; ++ } ++ ++ is_dir = S_ISDIR(inode->i_mode); ++ ++ read_lock(&trustee_hash_lock); ++ amask = trustee_perm(dentry, mnt, file_name, ret, depth, is_dir, ++ (struct trustee_hash_element **)NULL); ++ read_unlock(&trustee_hash_lock); ++ dmask = amask >> TRUSTEE_NUM_ACL_BITS; ++ ++ /* no permission if denied */ ++ if (trustee_mask_to_normal_mask(dmask, is_dir) & mask & ALL_MAYS) { ++ ret = -EACCES; ++ goto out; ++ } ++ /* use unix perms */ ++ if (!(dmask & TRUSTEE_USE_UNIX_MASK) && ++ (amask & TRUSTEE_USE_UNIX_MASK) && (!ret)) ++ goto out; ++ ++ /* if the file isn't executable, then the trustees shouldn't ++ * make it executable ++ */ ++ if ((mask & MAY_EXEC) && !(mode & S_IXOTH) && ++ !((mode >> 3) & S_IXOTH) & !((mode >> 6) & S_IXOTH) && ++ (!is_dir)) { ++ ret = -EACCES; ++ goto out; ++ } ++ /* Check trustees for permission ++ */ ++ if ((trustee_mask_to_normal_mask(amask, is_dir) & mask & ALL_MAYS) ++ == mask) { ++ ret = 0; ++ goto out; ++ } else ++ ret = -EACCES; ++ ++ out: ++ kfree(file_name); ++ out_dentry: ++ dput(dentry); ++ out_mnt: ++ mntput(mnt); ++ ++ return ret; ++} ++ ++/* We should only allow hard links under one of two conditions: ++ * 1. Its in the same trustee ++ * - if the two dentries are covered by the same trustee, there shouldn't ++ * be much of a problem with allowing the hardlink to occur. ++ * 2. fsuid = 0 ++ */ ++static int trustees_inode_link(struct dentry *old_dentry, ++ struct inode *dir, ++ struct dentry *new_dentry) ++{ ++ if (current->fsuid == 0) ++ return 0; ++ ++ if (have_same_trustees(old_dentry, new_dentry)) ++ return 0; ++ ++ return -EXDEV; ++} ++ ++/* We have a few renames to protect against: ++ * 1. Any file or directory that is affected by different trustees at its ++ * old location than at its new location. ++ * 2. In the case of a directory, we should protect against moving a directory ++ * that has trustees set inside of it. ++ * ++ * In any case above, we return -EXDEV which signifies to the calling program that ++ * the files are on different devices, and assuming the program is written correctly ++ * it should then handle the situation by copying the files and removing the originals ++ * ( which will then use the trustees permissions as they are meant to be used ) ++ */ ++static int trustees_inode_rename(struct inode *old_dir, ++ struct dentry *old_dentry, ++ struct inode *new_dir, ++ struct dentry *new_dentry) ++{ ++ if (current->fsuid == 0) ++ return 0; ++ ++ if (have_same_trustees(old_dentry, new_dentry)) return 0; ++ ++ return -EXDEV; ++} ++ ++/* Return CAP_DAC_OVERRIDE on everything. We want to handle our own ++ * permissions (overriding those normally allowed by unix permissions) ++ */ ++static int trustees_capable(struct task_struct *tsk, int cap) ++{ ++ if (cap == CAP_DAC_OVERRIDE) ++ return 0; ++ ++ return cap_capable(tsk, cap); ++} ++ ++/* Register the security module ++ */ ++int trustees_init_security(void) ++{ ++ /* FIXME: add in secondary module register ++ * not worry about it now since I have better ++ * things to worry about. Comprende? ++ */ ++ if (register_security(&trustees_security_ops)) { ++ TS_ERR_MSG("Could not register security component\n"); ++ return -EINVAL; ++ } ++ ++ return 0; ++} +diff -Nurd linux-2.6.24/sound/oss/via82cxxx_audio.c linux-2.6.24-oxe810/sound/oss/via82cxxx_audio.c +--- linux-2.6.24/sound/oss/via82cxxx_audio.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/sound/oss/via82cxxx_audio.c 2008-06-11 17:46:29.000000000 +0200 +@@ -2104,6 +2104,7 @@ + { + struct via_info *card = vma->vm_private_data; + struct via_channel *chan = &card->ch_out; ++ unsigned long max_bufs; + struct page *dmapage; + unsigned long pgoff; + int rd, wr; +@@ -2127,14 +2128,11 @@ + rd = card->ch_in.is_mapped; + wr = card->ch_out.is_mapped; + +-#ifndef VIA_NDEBUG +- { +- unsigned long max_bufs = chan->frag_number; +- if (rd && wr) max_bufs *= 2; +- /* via_dsp_mmap() should ensure this */ +- assert (pgoff < max_bufs); +- } +-#endif ++ max_bufs = chan->frag_number; ++ if (rd && wr) ++ max_bufs *= 2; ++ if (pgoff >= max_bufs) ++ return NOPAGE_SIGBUS; + + /* if full-duplex (read+write) and we have two sets of bufs, + * then the playback buffers come first, sez soundcard.c */ +diff -Nurd linux-2.6.24/sound/usb/usx2y/usX2Yhwdep.c linux-2.6.24-oxe810/sound/usb/usx2y/usX2Yhwdep.c +--- linux-2.6.24/sound/usb/usx2y/usX2Yhwdep.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/sound/usb/usx2y/usX2Yhwdep.c 2008-06-11 17:46:26.000000000 +0200 +@@ -88,7 +88,7 @@ + us428->us428ctls_sharedmem->CtlSnapShotLast = -2; + } + area->vm_ops = &us428ctls_vm_ops; +- area->vm_flags |= VM_RESERVED; ++ area->vm_flags |= VM_RESERVED | VM_DONTEXPAND; + area->vm_private_data = hw->private_data; + return 0; + } +diff -Nurd linux-2.6.24/sound/usb/usx2y/usx2yhwdeppcm.c linux-2.6.24-oxe810/sound/usb/usx2y/usx2yhwdeppcm.c +--- linux-2.6.24/sound/usb/usx2y/usx2yhwdeppcm.c 2008-01-24 23:58:37.000000000 +0100 ++++ linux-2.6.24-oxe810/sound/usb/usx2y/usx2yhwdeppcm.c 2008-06-11 17:46:26.000000000 +0200 +@@ -728,7 +728,7 @@ + return -ENODEV; + } + area->vm_ops = &snd_usX2Y_hwdep_pcm_vm_ops; +- area->vm_flags |= VM_RESERVED; ++ area->vm_flags |= VM_RESERVED | VM_DONTEXPAND; + area->vm_private_data = hw->private_data; + return 0; + } |