User | Revision | Line number | New contents of line |
jinu |
0:6ba9b94b8997
|
1
|
/* Copyright (c) Nordic Semiconductor ASA
|
jinu |
0:6ba9b94b8997
|
2
|
* All rights reserved.
|
jinu |
0:6ba9b94b8997
|
3
|
*
|
jinu |
0:6ba9b94b8997
|
4
|
* Redistribution and use in source and binary forms, with or without modification,
|
jinu |
0:6ba9b94b8997
|
5
|
* are permitted provided that the following conditions are met:
|
jinu |
0:6ba9b94b8997
|
6
|
*
|
jinu |
0:6ba9b94b8997
|
7
|
* 1. Redistributions of source code must retain the above copyright notice, this
|
jinu |
0:6ba9b94b8997
|
8
|
* list of conditions and the following disclaimer.
|
jinu |
0:6ba9b94b8997
|
9
|
*
|
jinu |
0:6ba9b94b8997
|
10
|
* 2. Redistributions in binary form must reproduce the above copyright notice, this
|
jinu |
0:6ba9b94b8997
|
11
|
* list of conditions and the following disclaimer in the documentation and/or
|
jinu |
0:6ba9b94b8997
|
12
|
* other materials provided with the distribution.
|
jinu |
0:6ba9b94b8997
|
13
|
*
|
jinu |
0:6ba9b94b8997
|
14
|
* 3. Neither the name of Nordic Semiconductor ASA nor the names of other
|
jinu |
0:6ba9b94b8997
|
15
|
* contributors to this software may be used to endorse or promote products
|
jinu |
0:6ba9b94b8997
|
16
|
* derived from this software without specific prior written permission.
|
jinu |
0:6ba9b94b8997
|
17
|
*
|
jinu |
0:6ba9b94b8997
|
18
|
* 4. This software must only be used in a processor manufactured by Nordic
|
jinu |
0:6ba9b94b8997
|
19
|
* Semiconductor ASA, or in a processor manufactured by a third party that
|
jinu |
0:6ba9b94b8997
|
20
|
* is used in combination with a processor manufactured by Nordic Semiconductor.
|
jinu |
0:6ba9b94b8997
|
21
|
*
|
jinu |
0:6ba9b94b8997
|
22
|
*
|
jinu |
0:6ba9b94b8997
|
23
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
jinu |
0:6ba9b94b8997
|
24
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
jinu |
0:6ba9b94b8997
|
25
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
jinu |
0:6ba9b94b8997
|
26
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
|
jinu |
0:6ba9b94b8997
|
27
|
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
jinu |
0:6ba9b94b8997
|
28
|
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
jinu |
0:6ba9b94b8997
|
29
|
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
jinu |
0:6ba9b94b8997
|
30
|
* ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
jinu |
0:6ba9b94b8997
|
31
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
jinu |
0:6ba9b94b8997
|
32
|
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
jinu |
0:6ba9b94b8997
|
33
|
*/
|
jinu |
0:6ba9b94b8997
|
34
|
|
jinu |
0:6ba9b94b8997
|
35
|
#include "ble_gatts_evt_app.h"
|
jinu |
0:6ba9b94b8997
|
36
|
#include <string.h>
|
jinu |
0:6ba9b94b8997
|
37
|
#include "ble_serialization.h"
|
jinu |
0:6ba9b94b8997
|
38
|
#include "ble_gatts_struct_serialization.h"
|
jinu |
0:6ba9b94b8997
|
39
|
#include "app_util.h"
|
jinu |
0:6ba9b94b8997
|
40
|
|
jinu |
0:6ba9b94b8997
|
41
|
|
jinu |
0:6ba9b94b8997
|
42
|
uint32_t ble_gatts_evt_write_dec(uint8_t const * const p_buf,
|
jinu |
0:6ba9b94b8997
|
43
|
uint32_t packet_len,
|
jinu |
0:6ba9b94b8997
|
44
|
ble_evt_t * const p_event,
|
jinu |
0:6ba9b94b8997
|
45
|
uint32_t * const p_event_len)
|
jinu |
0:6ba9b94b8997
|
46
|
{
|
jinu |
0:6ba9b94b8997
|
47
|
SER_ASSERT_NOT_NULL(p_buf);
|
jinu |
0:6ba9b94b8997
|
48
|
SER_ASSERT_NOT_NULL(p_event_len);
|
jinu |
0:6ba9b94b8997
|
49
|
|
jinu |
0:6ba9b94b8997
|
50
|
uint32_t err_code = NRF_SUCCESS;
|
jinu |
0:6ba9b94b8997
|
51
|
uint32_t index = 0;
|
jinu |
0:6ba9b94b8997
|
52
|
|
jinu |
0:6ba9b94b8997
|
53
|
uint32_t in_event_len = *p_event_len;
|
jinu |
0:6ba9b94b8997
|
54
|
|
jinu |
0:6ba9b94b8997
|
55
|
*p_event_len = offsetof(ble_evt_t, evt.gatts_evt.params) - sizeof (ble_evt_hdr_t);
|
jinu |
0:6ba9b94b8997
|
56
|
|
jinu |
0:6ba9b94b8997
|
57
|
uint16_t conn_handle;
|
jinu |
0:6ba9b94b8997
|
58
|
err_code = uint16_t_dec(p_buf, packet_len, &index, &conn_handle);
|
jinu |
0:6ba9b94b8997
|
59
|
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
|
jinu |
0:6ba9b94b8997
|
60
|
|
jinu |
0:6ba9b94b8997
|
61
|
void * p_void_write = NULL;
|
jinu |
0:6ba9b94b8997
|
62
|
|
jinu |
0:6ba9b94b8997
|
63
|
if (p_event != NULL)
|
jinu |
0:6ba9b94b8997
|
64
|
{
|
jinu |
0:6ba9b94b8997
|
65
|
SER_ASSERT_LENGTH_LEQ(*p_event_len, in_event_len);
|
jinu |
0:6ba9b94b8997
|
66
|
p_event->evt.gatts_evt.conn_handle = conn_handle;
|
jinu |
0:6ba9b94b8997
|
67
|
|
jinu |
0:6ba9b94b8997
|
68
|
p_void_write = &(p_event->evt.gatts_evt.params.write);
|
jinu |
0:6ba9b94b8997
|
69
|
}
|
jinu |
0:6ba9b94b8997
|
70
|
|
jinu |
0:6ba9b94b8997
|
71
|
uint32_t tmp_struct_len = in_event_len - *p_event_len;
|
jinu |
0:6ba9b94b8997
|
72
|
err_code = ble_gatts_evt_write_t_dec(p_buf,
|
jinu |
0:6ba9b94b8997
|
73
|
packet_len,
|
jinu |
0:6ba9b94b8997
|
74
|
&index,
|
jinu |
0:6ba9b94b8997
|
75
|
&tmp_struct_len,
|
jinu |
0:6ba9b94b8997
|
76
|
p_void_write);
|
jinu |
0:6ba9b94b8997
|
77
|
SER_ASSERT(err_code == NRF_SUCCESS, err_code);
|
jinu |
0:6ba9b94b8997
|
78
|
|
jinu |
0:6ba9b94b8997
|
79
|
*p_event_len += tmp_struct_len;
|
jinu |
0:6ba9b94b8997
|
80
|
|
jinu |
0:6ba9b94b8997
|
81
|
SER_ASSERT_LENGTH_EQ(index, packet_len);
|
jinu |
0:6ba9b94b8997
|
82
|
|
jinu |
0:6ba9b94b8997
|
83
|
return err_code;
|
jinu |
0:6ba9b94b8997
|
84
|
}
|
jinu |
0:6ba9b94b8997
|
85
|
|