tsiry-sandratraina.com
A modern Music Player Daemon based on Rockbox open source high quality audio player
libadwaita
audio
rust
zig
deno
mpris
rockbox
mpd
1/***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
9 *
10 * Copyright (C) 2005 by Thom Johansen
11 *
12 * Generic ARM threading support
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/*---------------------------------------------------------------------------
25 * Start the thread running and terminate it if it returns
26 *---------------------------------------------------------------------------
27 */
28static void __attribute__((naked)) USED_ATTR start_thread(void)
29{
30 /* r0 = context */
31 asm volatile (
32 "ldr sp, [r0, #32] \n" /* Load initial sp */
33 "ldr r4, [r0, #40] \n" /* start in r4 since it's non-volatile */
34 "mov r1, #0 \n" /* Mark thread as running */
35 "str r1, [r0, #40] \n"
36#if NUM_CORES > 1
37 "bl commit_discard_idcache \n" /* Invalidate this core's cache. */
38#endif
39 "mov lr, pc \n" /* Call thread function */
40 "bx r4 \n"
41 ); /* No clobber list - new thread doesn't care */
42 thread_exit();
43#if 0
44 asm volatile (".ltorg"); /* Dump constant pool */
45#endif
46}
47
48/* For startup, place context pointer in r4 slot, start_thread pointer in r5
49 * slot, and thread function pointer in context.start. See load_context for
50 * what happens when thread is initially going to run. */
51#define THREAD_STARTUP_INIT(core, thread, function) \
52 ({ (thread)->context.r[0] = (uint32_t)&(thread)->context, \
53 (thread)->context.r[1] = (uint32_t)start_thread, \
54 (thread)->context.start = (uint32_t)function; })
55
56
57/*---------------------------------------------------------------------------
58 * Store non-volatile context.
59 *---------------------------------------------------------------------------
60 */
61static inline void store_context(void* addr)
62{
63 asm volatile(
64#if defined(CPU_ARM_MICRO) && ARCH_VERSION >= 7
65 "stmia %0, { r4-r11, lr } \n"
66 "str sp, [%0, #36] \n"
67#else
68 "stmia %0, { r4-r11, sp, lr } \n"
69#endif
70 : : "r" (addr)
71 );
72}
73
74/*---------------------------------------------------------------------------
75 * Load non-volatile context.
76 *---------------------------------------------------------------------------
77 */
78static inline void load_context(const void* addr)
79{
80 asm volatile(
81 BEGIN_ARM_ASM_SYNTAX_UNIFIED
82 "ldr r0, [%0, #40] \n" /* Load start pointer */
83 "cmp r0, #0 \n" /* Check for NULL */
84
85 /* If not already running, jump to start */
86#if ARM_ARCH == 4 && defined(USE_THUMB)
87 "ldmiane %0, { r0, r12 } \n"
88 "bxne r12 \n"
89#else
90 "ldmiane %0, { r0, pc } \n"
91#endif
92
93#if defined(CPU_ARM_MICRO) && ARCH_VERSION >= 7
94 "mov r0, %0 \n"
95 "ldmia r0, { r4-r11, lr } \n"
96 "ldr sp, [r0, #36] \n"
97#else
98 "ldmia %0, { r4-r11, sp, lr } \n" /* Load regs r4 to r14 from context */
99#endif
100 END_ARM_ASM_SYNTAX_UNIFIED
101 : : "r" (addr) : "r0" /* only! */
102 );
103}
104
105