Wii Nunchuk via RFM69HW to Duplo 9203 Remote Control Car Kit using ARM mbed on a FRDM-KL25Z
Dependencies: CRC FastPWM RFM69 USBDevice WakeUp WiiChuk_compat mbed-rtos mbed tlc59108
Fork of wiiNunchuk_compat by
Diff: main.cpp
- Revision:
- 18:18c91572768a
- Parent:
- 17:b9030e94b622
- Child:
- 20:95a8fe0a15bc
diff -r b9030e94b622 -r 18c91572768a main.cpp --- a/main.cpp Tue Jun 28 12:59:17 2016 +0000 +++ b/main.cpp Tue Jun 28 13:22:47 2016 +0000 @@ -401,6 +401,9 @@ pc.printf("unsnooze tx\r\n"); #endif } + nunchuk *last = n; + n = next; + next = last; read = nun->Read(&n->X, &n->Y, &n->aX, &n->aY, &n->aZ, &n->C, &n->Z); n->sum = 0; n->sum = calculate_crc8((char*)n, sizeof(struct nunchuk)); @@ -464,7 +467,11 @@ pc.printf("central\r\n"); central = true; } - if (n->C || n->Z) + double twitch = pow(n->aX - next->aX, 2.0) + pow(n->aY - next->aY, 2.0) + pow(n->aZ - next->aZ, 2.0); +#if DEBUG > 1 + pc.printf("twitch %f\r\n", twitch); +#endif + if (n->C || n->Z || twitch > 100) central_time.reset(); r = 1.0f; g = 1.0f;