jsmn_furi.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736
  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. if (!jsmn_memory_check(max_tokens))
  459. {
  460. FURI_LOG_E("JSMM.H", "Insufficient memory for JSON tokens.");
  461. return NULL;
  462. }
  463. // Create a temporary FuriString from key
  464. FuriString *key_str = furi_string_alloc();
  465. furi_string_cat_str(key_str, key);
  466. jsmn_parser parser;
  467. jsmn_init_furi(&parser);
  468. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  469. if (tokens == NULL)
  470. {
  471. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  472. furi_string_free(key_str);
  473. return NULL;
  474. }
  475. int ret = jsmn_parse_furi(&parser, json_data, tokens, max_tokens);
  476. if (ret < 0)
  477. {
  478. FURI_LOG_E("JSMM.H", "Failed to parse JSON: %d", ret);
  479. free(tokens);
  480. furi_string_free(key_str);
  481. return NULL;
  482. }
  483. if (ret < 1 || tokens[0].type != JSMN_OBJECT)
  484. {
  485. FURI_LOG_E("JSMM.H", "Root element is not an object.");
  486. free(tokens);
  487. furi_string_free(key_str);
  488. return NULL;
  489. }
  490. for (int i = 1; i < ret; i++)
  491. {
  492. if (jsoneq_furi(json_data, &tokens[i], key_str) == 0)
  493. {
  494. int length = tokens[i + 1].end - tokens[i + 1].start;
  495. FuriString *value = furi_string_alloc_set(json_data);
  496. furi_string_mid(value, tokens[i + 1].start, length);
  497. free(tokens);
  498. furi_string_free(key_str);
  499. return value;
  500. }
  501. }
  502. free(tokens);
  503. furi_string_free(key_str);
  504. char warning[128];
  505. snprintf(warning, sizeof(warning), "Failed to find the key \"%s\" in the JSON.", key);
  506. FURI_LOG_E("JSMM.H", warning);
  507. return NULL;
  508. }
  509. /**
  510. * Return the value at a given index in a JSON array for a given char* key.
  511. */
  512. FuriString *get_json_array_value_furi(const char *key, uint32_t index, const FuriString *json_data)
  513. {
  514. FuriString *array_str = get_json_value_furi(key, json_data);
  515. if (array_str == NULL)
  516. {
  517. FURI_LOG_E("JSMM.H", "Failed to get array for key");
  518. return NULL;
  519. }
  520. uint32_t max_tokens = json_token_count_furi(array_str);
  521. if (!jsmn_memory_check(max_tokens))
  522. {
  523. FURI_LOG_E("JSMM.H", "Insufficient memory for JSON tokens.");
  524. furi_string_free(array_str);
  525. return NULL;
  526. }
  527. jsmn_parser parser;
  528. jsmn_init_furi(&parser);
  529. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  530. if (tokens == NULL)
  531. {
  532. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  533. furi_string_free(array_str);
  534. return NULL;
  535. }
  536. int ret = jsmn_parse_furi(&parser, array_str, tokens, max_tokens);
  537. if (ret < 0)
  538. {
  539. FURI_LOG_E("JSMM.H", "Failed to parse JSON array: %d", ret);
  540. free(tokens);
  541. furi_string_free(array_str);
  542. return NULL;
  543. }
  544. if (ret < 1 || tokens[0].type != JSMN_ARRAY)
  545. {
  546. FURI_LOG_E("JSMM.H", "Value for key is not an array.");
  547. free(tokens);
  548. furi_string_free(array_str);
  549. return NULL;
  550. }
  551. if (index >= (uint32_t)tokens[0].size)
  552. {
  553. // FURI_LOG_E("JSMM.H", "Index %lu out of bounds for array with size %u.", index, tokens[0].size);
  554. free(tokens);
  555. furi_string_free(array_str);
  556. return NULL;
  557. }
  558. int elem_token = 1;
  559. for (uint32_t i = 0; i < index; i++)
  560. {
  561. elem_token = skip_token(tokens, elem_token, ret);
  562. if (elem_token == -1 || elem_token >= ret)
  563. {
  564. FURI_LOG_E("JSMM.H", "Error skipping tokens to reach element %lu.", i);
  565. free(tokens);
  566. furi_string_free(array_str);
  567. return NULL;
  568. }
  569. }
  570. jsmntok_t element = tokens[elem_token];
  571. int length = element.end - element.start;
  572. FuriString *value = furi_string_alloc_set(array_str);
  573. furi_string_mid(value, element.start, length);
  574. free(tokens);
  575. furi_string_free(array_str);
  576. return value;
  577. }
  578. /**
  579. * Extract all object values from a JSON array associated with a given char* key.
  580. */
  581. FuriString **get_json_array_values_furi(const char *key, const FuriString *json_data, int *num_values)
  582. {
  583. *num_values = 0;
  584. // Convert key to FuriString and call get_json_value_furi
  585. FuriString *array_str = get_json_value_furi(key, json_data);
  586. if (array_str == NULL)
  587. {
  588. FURI_LOG_E("JSMM.H", "Failed to get array for key");
  589. return NULL;
  590. }
  591. uint32_t max_tokens = json_token_count_furi(array_str);
  592. if (!jsmn_memory_check(max_tokens))
  593. {
  594. FURI_LOG_E("JSMM.H", "Insufficient memory for JSON tokens.");
  595. furi_string_free(array_str);
  596. return NULL;
  597. }
  598. jsmn_parser parser;
  599. jsmn_init_furi(&parser);
  600. jsmntok_t *tokens = (jsmntok_t *)malloc(sizeof(jsmntok_t) * max_tokens);
  601. if (tokens == NULL)
  602. {
  603. FURI_LOG_E("JSMM.H", "Failed to allocate memory for JSON tokens.");
  604. furi_string_free(array_str);
  605. return NULL;
  606. }
  607. int ret = jsmn_parse_furi(&parser, array_str, tokens, max_tokens);
  608. if (ret < 0)
  609. {
  610. FURI_LOG_E("JSMM.H", "Failed to parse JSON array: %d", ret);
  611. free(tokens);
  612. furi_string_free(array_str);
  613. return NULL;
  614. }
  615. if (tokens[0].type != JSMN_ARRAY)
  616. {
  617. FURI_LOG_E("JSMM.H", "Value for key is not an array.");
  618. free(tokens);
  619. furi_string_free(array_str);
  620. return NULL;
  621. }
  622. int array_size = tokens[0].size;
  623. FuriString **values = (FuriString **)malloc(array_size * sizeof(FuriString *));
  624. if (values == NULL)
  625. {
  626. FURI_LOG_E("JSMM.H", "Failed to allocate memory for array of values.");
  627. free(tokens);
  628. furi_string_free(array_str);
  629. return NULL;
  630. }
  631. int actual_num_values = 0;
  632. int current_token = 1;
  633. for (int i = 0; i < array_size; i++)
  634. {
  635. if (current_token >= ret)
  636. {
  637. FURI_LOG_E("JSMM.H", "Unexpected end of tokens while traversing array.");
  638. break;
  639. }
  640. jsmntok_t element = tokens[current_token];
  641. int length = element.end - element.start;
  642. FuriString *value = furi_string_alloc_set(array_str);
  643. furi_string_mid(value, element.start, length);
  644. values[actual_num_values] = value;
  645. actual_num_values++;
  646. // Skip this element and its descendants
  647. current_token = skip_token(tokens, current_token, ret);
  648. if (current_token == -1)
  649. {
  650. FURI_LOG_E("JSMM.H", "Error skipping tokens after element %d.", i);
  651. break;
  652. }
  653. }
  654. *num_values = actual_num_values;
  655. if (actual_num_values < array_size)
  656. {
  657. FuriString **reduced_values = (FuriString **)realloc(values, actual_num_values * sizeof(FuriString *));
  658. if (reduced_values != NULL)
  659. {
  660. values = reduced_values;
  661. }
  662. }
  663. free(tokens);
  664. furi_string_free(array_str);
  665. return values;
  666. }
  667. uint32_t json_token_count_furi(const FuriString *json)
  668. {
  669. if (json == NULL)
  670. {
  671. return JSMN_ERROR_INVAL;
  672. }
  673. jsmn_parser parser;
  674. jsmn_init_furi(&parser);
  675. // Pass NULL for tokens and 0 for num_tokens to get the token count only
  676. int ret = jsmn_parse_furi(&parser, json, NULL, 0);
  677. return ret; // If ret >= 0, it represents the number of tokens needed.
  678. }