RemoteIR.

Dependents:   RemoteIR_TestProgram SerialGPS_TestProgram StarBoardOrangeExpansion1 Door_Slamming_Device ... more

Committer:
shintamainjp
Date:
Fri Sep 17 20:22:38 2010 +0000
Revision:
9:dcfdac59ef74
Parent:
7:9452ba065449
Child:
10:c54fb1204d1e

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
shintamainjp 0:ec264f4ce158 1 /**
shintamainjp 9:dcfdac59ef74 2 * IR receiver (Version 0.0.4)
shintamainjp 0:ec264f4ce158 3 *
shintamainjp 0:ec264f4ce158 4 * Copyright (C) 2010 Shinichiro Nakamura (CuBeatSystems)
shintamainjp 0:ec264f4ce158 5 * http://shinta.main.jp/
shintamainjp 0:ec264f4ce158 6 */
shintamainjp 0:ec264f4ce158 7
shintamainjp 0:ec264f4ce158 8 #include "ReceiverIR.h"
shintamainjp 0:ec264f4ce158 9
shintamainjp 9:dcfdac59ef74 10 #define LOCK() sem.take()
shintamainjp 9:dcfdac59ef74 11 #define UNLOCK() sem.release()
shintamainjp 0:ec264f4ce158 12
shintamainjp 0:ec264f4ce158 13 #define InRange(x,y) ((((y) * 0.7) < (x)) && ((x) < ((y) * 1.3)))
shintamainjp 0:ec264f4ce158 14
shintamainjp 9:dcfdac59ef74 15 /**
shintamainjp 9:dcfdac59ef74 16 * Constructor.
shintamainjp 9:dcfdac59ef74 17 *
shintamainjp 9:dcfdac59ef74 18 * @param rxpin Pin for receive IR signal.
shintamainjp 9:dcfdac59ef74 19 */
shintamainjp 0:ec264f4ce158 20 ReceiverIR::ReceiverIR(PinName rxpin) : evt(rxpin) {
shintamainjp 9:dcfdac59ef74 21 init_state();
shintamainjp 0:ec264f4ce158 22 evt.fall(this, &ReceiverIR::isr_fall);
shintamainjp 0:ec264f4ce158 23 evt.rise(this, &ReceiverIR::isr_rise);
shintamainjp 0:ec264f4ce158 24 evt.mode(PullUp);
shintamainjp 0:ec264f4ce158 25 ticker.attach_us(this, &ReceiverIR::isr_wdt, 10 * 1000);
shintamainjp 0:ec264f4ce158 26 }
shintamainjp 0:ec264f4ce158 27
shintamainjp 9:dcfdac59ef74 28 /**
shintamainjp 9:dcfdac59ef74 29 * Destructor.
shintamainjp 9:dcfdac59ef74 30 */
shintamainjp 1:4adf16017a0f 31 ReceiverIR::~ReceiverIR() {
shintamainjp 1:4adf16017a0f 32 }
shintamainjp 1:4adf16017a0f 33
shintamainjp 9:dcfdac59ef74 34 /**
shintamainjp 9:dcfdac59ef74 35 * Get state.
shintamainjp 9:dcfdac59ef74 36 *
shintamainjp 9:dcfdac59ef74 37 * @return Current state.
shintamainjp 9:dcfdac59ef74 38 */
shintamainjp 0:ec264f4ce158 39 ReceiverIR::State ReceiverIR::getState() {
shintamainjp 9:dcfdac59ef74 40 LOCK();
shintamainjp 9:dcfdac59ef74 41 State s = work.state;
shintamainjp 9:dcfdac59ef74 42 UNLOCK();
shintamainjp 3:dfed23b157e6 43 wait_ms(10);
shintamainjp 0:ec264f4ce158 44 return s;
shintamainjp 0:ec264f4ce158 45 }
shintamainjp 0:ec264f4ce158 46
shintamainjp 9:dcfdac59ef74 47 /**
shintamainjp 9:dcfdac59ef74 48 * Get data.
shintamainjp 9:dcfdac59ef74 49 *
shintamainjp 9:dcfdac59ef74 50 * @param format Pointer to format.
shintamainjp 9:dcfdac59ef74 51 * @param buf Buffer of a data.
shintamainjp 9:dcfdac59ef74 52 * @param bitlength Bit length of the buffer.
shintamainjp 9:dcfdac59ef74 53 *
shintamainjp 9:dcfdac59ef74 54 * @return Data bit length.
shintamainjp 9:dcfdac59ef74 55 */
shintamainjp 4:2304646f6ff5 56 int ReceiverIR::getData(RemoteIR::Format *format, uint8_t *buf, int bitlength) {
shintamainjp 9:dcfdac59ef74 57 LOCK();
shintamainjp 0:ec264f4ce158 58
shintamainjp 4:2304646f6ff5 59 if (bitlength < data.bitcount) {
shintamainjp 9:dcfdac59ef74 60 UNLOCK();
shintamainjp 0:ec264f4ce158 61 return -1;
shintamainjp 0:ec264f4ce158 62 }
shintamainjp 0:ec264f4ce158 63
shintamainjp 9:dcfdac59ef74 64 const int nbits = data.bitcount;
shintamainjp 6:e57504fc802e 65 const int nbytes = data.bitcount / 8 + (((data.bitcount % 8) != 0) ? 1 : 0);
shintamainjp 0:ec264f4ce158 66 *format = data.format;
shintamainjp 5:e158c85c55ff 67 for (int i = 0; i < nbytes; i++) {
shintamainjp 0:ec264f4ce158 68 buf[i] = data.buffer[i];
shintamainjp 0:ec264f4ce158 69 }
shintamainjp 0:ec264f4ce158 70
shintamainjp 0:ec264f4ce158 71 init_state();
shintamainjp 0:ec264f4ce158 72
shintamainjp 9:dcfdac59ef74 73 UNLOCK();
shintamainjp 9:dcfdac59ef74 74 return nbits;
shintamainjp 0:ec264f4ce158 75 }
shintamainjp 0:ec264f4ce158 76
shintamainjp 0:ec264f4ce158 77 void ReceiverIR::init_state(void) {
shintamainjp 0:ec264f4ce158 78 work.c1 = -1;
shintamainjp 0:ec264f4ce158 79 work.c2 = -1;
shintamainjp 0:ec264f4ce158 80 work.c3 = -1;
shintamainjp 0:ec264f4ce158 81 work.d1 = -1;
shintamainjp 0:ec264f4ce158 82 work.d2 = -1;
shintamainjp 9:dcfdac59ef74 83 work.state = Idle;
shintamainjp 0:ec264f4ce158 84 data.format = RemoteIR::UNKNOWN;
shintamainjp 0:ec264f4ce158 85 data.bitcount = 0;
shintamainjp 0:ec264f4ce158 86 timer.stop();
shintamainjp 0:ec264f4ce158 87 timer.reset();
shintamainjp 0:ec264f4ce158 88 for (int i = 0; i < sizeof(data.buffer); i++) {
shintamainjp 0:ec264f4ce158 89 data.buffer[i] = 0;
shintamainjp 0:ec264f4ce158 90 }
shintamainjp 0:ec264f4ce158 91 }
shintamainjp 0:ec264f4ce158 92
shintamainjp 0:ec264f4ce158 93 void ReceiverIR::isr_wdt(void) {
shintamainjp 9:dcfdac59ef74 94 LOCK();
shintamainjp 0:ec264f4ce158 95 static int cnt = 0;
shintamainjp 9:dcfdac59ef74 96 if ((Idle != work.state) || ((0 <= work.c1) || (0 <= work.c2) || (0 <= work.c3) || (0 <= work.d1) || (0 <= work.d2))) {
shintamainjp 0:ec264f4ce158 97 cnt++;
shintamainjp 0:ec264f4ce158 98 if (cnt > 50) {
shintamainjp 3:dfed23b157e6 99 #if 1
shintamainjp 0:ec264f4ce158 100 printf("# WDT [c1=%d, c2=%d, c3=%d, d1=%d, d2=%d, state=%d, format=%d, bitcount=%d]\n",
shintamainjp 0:ec264f4ce158 101 work.c1,
shintamainjp 0:ec264f4ce158 102 work.c2,
shintamainjp 0:ec264f4ce158 103 work.c3,
shintamainjp 0:ec264f4ce158 104 work.d1,
shintamainjp 0:ec264f4ce158 105 work.d2,
shintamainjp 9:dcfdac59ef74 106 work.state,
shintamainjp 0:ec264f4ce158 107 data.format,
shintamainjp 0:ec264f4ce158 108 data.bitcount);
shintamainjp 0:ec264f4ce158 109 #endif
shintamainjp 0:ec264f4ce158 110 init_state();
shintamainjp 0:ec264f4ce158 111 cnt = 0;
shintamainjp 0:ec264f4ce158 112 }
shintamainjp 0:ec264f4ce158 113 } else {
shintamainjp 0:ec264f4ce158 114 cnt = 0;
shintamainjp 0:ec264f4ce158 115 }
shintamainjp 9:dcfdac59ef74 116 UNLOCK();
shintamainjp 0:ec264f4ce158 117 }
shintamainjp 0:ec264f4ce158 118
shintamainjp 0:ec264f4ce158 119 void ReceiverIR::isr_fall(void) {
shintamainjp 9:dcfdac59ef74 120 LOCK();
shintamainjp 9:dcfdac59ef74 121 switch (work.state) {
shintamainjp 0:ec264f4ce158 122 case Idle:
shintamainjp 0:ec264f4ce158 123 if (work.c1 < 0) {
shintamainjp 0:ec264f4ce158 124 timer.start();
shintamainjp 0:ec264f4ce158 125 work.c1 = timer.read_us();
shintamainjp 0:ec264f4ce158 126 } else {
shintamainjp 0:ec264f4ce158 127 work.c3 = timer.read_us();
shintamainjp 0:ec264f4ce158 128 int a = work.c2 - work.c1;
shintamainjp 0:ec264f4ce158 129 int b = work.c3 - work.c2;
shintamainjp 0:ec264f4ce158 130 if (InRange(a, TUS_NEC * 16) && InRange(b, TUS_NEC * 8)) {
shintamainjp 0:ec264f4ce158 131 /*
shintamainjp 0:ec264f4ce158 132 * NEC.
shintamainjp 0:ec264f4ce158 133 */
shintamainjp 0:ec264f4ce158 134 data.format = RemoteIR::NEC;
shintamainjp 9:dcfdac59ef74 135 work.state = Receiving;
shintamainjp 0:ec264f4ce158 136 data.bitcount = 0;
shintamainjp 0:ec264f4ce158 137 } else if (InRange(a, TUS_NEC * 16) && InRange(b, TUS_NEC * 4)) {
shintamainjp 0:ec264f4ce158 138 /*
shintamainjp 0:ec264f4ce158 139 * NEC Repeat.
shintamainjp 0:ec264f4ce158 140 */
shintamainjp 3:dfed23b157e6 141 data.format = RemoteIR::NEC_REPEAT;
shintamainjp 9:dcfdac59ef74 142 work.state = Received;
shintamainjp 0:ec264f4ce158 143 data.bitcount = 0;
shintamainjp 3:dfed23b157e6 144 work.c1 = -1;
shintamainjp 3:dfed23b157e6 145 work.c2 = -1;
shintamainjp 3:dfed23b157e6 146 work.c3 = -1;
shintamainjp 3:dfed23b157e6 147 work.d1 = -1;
shintamainjp 3:dfed23b157e6 148 work.d2 = -1;
shintamainjp 0:ec264f4ce158 149 } else if (InRange(a, TUS_AEHA * 8) && InRange(b, TUS_AEHA * 4)) {
shintamainjp 0:ec264f4ce158 150 /*
shintamainjp 0:ec264f4ce158 151 * AEHA.
shintamainjp 0:ec264f4ce158 152 */
shintamainjp 0:ec264f4ce158 153 data.format = RemoteIR::AEHA;
shintamainjp 9:dcfdac59ef74 154 work.state = Receiving;
shintamainjp 0:ec264f4ce158 155 data.bitcount = 0;
shintamainjp 0:ec264f4ce158 156 } else if (InRange(a, TUS_AEHA * 8) && InRange(b, TUS_AEHA * 8)) {
shintamainjp 0:ec264f4ce158 157 /*
shintamainjp 0:ec264f4ce158 158 * AEHA Repeat.
shintamainjp 0:ec264f4ce158 159 */
shintamainjp 3:dfed23b157e6 160 data.format = RemoteIR::AEHA_REPEAT;
shintamainjp 9:dcfdac59ef74 161 work.state = Received;
shintamainjp 0:ec264f4ce158 162 data.bitcount = 0;
shintamainjp 3:dfed23b157e6 163 work.c1 = -1;
shintamainjp 3:dfed23b157e6 164 work.c2 = -1;
shintamainjp 3:dfed23b157e6 165 work.c3 = -1;
shintamainjp 3:dfed23b157e6 166 work.d1 = -1;
shintamainjp 3:dfed23b157e6 167 work.d2 = -1;
shintamainjp 0:ec264f4ce158 168 } else {
shintamainjp 0:ec264f4ce158 169 init_state();
shintamainjp 0:ec264f4ce158 170 }
shintamainjp 0:ec264f4ce158 171 }
shintamainjp 0:ec264f4ce158 172 break;
shintamainjp 0:ec264f4ce158 173 case Receiving:
shintamainjp 0:ec264f4ce158 174 if (RemoteIR::NEC == data.format) {
shintamainjp 0:ec264f4ce158 175 work.d2 = timer.read_us();
shintamainjp 0:ec264f4ce158 176 int a = work.d2 - work.d1;
shintamainjp 0:ec264f4ce158 177 if (InRange(a, TUS_NEC * 3)) {
shintamainjp 0:ec264f4ce158 178 data.buffer[data.bitcount / 8] |= (1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 179 } else if (InRange(a, TUS_NEC * 1)) {
shintamainjp 0:ec264f4ce158 180 data.buffer[data.bitcount / 8] &= ~(1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 181 }
shintamainjp 0:ec264f4ce158 182 data.bitcount++;
shintamainjp 3:dfed23b157e6 183 #if 0
shintamainjp 0:ec264f4ce158 184 /*
shintamainjp 0:ec264f4ce158 185 * Length of NEC is always 32 bits.
shintamainjp 0:ec264f4ce158 186 */
shintamainjp 0:ec264f4ce158 187 if (32 <= data.bitcount) {
shintamainjp 0:ec264f4ce158 188 data.state = Received;
shintamainjp 0:ec264f4ce158 189 work.c1 = -1;
shintamainjp 0:ec264f4ce158 190 work.c2 = -1;
shintamainjp 0:ec264f4ce158 191 work.c3 = -1;
shintamainjp 0:ec264f4ce158 192 work.d1 = -1;
shintamainjp 0:ec264f4ce158 193 work.d2 = -1;
shintamainjp 0:ec264f4ce158 194 }
shintamainjp 0:ec264f4ce158 195 #else
shintamainjp 0:ec264f4ce158 196 /*
shintamainjp 0:ec264f4ce158 197 * Set timeout for tail detection automatically.
shintamainjp 0:ec264f4ce158 198 */
shintamainjp 0:ec264f4ce158 199 timeout.detach();
shintamainjp 3:dfed23b157e6 200 timeout.attach_us(this, &ReceiverIR::isr_timeout, TUS_NEC * 5);
shintamainjp 0:ec264f4ce158 201 #endif
shintamainjp 0:ec264f4ce158 202 } else if (RemoteIR::AEHA == data.format) {
shintamainjp 0:ec264f4ce158 203 work.d2 = timer.read_us();
shintamainjp 0:ec264f4ce158 204 int a = work.d2 - work.d1;
shintamainjp 0:ec264f4ce158 205 if (InRange(a, TUS_AEHA * 3)) {
shintamainjp 0:ec264f4ce158 206 data.buffer[data.bitcount / 8] |= (1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 207 } else if (InRange(a, TUS_AEHA * 1)) {
shintamainjp 0:ec264f4ce158 208 data.buffer[data.bitcount / 8] &= ~(1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 209 }
shintamainjp 0:ec264f4ce158 210 data.bitcount++;
shintamainjp 3:dfed23b157e6 211 #if 0
shintamainjp 0:ec264f4ce158 212 /*
shintamainjp 0:ec264f4ce158 213 * Typical length of AEHA is 48 bits.
shintamainjp 0:ec264f4ce158 214 * Please check a specification of your remote controller if you find a problem.
shintamainjp 0:ec264f4ce158 215 */
shintamainjp 0:ec264f4ce158 216 if (48 <= data.bitcount) {
shintamainjp 0:ec264f4ce158 217 data.state = Received;
shintamainjp 0:ec264f4ce158 218 work.c1 = -1;
shintamainjp 0:ec264f4ce158 219 work.c2 = -1;
shintamainjp 0:ec264f4ce158 220 work.c3 = -1;
shintamainjp 0:ec264f4ce158 221 work.d1 = -1;
shintamainjp 0:ec264f4ce158 222 work.d2 = -1;
shintamainjp 0:ec264f4ce158 223 }
shintamainjp 0:ec264f4ce158 224 #else
shintamainjp 0:ec264f4ce158 225 /*
shintamainjp 0:ec264f4ce158 226 * Set timeout for tail detection automatically.
shintamainjp 0:ec264f4ce158 227 */
shintamainjp 0:ec264f4ce158 228 timeout.detach();
shintamainjp 3:dfed23b157e6 229 timeout.attach_us(this, &ReceiverIR::isr_timeout, TUS_AEHA * 5);
shintamainjp 0:ec264f4ce158 230 #endif
shintamainjp 0:ec264f4ce158 231 } else if (RemoteIR::SONY == data.format) {
shintamainjp 0:ec264f4ce158 232 work.d1 = timer.read_us();
shintamainjp 0:ec264f4ce158 233 }
shintamainjp 0:ec264f4ce158 234 break;
shintamainjp 0:ec264f4ce158 235 case Received:
shintamainjp 0:ec264f4ce158 236 break;
shintamainjp 0:ec264f4ce158 237 default:
shintamainjp 0:ec264f4ce158 238 break;
shintamainjp 0:ec264f4ce158 239 }
shintamainjp 9:dcfdac59ef74 240 UNLOCK();
shintamainjp 0:ec264f4ce158 241 }
shintamainjp 0:ec264f4ce158 242
shintamainjp 0:ec264f4ce158 243 void ReceiverIR::isr_rise(void) {
shintamainjp 9:dcfdac59ef74 244 LOCK();
shintamainjp 9:dcfdac59ef74 245 switch (work.state) {
shintamainjp 0:ec264f4ce158 246 case Idle:
shintamainjp 0:ec264f4ce158 247 if (0 <= work.c1) {
shintamainjp 0:ec264f4ce158 248 work.c2 = timer.read_us();
shintamainjp 0:ec264f4ce158 249 int a = work.c2 - work.c1;
shintamainjp 0:ec264f4ce158 250 if (InRange(a, TUS_SONY * 4)) {
shintamainjp 0:ec264f4ce158 251 data.format = RemoteIR::SONY;
shintamainjp 9:dcfdac59ef74 252 work.state = Receiving;
shintamainjp 0:ec264f4ce158 253 data.bitcount = 0;
shintamainjp 0:ec264f4ce158 254 } else {
shintamainjp 0:ec264f4ce158 255 static const int MINIMUM_LEADER_WIDTH = 150;
shintamainjp 0:ec264f4ce158 256 if (a < MINIMUM_LEADER_WIDTH) {
shintamainjp 0:ec264f4ce158 257 init_state();
shintamainjp 0:ec264f4ce158 258 }
shintamainjp 0:ec264f4ce158 259 }
shintamainjp 0:ec264f4ce158 260 } else {
shintamainjp 0:ec264f4ce158 261 init_state();
shintamainjp 0:ec264f4ce158 262 }
shintamainjp 0:ec264f4ce158 263 break;
shintamainjp 0:ec264f4ce158 264 case Receiving:
shintamainjp 0:ec264f4ce158 265 if (RemoteIR::NEC == data.format) {
shintamainjp 0:ec264f4ce158 266 work.d1 = timer.read_us();
shintamainjp 0:ec264f4ce158 267 } else if (RemoteIR::AEHA == data.format) {
shintamainjp 0:ec264f4ce158 268 work.d1 = timer.read_us();
shintamainjp 0:ec264f4ce158 269 } else if (RemoteIR::SONY == data.format) {
shintamainjp 0:ec264f4ce158 270 work.d2 = timer.read_us();
shintamainjp 0:ec264f4ce158 271 int a = work.d2 - work.d1;
shintamainjp 0:ec264f4ce158 272 if (InRange(a, TUS_SONY * 2)) {
shintamainjp 0:ec264f4ce158 273 data.buffer[data.bitcount / 8] |= (1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 274 } else if (InRange(a, TUS_SONY * 1)) {
shintamainjp 0:ec264f4ce158 275 data.buffer[data.bitcount / 8] &= ~(1 << (data.bitcount % 8));
shintamainjp 0:ec264f4ce158 276 }
shintamainjp 0:ec264f4ce158 277 data.bitcount++;
shintamainjp 3:dfed23b157e6 278 #if 0
shintamainjp 0:ec264f4ce158 279 /*
shintamainjp 9:dcfdac59ef74 280 * How do I know the correct length? (6bits, 12bits, 15bits, 20bits...)
shintamainjp 0:ec264f4ce158 281 * By a model only?
shintamainjp 0:ec264f4ce158 282 * Please check a specification of your remote controller if you find a problem.
shintamainjp 0:ec264f4ce158 283 */
shintamainjp 0:ec264f4ce158 284 if (12 <= data.bitcount) {
shintamainjp 0:ec264f4ce158 285 data.state = Received;
shintamainjp 0:ec264f4ce158 286 work.c1 = -1;
shintamainjp 0:ec264f4ce158 287 work.c2 = -1;
shintamainjp 0:ec264f4ce158 288 work.c3 = -1;
shintamainjp 0:ec264f4ce158 289 work.d1 = -1;
shintamainjp 0:ec264f4ce158 290 work.d2 = -1;
shintamainjp 0:ec264f4ce158 291 }
shintamainjp 0:ec264f4ce158 292 #else
shintamainjp 0:ec264f4ce158 293 /*
shintamainjp 0:ec264f4ce158 294 * Set timeout for tail detection automatically.
shintamainjp 0:ec264f4ce158 295 */
shintamainjp 0:ec264f4ce158 296 timeout.detach();
shintamainjp 3:dfed23b157e6 297 timeout.attach_us(this, &ReceiverIR::isr_timeout, TUS_SONY * 4);
shintamainjp 0:ec264f4ce158 298 #endif
shintamainjp 0:ec264f4ce158 299 }
shintamainjp 0:ec264f4ce158 300 break;
shintamainjp 0:ec264f4ce158 301 case Received:
shintamainjp 0:ec264f4ce158 302 break;
shintamainjp 0:ec264f4ce158 303 default:
shintamainjp 0:ec264f4ce158 304 break;
shintamainjp 0:ec264f4ce158 305 }
shintamainjp 9:dcfdac59ef74 306 UNLOCK();
shintamainjp 0:ec264f4ce158 307 }
shintamainjp 0:ec264f4ce158 308
shintamainjp 0:ec264f4ce158 309 void ReceiverIR::isr_timeout(void) {
shintamainjp 9:dcfdac59ef74 310 LOCK();
shintamainjp 9:dcfdac59ef74 311 #if 0
shintamainjp 9:dcfdac59ef74 312 printf("# TIMEOUT [c1=%d, c2=%d, c3=%d, d1=%d, d2=%d, state=%d, format=%d, bitcount=%d]\n",
shintamainjp 9:dcfdac59ef74 313 work.c1,
shintamainjp 9:dcfdac59ef74 314 work.c2,
shintamainjp 9:dcfdac59ef74 315 work.c3,
shintamainjp 9:dcfdac59ef74 316 work.d1,
shintamainjp 9:dcfdac59ef74 317 work.d2,
shintamainjp 9:dcfdac59ef74 318 work.state,
shintamainjp 9:dcfdac59ef74 319 data.format,
shintamainjp 9:dcfdac59ef74 320 data.bitcount);
shintamainjp 9:dcfdac59ef74 321 #endif
shintamainjp 9:dcfdac59ef74 322 if (work.state == Receiving) {
shintamainjp 9:dcfdac59ef74 323 work.state = Received;
shintamainjp 0:ec264f4ce158 324 work.c1 = -1;
shintamainjp 0:ec264f4ce158 325 work.c2 = -1;
shintamainjp 0:ec264f4ce158 326 work.c3 = -1;
shintamainjp 0:ec264f4ce158 327 work.d1 = -1;
shintamainjp 0:ec264f4ce158 328 work.d2 = -1;
shintamainjp 0:ec264f4ce158 329 }
shintamainjp 9:dcfdac59ef74 330 UNLOCK();
shintamainjp 0:ec264f4ce158 331 }