39#include <stdarg.h> 40#include <string.h> 41#include <syslog.h> 42#include <unistd.h> 43#include "hcsecd.h" 44 45 int yyparse (void); 46 int yylex (void); 47 48static void free_key (link_key_p key); 49static int hexa2int4(char *a); 50static int hexa2int8(char *a); 51 52extern int yylineno; 53static LIST_HEAD(, link_key) link_keys; 54 char *config_file = "/etc/bluetooth/hcsecd.conf"; 55 56static link_key_p key = NULL; 57%} 58 59%union { 60 char *string; 61} 62 63%token <string> T_BDADDRSTRING T_HEXSTRING T_STRING 64%token T_DEVICE T_BDADDR T_NAME T_KEY T_PIN T_NOKEY T_NOPIN T_JUNK 65 66%% 67 68config: line 69 | config line 70 ; 71 72line: T_DEVICE 73 { 74 key = (link_key_p) malloc(sizeof(*key)); 75 if (key == NULL) { 76 syslog(LOG_ERR, "Could not allocate new " \ 77 "config entry"); 78 exit(1); 79 } 80 81 memset(key, 0, sizeof(*key)); 82 } 83 '{' options '}' 84 { 85 if (get_key(&key->bdaddr, 1) != NULL) { 86 syslog(LOG_ERR, "Ignoring duplicated entry " \ 87 "for bdaddr %s", 88 bt_ntoa(&key->bdaddr, NULL)); 89 free_key(key); 90 } else 91 LIST_INSERT_HEAD(&link_keys, key, next); 92 93 key = NULL; 94 } 95 ; 96 97options: option ';' 98 | options option ';' 99 ; 100 101option: bdaddr 102 | name 103 | key 104 | pin 105 ; 106 107bdaddr: T_BDADDR T_BDADDRSTRING 108 { 109 if (!bt_aton($2, &key->bdaddr)) { 110 syslog(LOG_ERR, "Cound not parse BD_ADDR " \ 111 "'%s'", $2); 112 exit(1); 113 } 114 } 115 ; 116 117name: T_NAME T_STRING 118 { 119 if (key->name != NULL) 120 free(key->name); 121 122 key->name = strdup($2); 123 if (key->name == NULL) { 124 syslog(LOG_ERR, "Could not allocate new " \ 125 "device name"); 126 exit(1); 127 } 128 } 129 ; 130 131key: T_KEY T_HEXSTRING 132 { 133 int i, len; 134 135 if (key->key != NULL) 136 free(key->key); 137 138 key->key = (uint8_t *) malloc(NG_HCI_KEY_SIZE); 139 if (key->key == NULL) { 140 syslog(LOG_ERR, "Could not allocate new " \ 141 "link key"); 142 exit(1); 143 } 144 145 memset(key->key, 0, NG_HCI_KEY_SIZE); 146 147 len = strlen($2) / 2; 148 if (len > NG_HCI_KEY_SIZE) 149 len = NG_HCI_KEY_SIZE; 150 151 for (i = 0; i < len; i ++) 152 key->key[i] = hexa2int8((char *)($2) + 2*i); 153 } 154 | T_KEY T_NOKEY 155 { 156 if (key->key != NULL) 157 free(key->key); 158 159 key->key = NULL; 160 } 161 ; 162 163pin: T_PIN T_STRING 164 { 165 if (key->pin != NULL) 166 free(key->pin); 167 168 key->pin = strdup($2); 169 if (key->pin == NULL) { 170 syslog(LOG_ERR, "Could not allocate new " \ 171 "PIN code"); 172 exit(1); 173 } 174 } 175 | T_PIN T_NOPIN 176 { 177 if (key->pin != NULL) 178 free(key->pin); 179 180 key->pin = NULL; 181 } 182 ; 183 184%% 185 186/* Display parser error message */ 187void 188yyerror(char const *message) 189{ 190 syslog(LOG_ERR, "%s in line %d", message, yylineno); 191} 192 193/* Re-read config file */ 194void 195read_config_file(void) 196{ 197 extern FILE *yyin; 198 199 if (config_file == NULL) { 200 syslog(LOG_ERR, "Unknown config file name!"); 201 exit(1); 202 } 203 204 if ((yyin = fopen(config_file, "r")) == NULL) { 205 syslog(LOG_ERR, "Could not open config file '%s'. %s (%d)", 206 config_file, strerror(errno), errno); 207 exit(1); 208 } 209 210 clean_config(); 211 if (yyparse() < 0) { 212 syslog(LOG_ERR, "Could not parse config file '%s'",config_file); 213 exit(1); 214 } 215 216 fclose(yyin); 217 yyin = NULL; 218 219#if __config_debug__ 220 dump_config(); 221#endif 222} 223 224/* Clean config */ 225void 226clean_config(void) 227{ 228 link_key_p key = NULL; 229 230 while ((key = LIST_FIRST(&link_keys)) != NULL) { 231 LIST_REMOVE(key, next); 232 free_key(key); 233 } 234} 235 236/* Find link key entry in the list. Return exact or default match */ 237link_key_p 238get_key(bdaddr_p bdaddr, int exact_match) 239{ 240 link_key_p key = NULL, defkey = NULL; 241 242 LIST_FOREACH(key, &link_keys, next) { 243 if (memcmp(bdaddr, &key->bdaddr, sizeof(key->bdaddr)) == 0) 244 break; 245 246 if (!exact_match) 247 if (memcmp(NG_HCI_BDADDR_ANY, &key->bdaddr, 248 sizeof(key->bdaddr)) == 0) 249 defkey = key; 250 } 251 252 return ((key != NULL)? key : defkey); 253} 254 255#if __config_debug__ 256/* Dump config */ 257void 258dump_config(void) 259{ 260 link_key_p key = NULL; 261 char buffer[64]; 262 263 LIST_FOREACH(key, &link_keys, next) { 264 if (key->key != NULL) 265 snprintf(buffer, sizeof(buffer), 266"0x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x", 267 key->key[0], key->key[1], key->key[2], 268 key->key[3], key->key[4], key->key[5], 269 key->key[6], key->key[7], key->key[8], 270 key->key[9], key->key[10], key->key[11], 271 key->key[12], key->key[13], key->key[14], 272 key->key[15]); 273 274 syslog(LOG_DEBUG, 275"device %s " \ 276"bdaddr %s " \ 277"pin %s " \ 278"key %s", 279 (key->name != NULL)? key->name : "noname", 280 bt_ntoa(&key->bdaddr, NULL), 281 (key->pin != NULL)? key->pin : "nopin", 282 (key->key != NULL)? buffer : "nokey"); 283 } 284} 285#endif 286 287/* Read keys file */ 288int 289read_keys_file(void) 290{ 291 FILE *f = NULL; 292 link_key_t *key = NULL; 293 char buf[HCSECD_BUFFER_SIZE], *p = NULL, *cp = NULL; 294 bdaddr_t bdaddr; 295 int i, len; 296 297 if ((f = fopen(HCSECD_KEYSFILE, "r")) == NULL) { 298 if (errno == ENOENT) 299 return (0); 300 301 syslog(LOG_ERR, "Could not open keys file %s. %s (%d)\n", 302 HCSECD_KEYSFILE, strerror(errno), errno); 303 304 return (-1); 305 } 306 307 while ((p = fgets(buf, sizeof(buf), f)) != NULL) { 308 if (*p == '#') 309 continue; 310 if ((cp = strpbrk(p, " ")) == NULL) 311 continue; 312 313 *cp++ = '\0'; 314 315 if (!bt_aton(p, &bdaddr)) 316 continue; 317 318 if ((key = get_key(&bdaddr, 1)) == NULL) 319 continue; 320 321 if (key->key == NULL) { 322 key->key = (uint8_t *) malloc(NG_HCI_KEY_SIZE); 323 if (key->key == NULL) { 324 syslog(LOG_ERR, "Could not allocate link key"); 325 exit(1); 326 } 327 } 328 329 memset(key->key, 0, NG_HCI_KEY_SIZE); 330 331 len = strlen(cp) / 2; 332 if (len > NG_HCI_KEY_SIZE) 333 len = NG_HCI_KEY_SIZE; 334 335 for (i = 0; i < len; i ++) 336 key->key[i] = hexa2int8(cp + 2*i); 337 338 syslog(LOG_DEBUG, "Restored link key for the entry, " \ 339 "remote bdaddr %s, name '%s'", 340 bt_ntoa(&key->bdaddr, NULL), 341 (key->name != NULL)? key->name : "No name"); 342 } 343 344 fclose(f); 345 346 return (0); 347} 348 349/* Dump keys file */ 350int 351dump_keys_file(void) 352{ 353 link_key_p key = NULL; 354 char tmp[PATH_MAX], buf[HCSECD_BUFFER_SIZE]; 355 int f; 356 357 snprintf(tmp, sizeof(tmp), "%s.tmp", HCSECD_KEYSFILE); 358 if ((f = open(tmp, O_RDWR|O_CREAT|O_TRUNC|O_EXCL, 0600)) < 0) { 359 syslog(LOG_ERR, "Could not create temp keys file %s. %s (%d)\n", 360 tmp, strerror(errno), errno); 361 return (-1); 362 } 363 364 LIST_FOREACH(key, &link_keys, next) { 365 if (key->key == NULL) 366 continue; 367 368 snprintf(buf, sizeof(buf), 369"%s %02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", 370 bt_ntoa(&key->bdaddr, NULL), 371 key->key[0], key->key[1], key->key[2], key->key[3], 372 key->key[4], key->key[5], key->key[6], key->key[7], 373 key->key[8], key->key[9], key->key[10], key->key[11], 374 key->key[12], key->key[13], key->key[14], key->key[15]); 375 376 if (write(f, buf, strlen(buf)) < 0) { 377 syslog(LOG_ERR, "Could not write temp keys file. " \ 378 "%s (%d)\n", strerror(errno), errno); 379 break; 380 } 381 } 382 383 close(f); 384 385 if (rename(tmp, HCSECD_KEYSFILE) < 0) { 386 syslog(LOG_ERR, "Could not rename(%s, %s). %s (%d)\n", 387 tmp, HCSECD_KEYSFILE, strerror(errno), errno); 388 unlink(tmp); 389 return (-1); 390 } 391 392 return (0); 393} 394 395/* Free key entry */ 396static void 397free_key(link_key_p key) 398{ 399 if (key->name != NULL) 400 free(key->name); 401 if (key->key != NULL) 402 free(key->key); 403 if (key->pin != NULL) 404 free(key->pin); 405 406 memset(key, 0, sizeof(*key)); 407 free(key); 408} 409 410/* Convert hex ASCII to int4 */ 411static int 412hexa2int4(char *a) 413{ 414 if ('0' <= *a && *a <= '9') 415 return (*a - '0'); 416 417 if ('A' <= *a && *a <= 'F') 418 return (*a - 'A' + 0xa); 419 420 if ('a' <= *a && *a <= 'f') 421 return (*a - 'a' + 0xa); 422 423 syslog(LOG_ERR, "Invalid hex character: '%c' (%#x)", *a, *a); 424 exit(1); 425} 426 427/* Convert hex ASCII to int8 */ 428static int 429hexa2int8(char *a) 430{ 431 return ((hexa2int4(a) << 4) | hexa2int4(a + 1)); 432} 433
| 40#include <stdarg.h> 41#include <string.h> 42#include <syslog.h> 43#include <unistd.h> 44#include "hcsecd.h" 45 46 int yyparse (void); 47 int yylex (void); 48 49static void free_key (link_key_p key); 50static int hexa2int4(char *a); 51static int hexa2int8(char *a); 52 53extern int yylineno; 54static LIST_HEAD(, link_key) link_keys; 55 char *config_file = "/etc/bluetooth/hcsecd.conf"; 56 57static link_key_p key = NULL; 58%} 59 60%union { 61 char *string; 62} 63 64%token <string> T_BDADDRSTRING T_HEXSTRING T_STRING 65%token T_DEVICE T_BDADDR T_NAME T_KEY T_PIN T_NOKEY T_NOPIN T_JUNK 66 67%% 68 69config: line 70 | config line 71 ; 72 73line: T_DEVICE 74 { 75 key = (link_key_p) malloc(sizeof(*key)); 76 if (key == NULL) { 77 syslog(LOG_ERR, "Could not allocate new " \ 78 "config entry"); 79 exit(1); 80 } 81 82 memset(key, 0, sizeof(*key)); 83 } 84 '{' options '}' 85 { 86 if (get_key(&key->bdaddr, 1) != NULL) { 87 syslog(LOG_ERR, "Ignoring duplicated entry " \ 88 "for bdaddr %s", 89 bt_ntoa(&key->bdaddr, NULL)); 90 free_key(key); 91 } else 92 LIST_INSERT_HEAD(&link_keys, key, next); 93 94 key = NULL; 95 } 96 ; 97 98options: option ';' 99 | options option ';' 100 ; 101 102option: bdaddr 103 | name 104 | key 105 | pin 106 ; 107 108bdaddr: T_BDADDR T_BDADDRSTRING 109 { 110 if (!bt_aton($2, &key->bdaddr)) { 111 syslog(LOG_ERR, "Cound not parse BD_ADDR " \ 112 "'%s'", $2); 113 exit(1); 114 } 115 } 116 ; 117 118name: T_NAME T_STRING 119 { 120 if (key->name != NULL) 121 free(key->name); 122 123 key->name = strdup($2); 124 if (key->name == NULL) { 125 syslog(LOG_ERR, "Could not allocate new " \ 126 "device name"); 127 exit(1); 128 } 129 } 130 ; 131 132key: T_KEY T_HEXSTRING 133 { 134 int i, len; 135 136 if (key->key != NULL) 137 free(key->key); 138 139 key->key = (uint8_t *) malloc(NG_HCI_KEY_SIZE); 140 if (key->key == NULL) { 141 syslog(LOG_ERR, "Could not allocate new " \ 142 "link key"); 143 exit(1); 144 } 145 146 memset(key->key, 0, NG_HCI_KEY_SIZE); 147 148 len = strlen($2) / 2; 149 if (len > NG_HCI_KEY_SIZE) 150 len = NG_HCI_KEY_SIZE; 151 152 for (i = 0; i < len; i ++) 153 key->key[i] = hexa2int8((char *)($2) + 2*i); 154 } 155 | T_KEY T_NOKEY 156 { 157 if (key->key != NULL) 158 free(key->key); 159 160 key->key = NULL; 161 } 162 ; 163 164pin: T_PIN T_STRING 165 { 166 if (key->pin != NULL) 167 free(key->pin); 168 169 key->pin = strdup($2); 170 if (key->pin == NULL) { 171 syslog(LOG_ERR, "Could not allocate new " \ 172 "PIN code"); 173 exit(1); 174 } 175 } 176 | T_PIN T_NOPIN 177 { 178 if (key->pin != NULL) 179 free(key->pin); 180 181 key->pin = NULL; 182 } 183 ; 184 185%% 186 187/* Display parser error message */ 188void 189yyerror(char const *message) 190{ 191 syslog(LOG_ERR, "%s in line %d", message, yylineno); 192} 193 194/* Re-read config file */ 195void 196read_config_file(void) 197{ 198 extern FILE *yyin; 199 200 if (config_file == NULL) { 201 syslog(LOG_ERR, "Unknown config file name!"); 202 exit(1); 203 } 204 205 if ((yyin = fopen(config_file, "r")) == NULL) { 206 syslog(LOG_ERR, "Could not open config file '%s'. %s (%d)", 207 config_file, strerror(errno), errno); 208 exit(1); 209 } 210 211 clean_config(); 212 if (yyparse() < 0) { 213 syslog(LOG_ERR, "Could not parse config file '%s'",config_file); 214 exit(1); 215 } 216 217 fclose(yyin); 218 yyin = NULL; 219 220#if __config_debug__ 221 dump_config(); 222#endif 223} 224 225/* Clean config */ 226void 227clean_config(void) 228{ 229 link_key_p key = NULL; 230 231 while ((key = LIST_FIRST(&link_keys)) != NULL) { 232 LIST_REMOVE(key, next); 233 free_key(key); 234 } 235} 236 237/* Find link key entry in the list. Return exact or default match */ 238link_key_p 239get_key(bdaddr_p bdaddr, int exact_match) 240{ 241 link_key_p key = NULL, defkey = NULL; 242 243 LIST_FOREACH(key, &link_keys, next) { 244 if (memcmp(bdaddr, &key->bdaddr, sizeof(key->bdaddr)) == 0) 245 break; 246 247 if (!exact_match) 248 if (memcmp(NG_HCI_BDADDR_ANY, &key->bdaddr, 249 sizeof(key->bdaddr)) == 0) 250 defkey = key; 251 } 252 253 return ((key != NULL)? key : defkey); 254} 255 256#if __config_debug__ 257/* Dump config */ 258void 259dump_config(void) 260{ 261 link_key_p key = NULL; 262 char buffer[64]; 263 264 LIST_FOREACH(key, &link_keys, next) { 265 if (key->key != NULL) 266 snprintf(buffer, sizeof(buffer), 267"0x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x", 268 key->key[0], key->key[1], key->key[2], 269 key->key[3], key->key[4], key->key[5], 270 key->key[6], key->key[7], key->key[8], 271 key->key[9], key->key[10], key->key[11], 272 key->key[12], key->key[13], key->key[14], 273 key->key[15]); 274 275 syslog(LOG_DEBUG, 276"device %s " \ 277"bdaddr %s " \ 278"pin %s " \ 279"key %s", 280 (key->name != NULL)? key->name : "noname", 281 bt_ntoa(&key->bdaddr, NULL), 282 (key->pin != NULL)? key->pin : "nopin", 283 (key->key != NULL)? buffer : "nokey"); 284 } 285} 286#endif 287 288/* Read keys file */ 289int 290read_keys_file(void) 291{ 292 FILE *f = NULL; 293 link_key_t *key = NULL; 294 char buf[HCSECD_BUFFER_SIZE], *p = NULL, *cp = NULL; 295 bdaddr_t bdaddr; 296 int i, len; 297 298 if ((f = fopen(HCSECD_KEYSFILE, "r")) == NULL) { 299 if (errno == ENOENT) 300 return (0); 301 302 syslog(LOG_ERR, "Could not open keys file %s. %s (%d)\n", 303 HCSECD_KEYSFILE, strerror(errno), errno); 304 305 return (-1); 306 } 307 308 while ((p = fgets(buf, sizeof(buf), f)) != NULL) { 309 if (*p == '#') 310 continue; 311 if ((cp = strpbrk(p, " ")) == NULL) 312 continue; 313 314 *cp++ = '\0'; 315 316 if (!bt_aton(p, &bdaddr)) 317 continue; 318 319 if ((key = get_key(&bdaddr, 1)) == NULL) 320 continue; 321 322 if (key->key == NULL) { 323 key->key = (uint8_t *) malloc(NG_HCI_KEY_SIZE); 324 if (key->key == NULL) { 325 syslog(LOG_ERR, "Could not allocate link key"); 326 exit(1); 327 } 328 } 329 330 memset(key->key, 0, NG_HCI_KEY_SIZE); 331 332 len = strlen(cp) / 2; 333 if (len > NG_HCI_KEY_SIZE) 334 len = NG_HCI_KEY_SIZE; 335 336 for (i = 0; i < len; i ++) 337 key->key[i] = hexa2int8(cp + 2*i); 338 339 syslog(LOG_DEBUG, "Restored link key for the entry, " \ 340 "remote bdaddr %s, name '%s'", 341 bt_ntoa(&key->bdaddr, NULL), 342 (key->name != NULL)? key->name : "No name"); 343 } 344 345 fclose(f); 346 347 return (0); 348} 349 350/* Dump keys file */ 351int 352dump_keys_file(void) 353{ 354 link_key_p key = NULL; 355 char tmp[PATH_MAX], buf[HCSECD_BUFFER_SIZE]; 356 int f; 357 358 snprintf(tmp, sizeof(tmp), "%s.tmp", HCSECD_KEYSFILE); 359 if ((f = open(tmp, O_RDWR|O_CREAT|O_TRUNC|O_EXCL, 0600)) < 0) { 360 syslog(LOG_ERR, "Could not create temp keys file %s. %s (%d)\n", 361 tmp, strerror(errno), errno); 362 return (-1); 363 } 364 365 LIST_FOREACH(key, &link_keys, next) { 366 if (key->key == NULL) 367 continue; 368 369 snprintf(buf, sizeof(buf), 370"%s %02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n", 371 bt_ntoa(&key->bdaddr, NULL), 372 key->key[0], key->key[1], key->key[2], key->key[3], 373 key->key[4], key->key[5], key->key[6], key->key[7], 374 key->key[8], key->key[9], key->key[10], key->key[11], 375 key->key[12], key->key[13], key->key[14], key->key[15]); 376 377 if (write(f, buf, strlen(buf)) < 0) { 378 syslog(LOG_ERR, "Could not write temp keys file. " \ 379 "%s (%d)\n", strerror(errno), errno); 380 break; 381 } 382 } 383 384 close(f); 385 386 if (rename(tmp, HCSECD_KEYSFILE) < 0) { 387 syslog(LOG_ERR, "Could not rename(%s, %s). %s (%d)\n", 388 tmp, HCSECD_KEYSFILE, strerror(errno), errno); 389 unlink(tmp); 390 return (-1); 391 } 392 393 return (0); 394} 395 396/* Free key entry */ 397static void 398free_key(link_key_p key) 399{ 400 if (key->name != NULL) 401 free(key->name); 402 if (key->key != NULL) 403 free(key->key); 404 if (key->pin != NULL) 405 free(key->pin); 406 407 memset(key, 0, sizeof(*key)); 408 free(key); 409} 410 411/* Convert hex ASCII to int4 */ 412static int 413hexa2int4(char *a) 414{ 415 if ('0' <= *a && *a <= '9') 416 return (*a - '0'); 417 418 if ('A' <= *a && *a <= 'F') 419 return (*a - 'A' + 0xa); 420 421 if ('a' <= *a && *a <= 'f') 422 return (*a - 'a' + 0xa); 423 424 syslog(LOG_ERR, "Invalid hex character: '%c' (%#x)", *a, *a); 425 exit(1); 426} 427 428/* Convert hex ASCII to int8 */ 429static int 430hexa2int8(char *a) 431{ 432 return ((hexa2int4(a) << 4) | hexa2int4(a + 1)); 433} 434
|