nakagawa kit emurator (add CR) BaudRate 115200,p20

Dependencies:   mbed NetServicesMin

Committer:
recotana
Date:
Thu Mar 22 14:35:48 2012 +0000
Revision:
0:e5342390978b
Child:
2:c3f3d783560d

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
recotana 0:e5342390978b 1 #include "types.h"
recotana 0:e5342390978b 2 #include "data_models.h"
recotana 0:e5342390978b 3 #include "EthernetNetIf.h"
recotana 0:e5342390978b 4
recotana 0:e5342390978b 5
recotana 0:e5342390978b 6 void initPayload(Payload *_payload)
recotana 0:e5342390978b 7 {
recotana 0:e5342390978b 8 _payload->size=sizeof(Payload);
recotana 0:e5342390978b 9 _payload->dummy = 0;
recotana 0:e5342390978b 10 _payload->ftype = Ftype_Type_B;
recotana 0:e5342390978b 11
recotana 0:e5342390978b 12 Frame *frame=&_payload->frame;
recotana 0:e5342390978b 13
recotana 0:e5342390978b 14 for(int i=0 ; i < sizeof(frame->id.personalId) ; i++) frame->id.personalId[i]=0;
recotana 0:e5342390978b 15
recotana 0:e5342390978b 16 frame->message.frameNumber=0xFFFF;
recotana 0:e5342390978b 17 frame->message.device=SERVER;
recotana 0:e5342390978b 18 frame->message.command=PING;
recotana 0:e5342390978b 19
recotana 0:e5342390978b 20 for(int i=0 ; i < sizeof(_payload->frame.message.data) ; i++) _payload->frame.message.data[i]=0;
recotana 0:e5342390978b 21 }
recotana 0:e5342390978b 22
recotana 0:e5342390978b 23 void payloadToNetwork(Payload *_payload)
recotana 0:e5342390978b 24 {
recotana 0:e5342390978b 25 Frame *frame=&_payload->frame;
recotana 0:e5342390978b 26 _payload->size = htons(_payload->size);
recotana 0:e5342390978b 27 frame->id.head = htons(frame->id.head);
recotana 0:e5342390978b 28 frame->message.totalSize = htons(frame->message.totalSize);
recotana 0:e5342390978b 29 frame->message.frameNumber = htons(frame->message.frameNumber);
recotana 0:e5342390978b 30
recotana 0:e5342390978b 31 }
recotana 0:e5342390978b 32 void networkToPayload(Payload *_payload)
recotana 0:e5342390978b 33 {
recotana 0:e5342390978b 34 Frame *frame=&_payload->frame;
recotana 0:e5342390978b 35 _payload->size = ntohs(_payload->size);
recotana 0:e5342390978b 36 frame->id.head = ntohs(frame->id.head);
recotana 0:e5342390978b 37 frame->message.totalSize = ntohs(frame->message.totalSize);
recotana 0:e5342390978b 38 frame->message.frameNumber = ntohs(frame->message.frameNumber);
recotana 0:e5342390978b 39 }
recotana 0:e5342390978b 40
recotana 0:e5342390978b 41 void initTestPayloadData(Payload *_payload)
recotana 0:e5342390978b 42 {
recotana 0:e5342390978b 43 Frame *frame=&_payload->frame;
recotana 0:e5342390978b 44
recotana 0:e5342390978b 45 initPayload(_payload);
recotana 0:e5342390978b 46 _payload->size=sizeof(Payload);
recotana 0:e5342390978b 47
recotana 0:e5342390978b 48 frame->id.head=0x0000;
recotana 0:e5342390978b 49 uint8_t tmpid[14]={0x31,0x32,0x33,0x34,0x35,0x36,0x37,0x38,0x39,0x40,0x41,0x42,0x43,0x44};
recotana 0:e5342390978b 50 for(int i=0;i<sizeof(tmpid);i++) frame->id.personalId[i]=tmpid[i];
recotana 0:e5342390978b 51
recotana 0:e5342390978b 52
recotana 0:e5342390978b 53 frame->message.frameNumber=1;
recotana 0:e5342390978b 54 frame->message.device=LED_SENDER;
recotana 0:e5342390978b 55 frame->message.command=SEND_SINGLE;
recotana 0:e5342390978b 56
recotana 0:e5342390978b 57 uint8_t tmpdata[42]={
recotana 0:e5342390978b 58 1,2,3,4,5,6,7,8,9,10,
recotana 0:e5342390978b 59 11,12,13,14,15,16,17,18,19,20,
recotana 0:e5342390978b 60 21,22,23,24,25,26,27,28,29,30,
recotana 0:e5342390978b 61 31,32,33,34,35,36,37,38,39,40,
recotana 0:e5342390978b 62 41,42};
recotana 0:e5342390978b 63 for(int i=0;i<sizeof(tmpdata);i++) frame->message.data[i]=tmpdata[i];
recotana 0:e5342390978b 64
recotana 0:e5342390978b 65 frame->message.totalSize=
recotana 0:e5342390978b 66 sizeof(frame->message.totalSize)
recotana 0:e5342390978b 67 +sizeof(frame->message.frameNumber)
recotana 0:e5342390978b 68 +sizeof(frame->message.device)
recotana 0:e5342390978b 69 +sizeof(frame->message.command)
recotana 0:e5342390978b 70 +sizeof(frame->message.data);
recotana 0:e5342390978b 71
recotana 0:e5342390978b 72 }
recotana 0:e5342390978b 73
recotana 0:e5342390978b 74
recotana 0:e5342390978b 75 void dumpPayload(Payload *_payload)
recotana 0:e5342390978b 76 {
recotana 0:e5342390978b 77 Frame *frame=&_payload->frame;
recotana 0:e5342390978b 78 printf("\r\n======== dump!!\r\n");
recotana 0:e5342390978b 79 printf("payload\nsize:%04X\r\n ",_payload->size);
recotana 0:e5342390978b 80 printf("Type:%0X\r\n ",_payload->ftype);
recotana 0:e5342390978b 81
recotana 0:e5342390978b 82 printf("Payload id_head:%04X\r\n personal id:",_payload->frame.id.head);
recotana 0:e5342390978b 83 for(int i=0 ; i < sizeof(frame->id.personalId) ; i++){
recotana 0:e5342390978b 84 printf("%d:%02X ",i,frame->id.personalId[i]);
recotana 0:e5342390978b 85 }
recotana 0:e5342390978b 86
recotana 0:e5342390978b 87 printf("\r\n");
recotana 0:e5342390978b 88
recotana 0:e5342390978b 89 printf("total size:%d , frame number:%d , divece:%0X , command:%02X\r\n"
recotana 0:e5342390978b 90 ,frame->message.totalSize
recotana 0:e5342390978b 91 ,frame->message.frameNumber
recotana 0:e5342390978b 92 ,frame->message.device
recotana 0:e5342390978b 93 ,frame->message.command);
recotana 0:e5342390978b 94
recotana 0:e5342390978b 95 printf("message data:\r\n");
recotana 0:e5342390978b 96 for(int i=0 ; i < sizeof(frame->message.data) ; i++){
recotana 0:e5342390978b 97 printf("%d:%02X ",i,_payload->frame.message.data[i]);
recotana 0:e5342390978b 98 }
recotana 0:e5342390978b 99
recotana 0:e5342390978b 100 printf("\r\n--- RAW DATA -------\r\n");
recotana 0:e5342390978b 101 for(int i=0 ; i < sizeof(Payload) ; i++){
recotana 0:e5342390978b 102 printf("%d:%02X ",i,((uint8_t*)_payload)[i]);
recotana 0:e5342390978b 103 }
recotana 0:e5342390978b 104 printf("\r\n");
recotana 0:e5342390978b 105
recotana 0:e5342390978b 106 }