1223

Dependencies:   BufferedSerial SoftPWM mbed send

Fork of nRF24L01P_Hello_World by YX ZHANG

JY901.h

Committer:
accelerator225
Date:
2017-11-08
Revision:
4:876bfa91934c

File content as of revision 4:876bfa91934c:

#include "mbed.h"
#include "BufferedSerial.h"
class JY901
{
    int state, token, payloadLen, recvLen;
    unsigned char payloadBuf[16];
protected:
    BufferedSerial mod;
    float acc[3], gyo[3], mag[3], att[3];
    void parseCmpt(int token, unsigned char* payloadBuf, int payloadLen);
    void parseInput(const char* data, int len);
public:
    JY901(PinName TX, PinName RX) : mod(TX, RX, 32){}
    ~JY901() {}
    void receiveData();
    void getAcc(float &x, float &y, float &z){
        x = acc[0];
        y = acc[1];
        z = acc[2];
    }
    void getGyo(float &x, float &y, float &z){
        x = gyo[0];
        y = gyo[1];
        z = gyo[2];
    }
    void getMag(float &x, float &y, float &z){
        x = mag[0];
        y = mag[1];
        z = mag[2];
    }
    void getAttitude(float &roll, float &pitch, float &yaw){
        roll = att[0];
        pitch = att[1];
        yaw = att[2];
    }
};