MyRFID.cpp

00001 #include "MyRFID.h"
00002 #include "mbed.h"
00003 
00004 using namespace mbed;
00005 
00006 MyRFID::MyRFID(PinName tx, PinName rx)
00007         : _rfid(tx,rx) {}
00008 
00009 
00010 
00011 int MyRFID::readable(void) {
00012     return (_rfid.readable());
00013 }
00014 
00015 void MyRFID::baud(int baudrate) {
00016     return (_rfid.baud(baudrate));
00017 }
00018 
00019 unsigned int MyRFID::read(void) {
00020 
00021     unsigned int id=0;
00022     int len,i;
00023 
00024     _rfid.getc();//header
00025     _rfid.getc();//header
00026     len = _rfid.getc();
00027 
00028     char data[len];
00029     for (i=0;i<len;i++) {
00030         data[i]=_rfid.getc();
00031     }
00032     if (data[0]==0x50) {//success
00033         for (i=0;i<4;i++) {
00034             id |= (data[4-i] << (i * 8));
00035         }
00036     } else {//failre
00037     }
00038 
00039     return id;
00040 }