54 lines
842 B
C++
54 lines
842 B
C++
// (C) 2018 by Folkert van Heusden
|
|
// Released under Apache License v2.0
|
|
#if defined(ESP32)
|
|
#include <Arduino.h>
|
|
#endif
|
|
#include <stdarg.h>
|
|
#include <stdint.h>
|
|
#include <string>
|
|
#include <sys/time.h>
|
|
|
|
void setBit(uint16_t & v, const int bit, const bool vb)
|
|
{
|
|
const uint16_t mask = 1 << bit;
|
|
|
|
v &= ~mask;
|
|
|
|
if (vb)
|
|
v |= mask;
|
|
}
|
|
|
|
#if !defined(ESP32)
|
|
std::string format(const char *const fmt, ...)
|
|
{
|
|
char *buffer = nullptr;
|
|
va_list ap;
|
|
|
|
va_start(ap, fmt);
|
|
(void)vasprintf(&buffer, fmt, ap);
|
|
va_end(ap);
|
|
|
|
std::string result = buffer;
|
|
free(buffer);
|
|
|
|
return result;
|
|
}
|
|
#endif
|
|
|
|
unsigned long get_ms()
|
|
{
|
|
#if defined(ESP32)
|
|
return millis();
|
|
#else
|
|
struct timeval tv;
|
|
|
|
gettimeofday(&tv, NULL);
|
|
|
|
return tv.tv_sec * 1000 + tv.tv_usec / 1000;
|
|
#endif
|
|
}
|
|
|
|
int parity(int v)
|
|
{
|
|
return __builtin_parity(v); // FIXME
|
|
}
|