local fix version of myBlueUSB (http://mbed.org/users/networker/code/myBlueUSB/). - merge deleted files which are required to compile. - enable echo back of received data via RFCOMM.
Dependencies: AvailableMemory FatFileSystem mbed myUSBHost
sdp/sdp_data.cpp
- Committer:
- nobukuma
- Date:
- 2013-12-08
- Revision:
- 2:9f25a7fa1a54
- Parent:
- 0:003889bc474f
File content as of revision 2:9f25a7fa1a54:
#include "mbed.h" #include "sdp_data.h" #include "Utils.h" char sdp_data::ret[12]; unsigned sdp_data::asUnsigned() { switch (type) { case NULL_: return 0; case UNSIGNED: case SIGNED: case BOOL: return data; case UUID: #ifdef LONGUUID return uuid[6] + uuid[7]<<16; #else return data; #endif default: return 0; } } const char* sdp_data::asString(bool alt) { char sep = ','; switch (type) { case NULL_: return "NULL"; case UNSIGNED: if (alt) sprintf(ret, "0x%0*X", size*2, data); else sprintf(ret, "%u", data); return ret; case SIGNED: sprintf(ret, "%d", data); return ret; case BOOL: return data ? "TRUE" : "FALSE"; case STRING: case URL: return str; case ALTERNATIVE: sep = '|'; case SEQUENCE: { if (longstr) delete[] longstr; int n = sprintf(ret, "SEQ %d { ", size) + 1; longstr = new char[n]; strcpy(longstr, ret); for (int i = 0; i < sequence.size(); i++) { const char *s = sequence[i]->asString(alt); n = strlen(longstr) + strlen(s) + 2; char *t = new char[n]; strcpy(t, longstr); strcat(t, s); t[n-2] = sep; t[n-1]='\0'; //printf("[%s]+[%s]+%c=[%s]\n", longstr, s, sep, t); delete[] longstr; longstr = t; } longstr[n-2] = '}'; } return longstr; case UUID: #ifdef LONGUUID switch (size) { case 2: sprintf(ret, "0x%04X", uuid[6]); return ret; case 4: sprintf(ret, "0x%04X%04X", uuid[7],uuid[6]); return ret; case 16: longstr = new char[35]; sprintf(longstr, "%04X%04X-%04X-%04X-%04X-%04X%04X%04X", uuid[7],uuid[6],uuid[5],uuid[4],uuid[3],uuid[2],uuid[1],uuid[0]); return longstr; } #else switch (size) { case 2: sprintf(ret, "0x%04X", data & 0xffff); return ret; case 4: sprintf(ret, "0x%08X", data); return ret; case 16: longstr = new char[35]; sprintf(longstr, "%08X-%04X-%04X-%04X-%04X%04X%04X", data,base_uuid[5],base_uuid[4],base_uuid[3],base_uuid[2],base_uuid[1],base_uuid[0]); return longstr; } #endif } return "Unsupported"; } unsigned sdp_data::Size() { if (size==0 && type==SEQUENCE) return 2; if (size<3 || size==4 || size==8 || size==16) return size+1;//include descriptor if (size < 256) return size+2; //1 extra byte if (size < 65536) return size+3; //2 extra bytes return size+5; //4 extra bytes } unsigned sdp_data::sizedesc(unsigned char *buf) { int desc, extra=0; switch (size) { case 0: /* should be: if (type != NULL_) { desc = 5; extra = 1; buf[1] = 0; } */ case 1: desc = 0; break; case 2: desc = 1; break; case 4: desc = 2; break; case 8: desc = 3; break; case 16: desc = 4; break; default: if (size < 256) { desc = 5; extra = 1; buf[1] = size; } else if (size < 65536) { desc = 6; extra = 2; *(unsigned short*)&buf[1] = size; } else { desc = 7; extra = 4; *(unsigned*)&buf[1] = size; } } buf[0] |= desc; return extra+1; } void sdp_data::revcpy(unsigned char*d, const unsigned char*s, int n) { for (int i = 0; i < n; i++) d[i] = s[n-i-1]; } unsigned sdp_data::build(unsigned char *buf, unsigned max) {//max is ignored int p = 0; buf[p] = type<<3; switch (type) { case NULL_: p++; break; case UNSIGNED: case SIGNED: case BOOL: p += sizedesc(buf+p); revcpy(buf+p, (unsigned char*)&data, size); break; case UUID: p += sizedesc(buf+p); #ifdef LONGUUID switch (size) { case 2: case 4: revcpy(buf+p, (unsigned char*)&uuid[6], size); break; case 16: revcpy(buf+p, (unsigned char*)uuid, size); break; } #else switch (size) { case 2: case 4: revcpy(buf+p, (unsigned char*)&data, size); break; case 16: revcpy(buf+p, (unsigned char*)&data, 4); revcpy(buf+p+4, base_uuid, 12); break; } #endif break; case STRING: case URL: p += sizedesc(buf+p); memcpy(buf+p, str, size); break; case SEQUENCE: case ALTERNATIVE: { if (sequence.size()==0) {//hack: should be solved in sizedesc buf[p++] |= 5; buf[p++] = 0; break; } int n = 0; p += sizedesc(buf+p); for (int i = 0; i < sequence.size(); i++) n += sequence.at(i)->build(buf+p+n, max-p); } break; } p += size; // printfBytes("Build:", buf, p); return p; } bool sdp_data::findUUID(unsigned uuid) { if (type == UUID) return asUnsigned()==uuid; if (type==SEQUENCE || type==ALTERNATIVE) { for (int i = 0; i < sequence.size(); i++) { if (sequence[i]->findUUID(uuid)) return true; } } return false; }