FreeCalypso > hg > freecalypso-sw
comparison gsm-fw/L1/cfile/l1_small_asm.S @ 571:8d6062f4e7e4
L1: l1_small.c reworked for FreeCalypso
| author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
|---|---|
| date | Sun, 10 Aug 2014 19:51:26 +0000 |
| parents | |
| children |
comparison
equal
deleted
inserted
replaced
| 570:962f0d3a4e7e | 571:8d6062f4e7e4 |
|---|---|
| 1 /* | |
| 2 * Assembly code extracted out of TI's l1_small.c | |
| 3 * | |
| 4 * This code is correct ONLY for CHIPSET 10 or 11 as currently used | |
| 5 * by FreeCalypso; see TI's original code for what changes would be | |
| 6 * needed to support other CHIPSETs. | |
| 7 */ | |
| 8 | |
| 9 .text | |
| 10 .code 32 | |
| 11 | |
| 12 /*-------------------------------------------------------*/ | |
| 13 /* _GSM_Small_Sleep */ | |
| 14 /* (formerly INT_Small_Sleep) */ | |
| 15 /*-------------------------------------------------------*/ | |
| 16 /* */ | |
| 17 /* Description: small sleep */ | |
| 18 /* ------------ */ | |
| 19 /* Called by TCT_Schedule main loop of Nucleus */ | |
| 20 /*-------------------------------------------------------*/ | |
| 21 | |
| 22 #define SMALL_SLEEP 0x01 | |
| 23 #define ALL_SLEEP 0x04 | |
| 24 #define PWR_MNGT 0x01 | |
| 25 | |
| 26 .globl _GSM_Small_Sleep | |
| 27 _GSM_Small_Sleep: | |
| 28 | |
| 29 ldr r0,Switch | |
| 30 ldr r0,[r0] | |
| 31 ldrb r1,[r0] | |
| 32 cmp r1,#PWR_MNGT | |
| 33 bne TCT_Schedule_Loop | |
| 34 | |
| 35 ldr r0,Mode | |
| 36 ldr r0,[r0] | |
| 37 ldrb r1,[r0] | |
| 38 cmp r1,#SMALL_SLEEP | |
| 39 beq Small_sleep_ok | |
| 40 cmp r1,#ALL_SLEEP | |
| 41 bne TCT_Schedule_Loop | |
| 42 | |
| 43 Small_sleep_ok: | |
| 44 | |
| 45 // ***************************************************** | |
| 46 //reset the DEEP_SLEEP bit 12 of CNTL_ARM_CLK register | |
| 47 // (Cf BUG_1278) | |
| 48 | |
| 49 ldr r0,addrCLKM @ pick up CNTL_ARM_CLK register address | |
| 50 ldrh r1,[r0] @ take the current value of the register | |
| 51 orr r1,r1,#0x1000 @ reset the bit | |
| 52 strh r1,[r0] @ store the result | |
| 53 | |
| 54 ldr r0,addrCLKM @ pick up CLKM clock register address | |
| 55 ldrh r1,[r0] @ take the current value of the register | |
| 56 bic r1,r1,#1 @ disable ARM clock | |
| 57 strh r1,[r0] | |
| 58 | |
| 59 B TCT_Schedule_Loop @ Return to TCT_Schedule main loop | |
| 60 | |
| 61 addrCLKM: .word 0xfffffd00 @ CLKM clock register address | |
| 62 | |
| 63 Mode: .word mode_authorized | |
| 64 Switch: .word switch_PWR_MNGT |