jsmn_furi.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719
  1. /*
  2. * MIT License
  3. *
  4. * Copyright (c) 2010 Serge Zaitsev
  5. *
  6. * [License text continues...]
  7. */
  8. #include <jsmn/jsmn_furi.h>
  9. // Forward declarations of helper functions
  10. static int jsoneq_furi(const FuriString *json, jsmntok_t *tok, const FuriString *s);
  11. static int skip_token(const jsmntok_t *tokens, int start, int total);
  12. /**
  13. * Allocates a fresh unused token from the token pool.
  14. */
  15. static jsmntok_t *jsmn_alloc_token(jsmn_parser *parser, jsmntok_t *tokens,
  16. const size_t num_tokens)
  17. {
  18. if (parser->toknext >= num_tokens)
  19. {
  20. return NULL;
  21. }
  22. jsmntok_t *tok = &tokens[parser->toknext++];
  23. tok->start = tok->end = -1;
  24. tok->size = 0;
  25. #ifdef JSMN_PARENT_LINKS
  26. tok->parent = -1;
  27. #endif
  28. return tok;
  29. }
  30. /**
  31. * Fills token type and boundaries.
  32. */
  33. static void jsmn_fill_token(jsmntok_t *token, const jsmntype_t type,
  34. const int start, const int end)
  35. {
  36. token->type = type;
  37. token->start = start;
  38. token->end = end;
  39. token->size = 0;
  40. }
  41. /**
  42. * Fills next available token with JSON primitive.
  43. * Now uses FuriString to access characters.
  44. */
  45. static int jsmn_parse_primitive(jsmn_parser *parser, const FuriString *js,
  46. jsmntok_t *tokens, const size_t num_tokens)
  47. {
  48. size_t len = furi_string_size(js);
  49. int start = parser->pos;
  50. for (; parser->pos < len; parser->pos++)
  51. {
  52. char c = furi_string_get_char(js, parser->pos);
  53. switch (c)
  54. {
  55. #ifndef JSMN_STRICT
  56. case ':':
  57. #endif
  58. case '\t':
  59. case '\r':
  60. case '\n':
  61. case ' ':
  62. case ',':
  63. case ']':
  64. case '}':
  65. goto found;
  66. default:
  67. break;
  68. }
  69. if (c < 32 || c >= 127)
  70. {
  71. parser->pos = start;
  72. return JSMN_ERROR_INVAL;
  73. }
  74. }
  75. #ifdef JSMN_STRICT
  76. // In strict mode primitive must be followed by a comma/object/array
  77. parser->pos = start;
  78. return JSMN_ERROR_PART;
  79. #endif
  80. found:
  81. if (tokens == NULL)
  82. {
  83. parser->pos--;
  84. return 0;
  85. }
  86. jsmntok_t *token = jsmn_alloc_token(parser, tokens, num_tokens);
  87. if (token == NULL)
  88. {
  89. parser->pos = start;
  90. return JSMN_ERROR_NOMEM;
  91. }
  92. jsmn_fill_token(token, JSMN_PRIMITIVE, start, parser->pos);
  93. #ifdef JSMN_PARENT_LINKS
  94. token->parent = parser->toksuper;
  95. #endif
  96. parser->pos--;
  97. return 0;
  98. }
  99. /**
  100. * Fills next token with JSON string.
  101. * Now uses FuriString to access characters.
  102. */
  103. static int jsmn_parse_string(jsmn_parser *parser, const FuriString *js,
  104. jsmntok_t *tokens, const size_t num_tokens)
  105. {
  106. size_t len = furi_string_size(js);
  107. int start = parser->pos;
  108. parser->pos++;
  109. for (; parser->pos < len; parser->pos++)
  110. {
  111. char c = furi_string_get_char(js, parser->pos);
  112. if (c == '\"')
  113. {
  114. if (tokens == NULL)
  115. {
  116. return 0;
  117. }
  118. jsmntok_t *token = jsmn_alloc_token(parser, tokens, num_tokens);
  119. if (token == NULL)
  120. {
  121. parser->pos = start;
  122. return JSMN_ERROR_NOMEM;
  123. }
  124. jsmn_fill_token(token, JSMN_STRING, start + 1, parser->pos);
  125. #ifdef JSMN_PARENT_LINKS
  126. token->parent = parser->toksuper;
  127. #endif
  128. return 0;
  129. }
  130. if (c == '\\' && (parser->pos + 1) < len)
  131. {
  132. parser->pos++;
  133. char esc = furi_string_get_char(js, parser->pos);
  134. switch (esc)
  135. {
  136. case '\"':
  137. case '/':
  138. case '\\':
  139. case 'b':
  140. case 'f':
  141. case 'r':
  142. case 'n':
  143. case 't':
  144. break;
  145. case 'u':
  146. {
  147. parser->pos++;
  148. for (int i = 0; i < 4 && parser->pos < len; i++)
  149. {
  150. char hex = furi_string_get_char(js, parser->pos);
  151. if (!((hex >= '0' && hex <= '9') ||
  152. (hex >= 'A' && hex <= 'F') ||
  153. (hex >= 'a' && hex <= 'f')))
  154. {
  155. parser->pos = start;
  156. return JSMN_ERROR_INVAL;
  157. }
  158. parser->pos++;
  159. }
  160. parser->pos--;
  161. break;
  162. }
  163. default:
  164. parser->pos = start;
  165. return JSMN_ERROR_INVAL;
  166. }
  167. }
  168. }
  169. parser->pos = start;
  170. return JSMN_ERROR_PART;
  171. }
  172. /**
  173. * Create JSON parser
  174. */
  175. void jsmn_init_furi(jsmn_parser *parser)
  176. {
  177. parser->pos = 0;
  178. parser->toknext = 0;
  179. parser->toksuper = -1;
  180. }
  181. /**
  182. * Parse JSON string and fill tokens.
  183. * Now uses FuriString for the input JSON.
  184. */
  185. int jsmn_parse_furi(jsmn_parser *parser, const FuriString *js,
  186. jsmntok_t *tokens, const unsigned int num_tokens)
  187. {
  188. size_t len = furi_string_size(js);
  189. int r;
  190. int i;
  191. int count = parser->toknext;
  192. for (; parser->pos < len; parser->pos++)
  193. {
  194. char c = furi_string_get_char(js, parser->pos);
  195. jsmntype_t type;
  196. switch (c)
  197. {
  198. case '{':
  199. case '[':
  200. {
  201. count++;
  202. if (tokens == NULL)
  203. {
  204. break;
  205. }
  206. jsmntok_t *token = jsmn_alloc_token(parser, tokens, num_tokens);
  207. if (token == NULL)
  208. return JSMN_ERROR_NOMEM;
  209. if (parser->toksuper != -1)
  210. {
  211. jsmntok_t *t = &tokens[parser->toksuper];
  212. #ifdef JSMN_STRICT
  213. if (t->type == JSMN_OBJECT)
  214. return JSMN_ERROR_INVAL;
  215. #endif
  216. t->size++;
  217. #ifdef JSMN_PARENT_LINKS
  218. token->parent = parser->toksuper;
  219. #endif
  220. }
  221. token->type = (c == '{' ? JSMN_OBJECT : JSMN_ARRAY);
  222. token->start = parser->pos;
  223. parser->toksuper = parser->toknext - 1;
  224. break;
  225. }
  226. case '}':
  227. case ']':
  228. if (tokens == NULL)
  229. {
  230. break;
  231. }
  232. type = (c == '}' ? JSMN_OBJECT : JSMN_ARRAY);
  233. #ifdef JSMN_PARENT_LINKS
  234. if (parser->toknext < 1)
  235. {
  236. return JSMN_ERROR_INVAL;
  237. }
  238. {
  239. jsmntok_t *token = &tokens[parser->toknext - 1];
  240. for (;;)
  241. {
  242. if (token->start != -1 && token->end == -1)
  243. {
  244. if (token->type != type)
  245. return JSMN_ERROR_INVAL;
  246. token->end = parser->pos + 1;
  247. parser->toksuper = token->parent;
  248. break;
  249. }
  250. if (token->parent == -1)
  251. {
  252. if (token->type != type || parser->toksuper == -1)
  253. {
  254. return JSMN_ERROR_INVAL;
  255. }
  256. break;
  257. }
  258. token = &tokens[token->parent];
  259. }
  260. }
  261. #else
  262. {
  263. jsmntok_t *token;
  264. for (i = parser->toknext - 1; i >= 0; i--)
  265. {
  266. token = &tokens[i];
  267. if (token->start != -1 && token->end == -1)
  268. {
  269. if (token->type != type)
  270. return JSMN_ERROR_INVAL;
  271. parser->toksuper = -1;
  272. token->end = parser->pos + 1;
  273. break;
  274. }
  275. }
  276. if (i == -1)
  277. return JSMN_ERROR_INVAL;
  278. for (; i >= 0; i--)
  279. {
  280. token = &tokens[i];
  281. if (token->start != -1 && token->end == -1)
  282. {
  283. parser->toksuper = i;
  284. break;
  285. }
  286. }
  287. }
  288. #endif
  289. break;
  290. case '\"':
  291. r = jsmn_parse_string(parser, js, tokens, num_tokens);
  292. if (r < 0)
  293. return r;
  294. count++;
  295. if (parser->toksuper != -1 && tokens != NULL)
  296. {
  297. tokens[parser->toksuper].size++;
  298. }
  299. break;
  300. case '\t':
  301. case '\r':
  302. case '\n':
  303. case ' ':
  304. // Whitespace - ignore
  305. break;
  306. case ':':
  307. parser->toksuper = parser->toknext - 1;
  308. break;
  309. case ',':
  310. if (tokens != NULL && parser->toksuper != -1 &&
  311. tokens[parser->toksuper].type != JSMN_ARRAY &&
  312. tokens[parser->toksuper].type != JSMN_OBJECT)
  313. {
  314. #ifdef JSMN_PARENT_LINKS
  315. parser->toksuper = tokens[parser->toksuper].parent;
  316. #else
  317. for (i = parser->toknext - 1; i >= 0; i--)
  318. {
  319. if (tokens[i].type == JSMN_ARRAY || tokens[i].type == JSMN_OBJECT)
  320. {
  321. if (tokens[i].start != -1 && tokens[i].end == -1)
  322. {
  323. parser->toksuper = i;
  324. break;
  325. }
  326. }
  327. }
  328. #endif
  329. }
  330. break;
  331. #ifdef JSMN_STRICT
  332. case '-':
  333. case '0':
  334. case '1':
  335. case '2':
  336. case '3':
  337. case '4':
  338. case '5':
  339. case '6':
  340. case '7':
  341. case '8':
  342. case '9':
  343. case 't':
  344. case 'f':
  345. case 'n':
  346. if (tokens != NULL && parser->toksuper != -1)
  347. {
  348. const jsmntok_t *t = &tokens[parser->toksuper];
  349. if (t->type == JSMN_OBJECT ||
  350. (t->type == JSMN_STRING && t->size != 0))
  351. {
  352. return JSMN_ERROR_INVAL;
  353. }
  354. }
  355. #else
  356. default:
  357. #endif
  358. r = jsmn_parse_primitive(parser, js, tokens, num_tokens);
  359. if (r < 0)
  360. return r;
  361. count++;
  362. if (parser->toksuper != -1 && tokens != NULL)
  363. {
  364. tokens[parser->toksuper].size++;
  365. }
  366. break;
  367. #ifdef JSMN_STRICT
  368. default:
  369. return JSMN_ERROR_INVAL;
  370. #endif
  371. }
  372. }
  373. if (tokens != NULL)
  374. {
  375. for (i = parser->toknext - 1; i >= 0; i--)
  376. {
  377. if (tokens[i].start != -1 && tokens[i].end == -1)
  378. {
  379. return JSMN_ERROR_PART;
  380. }
  381. }
  382. }
  383. return count;
  384. }
  385. // Helper function to create a JSON object: {"key":"value"}
  386. FuriString *get_json_furi(const FuriString *key, const FuriString *value)
  387. {
  388. FuriString *result = furi_string_alloc();
  389. furi_string_printf(result, "{\"%s\":\"%s\"}",
  390. furi_string_get_cstr(key),
  391. furi_string_get_cstr(value));
  392. return result; // Caller responsible for furi_string_free
  393. }
  394. // Helper function to compare JSON keys
  395. static int jsoneq_furi(const FuriString *json, jsmntok_t *tok, const FuriString *s)
  396. {
  397. size_t s_len = furi_string_size(s);
  398. size_t tok_len = tok->end - tok->start;
  399. if (tok->type != JSMN_STRING)
  400. return -1;
  401. if (s_len != tok_len)
  402. return -1;
  403. FuriString *sub = furi_string_alloc_set(json);
  404. furi_string_mid(sub, tok->start, tok_len);
  405. int res = furi_string_cmp(sub, s);
  406. furi_string_free(sub);
  407. return (res == 0) ? 0 : -1;
  408. }
  409. // Skip a token and its descendants
  410. static int skip_token(const jsmntok_t *tokens, int start, int total)
  411. {
  412. if (start < 0 || start >= total)
  413. return -1;
  414. int i = start;
  415. if (tokens[i].type == JSMN_OBJECT)
  416. {
  417. int pairs = tokens[i].size;
  418. i++;
  419. for (int p = 0; p < pairs; p++)
  420. {
  421. i++; // skip key
  422. if (i >= total)
  423. return -1;
  424. i = skip_token(tokens, i, total); // skip value
  425. if (i == -1)
  426. return -1;
  427. }
  428. return i;
  429. }
  430. else if (tokens[i].type == JSMN_ARRAY)
  431. {
  432. int elems = tokens[i].size;
  433. i++;
  434. for (int e = 0; e < elems; e++)
  435. {
  436. i = skip_token(tokens, i, total);
  437. if (i == -1)
  438. return -1;
  439. }
  440. return i;
  441. }
  442. else
  443. {
  444. return i + 1;
  445. }
  446. }
  447. /**
  448. * Parse JSON and return the value associated with a given char* key.
  449. */
  450. FuriString *get_json_value_furi(const char *key, const FuriString *json_data)
  451. {
  452. if (json_data == NULL)
  453. {
  454. FURI_LOG_E("JSMM.H", "JSON data is NULL");
  455. return NULL;
  456. }
  457. uint32_t max_tokens = json_token_count_furi(json_data);
  458. // Create a temporary FuriString from key
  459. FuriString *key_str = furi_string_alloc();
  460. furi_string_cat_str(key_str, key);
  461. jsmn_parser parser;
  462. jsmn_init_furi(&parser);
  463. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  464. if (tokens == NULL)
  465. {
  466. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  467. furi_string_free(key_str);
  468. return NULL;
  469. }
  470. int ret = jsmn_parse_furi(&parser, json_data, tokens, max_tokens);
  471. if (ret < 0)
  472. {
  473. FURI_LOG_E("JSMM.H", "Failed to parse JSON: %d", ret);
  474. free(tokens);
  475. furi_string_free(key_str);
  476. return NULL;
  477. }
  478. if (ret < 1 || tokens[0].type != JSMN_OBJECT)
  479. {
  480. FURI_LOG_E("JSMM.H", "Root element is not an object.");
  481. free(tokens);
  482. furi_string_free(key_str);
  483. return NULL;
  484. }
  485. for (int i = 1; i < ret; i++)
  486. {
  487. if (jsoneq_furi(json_data, &tokens[i], key_str) == 0)
  488. {
  489. int length = tokens[i + 1].end - tokens[i + 1].start;
  490. FuriString *value = furi_string_alloc_set(json_data);
  491. furi_string_mid(value, tokens[i + 1].start, length);
  492. free(tokens);
  493. furi_string_free(key_str);
  494. return value;
  495. }
  496. }
  497. free(tokens);
  498. furi_string_free(key_str);
  499. char warning[128];
  500. snprintf(warning, sizeof(warning), "Failed to find the key \"%s\" in the JSON.", key);
  501. FURI_LOG_E("JSMM.H", warning);
  502. return NULL;
  503. }
  504. /**
  505. * Return the value at a given index in a JSON array for a given char* key.
  506. */
  507. FuriString *get_json_array_value_furi(const char *key, uint32_t index, const FuriString *json_data)
  508. {
  509. FuriString *array_str = get_json_value_furi(key, json_data);
  510. if (array_str == NULL)
  511. {
  512. FURI_LOG_E("JSMM.H", "Failed to get array for key");
  513. return NULL;
  514. }
  515. uint32_t max_tokens = json_token_count_furi(array_str);
  516. jsmn_parser parser;
  517. jsmn_init_furi(&parser);
  518. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  519. if (tokens == NULL)
  520. {
  521. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  522. furi_string_free(array_str);
  523. return NULL;
  524. }
  525. int ret = jsmn_parse_furi(&parser, array_str, tokens, max_tokens);
  526. if (ret < 0)
  527. {
  528. FURI_LOG_E("JSMM.H", "Failed to parse JSON array: %d", ret);
  529. free(tokens);
  530. furi_string_free(array_str);
  531. return NULL;
  532. }
  533. if (ret < 1 || tokens[0].type != JSMN_ARRAY)
  534. {
  535. FURI_LOG_E("JSMM.H", "Value for key is not an array.");
  536. free(tokens);
  537. furi_string_free(array_str);
  538. return NULL;
  539. }
  540. if (index >= (uint32_t)tokens[0].size)
  541. {
  542. FURI_LOG_E("JSMM.H", "Index %lu out of bounds for array with size %u.", index, tokens[0].size);
  543. free(tokens);
  544. furi_string_free(array_str);
  545. return NULL;
  546. }
  547. int elem_token = 1;
  548. for (uint32_t i = 0; i < index; i++)
  549. {
  550. elem_token = skip_token(tokens, elem_token, ret);
  551. if (elem_token == -1 || elem_token >= ret)
  552. {
  553. FURI_LOG_E("JSMM.H", "Error skipping tokens to reach element %lu.", i);
  554. free(tokens);
  555. furi_string_free(array_str);
  556. return NULL;
  557. }
  558. }
  559. jsmntok_t element = tokens[elem_token];
  560. int length = element.end - element.start;
  561. FuriString *value = furi_string_alloc_set(array_str);
  562. furi_string_mid(value, element.start, length);
  563. free(tokens);
  564. furi_string_free(array_str);
  565. return value;
  566. }
  567. /**
  568. * Extract all object values from a JSON array associated with a given char* key.
  569. */
  570. FuriString **get_json_array_values_furi(const char *key, const FuriString *json_data, int *num_values)
  571. {
  572. *num_values = 0;
  573. // Convert key to FuriString and call get_json_value_furi
  574. FuriString *array_str = get_json_value_furi(key, json_data);
  575. if (array_str == NULL)
  576. {
  577. FURI_LOG_E("JSMM.H", "Failed to get array for key");
  578. return NULL;
  579. }
  580. uint32_t max_tokens = json_token_count_furi(array_str);
  581. jsmn_parser parser;
  582. jsmn_init_furi(&parser);
  583. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  584. if (tokens == NULL)
  585. {
  586. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  587. furi_string_free(array_str);
  588. return NULL;
  589. }
  590. int ret = jsmn_parse_furi(&parser, array_str, tokens, max_tokens);
  591. if (ret < 0)
  592. {
  593. FURI_LOG_E("JSMM.H", "Failed to parse JSON array: %d", ret);
  594. free(tokens);
  595. furi_string_free(array_str);
  596. return NULL;
  597. }
  598. if (tokens[0].type != JSMN_ARRAY)
  599. {
  600. FURI_LOG_E("JSMM.H", "Value for key is not an array.");
  601. free(tokens);
  602. furi_string_free(array_str);
  603. return NULL;
  604. }
  605. int array_size = tokens[0].size;
  606. FuriString **values = (FuriString **)malloc(array_size * sizeof(FuriString *));
  607. if (values == NULL)
  608. {
  609. FURI_LOG_E("JSMM.H", "Failed to allocate memory for array of values.");
  610. free(tokens);
  611. furi_string_free(array_str);
  612. return NULL;
  613. }
  614. int actual_num_values = 0;
  615. int current_token = 1;
  616. for (int i = 0; i < array_size; i++)
  617. {
  618. if (current_token >= ret)
  619. {
  620. FURI_LOG_E("JSMM.H", "Unexpected end of tokens while traversing array.");
  621. break;
  622. }
  623. jsmntok_t element = tokens[current_token];
  624. int length = element.end - element.start;
  625. FuriString *value = furi_string_alloc_set(array_str);
  626. furi_string_mid(value, element.start, length);
  627. values[actual_num_values] = value;
  628. actual_num_values++;
  629. // Skip this element and its descendants
  630. current_token = skip_token(tokens, current_token, ret);
  631. if (current_token == -1)
  632. {
  633. FURI_LOG_E("JSMM.H", "Error skipping tokens after element %d.", i);
  634. break;
  635. }
  636. }
  637. *num_values = actual_num_values;
  638. if (actual_num_values < array_size)
  639. {
  640. FuriString **reduced_values = (FuriString **)realloc(values, actual_num_values * sizeof(FuriString *));
  641. if (reduced_values != NULL)
  642. {
  643. values = reduced_values;
  644. }
  645. }
  646. free(tokens);
  647. furi_string_free(array_str);
  648. return values;
  649. }
  650. uint32_t json_token_count_furi(const FuriString *json)
  651. {
  652. if (json == NULL)
  653. {
  654. return JSMN_ERROR_INVAL;
  655. }
  656. jsmn_parser parser;
  657. jsmn_init_furi(&parser);
  658. // Pass NULL for tokens and 0 for num_tokens to get the token count only
  659. int ret = jsmn_parse_furi(&parser, json, NULL, 0);
  660. return ret; // If ret >= 0, it represents the number of tokens needed.
  661. }