You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
104 lines
1.8 KiB
104 lines
1.8 KiB
3 months ago
|
/*
|
||
|
|
* General Utility Library for STM32
|
||
|
|
*
|
||
|
|
* (c) 2018--2019 Martin Mareš <mj@ucw.cz>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdbool.h>
|
||
|
|
#include <stddef.h>
|
||
|
|
#include <stdint.h>
|
||
|
|
|
||
|
|
#include "config.h"
|
||
|
|
|
||
|
|
// Types
|
||
|
|
|
||
|
|
typedef unsigned int uint;
|
||
|
|
typedef uint8_t byte;
|
||
|
|
typedef uint16_t u16;
|
||
|
|
typedef int16_t s16;
|
||
|
|
typedef uint32_t u32;
|
||
|
|
typedef int32_t s32;
|
||
|
|
|
||
|
|
// Macros
|
||
|
|
|
||
|
|
#define MIN(x,y) ((x) < (y) ? (x) : (y))
|
||
|
|
#define MAX(x,y) ((x) > (y) ? (x) : (y))
|
||
|
|
#define CLAMP(x,min,max) ({ typeof(x) _t=x; (_t < min) ? min : (_t > max) ? max : _t; })
|
||
|
|
#define ARRAY_SIZE(ary) (sizeof(ary)/sizeof((ary)[0]))
|
||
|
|
|
||
|
|
#define UNUSED __attribute__((unused))
|
||
|
|
|
||
|
|
// Unaligned access to data
|
||
|
|
|
||
|
|
static inline uint get_u16_le(byte *p)
|
||
|
|
{
|
||
|
|
return (p[1] << 8) | p[0];
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline uint get_u16_be(byte *p)
|
||
|
|
{
|
||
|
|
return (p[0] << 8) | p[1];
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline uint get_u32_le(byte *p)
|
||
|
|
{
|
||
|
|
return (p[3] << 24) | (p[2] << 16) | (p[1] << 8) | p[0];
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline uint get_u32_be(byte *p)
|
||
|
|
{
|
||
|
|
return (p[0] << 24) | (p[1] << 16) | (p[2] << 8) | p[3];
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u16_le(byte *p, u16 x)
|
||
|
|
{
|
||
|
|
p[0] = x;
|
||
|
|
p[1] = x >> 8;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u16_be(byte *p, u16 x)
|
||
|
|
{
|
||
|
|
p[0] = x >> 8;
|
||
|
|
p[1] = x;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u32_be(byte *p, u32 x)
|
||
|
|
{
|
||
|
|
p[0] = x >> 24;
|
||
|
|
p[1] = (x >> 16) & 0xff;
|
||
|
|
p[2] = (x >> 8) & 0xff;
|
||
|
|
p[3] = x & 0xff;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void put_u32_le(byte *p, u32 x)
|
||
|
|
{
|
||
|
|
p[3] = x >> 24;
|
||
|
|
p[2] = (x >> 16) & 0xff;
|
||
|
|
p[1] = (x >> 8) & 0xff;
|
||
|
|
p[0] = x & 0xff;
|
||
|
|
}
|
||
|
|
|
||
|
|
// CPU instructions not covered by libopencm3
|
||
|
|
|
||
|
|
static inline void wait_for_interrupt(void)
|
||
|
|
{
|
||
|
|
asm volatile ("wfi");
|
||
|
|
}
|
||
|
|
|
||
|
|
// A compiler memory barrier
|
||
|
|
|
||
|
|
static inline void barrier(void)
|
||
|
|
{
|
||
|
|
asm volatile ("" : : : "memory");
|
||
|
|
}
|
||
|
|
|
||
|
|
// util-debug.c
|
||
|
|
|
||
|
|
void debug_printf(const char *fmt, ...) __attribute__((format(printf,1,2)));
|
||
|
|
void debug_puts(const char *s);
|
||
|
|
void debug_putc(int c);
|
||
|
|
void debug_flush(void);
|
||
|
|
|
||
|
|
void debug_led(bool light);
|
||
|
|
void debug_led_toggle(void);
|