cpu.h

Go to the documentation of this file.

/*
 * SPDX-FileCopyrightText: 2014 Freie Universität Berlin (FUB) & INRIA
 * SPDX-License-Identifier: LGPL-2.1-only
 */
 
#pragma once

 
#include <stdint.h>
 
#include <msp430.h>
 
#include "sched.h"
#include "thread.h"
 
#ifdef __cplusplus
extern "C" {
#endif

#define WORDSIZE 16

#define PROVIDES_PM_SET_LOWEST

#define ISR(a,b)        void __attribute__((naked, interrupt (a))) b(void)

extern volatile int __irq_is_in;

static inline void __attribute__((always_inline)) __save_context(void)
{
    __asm__("push r15");
    __asm__("push r14");
    __asm__("push r13");
    __asm__("push r12");
    __asm__("push r11");
    __asm__("push r10");
    __asm__("push r9");
    __asm__("push r8");
    __asm__("push r7");
    __asm__("push r6");
    __asm__("push r5");
    __asm__("push r4");
 
    __asm__("mov.w r1,%0" : "=r"(thread_get_active()->sp));
}

static inline void __attribute__((always_inline)) __restore_context(void)
{
    __asm__("mov.w %0,r1" : : "m"(thread_get_active()->sp));
 
    __asm__("pop r4");
    __asm__("pop r5");
    __asm__("pop r6");
    __asm__("pop r7");
    __asm__("pop r8");
    __asm__("pop r9");
    __asm__("pop r10");
    __asm__("pop r11");
    __asm__("pop r12");
    __asm__("pop r13");
    __asm__("pop r14");
    __asm__("pop r15");
    __asm__("reti");
}

static inline void __attribute__((always_inline)) __enter_isr(void)
{
    /* modify state register pushed to stack to not got to power saving
     * mode right again */
    __asm__ volatile(
        "bic %[mask], 0(SP)"            "\n\t"
        : /* no outputs */
        : [mask]    "i"(CPUOFF | SCG0 | SCG1 | OSCOFF)
        : "memory"
    );
    extern char __stack;    /* defined by linker script to end of RAM */
    __save_context();
    __asm__("mov.w %0,r1" : : "i"(&__stack));
    __irq_is_in = 1;
}

static inline void __attribute__((always_inline)) __exit_isr(void)
{
    __irq_is_in = 0;
 
    if (sched_context_switch_request) {
        sched_run();
    }
 
    __restore_context();
}

__attribute__((always_inline))
static inline uintptr_t cpu_get_caller_pc(void)
{
    return (uintptr_t)__builtin_return_address(0);
}
 
#ifdef __cplusplus
}
#endif