recieveController

Dependents:   hayatoShooter

recieveController.cpp

Committer:
WAT34
Date:
2017-12-07
Revision:
3:6287618256b5
Parent:
2:ead1b55ec5f0
Parent:
1:445486d27613
Child:
5:ccf493e265d1

File content as of revision 3:6287618256b5:

#include "recieveController.h"

recieveController::recieveController(PinName tx,PinName rx,const uint8_t& id):serial(tx,rx)
{
  id_ = id;
  serial.baud(115200);
  buttons = 0;
  for(int i = 0;i<sizeof(analogs);i++)
  {
   analogs[i] = 0;
  }

}


void recieveController::update()
{
  // printf("updating");
  char data[50],*data2,*data3,*button_,*analog[4],*intensity,*bt,*tmpdata,*address;
  string head;

  serial.gets(data,50);
  //printf("%s",data);
  head = strtok(data,"-");
  button_ = strtok(NULL,"-");
  analog[0] = strtok(NULL,"-");
  analog[1] = strtok(NULL,"-");
  analog[2] = strtok(NULL,"-");
  analog[3] = strtok(NULL,"-");
  intensity = strtok(NULL,"-");
  if(*intensity < 10)return;
  if(head != "RXT015")return;

  printf("%s\n",*analog[1]);
  buttons = strtoul(button_,0,16);
  analogs[0] = strtoul(analog[0],0,16);
  analogs[1] = strtoul(analog[1],0,16);
  analogs[2] = strtoul(analog[2],0,16);
  analogs[3] = strtoul(analog[3],0,16);
  return;
}
int  recieveController::getButtons()
{
  return buttons;
}

uint8_t recieveController::getAnalog(const uint8_t& index)
{

 // printf("analogs%d",analogs[index]);
  return analogs[index];
}