Tony YI / Mbed 2 deprecated ESDC2014

123123123123123123123123123

Dependencies:   mbed

compass.cpp

Committer:
terryLAI
Date:
2014-07-03
Revision:
2:442902ec3aa1
Parent:
1:cbec1283a16a
Child:
3:4306d042af6f

File content as of revision 2:442902ec3aa1:

#include "compass.h"

COMPASS::COMPASS(PinName tx, PinName rx)
{
   this->serial= new MySerial(tx,rx);
   serial->baud(56000);
   serial->format(8,SerialBase::None, 1);
   init();
}


uint16_t COMPASS::read()
{
    resume();
    buffer[0]=serial->getc();
    buffer[1]=serial->getc();
    stop();
    degree=(uint8_t)(buffer[0])*256+(uint8_t)(buffer[1]);
    return degree;
}

void COMPASS::init() 
{
    run();
    stop();
}

void COMPASS::run() 
{
    write2Bytes(RUN_MSB,RUN_LSB);
}


void COMPASS::stop() 
{
    write2Bytes(STOP_MSB,STOP_LSB);
}


void COMPASS::resume() 
{
    write2Bytes(RESUME_MSB,RESUME_LSB);
}


void COMPASS::reset() 
{
    write2Bytes(RST_MSB,RST_LSB);
}

void COMPASS::write2Bytes(char msb, char lsb) 
{
    serial->putc(msb);
    serial->putc(lsb);
   
}