mirror of https://github.com/ArduPilot/ardupilot
69 lines
1.8 KiB
C
69 lines
1.8 KiB
C
|
|
#ifndef __AP_PROGMEM_AVR_H__
|
|
#define __AP_PROGMEM_AVR_H__
|
|
|
|
#include <avr/pgmspace.h>
|
|
|
|
// prog_char_t is used as a wrapper type for prog_char, which is
|
|
// a character stored in flash. By using this wrapper type we can
|
|
// auto-detect at compile time if a call to a string function is using
|
|
// a flash-stored string or not
|
|
typedef struct {
|
|
char c;
|
|
} prog_char_t;
|
|
|
|
typedef char prog_char;
|
|
|
|
#undef PSTR
|
|
#define PSTR(s) (__extension__({static const prog_char __c[] PROGMEM = (s); \
|
|
(const prog_char_t *)&__c[0]; }))
|
|
|
|
|
|
static inline int strcasecmp_P(const char *str1, const prog_char_t *pstr)
|
|
{
|
|
return strcasecmp_P(str1, (const prog_char *)pstr);
|
|
}
|
|
|
|
static inline int strcmp_P(const char *str1, const prog_char_t *pstr)
|
|
{
|
|
return strcmp_P(str1, (const prog_char *)pstr);
|
|
}
|
|
|
|
static inline size_t strlen_P(const prog_char_t *pstr)
|
|
{
|
|
return strlen_P((const prog_char *)pstr);
|
|
}
|
|
|
|
static inline void *memcpy_P(void *dest, const prog_char_t *src, size_t n)
|
|
{
|
|
return memcpy_P(dest, (const prog_char *)src, n);
|
|
}
|
|
|
|
|
|
static inline char *strncpy_P(char *buffer, const prog_char_t *pstr, size_t buffer_size)
|
|
{
|
|
return strncpy_P(buffer, (const prog_char *)pstr, buffer_size);
|
|
}
|
|
|
|
static inline void pgm_read_block(const void *s, void *dest, uint8_t len) {
|
|
uint8_t *dp = (uint8_t *)dest;
|
|
for (uint8_t i=0; i<len; i++) {
|
|
dp[i] = pgm_read_byte(i + (const prog_char *)s);
|
|
}
|
|
}
|
|
|
|
// read something the size of a pointer. This makes the menu code more
|
|
// portable
|
|
static inline uintptr_t pgm_read_pointer(const void *s)
|
|
{
|
|
if (sizeof(uintptr_t) == sizeof(uint16_t)) {
|
|
return (uintptr_t)pgm_read_word(s);
|
|
} else {
|
|
uintptr_t p;
|
|
pgm_read_block(s, &p, sizeof(p));
|
|
return p;
|
|
}
|
|
}
|
|
|
|
#endif // __AP_PROGMEM_AVR_H__
|