Idle

ti.mcu.cc23xx/Idle.em
 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
import em from '@$$emscript'
export const $U = em.$declare('MODULE')

import * as Debug from '@em.lang/Debug.em'
import * as IntrVec from '@em.arch.arm/IntrVec.em'

export type SleepCB = cb_t<[]>

const sleep_enter_tab = $table<SleepCB>('ro')
const sleep_leave_tab = $table<SleepCB>('ro')

export namespace em$meta {

    export function addSleepEnter(cb: SleepCB) {
        sleep_enter_tab.$add(cb)
    }

    export function addSleepLeave(cb: SleepCB) {
        sleep_leave_tab.$add(cb)
    }
}

var cur_pause_only = false

export function em$startup() {
    em.$['%%b+']
    $R.PMCTL.VDDRCTL.$$ = $R.PMCTL_VDDRCTL_SELECT
    $R.EVTULL.WKUPMASK.$$ = $R.EVTULL_WKUPMASK_AON_IOC_COMB | $R.EVTULL_WKUPMASK_AON_RTC_COMB
}

function doSleep() {
    for (let i = 0; i < sleep_enter_tab.$len; i++) {
        const cb = sleep_enter_tab[i]
        cb()
    }
    em.$['%%b:'](2)
    em.$['%%b-']
    Debug.reset()
    $R.CKMD.LDOCTL.$$ = 0
    IntrVec.PRIMASK_set(1)
    e$`HapiEnterStandby(0)`
    Debug.startup()
    em.$['%%b+']
    for (let i = 0; i < sleep_leave_tab.$len; i++) {
        const cb = sleep_leave_tab[i]
        cb()
    }
    IntrVec.PRIMASK_set(0)
}

function doPause() {
    em.$['%%b:'](1)
    em.$['%%b-']
    IntrVec.PRIMASK_set(1)
    e$`asm volatile ("wfi")`
    em.$['%%b+']
    IntrVec.PRIMASK_set(0)
}

export function setPauseOnly(pause_only: bool_t) {
    cur_pause_only = pause_only
}

export function exec() {
    if (cur_pause_only) {
        doPause()
    }
    else {
        doSleep()
    }
}

export function wakeup() {

}