recieveController

Dependents:   hayatoShooter

Revision:
2:ead1b55ec5f0
Parent:
0:57fc300625c4
Child:
3:6287618256b5
--- a/recieveController.cpp	Fri Sep 01 11:18:24 2017 +0900
+++ b/recieveController.cpp	Thu Dec 07 00:57:04 2017 +0900
@@ -4,9 +4,10 @@
 {
   id_ = id;
   serial.baud(115200);
-  for(int i = 0;i<5;i++)
+  buttons = 0;
+  for(int i = 0;i<sizeof(analogs);i++)
   {
-    buttons[i] = 0;
+   analogs[i] = 0;
   }
 
 }
@@ -15,23 +16,38 @@
 void recieveController::update()
 {
   // printf("updating");
-  char data[50],*data2,*data3,*button_,*analog[4],*intensity,*bt,*tmpdata;
+  char data[50],*data2,*data3,*button_,*analog[4],*intensity,*bt,*tmpdata,*address;
+  string head;
 
   serial.gets(data,50);
-  // printf("%s",data);
-  strtok(data,"-");
+  //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("%d\n",strtoul(button_,0,16) );
-  buttons[0] = strtoul(button_,0,16);
-  buttons[1] = strtoul(analog[0],0,16);
-  buttons[2] = strtoul(analog[1],0,16);
-  buttons[3] = strtoul(analog[2],0,16);
-  buttons[4] = strtoul(analog[3],0,16);
+  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];
+}
+