phirawat rattanachote
v2
Fork of
Communication_Robot
by 
Betago
Diff: Receiver.cpp
- Revision:
- 14:cf43df0ddb93
- Parent:
- 13:bc19774be4df
--- a/Receiver.cpp Tue Jun 07 03:14:19 2016 +0000
+++ b/Receiver.cpp Tue Jun 07 17:22:37 2016 +0000
@@ -390,11 +390,8 @@
package.robotId = 0x00;
package.length = 22;//122
package.instructionErrorId = WRITE_DATA;
- for(i=0;i<20;i++)
- {
- package.parameter[i]=0xAA;
- }
- /* while(k<60)
+
+ while(k<60)
{ //PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
FloatSep( lidar1.Data[k],intData,floatData);
package.parameter[i]=intData[0];
@@ -403,10 +400,127 @@
j=j+2;
k++;
- }*/
+ }
rs485_dirc=1;
wait_us(RS485_DELAY);
return com->sendCommunicatePacket(&package);
}
+uint8_t Bear_Receiver::sendlidar2()
+{
+ int i=0,j=1,k=60;
+ uint8_t intData[2],floatData[2];
+ ANDANTE_PROTOCOL_PACKET package;
+ //BUFFER_SIZE=143
+ package.robotId = 0x00;
+ package.length = 122;
+ package.instructionErrorId = WRITE_DATA;
+
+ while(k<120)
+ {//PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
+ FloatSep( lidar1.Data[k],intData,floatData);
+ package.parameter[i]=intData[0];
+ package.parameter[j]=intData[1];
+ i=i+2;
+ j=j+2;
+ k++;
+
+ }
+ //rs485_dirc1=1;
+ wait_us(RS485_DELAY);
+ return com->sendCommunicatePacket(&package);
+
+}
+uint8_t Bear_Receiver::sendlidar3()
+{
+ int i=0,j=1,k=120;
+ uint8_t intData[2],floatData[2];
+ ANDANTE_PROTOCOL_PACKET package;
+ //BUFFER_SIZE=143
+ package.robotId = 0x00;
+ package.length = 122;
+ package.instructionErrorId = WRITE_DATA;
+ while(k<180)
+ {//PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
+ FloatSep( lidar1.Data[k],intData,floatData);
+ package.parameter[i]=intData[0];
+ package.parameter[j]=intData[1];
+ i=i+2;
+ j=j+2;
+ k++;
+ }
+ //rs485_dirc1=1;
+ wait_us(RS485_DELAY);
+ return com->sendCommunicatePacket(&package);
+
+}
+uint8_t Bear_Receiver::sendlidar4()
+{
+ int i=0,j=1,k=180;
+ uint8_t intData[2],floatData[2];
+ ANDANTE_PROTOCOL_PACKET package;
+ //BUFFER_SIZE=143
+ package.robotId = 0x00;
+ package.length = 122;
+ package.instructionErrorId = WRITE_DATA;
+ while(k<240)
+ {//PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
+ FloatSep( lidar1.Data[k],intData,floatData);
+ package.parameter[i]=intData[0];
+ package.parameter[j]=intData[1];
+ i=i+2;
+ j=j+2;
+ k++;
+ }
+ // rs485_dirc1=1;
+ wait_us(RS485_DELAY);
+ return com->sendCommunicatePacket(&package);
+
+}
+uint8_t Bear_Receiver::sendlidar5()
+{
+ int i=0,j=1,k=240;
+ uint8_t intData[2],floatData[2];
+ ANDANTE_PROTOCOL_PACKET package;
+ //BUFFER_SIZE=143
+ package.robotId = 0x00;
+ package.length = 122;
+ package.instructionErrorId = WRITE_DATA;
+ while(k<300)
+ {//PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
+ FloatSep( lidar1.Data[k],intData,floatData);
+ package.parameter[i]=intData[0];
+ package.parameter[j]=intData[1];
+ i=i+2;
+ j=j+2;
+ k++;
+ }
+
+ // rs485_dirc1=1;
+ wait_us(RS485_DELAY);
+ return com->sendCommunicatePacket(&package);
+}
+uint8_t Bear_Receiver::sendlidar6()
+{
+ int i=0,j=1,k=300;
+ uint8_t intData[2],floatData[2];
+ ANDANTE_PROTOCOL_PACKET package;
+ //BUFFER_SIZE=143
+ package.robotId = 0x00;
+ package.length = 122;
+ package.instructionErrorId = WRITE_DATA;
+ while(k<360)
+ {//PC.printf("i= %d,j= %d,k = %d\n",i,j,k);
+ FloatSep( lidar1.Data[k],intData,floatData);
+ package.parameter[i]=intData[0];
+ package.parameter[j]=intData[1];
+ i=i+2;
+ j=j+2;
+ k++;
+ }
+ // rs485_dirc1=1;
+ wait_us(RS485_DELAY);
+ return com->sendCommunicatePacket(&package);
+
+}
\ No newline at end of file