gaku takasawa / MyLib

mylibrary

Nunchuck/Nunchuck.cpp@2:7b7821addb45, 2017-05-11 (annotated)

Committer:
gaku_sigu
Date:
Thu May 11 07:10:17 2017 +0000
Revision:
2:7b7821addb45
Parent:
0:a919993ff50f
Child:
3:e7a900958f54
????????????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gaku_sigu 0:a919993ff50f 1 #include "Nunchuck.h"
gaku_sigu 0:a919993ff50f 2
gaku_sigu 0:a919993ff50f 3
gaku_sigu 0:a919993ff50f 4 Nunchuck::Nunchuck(PinName SDA, PinName SCL) : I2C(SDA, SCL)
gaku_sigu 0:a919993ff50f 5 {
gaku_sigu 0:a919993ff50f 6 flag = 0;
gaku_sigu 0:a919993ff50f 7 for(int i = 0; i < 6; i++)
gaku_sigu 0:a919993ff50f 8 data[i] = 0;
gaku_sigu 0:a919993ff50f 9 init();
gaku_sigu 0:a919993ff50f 10 timer.start();
gaku_sigu 0:a919993ff50f 11 }
gaku_sigu 0:a919993ff50f 12
gaku_sigu 0:a919993ff50f 13 bool Nunchuck::init()
gaku_sigu 0:a919993ff50f 14 {
gaku_sigu 0:a919993ff50f 15 unsigned char cmd[] = {0x40, 0x00};
gaku_sigu 0:a919993ff50f 16 if (I2C::write(ADDR, (const char*)cmd, sizeof(cmd)) == 0)
gaku_sigu 0:a919993ff50f 17 return 1;
gaku_sigu 0:a919993ff50f 18 else
gaku_sigu 0:a919993ff50f 19 return 0;
gaku_sigu 0:a919993ff50f 20 }
gaku_sigu 0:a919993ff50f 21
gaku_sigu 0:a919993ff50f 22 void Nunchuck::getdata()
gaku_sigu 0:a919993ff50f 23 {
gaku_sigu 0:a919993ff50f 24 if(timer.read_ms() < 50)
gaku_sigu 0:a919993ff50f 25 return;
gaku_sigu 0:a919993ff50f 26
gaku_sigu 0:a919993ff50f 27
gaku_sigu 0:a919993ff50f 28 if(flag) {
gaku_sigu 0:a919993ff50f 29 const unsigned char cmd[] = {0x00};
gaku_sigu 0:a919993ff50f 30 if (I2C::write(ADDR, (const char*)cmd, sizeof(cmd)) == 0)
gaku_sigu 0:a919993ff50f 31 {
gaku_sigu 0:a919993ff50f 32 wait(0.01);
gaku_sigu 0:a919993ff50f 33 if (I2C::read(ADDR, data, sizeof(data)) == 0)
gaku_sigu 0:a919993ff50f 34 {
gaku_sigu 2:7b7821addb45 35 for(int i = 0; i < 6; ++i)
gaku_sigu 0:a919993ff50f 36 data[i] = (data[i] ^ 0x17) + 0x17;
gaku_sigu 0:a919993ff50f 37 }
gaku_sigu 0:a919993ff50f 38 }
gaku_sigu 0:a919993ff50f 39 }
gaku_sigu 0:a919993ff50f 40 else
gaku_sigu 0:a919993ff50f 41 flag = init();
gaku_sigu 0:a919993ff50f 42
gaku_sigu 0:a919993ff50f 43 timer.reset();
gaku_sigu 0:a919993ff50f 44 }
gaku_sigu 0:a919993ff50f 45
gaku_sigu 0:a919993ff50f 46
gaku_sigu 0:a919993ff50f 47 int8_t Nunchuck::analogx()
gaku_sigu 0:a919993ff50f 48 {
gaku_sigu 0:a919993ff50f 49 getdata();
gaku_sigu 0:a919993ff50f 50 int8_t temp;
gaku_sigu 0:a919993ff50f 51 temp = data[0] - 128;
gaku_sigu 0:a919993ff50f 52 #if ANALOGDATA
gaku_sigu 0:a919993ff50f 53 if(-1*(DEADZONE) < temp && temp < DEADZONE)
gaku_sigu 0:a919993ff50f 54 temp = 0;
gaku_sigu 0:a919993ff50f 55 #else
gaku_sigu 0:a919993ff50f 56 if(-50 < temp && temp < 50)
gaku_sigu 0:a919993ff50f 57 temp = 0;
gaku_sigu 0:a919993ff50f 58 else if(temp <= -50)
gaku_sigu 0:a919993ff50f 59 temp = -1;
gaku_sigu 0:a919993ff50f 60 else if(temp >= 50)
gaku_sigu 0:a919993ff50f 61 temp = 1;
gaku_sigu 0:a919993ff50f 62 #endif
gaku_sigu 0:a919993ff50f 63 return temp;
gaku_sigu 0:a919993ff50f 64 }
gaku_sigu 0:a919993ff50f 65
gaku_sigu 0:a919993ff50f 66
gaku_sigu 0:a919993ff50f 67 int8_t Nunchuck::analogy()
gaku_sigu 0:a919993ff50f 68 {
gaku_sigu 0:a919993ff50f 69 getdata();
gaku_sigu 0:a919993ff50f 70 int8_t temp;
gaku_sigu 0:a919993ff50f 71 temp = data[1] - 128;
gaku_sigu 0:a919993ff50f 72 #if ANALOGDATA
gaku_sigu 0:a919993ff50f 73 if(-1*(DEADZONE) < temp && temp < DEADZONE)
gaku_sigu 0:a919993ff50f 74 temp = 0;
gaku_sigu 0:a919993ff50f 75 #else
gaku_sigu 0:a919993ff50f 76 if(-50 < temp && temp < 50)
gaku_sigu 0:a919993ff50f 77 temp = 0;
gaku_sigu 0:a919993ff50f 78 else if(temp <= -50)
gaku_sigu 0:a919993ff50f 79 temp = -1;
gaku_sigu 0:a919993ff50f 80 else if(temp >= 50)
gaku_sigu 0:a919993ff50f 81 temp = 1;
gaku_sigu 0:a919993ff50f 82 #endif
gaku_sigu 0:a919993ff50f 83 return temp;
gaku_sigu 0:a919993ff50f 84 }
gaku_sigu 0:a919993ff50f 85
gaku_sigu 0:a919993ff50f 86
gaku_sigu 0:a919993ff50f 87 int Nunchuck::accx()
gaku_sigu 0:a919993ff50f 88 {
gaku_sigu 0:a919993ff50f 89 getdata();
gaku_sigu 0:a919993ff50f 90 int temp = data[2] << 2;
gaku_sigu 0:a919993ff50f 91 if ((data[5] >> 2) & 1) temp += 2;
gaku_sigu 0:a919993ff50f 92 if ((data[5] >> 3) & 1) temp += 1;
gaku_sigu 0:a919993ff50f 93 return data[2];
gaku_sigu 0:a919993ff50f 94 }
gaku_sigu 0:a919993ff50f 95
gaku_sigu 0:a919993ff50f 96
gaku_sigu 0:a919993ff50f 97 int Nunchuck::accy()
gaku_sigu 0:a919993ff50f 98 {
gaku_sigu 0:a919993ff50f 99 getdata();
gaku_sigu 0:a919993ff50f 100 int temp = data[3] << 2;
gaku_sigu 0:a919993ff50f 101 if ((data[5] >> 4) & 1) temp += 2;
gaku_sigu 0:a919993ff50f 102 if ((data[5] >> 5) & 1) temp += 1;
gaku_sigu 0:a919993ff50f 103 return data[3];
gaku_sigu 0:a919993ff50f 104 }
gaku_sigu 0:a919993ff50f 105
gaku_sigu 0:a919993ff50f 106
gaku_sigu 0:a919993ff50f 107 int Nunchuck::accz()
gaku_sigu 0:a919993ff50f 108 {
gaku_sigu 0:a919993ff50f 109 getdata();
gaku_sigu 0:a919993ff50f 110 int temp = data[4] << 2;
gaku_sigu 0:a919993ff50f 111 if ((data[5] >> 6) & 1) temp += 2;
gaku_sigu 0:a919993ff50f 112 if ((data[5] >> 7) & 1) temp += 1;
gaku_sigu 0:a919993ff50f 113 return data[4];
gaku_sigu 0:a919993ff50f 114 }
gaku_sigu 0:a919993ff50f 115
gaku_sigu 0:a919993ff50f 116
gaku_sigu 0:a919993ff50f 117 bool Nunchuck::buttonz()
gaku_sigu 0:a919993ff50f 118 {
gaku_sigu 0:a919993ff50f 119 getdata();
gaku_sigu 0:a919993ff50f 120 return !(data[5] & 0x01);
gaku_sigu 0:a919993ff50f 121 }
gaku_sigu 0:a919993ff50f 122
gaku_sigu 0:a919993ff50f 123
gaku_sigu 0:a919993ff50f 124 bool Nunchuck::buttonc()
gaku_sigu 0:a919993ff50f 125 {
gaku_sigu 0:a919993ff50f 126 getdata();
gaku_sigu 0:a919993ff50f 127 return !(data[5] & 0x02);
gaku_sigu 0:a919993ff50f 128 }