sdp_set.c revision 1.1.2.2
1 1.1.2.2 jym /* $NetBSD: sdp_set.c,v 1.1.2.2 2009/05/13 19:18:20 jym Exp $ */ 2 1.1.2.2 jym 3 1.1.2.2 jym /*- 4 1.1.2.2 jym * Copyright (c) 2009 The NetBSD Foundation, Inc. 5 1.1.2.2 jym * All rights reserved. 6 1.1.2.2 jym * 7 1.1.2.2 jym * This code is derived from software contributed to The NetBSD Foundation 8 1.1.2.2 jym * by Iain Hibbert. 9 1.1.2.2 jym * 10 1.1.2.2 jym * Redistribution and use in source and binary forms, with or without 11 1.1.2.2 jym * modification, are permitted provided that the following conditions 12 1.1.2.2 jym * are met: 13 1.1.2.2 jym * 1. Redistributions of source code must retain the above copyright 14 1.1.2.2 jym * notice, this list of conditions and the following disclaimer. 15 1.1.2.2 jym * 2. Redistributions in binary form must reproduce the above copyright 16 1.1.2.2 jym * notice, this list of conditions and the following disclaimer in the 17 1.1.2.2 jym * documentation and/or other materials provided with the distribution. 18 1.1.2.2 jym * 19 1.1.2.2 jym * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.1.2.2 jym * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.1.2.2 jym * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.1.2.2 jym * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.1.2.2 jym * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.1.2.2 jym * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.1.2.2 jym * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.1.2.2 jym * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.1.2.2 jym * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.1.2.2 jym * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.1.2.2 jym * POSSIBILITY OF SUCH DAMAGE. 30 1.1.2.2 jym */ 31 1.1.2.2 jym 32 1.1.2.2 jym #include <sys/cdefs.h> 33 1.1.2.2 jym __RCSID("$NetBSD: sdp_set.c,v 1.1.2.2 2009/05/13 19:18:20 jym Exp $"); 34 1.1.2.2 jym 35 1.1.2.2 jym #include <bluetooth.h> 36 1.1.2.2 jym #include <limits.h> 37 1.1.2.2 jym #include <sdp.h> 38 1.1.2.2 jym 39 1.1.2.2 jym /****************************************************************************** 40 1.1.2.2 jym * sdp_set_xxxx(data, value) 41 1.1.2.2 jym * 42 1.1.2.2 jym * update a value, will fail if data element is not of the correct type 43 1.1.2.2 jym */ 44 1.1.2.2 jym 45 1.1.2.2 jym bool 46 1.1.2.2 jym sdp_set_bool(const sdp_data_t *data, bool value) 47 1.1.2.2 jym { 48 1.1.2.2 jym uint8_t *p = data->next; 49 1.1.2.2 jym 50 1.1.2.2 jym if (p + 2 > data->end 51 1.1.2.2 jym || *p != SDP_DATA_BOOL) 52 1.1.2.2 jym return false; 53 1.1.2.2 jym 54 1.1.2.2 jym *p = (value ? 0x01 : 0x00); 55 1.1.2.2 jym return true; 56 1.1.2.2 jym } 57 1.1.2.2 jym 58 1.1.2.2 jym bool 59 1.1.2.2 jym sdp_set_uint(const sdp_data_t *data, uintmax_t value) 60 1.1.2.2 jym { 61 1.1.2.2 jym uint8_t *p = data->next; 62 1.1.2.2 jym 63 1.1.2.2 jym if (p + 1 > data->end) 64 1.1.2.2 jym return false; 65 1.1.2.2 jym 66 1.1.2.2 jym switch (*p++) { 67 1.1.2.2 jym case SDP_DATA_UINT8: 68 1.1.2.2 jym if (p + 1 > data->end 69 1.1.2.2 jym || value > UINT8_MAX) 70 1.1.2.2 jym return false; 71 1.1.2.2 jym 72 1.1.2.2 jym *p = (uint8_t)value; 73 1.1.2.2 jym break; 74 1.1.2.2 jym 75 1.1.2.2 jym case SDP_DATA_UINT16: 76 1.1.2.2 jym if (p + 2 > data->end 77 1.1.2.2 jym || value > UINT16_MAX) 78 1.1.2.2 jym return false; 79 1.1.2.2 jym 80 1.1.2.2 jym be16enc(p, (uint16_t)value); 81 1.1.2.2 jym break; 82 1.1.2.2 jym 83 1.1.2.2 jym case SDP_DATA_UINT32: 84 1.1.2.2 jym if (p + 4 > data->end 85 1.1.2.2 jym || value > UINT32_MAX) 86 1.1.2.2 jym return false; 87 1.1.2.2 jym 88 1.1.2.2 jym be32enc(p, (uint32_t)value); 89 1.1.2.2 jym break; 90 1.1.2.2 jym 91 1.1.2.2 jym case SDP_DATA_UINT64: 92 1.1.2.2 jym if (p + 8 > data->end 93 1.1.2.2 jym || value > UINT64_MAX) 94 1.1.2.2 jym return false; 95 1.1.2.2 jym 96 1.1.2.2 jym be64enc(p, (uint64_t)value); 97 1.1.2.2 jym break; 98 1.1.2.2 jym 99 1.1.2.2 jym case SDP_DATA_UINT128: 100 1.1.2.2 jym if (p + 16 > data->end) 101 1.1.2.2 jym return false; 102 1.1.2.2 jym 103 1.1.2.2 jym be64enc(p + 0, (uint64_t)0); 104 1.1.2.2 jym be64enc(p + 8, (uint64_t)value); 105 1.1.2.2 jym break; 106 1.1.2.2 jym 107 1.1.2.2 jym default: 108 1.1.2.2 jym return false; 109 1.1.2.2 jym } 110 1.1.2.2 jym 111 1.1.2.2 jym return true; 112 1.1.2.2 jym } 113 1.1.2.2 jym 114 1.1.2.2 jym bool 115 1.1.2.2 jym sdp_set_int(const sdp_data_t *data, intmax_t value) 116 1.1.2.2 jym { 117 1.1.2.2 jym uint8_t *p = data->next; 118 1.1.2.2 jym 119 1.1.2.2 jym if (p + 1 > data->end) 120 1.1.2.2 jym return false; 121 1.1.2.2 jym 122 1.1.2.2 jym switch (*p++) { 123 1.1.2.2 jym case SDP_DATA_INT8: 124 1.1.2.2 jym if (p + 1 > data->end 125 1.1.2.2 jym || value > INT8_MAX 126 1.1.2.2 jym || value < INT8_MIN) 127 1.1.2.2 jym return false; 128 1.1.2.2 jym 129 1.1.2.2 jym *p = (uint8_t)value; 130 1.1.2.2 jym break; 131 1.1.2.2 jym 132 1.1.2.2 jym case SDP_DATA_INT16: 133 1.1.2.2 jym if (p + 2 > data->end 134 1.1.2.2 jym || value > INT16_MAX 135 1.1.2.2 jym || value < INT16_MIN) 136 1.1.2.2 jym return false; 137 1.1.2.2 jym 138 1.1.2.2 jym be16enc(p, (uint16_t)value); 139 1.1.2.2 jym break; 140 1.1.2.2 jym 141 1.1.2.2 jym case SDP_DATA_INT32: 142 1.1.2.2 jym if (p + 4 > data->end 143 1.1.2.2 jym || value > INT32_MAX 144 1.1.2.2 jym || value < INT32_MIN) 145 1.1.2.2 jym return false; 146 1.1.2.2 jym 147 1.1.2.2 jym be32enc(p, (uint32_t)value); 148 1.1.2.2 jym break; 149 1.1.2.2 jym 150 1.1.2.2 jym case SDP_DATA_INT64: 151 1.1.2.2 jym if (p + 8 > data->end 152 1.1.2.2 jym || value > INT64_MAX 153 1.1.2.2 jym || value < INT64_MIN) 154 1.1.2.2 jym return false; 155 1.1.2.2 jym 156 1.1.2.2 jym be64enc(p, (uint64_t)value); 157 1.1.2.2 jym break; 158 1.1.2.2 jym 159 1.1.2.2 jym case SDP_DATA_INT128: 160 1.1.2.2 jym if (p + 16 > data->end) 161 1.1.2.2 jym return false; 162 1.1.2.2 jym 163 1.1.2.2 jym be64enc(p + 0, (uint64_t)0); 164 1.1.2.2 jym be64enc(p + 8, (uint64_t)value); 165 1.1.2.2 jym break; 166 1.1.2.2 jym 167 1.1.2.2 jym default: 168 1.1.2.2 jym return false; 169 1.1.2.2 jym } 170 1.1.2.2 jym 171 1.1.2.2 jym return true; 172 1.1.2.2 jym } 173 1.1.2.2 jym 174 1.1.2.2 jym static bool 175 1.1.2.2 jym _sdp_set_ext(uint8_t type, const sdp_data_t *data, ssize_t len) 176 1.1.2.2 jym { 177 1.1.2.2 jym uint8_t *p = data->next; 178 1.1.2.2 jym 179 1.1.2.2 jym if (p + 1 > data->end 180 1.1.2.2 jym || SDP_DATA_TYPE(*p) != type) 181 1.1.2.2 jym return false; 182 1.1.2.2 jym 183 1.1.2.2 jym switch (SDP_DATA_SIZE(*p++)) { 184 1.1.2.2 jym case SDP_DATA_EXT8: 185 1.1.2.2 jym if (len == -1) { 186 1.1.2.2 jym if (p + 1 > data->end) 187 1.1.2.2 jym return false; 188 1.1.2.2 jym 189 1.1.2.2 jym len = data->end - p - 1; 190 1.1.2.2 jym } else if (p + 1 + len > data->end) 191 1.1.2.2 jym return false; 192 1.1.2.2 jym 193 1.1.2.2 jym if (len > UINT8_MAX) 194 1.1.2.2 jym return false; 195 1.1.2.2 jym 196 1.1.2.2 jym *p = (uint8_t)len; 197 1.1.2.2 jym break; 198 1.1.2.2 jym 199 1.1.2.2 jym case SDP_DATA_EXT16: 200 1.1.2.2 jym if (len == -1) { 201 1.1.2.2 jym if (p + 2 > data->end) 202 1.1.2.2 jym return false; 203 1.1.2.2 jym 204 1.1.2.2 jym len = data->end - p - 2; 205 1.1.2.2 jym } else if (p + 2 + len > data->end) 206 1.1.2.2 jym return false; 207 1.1.2.2 jym 208 1.1.2.2 jym if (len > UINT16_MAX) 209 1.1.2.2 jym return false; 210 1.1.2.2 jym 211 1.1.2.2 jym be16enc(p, (uint16_t)len); 212 1.1.2.2 jym break; 213 1.1.2.2 jym 214 1.1.2.2 jym case SDP_DATA_EXT32: 215 1.1.2.2 jym if (len == -1) { 216 1.1.2.2 jym if (p + 4 > data->end) 217 1.1.2.2 jym return false; 218 1.1.2.2 jym 219 1.1.2.2 jym len = data->end - p - 4; 220 1.1.2.2 jym } else if (p + 4 + len > data->end) 221 1.1.2.2 jym return false; 222 1.1.2.2 jym 223 1.1.2.2 jym if (len > UINT32_MAX) 224 1.1.2.2 jym return false; 225 1.1.2.2 jym 226 1.1.2.2 jym be32enc(p, (uint32_t)len); 227 1.1.2.2 jym break; 228 1.1.2.2 jym 229 1.1.2.2 jym default: 230 1.1.2.2 jym return false; 231 1.1.2.2 jym } 232 1.1.2.2 jym 233 1.1.2.2 jym return true; 234 1.1.2.2 jym } 235 1.1.2.2 jym 236 1.1.2.2 jym bool 237 1.1.2.2 jym sdp_set_seq(const sdp_data_t *data, ssize_t len) 238 1.1.2.2 jym { 239 1.1.2.2 jym 240 1.1.2.2 jym return _sdp_set_ext(SDP_DATA_SEQ, data, len); 241 1.1.2.2 jym } 242 1.1.2.2 jym 243 1.1.2.2 jym bool 244 1.1.2.2 jym sdp_set_alt(const sdp_data_t *data, ssize_t len) 245 1.1.2.2 jym { 246 1.1.2.2 jym 247 1.1.2.2 jym return _sdp_set_ext(SDP_DATA_ALT, data, len); 248 1.1.2.2 jym } 249
Indexes created Mon Sep 29 21:09:56 GMT 2025