Junichi Katsu / Mbed 2 deprecated BLE_RCBController2

Dependencies:   BLE_API mbed

Fork of BLE_RCBController by Junichi Katsu

nRF51822/nordic/ble/ble_advdata_parser.cpp

Committer:
jksoft
Date:
2014-08-20
Revision:
1:48f6e08a3ac2
Parent:
BLE_API_Native_IRC/hw/nRF51822n/nordic/ble/ble_advdata_parser.cpp@ 0:8c643bfe55b7

File content as of revision 1:48f6e08a3ac2:

#include "ble_advdata_parser.h"

uint32_t ble_advdata_parser_field_find(uint8_t type, uint8_t * p_advdata, uint8_t * len, uint8_t ** pp_field_data)
{
    uint32_t index = 0;
    
    while (index < *len)
    {
        uint8_t field_length = p_advdata[index];
        uint8_t field_type = p_advdata[index+1];
        
        if (field_type == type)
        {
            *pp_field_data = &p_advdata[index+2];
            *len = field_length-1;
            return NRF_SUCCESS;
        }
        index += field_length+1;
    }
    return NRF_ERROR_NOT_FOUND;
}