зеркало из https://github.com/mozilla/gecko-dev.git
114 строки
2.7 KiB
C++
114 строки
2.7 KiB
C++
/* -*- Mode: c++; c-basic-offset: 2; indent-tabs-mode: nil; tab-width: 40 -*- */
|
|
/* vim: set ts=2 et sw=2 tw=80: */
|
|
/* This Source Code Form is subject to the terms of the Mozilla Public
|
|
* License, v. 2.0. If a copy of the MPL was not distributed with this file,
|
|
* You can obtain one at http://mozilla.org/MPL/2.0/. */
|
|
|
|
#include "ObexBase.h"
|
|
|
|
BEGIN_BLUETOOTH_NAMESPACE
|
|
|
|
int
|
|
AppendHeaderName(uint8_t* retBuf, const char* name, int length)
|
|
{
|
|
int headerLength = length + 3;
|
|
|
|
retBuf[0] = ObexHeaderId::Name;
|
|
retBuf[1] = (headerLength & 0xFF00) >> 8;
|
|
retBuf[2] = headerLength & 0x00FF;
|
|
|
|
memcpy(&retBuf[3], name, length);
|
|
|
|
return headerLength;
|
|
}
|
|
|
|
int
|
|
AppendHeaderBody(uint8_t* retBuf, uint8_t* data, int length)
|
|
{
|
|
int headerLength = length + 3;
|
|
|
|
retBuf[0] = ObexHeaderId::Body;
|
|
retBuf[1] = (headerLength & 0xFF00) >> 8;
|
|
retBuf[2] = headerLength & 0x00FF;
|
|
|
|
memcpy(&retBuf[3], data, length);
|
|
|
|
return headerLength;
|
|
}
|
|
|
|
int
|
|
AppendHeaderLength(uint8_t* retBuf, int objectLength)
|
|
{
|
|
retBuf[0] = ObexHeaderId::Length;
|
|
retBuf[1] = (objectLength & 0xFF000000) >> 24;
|
|
retBuf[2] = (objectLength & 0x00FF0000) >> 16;
|
|
retBuf[3] = (objectLength & 0x0000FF00) >> 8;
|
|
retBuf[4] = objectLength & 0x000000FF;
|
|
|
|
return 5;
|
|
}
|
|
|
|
int
|
|
AppendHeaderConnectionId(uint8_t* retBuf, int connectionId)
|
|
{
|
|
retBuf[0] = ObexHeaderId::ConnectionId;
|
|
retBuf[1] = (connectionId & 0xFF000000) >> 24;
|
|
retBuf[2] = (connectionId & 0x00FF0000) >> 16;
|
|
retBuf[3] = (connectionId & 0x0000FF00) >> 8;
|
|
retBuf[4] = connectionId & 0x000000FF;
|
|
|
|
return 5;
|
|
}
|
|
|
|
void
|
|
SetObexPacketInfo(uint8_t* retBuf, uint8_t opcode, int packetLength)
|
|
{
|
|
retBuf[0] = opcode;
|
|
retBuf[1] = (packetLength & 0xFF00) >> 8;
|
|
retBuf[2] = packetLength & 0x00FF;
|
|
}
|
|
|
|
void
|
|
ParseHeaders(uint8_t* buf, int totalLength, ObexHeaderSet* retHandlerSet)
|
|
{
|
|
uint8_t* ptr = buf;
|
|
|
|
while (ptr - buf < totalLength) {
|
|
ObexHeaderId headerId = (ObexHeaderId)*ptr++;
|
|
int headerLength = 0;
|
|
uint8_t highByte, lowByte;
|
|
|
|
// Defined in 2.1 OBEX Headers, IrOBEX 1.2
|
|
switch (headerId >> 6)
|
|
{
|
|
case 0x00:
|
|
// NULL terminated Unicode text, length prefixed with 2 byte unsigned integer.
|
|
case 0x01:
|
|
// byte sequence, length prefixed with 2 byte unsigned integer.
|
|
highByte = *ptr++;
|
|
lowByte = *ptr++;
|
|
headerLength = ((int)highByte << 8) | lowByte;
|
|
break;
|
|
|
|
case 0x02:
|
|
// 1 byte quantity
|
|
headerLength = 1;
|
|
break;
|
|
|
|
case 0x03:
|
|
// 4 byte quantity
|
|
headerLength = 4;
|
|
break;
|
|
}
|
|
|
|
// Content
|
|
uint8_t* headerContent = new uint8_t[headerLength];
|
|
memcpy(headerContent, ptr, headerLength);
|
|
retHandlerSet->AddHeader(new ObexHeader(headerId, headerLength, headerContent));
|
|
|
|
ptr += headerLength;
|
|
}
|
|
}
|
|
|
|
END_BLUETOOTH_NAMESPACE
|