ARM: sa11x0: fix sleep entry

 *

 * Causes sa11x0 to enter sleep state

 *

 * Must be aligned to a cacheline.

 */

	.balign	32

ENTRY(sa1100_finish_suspend)

	@ disable clock switching

	mcr	p15, 0, r1, c15, c2, 2

	ldr	r6, =MDREFR

	ldr	r4, [r6]

	orr     r4, r4, #MDREFR_K1DB2

	ldr	r5, =PPCR

	@ Pre-load __udelay into the I-cache

	mov	r0, #1

	bl	__udelay

	mov	r0, r0

	@ The following must all exist in a single cache line to

	@ avoid accessing memory until this sequence is complete,

	@ otherwise we occasionally hang.

	@ Adjust memory timing before lowering CPU clock

	@ Clock speed adjustment without changing memory timing makes

	@ CPU hang in some cases

        ldr     r0, =MDREFR

        ldr     r1, [r0]

        orr     r1, r1, #MDREFR_K1DB2

        str     r1, [r0]

	str     r4, [r6]

	@ delay 90us and set CPU PLL to lowest speed

	@ fixes resume problem on high speed SA1110

	mov	r0, #90

	bl	__udelay

	ldr	r0, =PPCR

	mov	r1, #0

	str	r1, [r0]

	str	r1, [r5]

	mov	r0, #90

	bl	__udelay

	bic	r5, r5, #FMsk(MSC_RT)

	bic	r5, r5, #FMsk(MSC_RT)<<16

	ldr	r6, =MDREFR

	ldr	r7, [r6]

	bic	r7, r7, #0x0000FF00

	bic	r7, r7, #0x000000F0