github/chiaki
1
0
Fork 0
mirror of https://git.sr.ht/~thestr4ng3r/chiaki synced 2025-08-21 14:03:11 -07:00
Code Issues Projects Releases Packages Wiki Activity Actions

Add Orientation Tracker

Browse source
This commit is contained in:
Florian Märkl 2021-01-06 15:47:42 +01:00
commit 32e1539c22
No known key found for this signature in database
GPG key ID: 125BC8A5A6A1E857
6 changed files with 182 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

4
setsu/demo/motion.c
View file

@ -44,7 +44,7 @@ void sigint(int s)
#define BAR_LENGTH 100
#define BAR_MAX 2.0f
#define BAR_MAX_GYRO 180.0f
#define BAR_MAX_GYRO M_PI
void print_state()
{
@ -69,7 +69,7 @@ void print_state()
}
bool cov = ((vals.v[b] < 0.0f) == (cur < 0.0f)) && fabsf(vals.v[b]) > fabsf(cur);
float next = BAR_VAL(bi + 1);
#define MARK_VAL (b > 2 ? 90.0f : 1.0f)
#define MARK_VAL (b > 2 ? 0.5f * M_PI : 1.0f)
bool mark = cur < -MARK_VAL && next >= -MARK_VAL || prev < MARK_VAL && cur >= MARK_VAL;
buf[i++] = cov ? (mark ? '#' : '=') : (mark ? '.' : ' ');
#undef BAR_VAL