diff options
author | Michael Sparmann <theseven@rockbox.org> | 2011-01-02 23:16:27 +0000 |
---|---|---|
committer | Michael Sparmann <theseven@rockbox.org> | 2011-01-02 23:16:27 +0000 |
commit | 152847977a420487d9c3728841101ef708e41373 (patch) | |
tree | f4113d0d6f60355d1ba00d78fc96e97a98e4d493 /firmware/target | |
parent | 6f40387e742322c4860af2f389a4b531e669801f (diff) | |
download | rockbox-152847977a420487d9c3728841101ef708e41373.tar.gz rockbox-152847977a420487d9c3728841101ef708e41373.zip |
New port: iPod Classic (also known as iPod 6G/6.5G/7G)
Major known issues:
- No bootloader yet
- No support for the first-generation 160GB CE-ATA hard disk drive yet
- Audio playback is slow, only FLAC seems to reach realtime
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@28953 a1c6a512-1295-4272-9138-f99709370657
Diffstat (limited to 'firmware/target')
31 files changed, 3245 insertions, 2 deletions
diff --git a/firmware/target/arm/mmu-arm.S b/firmware/target/arm/mmu-arm.S index 5693ca587b..24abfec1a7 100644 --- a/firmware/target/arm/mmu-arm.S +++ b/firmware/target/arm/mmu-arm.S | |||
@@ -18,6 +18,7 @@ | |||
18 | * KIND, either express or implied. | 18 | * KIND, either express or implied. |
19 | * | 19 | * |
20 | ****************************************************************************/ | 20 | ****************************************************************************/ |
21 | #define ASM | ||
21 | #include "config.h" | 22 | #include "config.h" |
22 | #include "cpu.h" | 23 | #include "cpu.h" |
23 | 24 | ||
@@ -27,7 +28,7 @@ | |||
27 | /* MMU present but unused */ | 28 | /* MMU present but unused */ |
28 | #define HAVE_TEST_AND_CLEAN_CACHE | 29 | #define HAVE_TEST_AND_CLEAN_CACHE |
29 | 30 | ||
30 | #elif CONFIG_CPU == DM320 || CONFIG_CPU == AS3525v2 | 31 | #elif CONFIG_CPU == DM320 || CONFIG_CPU == AS3525v2 || CONFIG_CPU == S5L8702 |
31 | #define USE_MMU | 32 | #define USE_MMU |
32 | #define HAVE_TEST_AND_CLEAN_CACHE | 33 | #define HAVE_TEST_AND_CLEAN_CACHE |
33 | 34 | ||
diff --git a/firmware/target/arm/s5l8700/ipodnano2g/piezo-nano2g.c b/firmware/target/arm/s5l8700/ipodnano2g/piezo-nano2g.c new file mode 100644 index 0000000000..b41790833f --- /dev/null +++ b/firmware/target/arm/s5l8700/ipodnano2g/piezo-nano2g.c | |||
@@ -0,0 +1,95 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2006-2007 Robert Keevil | ||
11 | * | ||
12 | * All files in this archive are subject to the GNU General Public License. | ||
13 | * See the file COPYING in the source tree root for full license agreement. | ||
14 | * | ||
15 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
16 | * KIND, either express or implied. | ||
17 | * | ||
18 | ****************************************************************************/ | ||
19 | |||
20 | #include "system.h" | ||
21 | #include "kernel.h" | ||
22 | #include "piezo.h" | ||
23 | |||
24 | static unsigned int duration; | ||
25 | static bool beeping; | ||
26 | |||
27 | void INT_TIMERD(void) | ||
28 | { | ||
29 | /* clear interrupt */ | ||
30 | TDCON = TDCON; | ||
31 | if (!(--duration)) | ||
32 | { | ||
33 | beeping = 0; | ||
34 | TDCMD = (1 << 1); /* TD_CLR */ | ||
35 | } | ||
36 | } | ||
37 | |||
38 | void piezo_start(unsigned short cycles, unsigned short periods) | ||
39 | { | ||
40 | #ifndef SIMULATOR | ||
41 | duration = periods; | ||
42 | beeping = 1; | ||
43 | /* configure timer for 100 kHz */ | ||
44 | TDCMD = (1 << 1); /* TD_CLR */ | ||
45 | TDPRE = 30 - 1; /* prescaler */ | ||
46 | TDCON = (1 << 13) | /* TD_INT1_EN */ | ||
47 | (0 << 12) | /* TD_INT0_EN */ | ||
48 | (0 << 11) | /* TD_START */ | ||
49 | (2 << 8) | /* TD_CS = PCLK / 16 */ | ||
50 | (1 << 4); /* TD_MODE_SEL = PWM mode */ | ||
51 | TDDATA0 = cycles; /* set interval period */ | ||
52 | TDDATA1 = cycles << 1; /* set interval period */ | ||
53 | TDCMD = (1 << 0); /* TD_EN */ | ||
54 | |||
55 | /* enable timer interrupt */ | ||
56 | INTMSK |= INTMSK_TIMERD; | ||
57 | #endif | ||
58 | } | ||
59 | |||
60 | void piezo_stop(void) | ||
61 | { | ||
62 | #ifndef SIMULATOR | ||
63 | TDCMD = (1 << 1); /* TD_CLR */ | ||
64 | #endif | ||
65 | } | ||
66 | |||
67 | void piezo_clear(void) | ||
68 | { | ||
69 | piezo_stop(); | ||
70 | } | ||
71 | |||
72 | bool piezo_busy(void) | ||
73 | { | ||
74 | return beeping; | ||
75 | } | ||
76 | |||
77 | void piezo_init(void) | ||
78 | { | ||
79 | beeping = 0; | ||
80 | } | ||
81 | |||
82 | void piezo_button_beep(bool beep, bool force) | ||
83 | { | ||
84 | if (force) | ||
85 | while (beeping) | ||
86 | yield(); | ||
87 | |||
88 | if (!beeping) | ||
89 | { | ||
90 | if (beep) | ||
91 | piezo_start(22, 457); | ||
92 | else | ||
93 | piezo_start(40, 4); | ||
94 | } | ||
95 | } | ||
diff --git a/firmware/target/arm/s5l8700/ipodnano2g/piezo.h b/firmware/target/arm/s5l8700/ipodnano2g/piezo.h new file mode 100644 index 0000000000..d9837cc6a9 --- /dev/null +++ b/firmware/target/arm/s5l8700/ipodnano2g/piezo.h | |||
@@ -0,0 +1,24 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2006-2007 Robert Keevil | ||
11 | * | ||
12 | * All files in this archive are subject to the GNU General Public License. | ||
13 | * See the file COPYING in the source tree root for full license agreement. | ||
14 | * | ||
15 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
16 | * KIND, either express or implied. | ||
17 | * | ||
18 | ****************************************************************************/ | ||
19 | |||
20 | void piezo_init(void); | ||
21 | void piezo_stop(void); | ||
22 | void piezo_clear(void); | ||
23 | bool piezo_busy(void); | ||
24 | void piezo_button_beep(bool beep, bool force); | ||
diff --git a/firmware/target/arm/s5l8702/app.lds b/firmware/target/arm/s5l8702/app.lds new file mode 100644 index 0000000000..fafdea4cd9 --- /dev/null +++ b/firmware/target/arm/s5l8702/app.lds | |||
@@ -0,0 +1,142 @@ | |||
1 | #define ASM | ||
2 | #include "config.h" | ||
3 | #include "cpu.h" | ||
4 | |||
5 | ENTRY(start) | ||
6 | |||
7 | OUTPUT_FORMAT(elf32-littlearm) | ||
8 | OUTPUT_ARCH(arm) | ||
9 | STARTUP(target/arm/s5l8702/crt0.o) | ||
10 | |||
11 | #define PLUGINSIZE PLUGIN_BUFFER_SIZE | ||
12 | #define CODECSIZE CODEC_SIZE | ||
13 | |||
14 | #define IRAMORIG 0x0 | ||
15 | #define DRAMORIG 0x08000000 | ||
16 | |||
17 | /* End of the audio buffer, where the codec buffer starts */ | ||
18 | #define ENDAUDIOADDR (DRAMORIG + DRAMSIZE) | ||
19 | |||
20 | #define DRAMSIZE (DRAM_SIZE - PLUGINSIZE - CODECSIZE - TTB_SIZE) | ||
21 | #define CODECORIG (ENDAUDIOADDR) | ||
22 | #define IRAMSIZE (56*1024) /* 256KB total - 56KB for core, 200KB for codecs */ | ||
23 | |||
24 | /* Where the codec buffer ends, and the plugin buffer starts */ | ||
25 | #define ENDADDR (ENDAUDIOADDR + CODECSIZE) | ||
26 | |||
27 | MEMORY | ||
28 | { | ||
29 | IRAM : ORIGIN = IRAMORIG, LENGTH = IRAMSIZE | ||
30 | DRAM : ORIGIN = DRAMORIG, LENGTH = DRAMSIZE | ||
31 | } | ||
32 | |||
33 | SECTIONS | ||
34 | { | ||
35 | loadaddress = DRAMORIG; | ||
36 | |||
37 | .intvect : { | ||
38 | _intvectstart = . ; | ||
39 | *(.intvect) | ||
40 | _intvectend = _newstart ; | ||
41 | } >IRAM AT> DRAM | ||
42 | _intvectcopy = LOADADDR(.intvect) ; | ||
43 | |||
44 | .text : | ||
45 | { | ||
46 | _loadaddress = .; | ||
47 | _textstart = .; | ||
48 | *(.init.text) | ||
49 | *(.text) | ||
50 | *(.text*) | ||
51 | *(.glue_7) | ||
52 | *(.glue_7t) | ||
53 | . = ALIGN(0x4); | ||
54 | } > DRAM | ||
55 | |||
56 | .rodata : | ||
57 | { | ||
58 | *(.rodata*) | ||
59 | . = ALIGN(0x4); | ||
60 | } > DRAM | ||
61 | |||
62 | .data : | ||
63 | { | ||
64 | *(.data*) | ||
65 | . = ALIGN(0x4); | ||
66 | } > DRAM | ||
67 | |||
68 | /DISCARD/ : | ||
69 | { | ||
70 | *(.eh_frame) | ||
71 | } | ||
72 | |||
73 | .iram : | ||
74 | { | ||
75 | _iramstart = .; | ||
76 | *(.icode) | ||
77 | *(.irodata) | ||
78 | *(.idata) | ||
79 | . = ALIGN(0x4); | ||
80 | _iramend = .; | ||
81 | } > IRAM AT> DRAM | ||
82 | _iramcopy = LOADADDR(.iram) ; | ||
83 | |||
84 | .ibss (NOLOAD) : | ||
85 | { | ||
86 | _iedata = .; | ||
87 | *(.qharray) | ||
88 | *(.ibss) | ||
89 | . = ALIGN(0x4); | ||
90 | _iend = .; | ||
91 | } > IRAM | ||
92 | |||
93 | .stack (NOLOAD) : | ||
94 | { | ||
95 | *(.stack) | ||
96 | stackbegin = .; | ||
97 | _stackbegin = .; | ||
98 | . += 0x4000; | ||
99 | stackend = .; | ||
100 | _stackend = .; | ||
101 | _irqstackbegin = .; | ||
102 | . += 0x400; | ||
103 | _irqstackend = .; | ||
104 | _fiqstackbegin = .; | ||
105 | . += 0x400; | ||
106 | _fiqstackend = .; | ||
107 | } > IRAM | ||
108 | |||
109 | .bss (NOLOAD) : | ||
110 | { | ||
111 | _edata = .; | ||
112 | *(.bss*) | ||
113 | *(COMMON) | ||
114 | . = ALIGN(0x4); | ||
115 | _end = .; | ||
116 | } > DRAM | ||
117 | |||
118 | .audiobuf (NOLOAD) : | ||
119 | { | ||
120 | . = ALIGN(4); | ||
121 | _audiobuffer = .; | ||
122 | audiobuffer = .; | ||
123 | } > DRAM | ||
124 | |||
125 | .audiobufend ENDAUDIOADDR (NOLOAD) : | ||
126 | { | ||
127 | audiobufend = .; | ||
128 | _audiobufend = .; | ||
129 | } > DRAM | ||
130 | |||
131 | .codec CODECORIG (NOLOAD) : | ||
132 | { | ||
133 | codecbuf = .; | ||
134 | _codecbuf = .; | ||
135 | } > DRAM | ||
136 | |||
137 | .plugin ENDADDR (NOLOAD) : | ||
138 | { | ||
139 | _pluginbuf = .; | ||
140 | pluginbuf = .; | ||
141 | } | ||
142 | } | ||
diff --git a/firmware/target/arm/s5l8702/boot.lds b/firmware/target/arm/s5l8702/boot.lds new file mode 100644 index 0000000000..9741cee45e --- /dev/null +++ b/firmware/target/arm/s5l8702/boot.lds | |||
@@ -0,0 +1,94 @@ | |||
1 | #define ASM | ||
2 | #include "config.h" | ||
3 | |||
4 | ENTRY(start) | ||
5 | #ifdef ROCKBOX_LITTLE_ENDIAN | ||
6 | OUTPUT_FORMAT(elf32-littlearm) | ||
7 | #else | ||
8 | OUTPUT_FORMAT(elf32-bigarm) | ||
9 | #endif | ||
10 | OUTPUT_ARCH(arm) | ||
11 | STARTUP(target/arm/s5l8702/crt0.o) | ||
12 | |||
13 | #ifdef IPOD_NANO2G | ||
14 | #define DRAMORIG 0x08000000 + ((MEMORYSIZE - 1) * 0x100000) | ||
15 | #define DRAMSIZE 0x00100000 | ||
16 | #else | ||
17 | #define DRAMORIG 0x08000000 | ||
18 | #define DRAMSIZE (DRAM_SIZE - TTB_SIZE) | ||
19 | #endif | ||
20 | |||
21 | #define IRAMORIG 0x22000000 | ||
22 | #define IRAMSIZE 256K | ||
23 | |||
24 | MEMORY | ||
25 | { | ||
26 | DRAM : ORIGIN = DRAMORIG, LENGTH = DRAMSIZE | ||
27 | IRAM : ORIGIN = IRAMORIG, LENGTH = IRAMSIZE | ||
28 | } | ||
29 | |||
30 | #define LOAD_AREA IRAM | ||
31 | |||
32 | SECTIONS | ||
33 | { | ||
34 | #ifdef NEEDS_INTVECT_COPYING | ||
35 | .intvect : { | ||
36 | _intvectstart = . ; | ||
37 | *(.intvect) | ||
38 | _intvectend = _newstart ; | ||
39 | } >IRAM AT> LOAD_AREA | ||
40 | _intvectcopy = LOADADDR(.intvect) ; | ||
41 | #endif | ||
42 | |||
43 | .text : { | ||
44 | #ifndef NEEDS_INTVECT_COPYING | ||
45 | *(.intvect) | ||
46 | #endif | ||
47 | *(.init.text) | ||
48 | *(.text*) | ||
49 | *(.glue_7*) | ||
50 | } > LOAD_AREA | ||
51 | |||
52 | .rodata : { | ||
53 | *(.rodata*) | ||
54 | . = ALIGN(0x4); | ||
55 | } > LOAD_AREA | ||
56 | |||
57 | .data : { | ||
58 | _datastart = . ; | ||
59 | *(.irodata) | ||
60 | *(.icode) | ||
61 | *(.idata) | ||
62 | *(.data*) | ||
63 | *(.ncdata*); | ||
64 | . = ALIGN(0x4); | ||
65 | _dataend = . ; | ||
66 | } > IRAM AT> LOAD_AREA | ||
67 | _datacopy = LOADADDR(.data) ; | ||
68 | |||
69 | .stack (NOLOAD) : | ||
70 | { | ||
71 | *(.stack) | ||
72 | _stackbegin = .; | ||
73 | stackbegin = .; | ||
74 | . += 0x2000; | ||
75 | _stackend = .; | ||
76 | stackend = .; | ||
77 | _irqstackbegin = .; | ||
78 | . += 0x400; | ||
79 | _irqstackend = .; | ||
80 | _fiqstackbegin = .; | ||
81 | . += 0x400; | ||
82 | _fiqstackend = .; | ||
83 | } > IRAM | ||
84 | |||
85 | .bss (NOLOAD) : { | ||
86 | _edata = .; | ||
87 | *(.bss*); | ||
88 | *(.ibss); | ||
89 | *(.ncbss*); | ||
90 | *(COMMON); | ||
91 | . = ALIGN(0x4); | ||
92 | _end = .; | ||
93 | } > IRAM | ||
94 | } | ||
diff --git a/firmware/target/arm/s5l8702/crt0.S b/firmware/target/arm/s5l8702/crt0.S new file mode 100644 index 0000000000..da2f49c971 --- /dev/null +++ b/firmware/target/arm/s5l8702/crt0.S | |||
@@ -0,0 +1,207 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: crt0.S 18776 2008-10-11 18:32:17Z gevaerts $ | ||
9 | * | ||
10 | * Copyright (C) 2008 by Marcoen Hirschberg | ||
11 | * Copyright (C) 2008 by Denes Balatoni | ||
12 | * | ||
13 | * This program is free software; you can redistribute it and/or | ||
14 | * modify it under the terms of the GNU General Public License | ||
15 | * as published by the Free Software Foundation; either version 2 | ||
16 | * of the License, or (at your option) any later version. | ||
17 | * | ||
18 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
19 | * KIND, either express or implied. | ||
20 | * | ||
21 | ****************************************************************************/ | ||
22 | #define ASM | ||
23 | #include "config.h" | ||
24 | #include "cpu.h" | ||
25 | |||
26 | #define CACHE_NONE 0 | ||
27 | #define CACHE_ALL 0x0C | ||
28 | |||
29 | .section .intvect,"ax",%progbits | ||
30 | .global start | ||
31 | .global _newstart | ||
32 | /* Exception vectors */ | ||
33 | start: | ||
34 | b _newstart | ||
35 | ldr pc, =undef_instr_handler | ||
36 | ldr pc, =software_int_handler | ||
37 | ldr pc, =prefetch_abort_handler | ||
38 | ldr pc, =data_abort_handler | ||
39 | ldr pc, =reserved_handler | ||
40 | ldr pc, =irq_handler | ||
41 | ldr pc, =fiq_handler | ||
42 | .ltorg | ||
43 | _newstart: | ||
44 | #if !defined(BOOTLOADER) | ||
45 | ldr pc, =newstart2 // we do not want to execute from 0x0 as iram will be mapped there | ||
46 | .section .init.text,"ax",%progbits | ||
47 | newstart2: | ||
48 | #endif | ||
49 | msr cpsr_c, #0xd3 /* enter supervisor mode, disable IRQ/FIQ */ | ||
50 | |||
51 | #ifdef BOOTLOADER | ||
52 | /* Relocate ourself to IRAM - we have been loaded to DRAM */ | ||
53 | mov r0, #0x08000000 /* source (DRAM) */ | ||
54 | mov r1, #0x22000000 /* dest (IRAM) */ | ||
55 | ldr r2, =_dataend | ||
56 | 1: | ||
57 | cmp r2, r1 | ||
58 | ldrhi r3, [r0], #4 | ||
59 | strhi r3, [r1], #4 | ||
60 | bhi 1b | ||
61 | |||
62 | ldr pc, =start_loc /* jump to the relocated start_loc: */ | ||
63 | start_loc: | ||
64 | #endif | ||
65 | |||
66 | mrc 15, 0, r0, c1, c0, 0 | ||
67 | bic r0, r0, #0x1000 | ||
68 | bic r0, r0, #0x5 | ||
69 | mcr 15, 0, r0, c1, c0, 0 // disable caches and protection unit | ||
70 | |||
71 | .cleancache: | ||
72 | mrc p15, 0, r15,c7,c10,3 | ||
73 | bne .cleancache | ||
74 | mov r0, #0 | ||
75 | mcr p15, 0, r0,c7,c10,4 | ||
76 | mcr p15, 0, r0,c7,c5,0 | ||
77 | bl ttb_init | ||
78 | |||
79 | mov r0, #0 @ physical address | ||
80 | mov r1, #0 @ virtual address | ||
81 | mov r2, #0x380 @ size (all memory) | ||
82 | mov r3, #CACHE_ALL | ||
83 | bl map_section | ||
84 | |||
85 | mov r0, #0x38000000 @ physical address | ||
86 | mov r1, #0x38000000 @ virtual address | ||
87 | mov r2, #0x80 @ size (AHB/APB) | ||
88 | mov r3, #CACHE_NONE | ||
89 | bl map_section | ||
90 | |||
91 | bl enable_mmu | ||
92 | |||
93 | mrc 15, 0, r0, c1, c0, 0 | ||
94 | orr r0, r0, #0x5 | ||
95 | orr r0, r0, #0x1000 | ||
96 | mcr 15, 0, r0, c1, c0, 0 // re-enable protection unit and caches | ||
97 | |||
98 | ldr r1, =0x38e00000 | ||
99 | add r2, r1, #0x00001000 | ||
100 | add r3, r1, #0x00002000 | ||
101 | sub r4, r0, #1 | ||
102 | str r4, [r1,#0x14] | ||
103 | str r4, [r2,#0x14] | ||
104 | str r4, [r1,#0xf00] | ||
105 | str r4, [r2,#0xf00] | ||
106 | str r4, [r3,#0x08] | ||
107 | str r4, [r3,#0x0c] | ||
108 | str r0, [r1,#0x14] | ||
109 | str r0, [r2,#0x14] | ||
110 | |||
111 | #if !defined(BOOTLOADER) | ||
112 | /* Copy interrupt vectors to iram */ | ||
113 | ldr r2, =_intvectstart | ||
114 | ldr r3, =_intvectend | ||
115 | ldr r4, =_intvectcopy | ||
116 | 1: | ||
117 | cmp r3, r2 | ||
118 | ldrhi r1, [r4], #4 | ||
119 | strhi r1, [r2], #4 | ||
120 | bhi 1b | ||
121 | #endif | ||
122 | |||
123 | /* Initialise bss section to zero */ | ||
124 | ldr r2, =_edata | ||
125 | ldr r3, =_end | ||
126 | mov r4, #0 | ||
127 | 1: | ||
128 | cmp r3, r2 | ||
129 | strhi r4, [r2], #4 | ||
130 | bhi 1b | ||
131 | |||
132 | #ifndef BOOTLOADER | ||
133 | /* Copy icode and data to ram */ | ||
134 | ldr r2, =_iramstart | ||
135 | ldr r3, =_iramend | ||
136 | ldr r4, =_iramcopy | ||
137 | 1: | ||
138 | cmp r3, r2 | ||
139 | ldrhi r1, [r4], #4 | ||
140 | strhi r1, [r2], #4 | ||
141 | bhi 1b | ||
142 | |||
143 | /* Initialise ibss section to zero */ | ||
144 | ldr r2, =_iedata | ||
145 | ldr r3, =_iend | ||
146 | mov r4, #0 | ||
147 | 1: | ||
148 | cmp r3, r2 | ||
149 | strhi r4, [r2], #4 | ||
150 | bhi 1b | ||
151 | #endif | ||
152 | |||
153 | /* Set up some stack and munge it with 0xdeadbeef */ | ||
154 | ldr sp, =stackend | ||
155 | ldr r2, =stackbegin | ||
156 | ldr r3, =0xdeadbeef | ||
157 | 1: | ||
158 | cmp sp, r2 | ||
159 | strhi r3, [r2], #4 | ||
160 | bhi 1b | ||
161 | |||
162 | /* Set up stack for IRQ mode */ | ||
163 | msr cpsr_c, #0xd2 | ||
164 | ldr sp, =_irqstackend | ||
165 | |||
166 | /* Set up stack for FIQ mode */ | ||
167 | msr cpsr_c, #0xd1 | ||
168 | ldr sp, =_fiqstackend | ||
169 | |||
170 | /* Let abort and undefined modes use IRQ stack */ | ||
171 | msr cpsr_c, #0xd7 | ||
172 | ldr sp, =_irqstackend | ||
173 | msr cpsr_c, #0xdb | ||
174 | ldr sp, =_irqstackend | ||
175 | |||
176 | /* Switch back to supervisor mode */ | ||
177 | msr cpsr_c, #0xd3 | ||
178 | |||
179 | bl main | ||
180 | |||
181 | .text | ||
182 | /* .global UIE*/ | ||
183 | |||
184 | /* All illegal exceptions call into UIE with exception address as first | ||
185 | * parameter. This is calculated differently depending on which exception | ||
186 | * we're in. Second parameter is exception number, used for a string lookup | ||
187 | * in UIE. */ | ||
188 | undef_instr_handler: | ||
189 | sub r0, lr, #4 | ||
190 | mov r1, #0 | ||
191 | b UIE | ||
192 | |||
193 | /* We run supervisor mode most of the time, and should never see a software | ||
194 | * exception being thrown. Perhaps make it illegal and call UIE? */ | ||
195 | software_int_handler: | ||
196 | reserved_handler: | ||
197 | movs pc, lr | ||
198 | |||
199 | prefetch_abort_handler: | ||
200 | sub r0, lr, #4 | ||
201 | mov r1, #1 | ||
202 | b UIE | ||
203 | |||
204 | data_abort_handler: | ||
205 | sub r0, lr, #8 | ||
206 | mov r1, #2 | ||
207 | b UIE | ||
diff --git a/firmware/target/arm/s5l8702/debug-s5l8702.c b/firmware/target/arm/s5l8702/debug-s5l8702.c new file mode 100644 index 0000000000..30d97d9203 --- /dev/null +++ b/firmware/target/arm/s5l8702/debug-s5l8702.c | |||
@@ -0,0 +1,151 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: debug-s5l8700.c 28719 2010-12-01 18:35:01Z Buschel $ | ||
9 | * | ||
10 | * Copyright © 2008 Rafaël Carré | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include <stdbool.h> | ||
23 | #include "config.h" | ||
24 | #include "kernel.h" | ||
25 | #include "debug-target.h" | ||
26 | #include "button.h" | ||
27 | #include "lcd.h" | ||
28 | #include "font.h" | ||
29 | #include "storage.h" | ||
30 | #include "power.h" | ||
31 | #include "pmu-target.h" | ||
32 | |||
33 | /* Skeleton for adding target specific debug info to the debug menu | ||
34 | */ | ||
35 | |||
36 | #define _DEBUG_PRINTF(a, varargs...) lcd_putsf(0, line++, (a), ##varargs); | ||
37 | |||
38 | bool __dbg_hw_info(void) | ||
39 | { | ||
40 | int line; | ||
41 | int i; | ||
42 | unsigned int state = 0; | ||
43 | const unsigned int max_states=2; | ||
44 | |||
45 | lcd_clear_display(); | ||
46 | lcd_setfont(FONT_SYSFIXED); | ||
47 | |||
48 | state=0; | ||
49 | while(1) | ||
50 | { | ||
51 | lcd_clear_display(); | ||
52 | line = 0; | ||
53 | |||
54 | if(state == 0) | ||
55 | { | ||
56 | _DEBUG_PRINTF("CPU:"); | ||
57 | _DEBUG_PRINTF("current_tick: %d", (unsigned int)current_tick); | ||
58 | line++; | ||
59 | } | ||
60 | else if(state==1) | ||
61 | { | ||
62 | _DEBUG_PRINTF("PMU:"); | ||
63 | for(i=0;i<7;i++) | ||
64 | { | ||
65 | char *device[] = {"(unknown)", | ||
66 | "(unknown)", | ||
67 | "(unknown)", | ||
68 | "(unknown)", | ||
69 | "(unknown)", | ||
70 | "(unknown)", | ||
71 | "(unknown)"}; | ||
72 | _DEBUG_PRINTF("ldo%d %s: %dmV %s",i, | ||
73 | pmu_read(0x2e + (i << 1))?" on":"off", | ||
74 | 900 + pmu_read(0x2d + (i << 1))*100, | ||
75 | device[i]); | ||
76 | } | ||
77 | _DEBUG_PRINTF("cpu voltage: %dmV",625 + pmu_read(0x1e)*25); | ||
78 | _DEBUG_PRINTF("memory voltage: %dmV",625 + pmu_read(0x22)*25); | ||
79 | line++; | ||
80 | _DEBUG_PRINTF("charging: %s", charging_state() ? "true" : "false"); | ||
81 | _DEBUG_PRINTF("backlight: %s", pmu_read(0x29) ? "on" : "off"); | ||
82 | _DEBUG_PRINTF("brightness value: %d", pmu_read(0x28)); | ||
83 | } | ||
84 | else | ||
85 | { | ||
86 | state=0; | ||
87 | } | ||
88 | |||
89 | |||
90 | lcd_update(); | ||
91 | switch(button_get_w_tmo(HZ/20)) | ||
92 | { | ||
93 | case BUTTON_SCROLL_BACK: | ||
94 | if(state!=0) state--; | ||
95 | break; | ||
96 | |||
97 | case BUTTON_SCROLL_FWD: | ||
98 | if(state!=max_states-1) | ||
99 | { | ||
100 | state++; | ||
101 | } | ||
102 | break; | ||
103 | |||
104 | case DEBUG_CANCEL: | ||
105 | case BUTTON_REL: | ||
106 | lcd_setfont(FONT_UI); | ||
107 | return false; | ||
108 | } | ||
109 | } | ||
110 | |||
111 | lcd_setfont(FONT_UI); | ||
112 | return false; | ||
113 | } | ||
114 | |||
115 | bool dbg_ports(void) | ||
116 | { | ||
117 | int line; | ||
118 | |||
119 | lcd_setfont(FONT_SYSFIXED); | ||
120 | |||
121 | while(1) | ||
122 | { | ||
123 | lcd_clear_display(); | ||
124 | line = 0; | ||
125 | |||
126 | _DEBUG_PRINTF("GPIO 0: %08x",(unsigned int)PDAT(0)); | ||
127 | _DEBUG_PRINTF("GPIO 1: %08x",(unsigned int)PDAT(1)); | ||
128 | _DEBUG_PRINTF("GPIO 2: %08x",(unsigned int)PDAT(2)); | ||
129 | _DEBUG_PRINTF("GPIO 3: %08x",(unsigned int)PDAT(3)); | ||
130 | _DEBUG_PRINTF("GPIO 4: %08x",(unsigned int)PDAT(4)); | ||
131 | _DEBUG_PRINTF("GPIO 5: %08x",(unsigned int)PDAT(5)); | ||
132 | _DEBUG_PRINTF("GPIO 6: %08x",(unsigned int)PDAT(6)); | ||
133 | _DEBUG_PRINTF("GPIO 7: %08x",(unsigned int)PDAT(7)); | ||
134 | _DEBUG_PRINTF("GPIO 8: %08x",(unsigned int)PDAT(8)); | ||
135 | _DEBUG_PRINTF("GPIO 9: %08x",(unsigned int)PDAT(9)); | ||
136 | _DEBUG_PRINTF("GPIO 10: %08x",(unsigned int)PDAT(10)); | ||
137 | _DEBUG_PRINTF("GPIO 11: %08x",(unsigned int)PDAT(11)); | ||
138 | _DEBUG_PRINTF("GPIO 12: %08x",(unsigned int)PDAT(12)); | ||
139 | _DEBUG_PRINTF("GPIO 13: %08x",(unsigned int)PDAT(13)); | ||
140 | _DEBUG_PRINTF("GPIO 14: %08x",(unsigned int)PDAT(14)); | ||
141 | _DEBUG_PRINTF("GPIO 15: %08x",(unsigned int)PDAT(15)); | ||
142 | _DEBUG_PRINTF("USEC : %08x",(unsigned int)USEC_TIMER); | ||
143 | |||
144 | lcd_update(); | ||
145 | if (button_get_w_tmo(HZ/10) == (DEBUG_CANCEL|BUTTON_REL)) | ||
146 | break; | ||
147 | } | ||
148 | lcd_setfont(FONT_UI); | ||
149 | return false; | ||
150 | } | ||
151 | |||
diff --git a/firmware/target/arm/s5l8702/debug-target.h b/firmware/target/arm/s5l8702/debug-target.h new file mode 100644 index 0000000000..79e3115dea --- /dev/null +++ b/firmware/target/arm/s5l8702/debug-target.h | |||
@@ -0,0 +1,33 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: debug-target.h 28522 2010-11-06 14:24:25Z wodz $ | ||
9 | * | ||
10 | * Copyright (C) 2007 by Karl Kurbjun | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #ifndef _DEBUG_TARGET_H_ | ||
23 | #define _DEBUG_TARGET_H_ | ||
24 | |||
25 | #include <stdbool.h> | ||
26 | |||
27 | #define DEBUG_CANCEL BUTTON_MENU | ||
28 | |||
29 | bool __dbg_hw_info(void); | ||
30 | bool dbg_ports(void); | ||
31 | |||
32 | #endif /* _DEBUG_TARGET_H_ */ | ||
33 | |||
diff --git a/firmware/target/arm/s5l8702/i2c-s5l8702.c b/firmware/target/arm/s5l8702/i2c-s5l8702.c new file mode 100644 index 0000000000..be286b34b7 --- /dev/null +++ b/firmware/target/arm/s5l8702/i2c-s5l8702.c | |||
@@ -0,0 +1,186 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: i2c-s5l8700.c 28589 2010-11-14 15:19:30Z theseven $ | ||
9 | * | ||
10 | * Copyright (C) 2009 by Bertrik Sikken | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "config.h" | ||
23 | #include "system.h" | ||
24 | #include "kernel.h" | ||
25 | #include "i2c-s5l8702.h" | ||
26 | |||
27 | /* Driver for the s5l8700 built-in I2C controller in master mode | ||
28 | |||
29 | Both the i2c_read and i2c_write function take the following arguments: | ||
30 | * slave, the address of the i2c slave device to read from / write to | ||
31 | * address, optional sub-address in the i2c slave (unused if -1) | ||
32 | * len, number of bytes to be transfered | ||
33 | * data, pointer to data to be transfered | ||
34 | A return value < 0 indicates an error. | ||
35 | |||
36 | Note: | ||
37 | * blocks the calling thread for the entire duraton of the i2c transfer but | ||
38 | uses wakeup_wait/wakeup_signal to allow other threads to run. | ||
39 | * ACK from slave is not checked, so functions never return an error | ||
40 | */ | ||
41 | |||
42 | static struct mutex i2c_mtx[2]; | ||
43 | |||
44 | void i2c_init(void) | ||
45 | { | ||
46 | mutex_init(&i2c_mtx[0]); | ||
47 | mutex_init(&i2c_mtx[1]); | ||
48 | |||
49 | /* initial config */ | ||
50 | IICADD(0) = 0; | ||
51 | IICADD(1) = 0; | ||
52 | IICCON(0) = (1 << 7) | /* ACK_GEN */ | ||
53 | (0 << 6) | /* CLKSEL = PCLK/16 */ | ||
54 | (1 << 5) | /* INT_EN */ | ||
55 | (1 << 4) | /* IRQ clear */ | ||
56 | (3 << 0); /* CK_REG */ | ||
57 | IICCON(1) = (1 << 7) | /* ACK_GEN */ | ||
58 | (0 << 6) | /* CLKSEL = PCLK/16 */ | ||
59 | (1 << 5) | /* INT_EN */ | ||
60 | (1 << 4) | /* IRQ clear */ | ||
61 | (3 << 0); /* CK_REG */ | ||
62 | |||
63 | /* serial output on */ | ||
64 | IICSTAT(0) = (1 << 4); | ||
65 | IICSTAT(1) = (1 << 4); | ||
66 | } | ||
67 | |||
68 | int i2c_write(int bus, unsigned char slave, int address, int len, const unsigned char *data) | ||
69 | { | ||
70 | mutex_lock(&i2c_mtx[bus]); | ||
71 | long timeout = current_tick + HZ / 50; | ||
72 | |||
73 | /* START */ | ||
74 | IICDS(bus) = slave & ~1; | ||
75 | IICSTAT(bus) = 0xF0; | ||
76 | IICCON(bus) = 0xB3; | ||
77 | while ((IICCON(bus) & 0x10) == 0) | ||
78 | if (TIME_AFTER(current_tick, timeout)) | ||
79 | { | ||
80 | mutex_unlock(&i2c_mtx[bus]); | ||
81 | return 1; | ||
82 | } | ||
83 | |||
84 | |||
85 | if (address >= 0) { | ||
86 | /* write address */ | ||
87 | IICDS(bus) = address; | ||
88 | IICCON(bus) = 0xB3; | ||
89 | while ((IICCON(bus) & 0x10) == 0) | ||
90 | if (TIME_AFTER(current_tick, timeout)) | ||
91 | { | ||
92 | mutex_unlock(&i2c_mtx[bus]); | ||
93 | return 2; | ||
94 | } | ||
95 | } | ||
96 | |||
97 | /* write data */ | ||
98 | while (len--) { | ||
99 | IICDS(bus) = *data++; | ||
100 | IICCON(bus) = 0xB3; | ||
101 | while ((IICCON(bus) & 0x10) == 0) | ||
102 | if (TIME_AFTER(current_tick, timeout)) | ||
103 | { | ||
104 | mutex_unlock(&i2c_mtx[bus]); | ||
105 | return 4; | ||
106 | } | ||
107 | } | ||
108 | |||
109 | /* STOP */ | ||
110 | IICSTAT(bus) = 0xD0; | ||
111 | IICCON(bus) = 0xB3; | ||
112 | while ((IICSTAT(bus) & (1 << 5)) != 0) | ||
113 | if (TIME_AFTER(current_tick, timeout)) | ||
114 | { | ||
115 | mutex_unlock(&i2c_mtx[bus]); | ||
116 | return 5; | ||
117 | } | ||
118 | |||
119 | mutex_unlock(&i2c_mtx[bus]); | ||
120 | return 0; | ||
121 | } | ||
122 | |||
123 | int i2c_read(int bus, unsigned char slave, int address, int len, unsigned char *data) | ||
124 | { | ||
125 | mutex_lock(&i2c_mtx[bus]); | ||
126 | long timeout = current_tick + HZ / 50; | ||
127 | |||
128 | if (address >= 0) { | ||
129 | /* START */ | ||
130 | IICDS(bus) = slave & ~1; | ||
131 | IICSTAT(bus) = 0xF0; | ||
132 | IICCON(bus) = 0xB3; | ||
133 | while ((IICCON(bus) & 0x10) == 0) | ||
134 | if (TIME_AFTER(current_tick, timeout)) | ||
135 | { | ||
136 | mutex_unlock(&i2c_mtx[bus]); | ||
137 | return 1; | ||
138 | } | ||
139 | |||
140 | /* write address */ | ||
141 | IICDS(bus) = address; | ||
142 | IICCON(bus) = 0xB3; | ||
143 | while ((IICCON(bus) & 0x10) == 0) | ||
144 | if (TIME_AFTER(current_tick, timeout)) | ||
145 | { | ||
146 | mutex_unlock(&i2c_mtx[bus]); | ||
147 | return 2; | ||
148 | } | ||
149 | } | ||
150 | |||
151 | /* (repeated) START */ | ||
152 | IICDS(bus) = slave | 1; | ||
153 | IICSTAT(bus) = 0xB0; | ||
154 | IICCON(bus) = 0xB3; | ||
155 | while ((IICCON(bus) & 0x10) == 0) | ||
156 | if (TIME_AFTER(current_tick, timeout)) | ||
157 | { | ||
158 | mutex_unlock(&i2c_mtx[bus]); | ||
159 | return 3; | ||
160 | } | ||
161 | |||
162 | while (len--) { | ||
163 | IICCON(bus) = (len == 0) ? 0x33 : 0xB3; /* NAK or ACK */ | ||
164 | while ((IICCON(bus) & 0x10) == 0) | ||
165 | if (TIME_AFTER(current_tick, timeout)) | ||
166 | { | ||
167 | mutex_unlock(&i2c_mtx[bus]); | ||
168 | return 4; | ||
169 | } | ||
170 | *data++ = IICDS(bus); | ||
171 | } | ||
172 | |||
173 | /* STOP */ | ||
174 | IICSTAT(bus) = 0x90; | ||
175 | IICCON(bus) = 0xB3; | ||
176 | while ((IICSTAT(bus) & (1 << 5)) != 0) | ||
177 | if (TIME_AFTER(current_tick, timeout)) | ||
178 | { | ||
179 | mutex_unlock(&i2c_mtx[bus]); | ||
180 | return 5; | ||
181 | } | ||
182 | |||
183 | mutex_unlock(&i2c_mtx[bus]); | ||
184 | return 0; | ||
185 | } | ||
186 | |||
diff --git a/firmware/target/arm/s5l8702/ipod6g/adc-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/adc-ipod6g.c new file mode 100644 index 0000000000..201af5ee00 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/adc-ipod6g.c | |||
@@ -0,0 +1,39 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: adc-s5l8700.c 21775 2009-07-11 14:12:02Z bertrik $ | ||
9 | * | ||
10 | * Copyright (C) 2009 by Bertrik Sikken | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "config.h" | ||
23 | |||
24 | #include "inttypes.h" | ||
25 | #include "s5l8702.h" | ||
26 | #include "adc.h" | ||
27 | #include "adc-target.h" | ||
28 | #include "pmu-target.h" | ||
29 | #include "kernel.h" | ||
30 | |||
31 | unsigned short adc_read(int channel) | ||
32 | { | ||
33 | return pmu_read_adc(channel); | ||
34 | } | ||
35 | |||
36 | void adc_init(void) | ||
37 | { | ||
38 | } | ||
39 | |||
diff --git a/firmware/target/arm/s5l8702/ipod6g/adc-target.h b/firmware/target/arm/s5l8702/ipod6g/adc-target.h new file mode 100644 index 0000000000..d4dce3d31f --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/adc-target.h | |||
@@ -0,0 +1,33 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: adc-target.h 21734 2009-07-09 20:17:47Z bertrik $ | ||
9 | * | ||
10 | * Copyright (C) 2006 by Barry Wardell | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef _ADC_TARGET_H_ | ||
22 | #define _ADC_TARGET_H_ | ||
23 | |||
24 | #define NUM_ADC_CHANNELS 4 | ||
25 | |||
26 | #define ADC_UNKNOWN_0 0 | ||
27 | #define ADC_UNKNOWN_1 1 | ||
28 | #define ADC_BATTERY 2 | ||
29 | #define ADC_UNKNOWN_3 3 | ||
30 | |||
31 | #define ADC_UNREG_POWER ADC_BATTERY /* For compatibility */ | ||
32 | |||
33 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/ata-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/ata-ipod6g.c new file mode 100644 index 0000000000..f1577ee857 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/ata-ipod6g.c | |||
@@ -0,0 +1,197 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: ata-meg-fx.c 27935 2010-08-28 23:12:11Z funman $ | ||
9 | * | ||
10 | * Copyright (C) 2011 by Michael Sparmann | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "config.h" | ||
22 | #include "cpu.h" | ||
23 | #include "kernel.h" | ||
24 | #include "thread.h" | ||
25 | #include "system.h" | ||
26 | #include "power.h" | ||
27 | #include "panic.h" | ||
28 | #include "pmu-target.h" | ||
29 | #include "ata.h" | ||
30 | #include "ata-target.h" | ||
31 | #include "s5l8702.h" | ||
32 | |||
33 | |||
34 | static struct wakeup ata_wakeup; | ||
35 | |||
36 | #ifdef HAVE_ATA_DMA | ||
37 | static uint32_t ata_dma_flags; | ||
38 | #endif | ||
39 | |||
40 | |||
41 | void ata_reset(void) | ||
42 | { | ||
43 | ATA_SWRST = 1; | ||
44 | sleep(HZ / 100); | ||
45 | ATA_SWRST = 0; | ||
46 | sleep(HZ / 10); | ||
47 | } | ||
48 | |||
49 | void ata_enable(bool on) | ||
50 | { | ||
51 | if (on) | ||
52 | { | ||
53 | PWRCON(0) &= ~(1 << 5); | ||
54 | ATA_CFG = 0x41; | ||
55 | sleep(HZ / 100); | ||
56 | ATA_CFG = 0x40; | ||
57 | sleep(HZ / 20); | ||
58 | ata_reset(); | ||
59 | ATA_CCONTROL = 1; | ||
60 | sleep(HZ / 5); | ||
61 | ATA_PIO_TIME = 0x191f7; | ||
62 | *ATA_HCYL = 0; | ||
63 | while (!(ATA_PIO_READY & 2)) yield(); | ||
64 | } | ||
65 | else | ||
66 | { | ||
67 | ATA_CCONTROL = 0; | ||
68 | while (!(ATA_CCONTROL & 2)) yield(); | ||
69 | PWRCON(1) |= 1 << 5; | ||
70 | } | ||
71 | } | ||
72 | |||
73 | bool ata_is_coldstart(void) | ||
74 | { | ||
75 | return false; | ||
76 | } | ||
77 | |||
78 | void ata_device_init(void) | ||
79 | { | ||
80 | VIC0INTENABLE = 1 << IRQ_ATA; | ||
81 | } | ||
82 | |||
83 | uint16_t ata_read_cbr(uint32_t volatile* reg) | ||
84 | { | ||
85 | while (!(ATA_PIO_READY & 2)); | ||
86 | volatile uint32_t __attribute__((unused)) dummy = *reg; | ||
87 | while (!(ATA_PIO_READY & 1)); | ||
88 | return ATA_PIO_RDATA; | ||
89 | } | ||
90 | |||
91 | void ata_write_cbr(uint32_t volatile* reg, uint16_t data) | ||
92 | { | ||
93 | while (!(ATA_PIO_READY & 2)); | ||
94 | *reg = data; | ||
95 | } | ||
96 | |||
97 | void ata_set_pio_timings(int mode) | ||
98 | { | ||
99 | if (mode >= 4) ATA_PIO_TIME = 0x7083; | ||
100 | if (mode >= 3) ATA_PIO_TIME = 0x2072; | ||
101 | else ATA_PIO_TIME = 0x11f3; | ||
102 | } | ||
103 | |||
104 | #ifdef HAVE_ATA_DMA | ||
105 | static void ata_set_mdma_timings(unsigned int mode) | ||
106 | { | ||
107 | if (mode >= 2) ATA_MDMA_TIME = 0x5072; | ||
108 | if (mode >= 1) ATA_MDMA_TIME = 0x7083; | ||
109 | else ATA_MDMA_TIME = 0x1c175; | ||
110 | } | ||
111 | |||
112 | static void ata_set_udma_timings(unsigned int mode) | ||
113 | { | ||
114 | if (mode >= 4) ATA_UDMA_TIME = 0x2010a52; | ||
115 | if (mode >= 3) ATA_UDMA_TIME = 0x2020a52; | ||
116 | if (mode >= 2) ATA_UDMA_TIME = 0x3030a52; | ||
117 | if (mode >= 1) ATA_UDMA_TIME = 0x3050a52; | ||
118 | else ATA_UDMA_TIME = 0x5071152; | ||
119 | } | ||
120 | |||
121 | void ata_dma_set_mode(unsigned char mode) | ||
122 | { | ||
123 | unsigned int modeidx = mode & 0x07; | ||
124 | unsigned int dmamode = mode & 0xf8; | ||
125 | |||
126 | if (dmamode == 0x40 && modeidx <= ATA_MAX_UDMA) | ||
127 | { | ||
128 | /* Using Ultra DMA */ | ||
129 | ata_set_udma_timings(dmamode); | ||
130 | ata_dma_flags = 0x60c; | ||
131 | } | ||
132 | else if (dmamode == 0x20 && modeidx <= ATA_MAX_MWDMA) | ||
133 | { | ||
134 | /* Using Multiword DMA */ | ||
135 | ata_set_mdma_timings(dmamode); | ||
136 | ata_dma_flags = 0x408; | ||
137 | } | ||
138 | else | ||
139 | { | ||
140 | /* Don't understand this - force PIO. */ | ||
141 | ata_dma_flags = 0; | ||
142 | } | ||
143 | } | ||
144 | |||
145 | bool ata_dma_setup(void *addr, unsigned long bytes, bool write) | ||
146 | { | ||
147 | if ((((int)addr) & 0xf) || (((int)bytes) & 0xf) || !ata_dma_flags) | ||
148 | return false; | ||
149 | |||
150 | if (write) clean_dcache(); | ||
151 | else invalidate_dcache(); | ||
152 | ATA_CCOMMAND = 2; | ||
153 | |||
154 | if (write) | ||
155 | { | ||
156 | ATA_SBUF_START = addr; | ||
157 | ATA_SBUF_SIZE = bytes; | ||
158 | ATA_CFG |= 0x10; | ||
159 | } | ||
160 | else | ||
161 | { | ||
162 | ATA_TBUF_START = addr; | ||
163 | ATA_TBUF_SIZE = bytes; | ||
164 | ATA_CFG &= ~0x10; | ||
165 | } | ||
166 | ATA_XFR_NUM = bytes - 1; | ||
167 | |||
168 | return true; | ||
169 | } | ||
170 | |||
171 | bool ata_dma_finish(void) | ||
172 | { | ||
173 | ATA_CFG |= ata_dma_flags; | ||
174 | ATA_CFG &= ~0x180; | ||
175 | wakeup_wait(&ata_wakeup, TIMEOUT_NOBLOCK); | ||
176 | ATA_IRQ = 0x1f; | ||
177 | ATA_IRQ_MASK = 1; | ||
178 | ATA_CCOMMAND = 1; | ||
179 | if (wakeup_wait(&ata_wakeup, HZ / 2) != OBJ_WAIT_SUCCEEDED) | ||
180 | { | ||
181 | ATA_CCOMMAND = 2; | ||
182 | ATA_CFG &= ~0x100c; | ||
183 | return false; | ||
184 | } | ||
185 | ATA_CCOMMAND = 2; | ||
186 | ATA_CFG &= ~0x100c; | ||
187 | return true; | ||
188 | } | ||
189 | #endif /* HAVE_ATA_DMA */ | ||
190 | |||
191 | void INT_ATA(void) | ||
192 | { | ||
193 | uint32_t ata_irq = ATA_IRQ; | ||
194 | ATA_IRQ = ata_irq; | ||
195 | if (ata_irq & ATA_IRQ_MASK) wakeup_signal(&ata_wakeup); | ||
196 | ATA_IRQ_MASK = 0; | ||
197 | } | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/ata-target.h b/firmware/target/arm/s5l8702/ipod6g/ata-target.h new file mode 100644 index 0000000000..e2e7bd298c --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/ata-target.h | |||
@@ -0,0 +1,47 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: ata-target.h 25525 2010-04-07 20:01:21Z torne $ | ||
9 | * | ||
10 | * Copyright (C) 2011 by Michael Sparmann | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef ATA_TARGET_H | ||
22 | #define ATA_TARGET_H | ||
23 | |||
24 | #include "inttypes.h" | ||
25 | #include "s5l8702.h" | ||
26 | |||
27 | #ifdef BOOTLOADER | ||
28 | #define ATA_DRIVER_CLOSE | ||
29 | #endif | ||
30 | |||
31 | #define ATA_SWAP_IDENTIFY(word) (swap16(word)) | ||
32 | |||
33 | void ata_reset(void); | ||
34 | void ata_device_init(void); | ||
35 | bool ata_is_coldstart(void); | ||
36 | uint16_t ata_read_cbr(uint32_t volatile* reg); | ||
37 | void ata_write_cbr(uint32_t volatile* reg, uint16_t data); | ||
38 | |||
39 | #define ATA_OUT8(reg, data) ata_write_cbr(reg, data) | ||
40 | #define ATA_OUT16(reg, data) ata_write_cbr(reg, data) | ||
41 | #define ATA_IN8(reg) ata_read_cbr(reg) | ||
42 | #define ATA_IN16(reg) ata_read_cbr(reg) | ||
43 | |||
44 | #define ATA_SET_DEVICE_FEATURES | ||
45 | void ata_set_pio_timings(int mode); | ||
46 | |||
47 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/audio-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/audio-ipod6g.c new file mode 100644 index 0000000000..6ede3d0c30 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/audio-ipod6g.c | |||
@@ -0,0 +1,65 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: audio-nano2g.c 23095 2009-10-11 09:17:12Z dave $ | ||
9 | * | ||
10 | * Copyright (C) 2006 by Michael Sevakis | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "system.h" | ||
22 | #include "cpu.h" | ||
23 | #include "audio.h" | ||
24 | #include "sound.h" | ||
25 | |||
26 | #if INPUT_SRC_CAPS != 0 | ||
27 | void audio_set_output_source(int source) | ||
28 | { | ||
29 | if ((unsigned)source >= AUDIO_NUM_SOURCES) | ||
30 | source = AUDIO_SRC_PLAYBACK; | ||
31 | } /* audio_set_output_source */ | ||
32 | |||
33 | void audio_input_mux(int source, unsigned flags) | ||
34 | { | ||
35 | (void)flags; | ||
36 | /* Prevent pops from unneeded switching */ | ||
37 | static int last_source = AUDIO_SRC_PLAYBACK; | ||
38 | |||
39 | switch (source) | ||
40 | { | ||
41 | default: /* playback - no recording */ | ||
42 | source = AUDIO_SRC_PLAYBACK; | ||
43 | case AUDIO_SRC_PLAYBACK: | ||
44 | #ifdef HAVE_RECORDING | ||
45 | if (source != last_source) | ||
46 | { | ||
47 | audiohw_set_monitor(false); | ||
48 | audiohw_disable_recording(); | ||
49 | } | ||
50 | #endif | ||
51 | break; | ||
52 | #ifdef HAVE_LINE_REC | ||
53 | case AUDIO_SRC_LINEIN: /* recording only */ | ||
54 | if (source != last_source) | ||
55 | { | ||
56 | audiohw_set_monitor(false); | ||
57 | audiohw_enable_recording(false); /* source line */ | ||
58 | } | ||
59 | break; | ||
60 | #endif | ||
61 | } /* end switch */ | ||
62 | |||
63 | last_source = source; | ||
64 | } /* audio_input_mux */ | ||
65 | #endif /* INPUT_SRC_CAPS != 0 */ | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/backlight-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/backlight-ipod6g.c new file mode 100644 index 0000000000..dc21d161de --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/backlight-ipod6g.c | |||
@@ -0,0 +1,67 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: backlight-nano2g.c 28601 2010-11-14 20:39:18Z theseven $ | ||
9 | * | ||
10 | * Copyright (C) 2009 by Dave Chapman | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include <stdbool.h> | ||
22 | |||
23 | #include "config.h" | ||
24 | #include "kernel.h" | ||
25 | #include "backlight.h" | ||
26 | #include "backlight-target.h" | ||
27 | #include "pmu-target.h" | ||
28 | |||
29 | #ifdef HAVE_LCD_SLEEP | ||
30 | bool lcd_active(void); | ||
31 | void lcd_awake(void); | ||
32 | void lcd_update(void); | ||
33 | #endif | ||
34 | |||
35 | void _backlight_set_brightness(int brightness) | ||
36 | { | ||
37 | pmu_write(0x28, brightness); | ||
38 | } | ||
39 | |||
40 | void _backlight_on(void) | ||
41 | { | ||
42 | #ifdef HAVE_LCD_SLEEP | ||
43 | if (!lcd_active()) | ||
44 | { | ||
45 | lcd_awake(); | ||
46 | lcd_update(); | ||
47 | sleep(HZ/8); | ||
48 | } | ||
49 | #endif | ||
50 | pmu_write(0x29, 1); | ||
51 | } | ||
52 | |||
53 | void _backlight_off(void) | ||
54 | { | ||
55 | pmu_write(0x29, 0); | ||
56 | } | ||
57 | |||
58 | bool _backlight_init(void) | ||
59 | { | ||
60 | pmu_write(0x2a, 6); | ||
61 | pmu_write(0x28, 0x20); | ||
62 | pmu_write(0x2b, 20); | ||
63 | |||
64 | _backlight_on(); | ||
65 | |||
66 | return true; | ||
67 | } | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/backlight-target.h b/firmware/target/arm/s5l8702/ipod6g/backlight-target.h new file mode 100644 index 0000000000..05a8addfea --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/backlight-target.h | |||
@@ -0,0 +1,29 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: backlight-target.h 21478 2009-06-23 18:11:03Z bertrik $ | ||
9 | * | ||
10 | * Copyright (C) 2008 by Marcoen Hirschberg | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef BACKLIGHT_TARGET_H | ||
22 | #define BACKLIGHT_TARGET_H | ||
23 | |||
24 | bool _backlight_init(void); | ||
25 | void _backlight_on(void); | ||
26 | void _backlight_off(void); | ||
27 | void _backlight_set_brightness(int brightness); | ||
28 | |||
29 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/button-target.h b/firmware/target/arm/s5l8702/ipod6g/button-target.h new file mode 100644 index 0000000000..0bd89d1d2a --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/button-target.h | |||
@@ -0,0 +1,78 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: button-target.h 21828 2009-07-12 22:16:51Z dave $ | ||
9 | * | ||
10 | * Copyright (C) 2006 by Barry Wardell | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef _BUTTON_TARGET_H_ | ||
22 | #define _BUTTON_TARGET_H_ | ||
23 | |||
24 | #include <stdbool.h> | ||
25 | #include "config.h" | ||
26 | |||
27 | #define HAS_BUTTON_HOLD | ||
28 | |||
29 | bool button_hold(void); | ||
30 | void button_init_device(void); | ||
31 | int button_read_device(void); | ||
32 | |||
33 | void ipod_mini_button_int(void); | ||
34 | void ipod_3g_button_int(void); | ||
35 | void ipod_4g_button_int(void); | ||
36 | |||
37 | /* iPod specific button codes */ | ||
38 | |||
39 | #define BUTTON_SELECT 0x00000001 | ||
40 | #define BUTTON_MENU 0x00000002 | ||
41 | |||
42 | #define BUTTON_LEFT 0x00000004 | ||
43 | #define BUTTON_RIGHT 0x00000008 | ||
44 | #define BUTTON_SCROLL_FWD 0x00000010 | ||
45 | #define BUTTON_SCROLL_BACK 0x00000020 | ||
46 | |||
47 | #define BUTTON_PLAY 0x00000040 | ||
48 | |||
49 | #define BUTTON_MAIN (BUTTON_SELECT|BUTTON_MENU\ | ||
50 | |BUTTON_LEFT|BUTTON_RIGHT|BUTTON_SCROLL_FWD\ | ||
51 | |BUTTON_SCROLL_BACK|BUTTON_PLAY) | ||
52 | |||
53 | /* Remote control's buttons */ | ||
54 | #ifdef IPOD_ACCESSORY_PROTOCOL | ||
55 | #define BUTTON_RC_PLAY 0x00100000 | ||
56 | #define BUTTON_RC_STOP 0x00080000 | ||
57 | |||
58 | #define BUTTON_RC_LEFT 0x00040000 | ||
59 | #define BUTTON_RC_RIGHT 0x00020000 | ||
60 | #define BUTTON_RC_VOL_UP 0x00010000 | ||
61 | #define BUTTON_RC_VOL_DOWN 0x00008000 | ||
62 | |||
63 | #define BUTTON_REMOTE (BUTTON_RC_PLAY|BUTTON_RC_STOP\ | ||
64 | |BUTTON_RC_LEFT|BUTTON_RC_RIGHT\ | ||
65 | |BUTTON_RC_VOL_UP|BUTTON_RC_VOL_DOWN) | ||
66 | #else | ||
67 | #define BUTTON_REMOTE 0 | ||
68 | #endif | ||
69 | |||
70 | /* This is for later | ||
71 | #define BUTTON_SCROLL_TOUCH 0x00000200 | ||
72 | */ | ||
73 | |||
74 | |||
75 | #define POWEROFF_BUTTON BUTTON_PLAY | ||
76 | #define POWEROFF_COUNT 40 | ||
77 | |||
78 | #endif /* _BUTTON_TARGET_H_ */ | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/cscodec-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/cscodec-ipod6g.c new file mode 100644 index 0000000000..460b254730 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/cscodec-ipod6g.c | |||
@@ -0,0 +1,64 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: wmcodec-s5l8700.c 22025 2009-07-25 00:49:13Z dave $ | ||
9 | * | ||
10 | * S5L8702-specific code for Cirrus codecs | ||
11 | * | ||
12 | * Copyright (c) 2010 Michael Sparmann | ||
13 | * | ||
14 | * This program is free software; you can redistribute it and/or | ||
15 | * modify it under the terms of the GNU General Public License | ||
16 | * as published by the Free Software Foundation; either version 2 | ||
17 | * of the License, or (at your option) any later version. | ||
18 | * | ||
19 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
20 | * KIND, either express or implied. | ||
21 | * | ||
22 | ****************************************************************************/ | ||
23 | |||
24 | #include "system.h" | ||
25 | #include "audiohw.h" | ||
26 | #include "i2c-s5l8702.h" | ||
27 | #include "s5l8702.h" | ||
28 | #include "cscodec.h" | ||
29 | |||
30 | void audiohw_init(void) | ||
31 | { | ||
32 | #ifdef HAVE_CS42L55 | ||
33 | audiohw_preinit(); | ||
34 | #endif | ||
35 | } | ||
36 | |||
37 | unsigned char cscodec_read(int reg) | ||
38 | { | ||
39 | unsigned char data; | ||
40 | i2c_read(0, 0x94, reg, 1, &data); | ||
41 | return data; | ||
42 | } | ||
43 | |||
44 | void cscodec_write(int reg, unsigned char data) | ||
45 | { | ||
46 | i2c_write(0, 0x94, reg, 1, &data); | ||
47 | } | ||
48 | |||
49 | void cscodec_power(bool state) | ||
50 | { | ||
51 | (void)state; //TODO: Figure out which LDO this is | ||
52 | } | ||
53 | |||
54 | void cscodec_reset(bool state) | ||
55 | { | ||
56 | if (state) PDAT(3) &= ~8; | ||
57 | else PDAT(3) |= 8; | ||
58 | } | ||
59 | |||
60 | void cscodec_clock(bool state) | ||
61 | { | ||
62 | if (state) CLKCON0C &= ~0xffff; | ||
63 | else CLKCON0C |= 0x8000; | ||
64 | } | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/lcd-asm-ipod6g.S b/firmware/target/arm/s5l8702/ipod6g/lcd-asm-ipod6g.S new file mode 100644 index 0000000000..2b170f329b --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/lcd-asm-ipod6g.S | |||
@@ -0,0 +1,295 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: lcd-as-video.S 26756 2010-06-11 04:41:36Z funman $ | ||
9 | * | ||
10 | * Copyright (C) 2010 by Andree Buschmann | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | /**************************************************************************** | ||
23 | * #define FORCE_FIFO_WAIT | ||
24 | * | ||
25 | * This is not needed in YUV blitting when the LCD IF is fast enough. In this | ||
26 | * case YUV-to-RGB conversion per pixel needs longer than the transfer of a | ||
27 | * pixel via the LCD IF. For iPod nano 2G this is true if the LCD IF is | ||
28 | * configured to use LCD_PHTIME = 0x00 (see lcd-nano2g.c). | ||
29 | ****************************************************************************/ | ||
30 | |||
31 | #include "config.h" | ||
32 | |||
33 | .section .icode, "ax", %progbits | ||
34 | |||
35 | /**************************************************************************** | ||
36 | * void lcd_write_line(const fb_data *addr, | ||
37 | * int pixelcount, | ||
38 | * const unsigned int lcd_base_addr); | ||
39 | * | ||
40 | * Writes pixelcount pixels from src-pointer (lcd_framebuffer) to LCD dataport. | ||
41 | */ | ||
42 | .align 2 | ||
43 | .global lcd_write_line | ||
44 | .type lcd_write_line, %function | ||
45 | /* r0 = addr, must be aligned */ | ||
46 | /* r1 = pixel count, must be even */ | ||
47 | lcd_write_line: /* r2 = LCD_BASE */ | ||
48 | stmfd sp!, {r4-r6, lr} /* save non-scratch registers */ | ||
49 | add r12, r2, #0x40 /* LCD_WDATA = LCD data port */ | ||
50 | |||
51 | .loop: | ||
52 | ldmia r0!, {r3, r5} /* read 2 pixel (=8 byte) */ | ||
53 | |||
54 | /* wait for FIFO half full */ | ||
55 | .fifo_wait: | ||
56 | ldr lr, [r2, #0x1C] /* while (LCD_STATUS & 0x08); */ | ||
57 | tst lr, #0x8 | ||
58 | bgt .fifo_wait | ||
59 | |||
60 | mov r4, r3, asr #16 /* r3 = 1st pixel, r4 = 2nd pixel */ | ||
61 | mov r6, r5, asr #16 /* r5 = 3rd pixel, r6 = 4th pixel */ | ||
62 | stmia r12, {r3-r6} /* write pixels (lowest 16 bit used) */ | ||
63 | |||
64 | subs r1, r1, #4 | ||
65 | bgt .loop | ||
66 | |||
67 | ldmpc regs=r4-r6 | ||
68 | |||
69 | /**************************************************************************** | ||
70 | * extern void lcd_write_yuv420_lines(unsigned char const * const src[3], | ||
71 | * const unsigned LCD_BASE, | ||
72 | * int width, | ||
73 | * int stride); | ||
74 | * | ||
75 | * Conversion from Motion JPEG and MPEG Y'PbPr to RGB is: | ||
76 | * |R| |1.164 0.000 1.596| |Y' - 16| | ||
77 | * |G| = |1.164 -0.391 -0.813| |Pb - 128| | ||
78 | * |B| |1.164 2.018 0.000| |Pr - 128| | ||
79 | * | ||
80 | * Scaled, normalized, rounded and tweaked to yield RGB 565: | ||
81 | * |R| |74 0 101| |Y' - 16| >> 9 | ||
82 | * |G| = |74 -24 -51| |Cb - 128| >> 8 | ||
83 | * |B| |74 128 0| |Cr - 128| >> 9 | ||
84 | * | ||
85 | * Converts two lines from YUV to RGB565 and writes to LCD at once. First loop | ||
86 | * loads Cb/Cr, calculates the chroma offset and saves them to buffer. Within | ||
87 | * the second loop these chroma offset are reloaded from buffer. Within each | ||
88 | * loop two pixels are calculated and written to LCD. | ||
89 | */ | ||
90 | .align 2 | ||
91 | .global lcd_write_yuv420_lines | ||
92 | .type lcd_write_yuv420_lines, %function | ||
93 | lcd_write_yuv420_lines: | ||
94 | /* r0 = src = yuv_src */ | ||
95 | /* r1 = dst = LCD_BASE */ | ||
96 | /* r2 = width */ | ||
97 | /* r3 = stride */ | ||
98 | stmfd sp!, { r4-r10, lr } /* save non-scratch */ | ||
99 | ldmia r0, { r9, r10, r12 } /* r9 = yuv_src[0] = Y'_p */ | ||
100 | /* r10 = yuv_src[1] = Cb_p */ | ||
101 | /* r12 = yuv_src[2] = Cr_p */ | ||
102 | add r3, r9, r3 /* r3 = &ysrc[stride] */ | ||
103 | add r4, r2, r2, asr #1 /* chroma buffer lenght = width/2 *3 */ | ||
104 | mov r4, r4, asl #2 /* use words for str/ldm possibility */ | ||
105 | add r4, r4, #19 /* plus room for 4 additional words, */ | ||
106 | bic r4, r4, #3 /* rounded up to multiples of 4 byte */ | ||
107 | sub sp, sp, r4 /* and allocate on stack */ | ||
108 | stmia sp, {r1-r4} /* LCD_BASE, width, &ysrc[stride], stack_alloc */ | ||
109 | |||
110 | mov r7, r2 /* r7 = loop count */ | ||
111 | add r8, sp, #16 /* chroma buffer */ | ||
112 | add lr, r1, #0x40 /* LCD data port = LCD_BASE + 0x40 */ | ||
113 | |||
114 | /* 1st loop start */ | ||
115 | 10: /* loop start */ | ||
116 | |||
117 | ldrb r0, [r10], #1 /* r0 = *usrc++ = *Cb_p++ */ | ||
118 | ldrb r1, [r12], #1 /* r1 = *vsrc++ = *Cr_p++ */ | ||
119 | |||
120 | sub r0, r0, #128 /* r0 = Cb-128 */ | ||
121 | sub r1, r1, #128 /* r1 = Cr-128 */ | ||
122 | |||
123 | add r2, r1, r1, asl #1 /* r2 = Cr*51 + Cb*24 */ | ||
124 | add r2, r2, r2, asl #4 | ||
125 | add r2, r2, r0, asl #3 | ||
126 | add r2, r2, r0, asl #4 | ||
127 | |||
128 | add r4, r1, r1, asl #2 /* r1 = Cr*101 */ | ||
129 | add r4, r4, r1, asl #5 | ||
130 | add r1, r4, r1, asl #6 | ||
131 | |||
132 | add r1, r1, #256 /* r1 = rv = (r1 + 256) >> 9 */ | ||
133 | mov r1, r1, asr #9 | ||
134 | rsb r2, r2, #128 /* r2 = guv = (-r2 + 128) >> 8 */ | ||
135 | mov r2, r2, asr #8 | ||
136 | add r0, r0, #2 /* r0 = bu = (Cb*128 + 256) >> 9 */ | ||
137 | mov r0, r0, asr #2 | ||
138 | stmia r8!, {r0-r2} /* store r0, r1 and r2 to chroma buffer */ | ||
139 | |||
140 | /* 1st loop, first pixel */ | ||
141 | ldrb r5, [r9], #1 /* r5 = *ysrc++ = *Y'_p++ */ | ||
142 | sub r5, r5, #16 /* r5 = (Y'-16) * 74 */ | ||
143 | add r3, r5, r5, asl #2 | ||
144 | add r5, r3, r5, asl #5 | ||
145 | |||
146 | add r6, r1, r5, asr #8 /* r6 = r = (Y >> 9) + rv */ | ||
147 | add r3, r2, r5, asr #7 /* r3 = g = (Y >> 8) + guv */ | ||
148 | add r4, r0, r5, asr #8 /* r4 = b = (Y >> 9) + bu */ | ||
149 | |||
150 | orr r5, r6, r4 /* check if clamping is needed... */ | ||
151 | orr r5, r5, r3, asr #1 /* ...at all */ | ||
152 | cmp r5, #31 | ||
153 | bls 15f /* -> no clamp */ | ||
154 | cmp r6, #31 /* clamp r */ | ||
155 | mvnhi r6, r6, asr #31 | ||
156 | andhi r6, r6, #31 | ||
157 | cmp r3, #63 /* clamp g */ | ||
158 | mvnhi r3, r3, asr #31 | ||
159 | andhi r3, r3, #63 | ||
160 | cmp r4, #31 /* clamp b */ | ||
161 | mvnhi r4, r4, asr #31 | ||
162 | andhi r4, r4, #31 | ||
163 | 15: /* no clamp */ | ||
164 | |||
165 | /* calculate pixel_1 and save to r4 for later pixel packing */ | ||
166 | orr r4, r4, r3, lsl #5 /* pixel_1 = r<<11 | g<<5 | b */ | ||
167 | orr r4, r4, r6, lsl #11 /* r4 = pixel_1 */ | ||
168 | |||
169 | /* 1st loop, second pixel */ | ||
170 | ldrb r5, [r9], #1 /* r5 = *ysrc++ = *Y'_p++ */ | ||
171 | sub r5, r5, #16 /* r5 = (Y'-16) * 74 */ | ||
172 | add r3, r5, r5, asl #2 | ||
173 | add r5, r3, r5, asl #5 | ||
174 | |||
175 | add r6, r1, r5, asr #8 /* r6 = r = (Y >> 9) + rv */ | ||
176 | add r3, r2, r5, asr #7 /* r3 = g = (Y >> 8) + guv */ | ||
177 | add r5, r0, r5, asr #8 /* r5 = b = (Y >> 9) + bu */ | ||
178 | |||
179 | orr r0, r6, r5 /* check if clamping is needed... */ | ||
180 | orr r0, r0, r3, asr #1 /* ...at all */ | ||
181 | cmp r0, #31 | ||
182 | bls 15f /* -> no clamp */ | ||
183 | cmp r6, #31 /* clamp r */ | ||
184 | mvnhi r6, r6, asr #31 | ||
185 | andhi r6, r6, #31 | ||
186 | cmp r3, #63 /* clamp g */ | ||
187 | mvnhi r3, r3, asr #31 | ||
188 | andhi r3, r3, #63 | ||
189 | cmp r5, #31 /* clamp b */ | ||
190 | mvnhi r5, r5, asr #31 | ||
191 | andhi r5, r5, #31 | ||
192 | 15: /* no clamp */ | ||
193 | |||
194 | /* calculate pixel_2 and pack with pixel_1 before writing */ | ||
195 | orr r5, r5, r3, lsl #5 /* pixel_2 = r<<11 | g<<5 | b */ | ||
196 | orr r5, r5, r6, lsl #11 /* r5 = pixel_2 */ | ||
197 | #ifdef FORCE_FIFO_WAIT | ||
198 | /* wait for FIFO half full */ | ||
199 | .fifo_wait1: | ||
200 | ldr r3, [lr, #-0x24] /* while (LCD_STATUS & 0x08); */ | ||
201 | tst r3, #0x8 | ||
202 | bgt .fifo_wait1 | ||
203 | #endif | ||
204 | stmia lr, {r4,r5} /* write pixel_1 and pixel_2 */ | ||
205 | |||
206 | subs r7, r7, #2 /* check for loop end */ | ||
207 | bgt 10b /* back to beginning */ | ||
208 | /* 1st loop end */ | ||
209 | |||
210 | /* Reload several registers for pointer rewinding for next loop */ | ||
211 | add r8, sp, #16 /* chroma buffer */ | ||
212 | ldmia sp, { r1, r7, r9} /* r1 = LCD_BASE */ | ||
213 | /* r7 = loop count */ | ||
214 | /* r9 = &ysrc[stride] */ | ||
215 | |||
216 | /* 2nd loop start */ | ||
217 | 20: /* loop start */ | ||
218 | /* restore r0 (bu), r1 (rv) and r2 (guv) from chroma buffer */ | ||
219 | ldmia r8!, {r0-r2} | ||
220 | |||
221 | /* 2nd loop, first pixel */ | ||
222 | ldrb r5, [r9], #1 /* r5 = *ysrc++ = *Y'_p++ */ | ||
223 | sub r5, r5, #16 /* r5 = (Y'-16) * 74 */ | ||
224 | add r3, r5, r5, asl #2 | ||
225 | add r5, r3, r5, asl #5 | ||
226 | |||
227 | add r6, r1, r5, asr #8 /* r6 = r = (Y >> 9) + rv */ | ||
228 | add r3, r2, r5, asr #7 /* r3 = g = (Y >> 8) + guv */ | ||
229 | add r4, r0, r5, asr #8 /* r4 = b = (Y >> 9) + bu */ | ||
230 | |||
231 | orr r5, r6, r4 /* check if clamping is needed... */ | ||
232 | orr r5, r5, r3, asr #1 /* ...at all */ | ||
233 | cmp r5, #31 | ||
234 | bls 15f /* -> no clamp */ | ||
235 | cmp r6, #31 /* clamp r */ | ||
236 | mvnhi r6, r6, asr #31 | ||
237 | andhi r6, r6, #31 | ||
238 | cmp r3, #63 /* clamp g */ | ||
239 | mvnhi r3, r3, asr #31 | ||
240 | andhi r3, r3, #63 | ||
241 | cmp r4, #31 /* clamp b */ | ||
242 | mvnhi r4, r4, asr #31 | ||
243 | andhi r4, r4, #31 | ||
244 | 15: /* no clamp */ | ||
245 | /* calculate pixel_1 and save to r4 for later pixel packing */ | ||
246 | orr r4, r4, r3, lsl #5 /* pixel_1 = r<<11 | g<<5 | b */ | ||
247 | orr r4, r4, r6, lsl #11 /* r4 = pixel_1 */ | ||
248 | |||
249 | /* 2nd loop, second pixel */ | ||
250 | ldrb r5, [r9], #1 /* r5 = *ysrc++ = *Y'_p++ */ | ||
251 | sub r5, r5, #16 /* r5 = (Y'-16) * 74 */ | ||
252 | add r3, r5, r5, asl #2 | ||
253 | add r5, r3, r5, asl #5 | ||
254 | |||
255 | add r6, r1, r5, asr #8 /* r6 = r = (Y >> 9) + rv */ | ||
256 | add r3, r2, r5, asr #7 /* r3 = g = (Y >> 8) + guv */ | ||
257 | add r5, r0, r5, asr #8 /* r5 = b = (Y >> 9) + bu */ | ||
258 | |||
259 | orr r0, r6, r5 /* check if clamping is needed... */ | ||
260 | orr r0, r0, r3, asr #1 /* ...at all */ | ||
261 | cmp r0, #31 | ||
262 | bls 15f /* -> no clamp */ | ||
263 | cmp r6, #31 /* clamp r */ | ||
264 | mvnhi r6, r6, asr #31 | ||
265 | andhi r6, r6, #31 | ||
266 | cmp r3, #63 /* clamp g */ | ||
267 | mvnhi r3, r3, asr #31 | ||
268 | andhi r3, r3, #63 | ||
269 | cmp r5, #31 /* clamp b */ | ||
270 | mvnhi r5, r5, asr #31 | ||
271 | andhi r5, r5, #31 | ||
272 | 15: /* no clamp */ | ||
273 | |||
274 | /* calculate pixel_2 and pack with pixel_1 before writing */ | ||
275 | orr r5, r5, r3, lsl #5 /* pixel_2 = r<<11 | g<<5 | b */ | ||
276 | orr r5, r5, r6, lsl #11 /* r5 = pixel_2 */ | ||
277 | #ifdef FORCE_FIFO_WAIT | ||
278 | /* wait for FIFO half full */ | ||
279 | .fifo_wait2: | ||
280 | ldr r3, [lr, #-0x24] /* while (LCD_STATUS & 0x08); */ | ||
281 | tst r3, #0x8 | ||
282 | bgt .fifo_wait2 | ||
283 | #endif | ||
284 | stmia lr, {r4,r5} /* write pixel_1 and pixel_2 */ | ||
285 | |||
286 | subs r7, r7, #2 /* check for loop end */ | ||
287 | bgt 20b /* back to beginning */ | ||
288 | /* 2nd loop end */ | ||
289 | |||
290 | ldr r3, [sp, #12] | ||
291 | add sp, sp, r3 /* deallocate buffer */ | ||
292 | ldmpc regs=r4-r10 /* restore registers */ | ||
293 | |||
294 | .ltorg | ||
295 | .size lcd_write_yuv420_lines, .-lcd_write_yuv420_lines | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/lcd-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/lcd-ipod6g.c new file mode 100644 index 0000000000..1de6a8e62f --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/lcd-ipod6g.c | |||
@@ -0,0 +1,286 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: lcd-nano2g.c 28868 2010-12-21 06:59:17Z Buschel $ | ||
9 | * | ||
10 | * Copyright (C) 2009 by Dave Chapman | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "config.h" | ||
22 | |||
23 | #include "hwcompat.h" | ||
24 | #include "kernel.h" | ||
25 | #include "lcd.h" | ||
26 | #include "system.h" | ||
27 | #include "cpu.h" | ||
28 | #include "pmu-target.h" | ||
29 | #include "power.h" | ||
30 | |||
31 | |||
32 | #define R_HORIZ_GRAM_ADDR_SET 0x200 | ||
33 | #define R_VERT_GRAM_ADDR_SET 0x201 | ||
34 | #define R_WRITE_DATA_TO_GRAM 0x202 | ||
35 | #define R_HORIZ_ADDR_START_POS 0x210 | ||
36 | #define R_HORIZ_ADDR_END_POS 0x211 | ||
37 | #define R_VERT_ADDR_START_POS 0x212 | ||
38 | #define R_VERT_ADDR_END_POS 0x213 | ||
39 | |||
40 | |||
41 | /* LCD type 1 register defines */ | ||
42 | |||
43 | #define R_COLUMN_ADDR_SET 0x2a | ||
44 | #define R_ROW_ADDR_SET 0x2b | ||
45 | #define R_MEMORY_WRITE 0x2c | ||
46 | |||
47 | |||
48 | /** globals **/ | ||
49 | |||
50 | int lcd_type; /* also needed in debug-s5l8702.c */ | ||
51 | |||
52 | |||
53 | static inline void s5l_lcd_write_cmd_data(int cmd, int data) | ||
54 | { | ||
55 | while (LCD_STATUS & 0x10); | ||
56 | LCD_WCMD = cmd; | ||
57 | |||
58 | while (LCD_STATUS & 0x10); | ||
59 | LCD_WDATA = data; | ||
60 | } | ||
61 | |||
62 | static inline void s5l_lcd_write_cmd(unsigned short cmd) | ||
63 | { | ||
64 | while (LCD_STATUS & 0x10); | ||
65 | LCD_WCMD = cmd; | ||
66 | } | ||
67 | |||
68 | static inline void s5l_lcd_write_data(unsigned short data) | ||
69 | { | ||
70 | while (LCD_STATUS & 0x10); | ||
71 | LCD_WDATA = data; | ||
72 | } | ||
73 | |||
74 | /*** hardware configuration ***/ | ||
75 | |||
76 | int lcd_default_contrast(void) | ||
77 | { | ||
78 | return 0x1f; | ||
79 | } | ||
80 | |||
81 | void lcd_set_contrast(int val) | ||
82 | { | ||
83 | (void)val; | ||
84 | } | ||
85 | |||
86 | void lcd_set_invert_display(bool yesno) | ||
87 | { | ||
88 | (void)yesno; | ||
89 | } | ||
90 | |||
91 | void lcd_set_flip(bool yesno) | ||
92 | { | ||
93 | (void)yesno; | ||
94 | } | ||
95 | |||
96 | bool lcd_active(void) | ||
97 | { | ||
98 | return true; | ||
99 | } | ||
100 | |||
101 | void lcd_shutdown(void) | ||
102 | { | ||
103 | pmu_write(0x2b, 0); /* Kill the backlight, instantly. */ | ||
104 | pmu_write(0x29, 0); | ||
105 | |||
106 | if (lcd_type == 3) | ||
107 | { | ||
108 | s5l_lcd_write_cmd_data(0x7, 0x172); | ||
109 | s5l_lcd_write_cmd_data(0x30, 0x3ff); | ||
110 | sleep(HZ / 10); | ||
111 | s5l_lcd_write_cmd_data(0x7, 0x120); | ||
112 | s5l_lcd_write_cmd_data(0x30, 0x0); | ||
113 | s5l_lcd_write_cmd_data(0x100, 0x780); | ||
114 | s5l_lcd_write_cmd_data(0x7, 0x0); | ||
115 | s5l_lcd_write_cmd_data(0x101, 0x260); | ||
116 | s5l_lcd_write_cmd_data(0x102, 0xa9); | ||
117 | sleep(HZ / 30); | ||
118 | s5l_lcd_write_cmd_data(0x100, 0x700); | ||
119 | s5l_lcd_write_cmd_data(0x100, 0x704); | ||
120 | } | ||
121 | else if (lcd_type == 1) | ||
122 | { | ||
123 | s5l_lcd_write_cmd(0x28); | ||
124 | s5l_lcd_write_cmd(0x10); | ||
125 | sleep(HZ / 10); | ||
126 | } | ||
127 | else | ||
128 | { | ||
129 | s5l_lcd_write_cmd(0x28); | ||
130 | sleep(HZ / 20); | ||
131 | s5l_lcd_write_cmd(0x10); | ||
132 | sleep(HZ / 20); | ||
133 | } | ||
134 | } | ||
135 | |||
136 | void lcd_sleep(void) | ||
137 | { | ||
138 | lcd_shutdown(); | ||
139 | } | ||
140 | |||
141 | /* LCD init */ | ||
142 | void lcd_init_device(void) | ||
143 | { | ||
144 | /* Detect lcd type */ | ||
145 | lcd_type = (PDAT6 & 0x30) >> 4; | ||
146 | } | ||
147 | |||
148 | /*** Update functions ***/ | ||
149 | |||
150 | static inline void lcd_write_pixel(fb_data pixel) | ||
151 | { | ||
152 | LCD_WDATA = pixel; | ||
153 | } | ||
154 | |||
155 | /* Update the display. | ||
156 | This must be called after all other LCD functions that change the display. */ | ||
157 | void lcd_update(void) ICODE_ATTR; | ||
158 | void lcd_update(void) | ||
159 | { | ||
160 | lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT); | ||
161 | } | ||
162 | |||
163 | /* Line write helper function. */ | ||
164 | extern void lcd_write_line(const fb_data *addr, | ||
165 | int pixelcount, | ||
166 | const unsigned int lcd_base_addr); | ||
167 | |||
168 | /* Update a fraction of the display. */ | ||
169 | void lcd_update_rect(int, int, int, int) ICODE_ATTR; | ||
170 | void lcd_update_rect(int x, int y, int width, int height) | ||
171 | { | ||
172 | int y0, x0, y1, x1; | ||
173 | fb_data* p; | ||
174 | |||
175 | /* Both x and width need to be preprocessed due to asm optimizations */ | ||
176 | x = x & ~1; /* ensure x is even */ | ||
177 | width = (width + 3) & ~3; /* ensure width is a multiple of 4 */ | ||
178 | |||
179 | x0 = x; /* start horiz */ | ||
180 | y0 = y; /* start vert */ | ||
181 | x1 = (x + width) - 1; /* max horiz */ | ||
182 | y1 = (y + height) - 1; /* max vert */ | ||
183 | |||
184 | if (lcd_type & 2) { | ||
185 | s5l_lcd_write_cmd_data(R_HORIZ_ADDR_START_POS, x0); | ||
186 | s5l_lcd_write_cmd_data(R_HORIZ_ADDR_END_POS, x1); | ||
187 | s5l_lcd_write_cmd_data(R_VERT_ADDR_START_POS, y0); | ||
188 | s5l_lcd_write_cmd_data(R_VERT_ADDR_END_POS, y1); | ||
189 | |||
190 | s5l_lcd_write_cmd_data(R_HORIZ_GRAM_ADDR_SET, (x1 << 8) | x0); | ||
191 | s5l_lcd_write_cmd_data(R_VERT_GRAM_ADDR_SET, (y1 << 8) | y0); | ||
192 | |||
193 | s5l_lcd_write_cmd(R_WRITE_DATA_TO_GRAM); | ||
194 | } else { | ||
195 | s5l_lcd_write_cmd(R_COLUMN_ADDR_SET); | ||
196 | s5l_lcd_write_data(x0 >> 8); | ||
197 | s5l_lcd_write_data(x0 & 0xff); | ||
198 | s5l_lcd_write_data(x1 >> 8); | ||
199 | s5l_lcd_write_data(x1 & 0xff); | ||
200 | |||
201 | s5l_lcd_write_cmd(R_ROW_ADDR_SET); | ||
202 | s5l_lcd_write_data(y0 >> 8); | ||
203 | s5l_lcd_write_data(y0 & 0xff); | ||
204 | s5l_lcd_write_data(y1 >> 8); | ||
205 | s5l_lcd_write_data(y1 & 0xff); | ||
206 | |||
207 | s5l_lcd_write_cmd(R_MEMORY_WRITE); | ||
208 | } | ||
209 | for (y = y0; y <= y1; y++) | ||
210 | for (x = x0; x <= x1; x++) | ||
211 | s5l_lcd_write_data(lcd_framebuffer[y][x]); | ||
212 | return; | ||
213 | |||
214 | /* Copy display bitmap to hardware */ | ||
215 | p = &lcd_framebuffer[y0][x0]; | ||
216 | if (LCD_WIDTH == width) { | ||
217 | /* Write all lines at once */ | ||
218 | lcd_write_line(p, height*LCD_WIDTH, LCD_BASE); | ||
219 | } else { | ||
220 | y1 = height; | ||
221 | do { | ||
222 | /* Write a single line */ | ||
223 | lcd_write_line(p, width, LCD_BASE); | ||
224 | p += LCD_WIDTH; | ||
225 | } while (--y1 > 0 ); | ||
226 | } | ||
227 | } | ||
228 | |||
229 | /* Line write helper function for lcd_yuv_blit. Writes two lines of yuv420. */ | ||
230 | extern void lcd_write_yuv420_lines(unsigned char const * const src[3], | ||
231 | const unsigned int lcd_baseadress, | ||
232 | int width, | ||
233 | int stride); | ||
234 | |||
235 | /* Blit a YUV bitmap directly to the LCD */ | ||
236 | void lcd_blit_yuv(unsigned char * const src[3], | ||
237 | int src_x, int src_y, int stride, | ||
238 | int x, int y, int width, int height) | ||
239 | { | ||
240 | unsigned int z, y0, x0, y1, x1;; | ||
241 | unsigned char const * yuv_src[3]; | ||
242 | |||
243 | width = (width + 1) & ~1; /* ensure width is even */ | ||
244 | |||
245 | x0 = x; /* start horiz */ | ||
246 | y0 = y; /* start vert */ | ||
247 | x1 = (x + width) - 1; /* max horiz */ | ||
248 | y1 = (y + height) - 1; /* max vert */ | ||
249 | |||
250 | if (lcd_type & 2) { | ||
251 | s5l_lcd_write_cmd_data(R_HORIZ_ADDR_START_POS, x0); | ||
252 | s5l_lcd_write_cmd_data(R_HORIZ_ADDR_END_POS, x1); | ||
253 | s5l_lcd_write_cmd_data(R_VERT_ADDR_START_POS, y0); | ||
254 | s5l_lcd_write_cmd_data(R_VERT_ADDR_END_POS, y1); | ||
255 | |||
256 | s5l_lcd_write_cmd_data(R_HORIZ_GRAM_ADDR_SET, (x1 << 8) | x0); | ||
257 | s5l_lcd_write_cmd_data(R_VERT_GRAM_ADDR_SET, (y1 << 8) | y0); | ||
258 | |||
259 | s5l_lcd_write_cmd(0); | ||
260 | s5l_lcd_write_cmd(R_WRITE_DATA_TO_GRAM); | ||
261 | } else { | ||
262 | s5l_lcd_write_cmd(R_COLUMN_ADDR_SET); | ||
263 | s5l_lcd_write_data(x0); /* Start column */ | ||
264 | s5l_lcd_write_data(x1); /* End column */ | ||
265 | |||
266 | s5l_lcd_write_cmd(R_ROW_ADDR_SET); | ||
267 | s5l_lcd_write_data(y0); /* Start row */ | ||
268 | s5l_lcd_write_data(y1); /* End row */ | ||
269 | |||
270 | s5l_lcd_write_cmd(R_MEMORY_WRITE); | ||
271 | } | ||
272 | |||
273 | z = stride * src_y; | ||
274 | yuv_src[0] = src[0] + z + src_x; | ||
275 | yuv_src[1] = src[1] + (z >> 2) + (src_x >> 1); | ||
276 | yuv_src[2] = src[2] + (yuv_src[1] - src[1]); | ||
277 | |||
278 | height >>= 1; | ||
279 | |||
280 | do { | ||
281 | lcd_write_yuv420_lines(yuv_src, LCD_BASE, width, stride); | ||
282 | yuv_src[0] += stride << 1; | ||
283 | yuv_src[1] += stride >> 1; /* Skip down one chroma line */ | ||
284 | yuv_src[2] += stride >> 1; | ||
285 | } while (--height > 0); | ||
286 | } | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/pmu-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/pmu-ipod6g.c new file mode 100644 index 0000000000..73d8f98083 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/pmu-ipod6g.c | |||
@@ -0,0 +1,143 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: pmu-nano2g.c 27752 2010-08-08 10:49:32Z bertrik $ | ||
9 | * | ||
10 | * Copyright © 2008 Rafaël Carré | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "config.h" | ||
23 | #include "kernel.h" | ||
24 | #include "i2c-s5l8702.h" | ||
25 | #include "pmu-target.h" | ||
26 | |||
27 | static struct mutex pmu_adc_mutex; | ||
28 | |||
29 | int pmu_read_multiple(int address, int count, unsigned char* buffer) | ||
30 | { | ||
31 | return i2c_read(0, 0xe6, address, count, buffer); | ||
32 | } | ||
33 | |||
34 | int pmu_write_multiple(int address, int count, unsigned char* buffer) | ||
35 | { | ||
36 | return i2c_write(0, 0xe6, address, count, buffer); | ||
37 | } | ||
38 | |||
39 | unsigned char pmu_read(int address) | ||
40 | { | ||
41 | unsigned char tmp; | ||
42 | |||
43 | pmu_read_multiple(address, 1, &tmp); | ||
44 | |||
45 | return tmp; | ||
46 | } | ||
47 | |||
48 | int pmu_write(int address, unsigned char val) | ||
49 | { | ||
50 | return pmu_write_multiple(address, 1, &val); | ||
51 | } | ||
52 | |||
53 | void pmu_init(void) | ||
54 | { | ||
55 | mutex_init(&pmu_adc_mutex); | ||
56 | } | ||
57 | |||
58 | int pmu_read_adc(unsigned int adc) | ||
59 | { | ||
60 | int data = 0; | ||
61 | mutex_lock(&pmu_adc_mutex); | ||
62 | pmu_write(0x54, 5 | (adc << 4)); | ||
63 | while ((data & 0x80) == 0) | ||
64 | { | ||
65 | yield(); | ||
66 | data = pmu_read(0x57); | ||
67 | } | ||
68 | int value = (pmu_read(0x55) << 2) | (data & 3); | ||
69 | mutex_unlock(&pmu_adc_mutex); | ||
70 | return value; | ||
71 | } | ||
72 | |||
73 | /* millivolts */ | ||
74 | int pmu_read_battery_voltage(void) | ||
75 | { | ||
76 | return pmu_read_adc(0) * 6; | ||
77 | } | ||
78 | |||
79 | /* milliamps */ | ||
80 | int pmu_read_battery_current(void) | ||
81 | { | ||
82 | // return pmu_read_adc(2); | ||
83 | return 0; | ||
84 | } | ||
85 | |||
86 | void pmu_ldo_on_in_standby(unsigned int ldo, int onoff) | ||
87 | { | ||
88 | if (ldo < 4) | ||
89 | { | ||
90 | unsigned char newval = pmu_read(0x3B) & ~(1 << (2 * ldo)); | ||
91 | if (onoff) newval |= 1 << (2 * ldo); | ||
92 | pmu_write(0x3B, newval); | ||
93 | } | ||
94 | else if (ldo < 8) | ||
95 | { | ||
96 | unsigned char newval = pmu_read(0x3C) & ~(1 << (2 * (ldo - 4))); | ||
97 | if (onoff) newval |= 1 << (2 * (ldo - 4)); | ||
98 | pmu_write(0x3C, newval); | ||
99 | } | ||
100 | } | ||
101 | |||
102 | void pmu_ldo_set_voltage(unsigned int ldo, unsigned char voltage) | ||
103 | { | ||
104 | if (ldo > 6) return; | ||
105 | pmu_write(0x2d + (ldo << 1), voltage); | ||
106 | } | ||
107 | |||
108 | void pmu_hdd_power(bool on) | ||
109 | { | ||
110 | pmu_write(0x1b, on ? 1 : 0); | ||
111 | } | ||
112 | |||
113 | void pmu_ldo_power_on(unsigned int ldo) | ||
114 | { | ||
115 | if (ldo > 6) return; | ||
116 | pmu_write(0x2e + (ldo << 1), 1); | ||
117 | } | ||
118 | |||
119 | void pmu_ldo_power_off(unsigned int ldo) | ||
120 | { | ||
121 | if (ldo > 6) return; | ||
122 | pmu_write(0x2e + (ldo << 1), 0); | ||
123 | } | ||
124 | |||
125 | void pmu_set_wake_condition(unsigned char condition) | ||
126 | { | ||
127 | pmu_write(0xd, condition); | ||
128 | } | ||
129 | |||
130 | void pmu_enter_standby(void) | ||
131 | { | ||
132 | pmu_write(0xc, 1); | ||
133 | } | ||
134 | |||
135 | void pmu_read_rtc(unsigned char* buffer) | ||
136 | { | ||
137 | pmu_read_multiple(0x59, 7, buffer); | ||
138 | } | ||
139 | |||
140 | void pmu_write_rtc(unsigned char* buffer) | ||
141 | { | ||
142 | pmu_write_multiple(0x59, 7, buffer); | ||
143 | } | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/pmu-target.h b/firmware/target/arm/s5l8702/ipod6g/pmu-target.h new file mode 100644 index 0000000000..a8c7851d97 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/pmu-target.h | |||
@@ -0,0 +1,46 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: pmu-target.h 24721 2010-02-17 15:54:48Z theseven $ | ||
9 | * | ||
10 | * Copyright © 2009 Michael Sparmann | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #ifndef __PMU_TARGET_H__ | ||
23 | #define __PMU_TARGET_H__ | ||
24 | |||
25 | #include <stdbool.h> | ||
26 | #include "config.h" | ||
27 | |||
28 | unsigned char pmu_read(int address); | ||
29 | int pmu_write(int address, unsigned char val); | ||
30 | int pmu_read_multiple(int address, int count, unsigned char* buffer); | ||
31 | int pmu_write_multiple(int address, int count, unsigned char* buffer); | ||
32 | int pmu_read_adc(unsigned int adc); | ||
33 | int pmu_read_battery_voltage(void); | ||
34 | int pmu_read_battery_current(void); | ||
35 | void pmu_init(void); | ||
36 | void pmu_ldo_on_in_standby(unsigned int ldo, int onoff); | ||
37 | void pmu_ldo_set_voltage(unsigned int ldo, unsigned char voltage); | ||
38 | void pmu_ldo_power_on(unsigned int ldo); | ||
39 | void pmu_ldo_power_off(unsigned int ldo); | ||
40 | void pmu_set_wake_condition(unsigned char condition); | ||
41 | void pmu_enter_standby(void); | ||
42 | void pmu_read_rtc(unsigned char* buffer); | ||
43 | void pmu_write_rtc(unsigned char* buffer); | ||
44 | void pmu_hdd_power(bool on); | ||
45 | |||
46 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/power-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/power-ipod6g.c new file mode 100644 index 0000000000..973e26968f --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/power-ipod6g.c | |||
@@ -0,0 +1,75 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: power-nano2g.c 28190 2010-10-01 18:09:10Z Buschel $ | ||
9 | * | ||
10 | * Copyright © 2009 Bertrik Sikken | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include <stdbool.h> | ||
22 | #include "config.h" | ||
23 | #include "inttypes.h" | ||
24 | #include "s5l8702.h" | ||
25 | #include "power.h" | ||
26 | #include "panic.h" | ||
27 | #include "pmu-target.h" | ||
28 | #include "usb_core.h" /* for usb_charging_maxcurrent_change */ | ||
29 | |||
30 | static int idepowered; | ||
31 | |||
32 | void power_off(void) | ||
33 | { | ||
34 | pmu_set_wake_condition(0x42); /* USB inserted or EXTON1 */ | ||
35 | pmu_enter_standby(); | ||
36 | |||
37 | while(1); | ||
38 | } | ||
39 | |||
40 | void power_init(void) | ||
41 | { | ||
42 | idepowered = false; | ||
43 | } | ||
44 | |||
45 | void ide_power_enable(bool on) | ||
46 | { | ||
47 | idepowered = on; | ||
48 | pmu_hdd_power(on); | ||
49 | } | ||
50 | |||
51 | bool ide_powered() | ||
52 | { | ||
53 | return idepowered; | ||
54 | } | ||
55 | |||
56 | #if CONFIG_CHARGING | ||
57 | |||
58 | #ifdef HAVE_USB_CHARGING_ENABLE | ||
59 | void usb_charging_maxcurrent_change(int maxcurrent) | ||
60 | { | ||
61 | bool on = (maxcurrent >= 500); | ||
62 | GPIOCMD = 0xb060e | (on ? 1 : 0); | ||
63 | } | ||
64 | #endif | ||
65 | |||
66 | unsigned int power_input_status(void) | ||
67 | { | ||
68 | return (PDAT(12) & 8) ? POWER_INPUT_NONE : POWER_INPUT_MAIN_CHARGER; | ||
69 | } | ||
70 | |||
71 | bool charging_state(void) | ||
72 | { | ||
73 | return false; //TODO: Figure out | ||
74 | } | ||
75 | #endif /* CONFIG_CHARGING */ | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/powermgmt-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/powermgmt-ipod6g.c new file mode 100644 index 0000000000..3bd3791eeb --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/powermgmt-ipod6g.c | |||
@@ -0,0 +1,88 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: powermgmt-nano2g.c 28159 2010-09-24 22:42:06Z Buschel $ | ||
9 | * | ||
10 | * Copyright © 2008 Rafaël Carré | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "config.h" | ||
23 | #include "powermgmt.h" | ||
24 | #include "pmu-target.h" | ||
25 | #include "power.h" | ||
26 | #include "audiohw.h" | ||
27 | |||
28 | const unsigned short battery_level_dangerous[BATTERY_TYPES_COUNT] = | ||
29 | { | ||
30 | 3600 | ||
31 | }; | ||
32 | |||
33 | const unsigned short battery_level_shutoff[BATTERY_TYPES_COUNT] = | ||
34 | { | ||
35 | 3350 | ||
36 | }; | ||
37 | |||
38 | /* voltages (millivolt) of 0%, 10%, ... 100% when charging disabled */ | ||
39 | const unsigned short percent_to_volt_discharge[BATTERY_TYPES_COUNT][11] = | ||
40 | { | ||
41 | { 3550, 3783, 3830, 3882, 3911, 3949, 3996, 4067, 4148, 4228, 4310 } | ||
42 | }; | ||
43 | |||
44 | #if CONFIG_CHARGING | ||
45 | /* voltages (millivolt) of 0%, 10%, ... 100% when charging enabled */ | ||
46 | const unsigned short percent_to_volt_charge[11] = | ||
47 | { | ||
48 | 3550, 3783, 3830, 3882, 3911, 3949, 3996, 4067, 4148, 4228, 4310 | ||
49 | }; | ||
50 | #endif /* CONFIG_CHARGING */ | ||
51 | |||
52 | /* ADC should read 0x3ff=6.00V */ | ||
53 | #define BATTERY_SCALE_FACTOR 6000 | ||
54 | /* full-scale ADC readout (2^10) in millivolt */ | ||
55 | |||
56 | |||
57 | /* Returns battery voltage from ADC [millivolts] */ | ||
58 | unsigned int battery_adc_voltage(void) | ||
59 | { | ||
60 | int compensation = (10 * (pmu_read_battery_current() - 7)) / 12; | ||
61 | if (charging_state()) return pmu_read_battery_voltage() - compensation; | ||
62 | return pmu_read_battery_voltage() + compensation; | ||
63 | } | ||
64 | |||
65 | |||
66 | #ifdef HAVE_ACCESSORY_SUPPLY | ||
67 | void accessory_supply_set(bool enable) | ||
68 | { | ||
69 | if (enable) | ||
70 | { | ||
71 | /* Accessory voltage supply on */ | ||
72 | //TODO: pmu_ldo_power_on(6); | ||
73 | } | ||
74 | else | ||
75 | { | ||
76 | /* Accessory voltage supply off */ | ||
77 | //TODO: pmu_ldo_power_off(6); | ||
78 | } | ||
79 | } | ||
80 | #endif | ||
81 | |||
82 | #ifdef HAVE_LINEOUT_POWEROFF | ||
83 | void lineout_set(bool enable) | ||
84 | { | ||
85 | /* Call audio hardware driver implementation */ | ||
86 | audiohw_enable_lineout(enable); | ||
87 | } | ||
88 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/ipod6g/rtc-ipod6g.c b/firmware/target/arm/s5l8702/ipod6g/rtc-ipod6g.c new file mode 100644 index 0000000000..76ef8ecb00 --- /dev/null +++ b/firmware/target/arm/s5l8702/ipod6g/rtc-ipod6g.c | |||
@@ -0,0 +1,72 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: rtc-nano2g.c 23114 2009-10-11 18:20:56Z theseven $ | ||
9 | * | ||
10 | * Copyright (C) 2002 by Linus Nielsen Feltzing, Uwe Freese, Laurent Baum | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "config.h" | ||
22 | #include "rtc.h" | ||
23 | #include "kernel.h" | ||
24 | #include "system.h" | ||
25 | #include "pmu-target.h" | ||
26 | |||
27 | void rtc_init(void) | ||
28 | { | ||
29 | } | ||
30 | |||
31 | int rtc_read_datetime(struct tm *tm) | ||
32 | { | ||
33 | unsigned int i; | ||
34 | unsigned char buf[7]; | ||
35 | |||
36 | pmu_read_rtc(buf); | ||
37 | |||
38 | for (i = 0; i < sizeof(buf); i++) | ||
39 | buf[i] = BCD2DEC(buf[i]); | ||
40 | |||
41 | tm->tm_sec = buf[0]; | ||
42 | tm->tm_min = buf[1]; | ||
43 | tm->tm_hour = buf[2]; | ||
44 | tm->tm_wday = buf[3]; | ||
45 | tm->tm_mday = buf[4]; | ||
46 | tm->tm_mon = buf[5] - 1; | ||
47 | tm->tm_year = buf[6] + 100; | ||
48 | |||
49 | return 0; | ||
50 | } | ||
51 | |||
52 | int rtc_write_datetime(const struct tm *tm) | ||
53 | { | ||
54 | unsigned int i; | ||
55 | unsigned char buf[7]; | ||
56 | |||
57 | buf[0] = tm->tm_sec; | ||
58 | buf[1] = tm->tm_min; | ||
59 | buf[2] = tm->tm_hour; | ||
60 | buf[3] = tm->tm_wday; | ||
61 | buf[4] = tm->tm_mday; | ||
62 | buf[5] = tm->tm_mon + 1; | ||
63 | buf[6] = tm->tm_year - 100; | ||
64 | |||
65 | for (i = 0; i < sizeof(buf); i++) | ||
66 | buf[i] = DEC2BCD(buf[i]); | ||
67 | |||
68 | pmu_write_rtc(buf); | ||
69 | |||
70 | return 0; | ||
71 | } | ||
72 | |||
diff --git a/firmware/target/arm/s5l8702/kernel-s5l8702.c b/firmware/target/arm/s5l8702/kernel-s5l8702.c new file mode 100644 index 0000000000..67dabd5f3f --- /dev/null +++ b/firmware/target/arm/s5l8702/kernel-s5l8702.c | |||
@@ -0,0 +1,56 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: kernel-s5l8700.c 28795 2010-12-11 17:52:52Z Buschel $ | ||
9 | * | ||
10 | * Copyright © 2009 Bertrik Sikken | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "config.h" | ||
22 | #include "system.h" | ||
23 | #include "kernel.h" | ||
24 | |||
25 | /* S5L8702 driver for the kernel timer | ||
26 | |||
27 | Timer B is configured as a 10 kHz timer | ||
28 | */ | ||
29 | |||
30 | void INT_TIMERB(void) | ||
31 | { | ||
32 | /* clear interrupt */ | ||
33 | TBCON = TBCON; | ||
34 | |||
35 | call_tick_tasks(); /* Run through the list of tick tasks */ | ||
36 | } | ||
37 | |||
38 | void tick_start(unsigned int interval_in_ms) | ||
39 | { | ||
40 | int cycles = 10 * interval_in_ms; | ||
41 | |||
42 | /* configure timer for 10 kHz */ | ||
43 | TBCMD = (1 << 1); /* TB_CLR */ | ||
44 | TBPRE = 208 - 1; /* prescaler */ | ||
45 | TBCON = (0 << 13) | /* TB_INT1_EN */ | ||
46 | (1 << 12) | /* TB_INT0_EN */ | ||
47 | (0 << 11) | /* TB_START */ | ||
48 | (2 << 8) | /* TB_CS = PCLK / 16 */ | ||
49 | (0 << 4); /* TB_MODE_SEL = interval mode */ | ||
50 | TBDATA0 = cycles; /* set interval period */ | ||
51 | TBCMD = (1 << 0); /* TB_EN */ | ||
52 | |||
53 | /* enable timer interrupt */ | ||
54 | VIC0INTENABLE = 1 << IRQ_TIMER; | ||
55 | } | ||
56 | |||
diff --git a/firmware/target/arm/s5l8702/pcm-s5l8702.c b/firmware/target/arm/s5l8702/pcm-s5l8702.c new file mode 100644 index 0000000000..7966eaddbd --- /dev/null +++ b/firmware/target/arm/s5l8702/pcm-s5l8702.c | |||
@@ -0,0 +1,219 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: pcm-s5l8700.c 28600 2010-11-14 19:49:20Z Buschel $ | ||
9 | * | ||
10 | * Copyright © 2011 Michael Sparmann | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include <string.h> | ||
22 | |||
23 | #include "config.h" | ||
24 | #include "system.h" | ||
25 | #include "audio.h" | ||
26 | #include "s5l8702.h" | ||
27 | #include "panic.h" | ||
28 | #include "audiohw.h" | ||
29 | #include "pcm.h" | ||
30 | #include "pcm_sampr.h" | ||
31 | #include "mmu-arm.h" | ||
32 | |||
33 | /* S5L8702 PCM driver tunables: */ | ||
34 | #define LLIMAX (2047) /* Maximum number of samples per LLI */ | ||
35 | #define CHUNKSIZE (8700) /* Maximum number of samples to handle with one IRQ */ | ||
36 | /* (bigger chunks will be segmented internally) */ | ||
37 | #define WATERMARK (512) /* Number of remaining samples to schedule IRQ at */ | ||
38 | |||
39 | static volatile int locked = 0; | ||
40 | static const int zerosample = 0; | ||
41 | static unsigned char dblbuf[WATERMARK * 4] IBSS_ATTR; | ||
42 | struct dma_lli lli[(CHUNKSIZE - WATERMARK + LLIMAX - 1) / LLIMAX + 1] | ||
43 | __attribute__((aligned(16))); | ||
44 | static const unsigned char* dataptr; | ||
45 | static size_t remaining; | ||
46 | |||
47 | /* Mask the DMA interrupt */ | ||
48 | void pcm_play_lock(void) | ||
49 | { | ||
50 | if (locked++ == 0) { | ||
51 | //TODO: Urgh, I don't like that at all... | ||
52 | VIC0INTENCLEAR = 1 << IRQ_DMAC0; | ||
53 | } | ||
54 | } | ||
55 | |||
56 | /* Unmask the DMA interrupt if enabled */ | ||
57 | void pcm_play_unlock(void) | ||
58 | { | ||
59 | if (--locked == 0) { | ||
60 | VIC0INTENABLE = 1 << IRQ_DMAC0; | ||
61 | } | ||
62 | } | ||
63 | |||
64 | void INT_DMAC0C0(void) ICODE_ATTR; | ||
65 | void INT_DMAC0C0(void) | ||
66 | { | ||
67 | DMAC0INTTCCLR = 1; | ||
68 | if (!remaining) pcm_play_get_more_callback((void**)&dataptr, &remaining); | ||
69 | if (!remaining) | ||
70 | { | ||
71 | lli->nextlli = NULL; | ||
72 | lli->control = 0x75249000; | ||
73 | clean_dcache(); | ||
74 | return; | ||
75 | } | ||
76 | uint32_t lastsize = MIN(WATERMARK * 4, remaining); | ||
77 | remaining -= lastsize; | ||
78 | struct dma_lli* lastlli; | ||
79 | if (remaining) lastlli = &lli[ARRAYLEN(lli) - 1]; | ||
80 | else lastlli = lli; | ||
81 | uint32_t chunksize = MIN(CHUNKSIZE * 4 - lastsize, remaining); | ||
82 | if (remaining > chunksize && chunksize > remaining - WATERMARK * 4) | ||
83 | chunksize = remaining - WATERMARK * 4; | ||
84 | remaining -= chunksize; | ||
85 | bool last = !chunksize; | ||
86 | int i = 0; | ||
87 | while (chunksize) | ||
88 | { | ||
89 | uint32_t thislli = MIN(LLIMAX * 4, chunksize); | ||
90 | chunksize -= thislli; | ||
91 | lli[i].srcaddr = (void*)dataptr; | ||
92 | lli[i].dstaddr = (void*)((int)&I2STXDB0); | ||
93 | lli[i].nextlli = chunksize ? &lli[i + 1] : lastlli; | ||
94 | lli[i].control = (chunksize ? 0x75249000 : 0xf5249000) | (thislli / 2); | ||
95 | dataptr += thislli; | ||
96 | i++; | ||
97 | } | ||
98 | if (!remaining) memcpy(dblbuf, dataptr, lastsize); | ||
99 | lastlli->srcaddr = remaining ? dataptr : dblbuf; | ||
100 | lastlli->dstaddr = (void*)((int)&I2STXDB0); | ||
101 | lastlli->nextlli = last ? NULL : lli; | ||
102 | lastlli->control = (last ? 0xf5249000 : 0x75249000) | (lastsize / 2); | ||
103 | dataptr += lastsize; | ||
104 | clean_dcache(); | ||
105 | if (!(DMAC0C0CONFIG & 1) && (lli[0].control & 0xfff)) | ||
106 | { | ||
107 | DMAC0C0LLI = lli[0]; | ||
108 | DMAC0C0CONFIG = 0x8a81; | ||
109 | } | ||
110 | else DMAC0C0NEXTLLI = lli; | ||
111 | } | ||
112 | |||
113 | void pcm_play_dma_start(const void* addr, size_t size) | ||
114 | { | ||
115 | dataptr = (const unsigned char*)addr; | ||
116 | remaining = size; | ||
117 | I2STXCOM = 0xe; | ||
118 | DMAC0CONFIG |= 4; | ||
119 | INT_DMAC0C0(); | ||
120 | } | ||
121 | |||
122 | void pcm_play_dma_stop(void) | ||
123 | { | ||
124 | DMAC0C0CONFIG = 0x8a80; | ||
125 | I2STXCOM = 0xa; | ||
126 | } | ||
127 | |||
128 | /* pause playback by disabling LRCK */ | ||
129 | void pcm_play_dma_pause(bool pause) | ||
130 | { | ||
131 | if (pause) I2STXCOM |= 1; | ||
132 | else I2STXCOM &= ~1; | ||
133 | } | ||
134 | |||
135 | void pcm_play_dma_init(void) | ||
136 | { | ||
137 | PWRCON(0) &= ~(1 << 4); | ||
138 | PWRCON(1) &= ~(1 << 7); | ||
139 | I2S40 = 0x110; | ||
140 | I2STXCON = 0xb100059; | ||
141 | I2SCLKCON = 1; | ||
142 | VIC0INTENABLE = 1 << IRQ_DMAC0; | ||
143 | |||
144 | audiohw_preinit(); | ||
145 | } | ||
146 | |||
147 | void pcm_postinit(void) | ||
148 | { | ||
149 | audiohw_postinit(); | ||
150 | } | ||
151 | |||
152 | void pcm_dma_apply_settings(void) | ||
153 | { | ||
154 | } | ||
155 | |||
156 | size_t pcm_get_bytes_waiting(void) | ||
157 | { | ||
158 | int bytes = remaining + (DMAC0C0LLI.control & 0xfff) * 2; | ||
159 | const struct dma_lli* lli = DMAC0C0LLI.nextlli; | ||
160 | while (lli) | ||
161 | { | ||
162 | bytes += (lli->control & 0xfff) * 2; | ||
163 | lli = lli->nextlli; | ||
164 | } | ||
165 | return bytes; | ||
166 | } | ||
167 | |||
168 | const void* pcm_play_dma_get_peak_buffer(int *count) | ||
169 | { | ||
170 | *count = (DMAC0C0LLI.control & 0xfff) * 2; | ||
171 | return (void*)(((uint32_t)DMAC0C0LLI.srcaddr) & ~3); | ||
172 | } | ||
173 | |||
174 | #ifdef HAVE_PCM_DMA_ADDRESS | ||
175 | void * pcm_dma_addr(void *addr) | ||
176 | { | ||
177 | return addr; | ||
178 | } | ||
179 | #endif | ||
180 | |||
181 | |||
182 | /**************************************************************************** | ||
183 | ** Recording DMA transfer | ||
184 | **/ | ||
185 | #ifdef HAVE_RECORDING | ||
186 | void pcm_rec_lock(void) | ||
187 | { | ||
188 | } | ||
189 | |||
190 | void pcm_rec_unlock(void) | ||
191 | { | ||
192 | } | ||
193 | |||
194 | void pcm_rec_dma_stop(void) | ||
195 | { | ||
196 | } | ||
197 | |||
198 | void pcm_rec_dma_start(void *addr, size_t size) | ||
199 | { | ||
200 | (void)addr; | ||
201 | (void)size; | ||
202 | } | ||
203 | |||
204 | void pcm_rec_dma_close(void) | ||
205 | { | ||
206 | } | ||
207 | |||
208 | |||
209 | void pcm_rec_dma_init(void) | ||
210 | { | ||
211 | } | ||
212 | |||
213 | |||
214 | const void * pcm_rec_dma_get_peak_buffer(void) | ||
215 | { | ||
216 | return NULL; | ||
217 | } | ||
218 | |||
219 | #endif /* HAVE_RECORDING */ | ||
diff --git a/firmware/target/arm/s5l8702/system-s5l8702.c b/firmware/target/arm/s5l8702/system-s5l8702.c new file mode 100644 index 0000000000..6973738790 --- /dev/null +++ b/firmware/target/arm/s5l8702/system-s5l8702.c | |||
@@ -0,0 +1,268 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: system-s5l8700.c 28935 2010-12-30 20:23:46Z Buschel $ | ||
9 | * | ||
10 | * Copyright (C) 2007 by Rob Purchase | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "kernel.h" | ||
23 | #include "system.h" | ||
24 | #include "panic.h" | ||
25 | #include "system-target.h" | ||
26 | #include "pmu-target.h" | ||
27 | |||
28 | #define default_interrupt(name) \ | ||
29 | extern __attribute__((weak,alias("UIRQ"))) void name (void) | ||
30 | |||
31 | void irq_handler(void) __attribute__((interrupt ("IRQ"), naked)); | ||
32 | void fiq_handler(void) __attribute__((interrupt ("FIQ"), naked, \ | ||
33 | weak, alias("fiq_dummy"))); | ||
34 | |||
35 | default_interrupt(INT_IRQ0); | ||
36 | default_interrupt(INT_IRQ1); | ||
37 | default_interrupt(INT_IRQ2); | ||
38 | default_interrupt(INT_IRQ3); | ||
39 | default_interrupt(INT_IRQ4); | ||
40 | default_interrupt(INT_IRQ5); | ||
41 | default_interrupt(INT_IRQ6); | ||
42 | default_interrupt(INT_IRQ7); | ||
43 | default_interrupt(INT_TIMERA); | ||
44 | default_interrupt(INT_TIMERB); | ||
45 | default_interrupt(INT_TIMERC); | ||
46 | default_interrupt(INT_TIMERD); | ||
47 | default_interrupt(INT_TIMERE); | ||
48 | default_interrupt(INT_TIMERF); | ||
49 | default_interrupt(INT_TIMERG); | ||
50 | default_interrupt(INT_TIMERH); | ||
51 | default_interrupt(INT_IRQ9); | ||
52 | default_interrupt(INT_IRQ10); | ||
53 | default_interrupt(INT_IRQ11); | ||
54 | default_interrupt(INT_IRQ12); | ||
55 | default_interrupt(INT_IRQ13); | ||
56 | default_interrupt(INT_IRQ14); | ||
57 | default_interrupt(INT_IRQ15); | ||
58 | default_interrupt(INT_DMAC0C0); | ||
59 | default_interrupt(INT_DMAC0C1); | ||
60 | default_interrupt(INT_DMAC0C2); | ||
61 | default_interrupt(INT_DMAC0C3); | ||
62 | default_interrupt(INT_DMAC0C4); | ||
63 | default_interrupt(INT_DMAC0C5); | ||
64 | default_interrupt(INT_DMAC0C6); | ||
65 | default_interrupt(INT_DMAC0C7); | ||
66 | default_interrupt(INT_DMAC1C0); | ||
67 | default_interrupt(INT_DMAC1C1); | ||
68 | default_interrupt(INT_DMAC1C2); | ||
69 | default_interrupt(INT_DMAC1C3); | ||
70 | default_interrupt(INT_DMAC1C4); | ||
71 | default_interrupt(INT_DMAC1C5); | ||
72 | default_interrupt(INT_DMAC1C6); | ||
73 | default_interrupt(INT_DMAC1C7); | ||
74 | default_interrupt(INT_IRQ18); | ||
75 | default_interrupt(INT_USB_FUNC); | ||
76 | default_interrupt(INT_IRQ20); | ||
77 | default_interrupt(INT_IRQ21); | ||
78 | default_interrupt(INT_IRQ22); | ||
79 | default_interrupt(INT_WHEEL); | ||
80 | default_interrupt(INT_IRQ24); | ||
81 | default_interrupt(INT_IRQ25); | ||
82 | default_interrupt(INT_IRQ26); | ||
83 | default_interrupt(INT_IRQ27); | ||
84 | default_interrupt(INT_IRQ28); | ||
85 | default_interrupt(INT_ATA); | ||
86 | default_interrupt(INT_IRQ30); | ||
87 | default_interrupt(INT_IRQ31); | ||
88 | default_interrupt(INT_IRQ32); | ||
89 | default_interrupt(INT_IRQ33); | ||
90 | default_interrupt(INT_IRQ34); | ||
91 | default_interrupt(INT_IRQ35); | ||
92 | default_interrupt(INT_IRQ36); | ||
93 | default_interrupt(INT_IRQ37); | ||
94 | default_interrupt(INT_IRQ38); | ||
95 | default_interrupt(INT_IRQ39); | ||
96 | default_interrupt(INT_IRQ40); | ||
97 | default_interrupt(INT_IRQ41); | ||
98 | default_interrupt(INT_IRQ42); | ||
99 | default_interrupt(INT_IRQ43); | ||
100 | default_interrupt(INT_IRQ44); | ||
101 | default_interrupt(INT_IRQ45); | ||
102 | default_interrupt(INT_IRQ46); | ||
103 | default_interrupt(INT_IRQ47); | ||
104 | default_interrupt(INT_IRQ48); | ||
105 | default_interrupt(INT_IRQ49); | ||
106 | default_interrupt(INT_IRQ50); | ||
107 | default_interrupt(INT_IRQ51); | ||
108 | default_interrupt(INT_IRQ52); | ||
109 | default_interrupt(INT_IRQ53); | ||
110 | default_interrupt(INT_IRQ54); | ||
111 | default_interrupt(INT_IRQ55); | ||
112 | default_interrupt(INT_IRQ56); | ||
113 | default_interrupt(INT_IRQ57); | ||
114 | default_interrupt(INT_IRQ58); | ||
115 | default_interrupt(INT_IRQ59); | ||
116 | default_interrupt(INT_IRQ60); | ||
117 | default_interrupt(INT_IRQ61); | ||
118 | default_interrupt(INT_IRQ62); | ||
119 | default_interrupt(INT_IRQ63); | ||
120 | |||
121 | |||
122 | int current_irq; | ||
123 | |||
124 | |||
125 | void INT_TIMER(void) ICODE_ATTR; | ||
126 | void INT_TIMER() | ||
127 | { | ||
128 | if (TACON & (TACON >> 4) & 0x7000) INT_TIMERA(); | ||
129 | if (TBCON & (TBCON >> 4) & 0x7000) INT_TIMERB(); | ||
130 | if (TCCON & (TCCON >> 4) & 0x7000) INT_TIMERC(); | ||
131 | if (TDCON & (TDCON >> 4) & 0x7000) INT_TIMERD(); | ||
132 | if (TFCON & (TFCON >> 4) & 0x7000) INT_TIMERF(); | ||
133 | if (TGCON & (TGCON >> 4) & 0x7000) INT_TIMERG(); | ||
134 | if (THCON & (THCON >> 4) & 0x7000) INT_TIMERH(); | ||
135 | } | ||
136 | |||
137 | void INT_DMAC0(void) ICODE_ATTR; | ||
138 | void INT_DMAC0() | ||
139 | { | ||
140 | uint32_t intsts = DMAC0INTSTS; | ||
141 | if (intsts & 1) INT_DMAC0C0(); | ||
142 | if (intsts & 2) INT_DMAC0C1(); | ||
143 | if (intsts & 4) INT_DMAC0C2(); | ||
144 | if (intsts & 8) INT_DMAC0C3(); | ||
145 | if (intsts & 0x10) INT_DMAC0C4(); | ||
146 | if (intsts & 0x20) INT_DMAC0C5(); | ||
147 | if (intsts & 0x40) INT_DMAC0C6(); | ||
148 | if (intsts & 0x80) INT_DMAC0C7(); | ||
149 | } | ||
150 | |||
151 | void INT_DMAC1(void) ICODE_ATTR; | ||
152 | void INT_DMAC1() | ||
153 | { | ||
154 | uint32_t intsts = DMAC1INTSTS; | ||
155 | if (intsts & 1) INT_DMAC1C0(); | ||
156 | if (intsts & 2) INT_DMAC1C1(); | ||
157 | if (intsts & 4) INT_DMAC1C2(); | ||
158 | if (intsts & 8) INT_DMAC1C3(); | ||
159 | if (intsts & 0x10) INT_DMAC1C4(); | ||
160 | if (intsts & 0x20) INT_DMAC1C5(); | ||
161 | if (intsts & 0x40) INT_DMAC1C6(); | ||
162 | if (intsts & 0x80) INT_DMAC1C7(); | ||
163 | } | ||
164 | |||
165 | static void (* const irqvector[])(void) = | ||
166 | { | ||
167 | INT_IRQ0,INT_IRQ1,INT_IRQ2,INT_IRQ3,INT_IRQ4,INT_IRQ5,INT_IRQ6,INT_IRQ7, | ||
168 | INT_TIMER,INT_IRQ9,INT_IRQ10,INT_IRQ11,INT_IRQ12,INT_IRQ13,INT_IRQ14,INT_IRQ15, | ||
169 | INT_DMAC0,INT_DMAC1,INT_IRQ18,INT_USB_FUNC,INT_IRQ20,INT_IRQ21,INT_IRQ22,INT_WHEEL, | ||
170 | INT_IRQ24,INT_IRQ25,INT_IRQ26,INT_IRQ27,INT_IRQ28,INT_ATA,INT_IRQ30,INT_IRQ31, | ||
171 | INT_IRQ32,INT_IRQ33,INT_IRQ34,INT_IRQ35,INT_IRQ36,INT_IRQ37,INT_IRQ38,INT_IRQ39, | ||
172 | INT_IRQ40,INT_IRQ41,INT_IRQ42,INT_IRQ43,INT_IRQ55,INT_IRQ56,INT_IRQ57,INT_IRQ58, | ||
173 | INT_IRQ48,INT_IRQ49,INT_IRQ50,INT_IRQ51,INT_IRQ52,INT_IRQ53,INT_IRQ54,INT_IRQ55, | ||
174 | INT_IRQ56,INT_IRQ57,INT_IRQ58,INT_IRQ59,INT_IRQ60,INT_IRQ61,INT_IRQ62,INT_IRQ63 | ||
175 | }; | ||
176 | |||
177 | static void UIRQ(void) | ||
178 | { | ||
179 | panicf("Unhandled IRQ %d!", current_irq); | ||
180 | } | ||
181 | |||
182 | void irq_handler(void) | ||
183 | { | ||
184 | /* | ||
185 | * Based on: linux/arch/arm/kernel/entry-armv.S and system-meg-fx.c | ||
186 | */ | ||
187 | |||
188 | asm volatile( "stmfd sp!, {r0-r7, ip, lr} \n" /* Store context */ | ||
189 | "sub sp, sp, #8 \n"); /* Reserve stack */ | ||
190 | |||
191 | void* dummy = VIC0ADDRESS; | ||
192 | dummy = VIC1ADDRESS; | ||
193 | uint32_t irqs0 = VIC0IRQSTATUS; | ||
194 | uint32_t irqs1 = VIC1IRQSTATUS; | ||
195 | for (current_irq = 0; irqs0; current_irq++, irqs0 >>= 1) | ||
196 | if (irqs0 & 1) | ||
197 | irqvector[current_irq](); | ||
198 | for (current_irq = 32; irqs1; current_irq++, irqs1 >>= 1) | ||
199 | if (irqs1 & 1) | ||
200 | irqvector[current_irq](); | ||
201 | VIC0ADDRESS = NULL; | ||
202 | VIC1ADDRESS = NULL; | ||
203 | |||
204 | asm volatile( "add sp, sp, #8 \n" /* Cleanup stack */ | ||
205 | "ldmfd sp!, {r0-r7, ip, lr} \n" /* Restore context */ | ||
206 | "subs pc, lr, #4 \n"); /* Return from IRQ */ | ||
207 | } | ||
208 | |||
209 | void fiq_dummy(void) | ||
210 | { | ||
211 | asm volatile ( | ||
212 | "subs pc, lr, #4 \r\n" | ||
213 | ); | ||
214 | } | ||
215 | |||
216 | |||
217 | void system_init(void) | ||
218 | { | ||
219 | pmu_init(); | ||
220 | VIC0INTENABLE = 1 << IRQ_WHEEL; | ||
221 | } | ||
222 | |||
223 | void system_reboot(void) | ||
224 | { | ||
225 | /* Reset the SoC */ | ||
226 | asm volatile("msr CPSR_c, #0xd3 \n" | ||
227 | "mov r0, #0x100000 \n" | ||
228 | "mov r1, #0x3c800000 \n" | ||
229 | "str r0, [r1] \n"); | ||
230 | |||
231 | /* Wait for reboot to kick in */ | ||
232 | while(1); | ||
233 | } | ||
234 | |||
235 | //extern void post_mortem_stub(void); | ||
236 | |||
237 | void system_exception_wait(void) | ||
238 | { | ||
239 | // post_mortem_stub(); | ||
240 | while(1); | ||
241 | } | ||
242 | |||
243 | int system_memory_guard(int newmode) | ||
244 | { | ||
245 | (void)newmode; | ||
246 | return 0; | ||
247 | } | ||
248 | |||
249 | #ifdef HAVE_ADJUSTABLE_CPU_FREQ | ||
250 | |||
251 | void set_cpu_frequency(long frequency) | ||
252 | { | ||
253 | if (cpu_frequency == frequency) | ||
254 | return; | ||
255 | |||
256 | if (frequency == CPUFREQ_MAX) | ||
257 | { | ||
258 | //TODO: Figure out and implement | ||
259 | } | ||
260 | else | ||
261 | { | ||
262 | //TODO: Figure out and implement | ||
263 | } | ||
264 | |||
265 | cpu_frequency = frequency; | ||
266 | } | ||
267 | |||
268 | #endif | ||
diff --git a/firmware/target/arm/s5l8702/system-target.h b/firmware/target/arm/s5l8702/system-target.h new file mode 100644 index 0000000000..96e0371526 --- /dev/null +++ b/firmware/target/arm/s5l8702/system-target.h | |||
@@ -0,0 +1,48 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: system-target.h 28791 2010-12-11 09:39:33Z Buschel $ | ||
9 | * | ||
10 | * Copyright (C) 2007 by Dave Chapman | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef SYSTEM_TARGET_H | ||
22 | #define SYSTEM_TARGET_H | ||
23 | |||
24 | #include "system-arm.h" | ||
25 | #include "mmu-arm.h" | ||
26 | |||
27 | //TODO: Figure out | ||
28 | #define CPUFREQ_SLEEP 32768 | ||
29 | #define CPUFREQ_MAX (1843200 * 4 * 26 / 1) /* 191692800 Hz */ | ||
30 | #define CPUFREQ_DEFAULT (CPUFREQ_MAX/4) /* 47923200 Hz */ | ||
31 | #define CPUFREQ_NORMAL (CPUFREQ_MAX/4) | ||
32 | |||
33 | #define STORAGE_WANTS_ALIGN | ||
34 | |||
35 | #define inl(a) (*(volatile unsigned long *) (a)) | ||
36 | #define outl(a,b) (*(volatile unsigned long *) (b) = (a)) | ||
37 | #define inb(a) (*(volatile unsigned char *) (a)) | ||
38 | #define outb(a,b) (*(volatile unsigned char *) (b) = (a)) | ||
39 | #define inw(a) (*(volatile unsigned short*) (a)) | ||
40 | #define outw(a,b) (*(volatile unsigned short*) (b) = (a)) | ||
41 | |||
42 | static inline void udelay(unsigned usecs) | ||
43 | { | ||
44 | unsigned stop = USEC_TIMER + usecs; | ||
45 | while (TIME_BEFORE(USEC_TIMER, stop)); | ||
46 | } | ||
47 | |||
48 | #endif /* SYSTEM_TARGET_H */ | ||
diff --git a/firmware/target/arm/s5l8702/timer-s5l8702.c b/firmware/target/arm/s5l8702/timer-s5l8702.c new file mode 100644 index 0000000000..fb56a9ffcf --- /dev/null +++ b/firmware/target/arm/s5l8702/timer-s5l8702.c | |||
@@ -0,0 +1,94 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id: timer-s5l8700.c 23103 2009-10-11 11:35:14Z theseven $ | ||
9 | * | ||
10 | * Copyright (C) 2009 Bertrik Sikken | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "config.h" | ||
23 | |||
24 | #include "inttypes.h" | ||
25 | #include "s5l8702.h" | ||
26 | #include "system.h" | ||
27 | #include "timer.h" | ||
28 | |||
29 | //TODO: This needs calibration once we figure out the clocking | ||
30 | |||
31 | void INT_TIMERC(void) | ||
32 | { | ||
33 | /* clear interrupt */ | ||
34 | TCCON = TCCON; | ||
35 | |||
36 | if (pfn_timer != NULL) { | ||
37 | pfn_timer(); | ||
38 | } | ||
39 | } | ||
40 | |||
41 | bool timer_set(long cycles, bool start) | ||
42 | { | ||
43 | static const int cs_table[] = {1, 2, 4, 6}; | ||
44 | int prescale, cs; | ||
45 | long count; | ||
46 | |||
47 | /* stop and clear timer */ | ||
48 | TCCMD = (1 << 1); /* TD_CLR */ | ||
49 | |||
50 | /* optionally unregister any previously registered timer user */ | ||
51 | if (start) { | ||
52 | if (pfn_unregister != NULL) { | ||
53 | pfn_unregister(); | ||
54 | pfn_unregister = NULL; | ||
55 | } | ||
56 | } | ||
57 | |||
58 | /* scale the count down with the clock select */ | ||
59 | for (cs = 0; cs < 4; cs++) { | ||
60 | count = cycles >> cs_table[cs]; | ||
61 | if ((count < 65536) || (cs == 3)) { | ||
62 | break; | ||
63 | } | ||
64 | } | ||
65 | |||
66 | /* scale the count down with the prescaler */ | ||
67 | prescale = 1; | ||
68 | while (count >= 65536) { | ||
69 | count >>= 1; | ||
70 | prescale <<= 1; | ||
71 | } | ||
72 | |||
73 | /* configure timer */ | ||
74 | TCCON = (1 << 12) | /* TD_INT0_EN */ | ||
75 | (cs << 8) | /* TS_CS */ | ||
76 | (0 << 4); /* TD_MODE_SEL, 0 = interval mode */ | ||
77 | TCPRE = prescale - 1; | ||
78 | TCDATA0 = count; | ||
79 | TCCMD = (1 << 0); /* TD_ENABLE */ | ||
80 | |||
81 | return true; | ||
82 | } | ||
83 | |||
84 | bool timer_start(void) | ||
85 | { | ||
86 | TCCMD = (1 << 0); /* TD_ENABLE */ | ||
87 | return true; | ||
88 | } | ||
89 | |||
90 | void timer_stop(void) | ||
91 | { | ||
92 | TCCMD = (0 << 0); /* TD_ENABLE */ | ||
93 | } | ||
94 | |||
diff --git a/firmware/target/arm/thread-arm.c b/firmware/target/arm/thread-arm.c index 9ea3d0bef9..84a3aecbd7 100644 --- a/firmware/target/arm/thread-arm.c +++ b/firmware/target/arm/thread-arm.c | |||
@@ -93,7 +93,8 @@ static inline void load_context(const void* addr) | |||
93 | 93 | ||
94 | #if defined(CPU_TCC780X) || defined(CPU_TCC77X) /* Single core only for now */ \ | 94 | #if defined(CPU_TCC780X) || defined(CPU_TCC77X) /* Single core only for now */ \ |
95 | || CONFIG_CPU == IMX31L || CONFIG_CPU == DM320 || CONFIG_CPU == AS3525 \ | 95 | || CONFIG_CPU == IMX31L || CONFIG_CPU == DM320 || CONFIG_CPU == AS3525 \ |
96 | || CONFIG_CPU == S3C2440 || CONFIG_CPU == S5L8701 || CONFIG_CPU == AS3525v2 | 96 | || CONFIG_CPU == S3C2440 || CONFIG_CPU == S5L8701 || CONFIG_CPU == AS3525v2 \ |
97 | || CONFIG_CPU == S5L8702 | ||
97 | /* Use the generic ARMv4/v5/v6 wait for IRQ */ | 98 | /* Use the generic ARMv4/v5/v6 wait for IRQ */ |
98 | static inline void core_sleep(void) | 99 | static inline void core_sleep(void) |
99 | { | 100 | { |