marshalls.cpp 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393
  1. /*************************************************************************/
  2. /* marshalls.cpp */
  3. /*************************************************************************/
  4. /* This file is part of: */
  5. /* GODOT ENGINE */
  6. /* https://godotengine.org */
  7. /*************************************************************************/
  8. /* Copyright (c) 2007-2018 Juan Linietsky, Ariel Manzur. */
  9. /* Copyright (c) 2014-2018 Godot Engine contributors (cf. AUTHORS.md) */
  10. /* */
  11. /* Permission is hereby granted, free of charge, to any person obtaining */
  12. /* a copy of this software and associated documentation files (the */
  13. /* "Software"), to deal in the Software without restriction, including */
  14. /* without limitation the rights to use, copy, modify, merge, publish, */
  15. /* distribute, sublicense, and/or sell copies of the Software, and to */
  16. /* permit persons to whom the Software is furnished to do so, subject to */
  17. /* the following conditions: */
  18. /* */
  19. /* The above copyright notice and this permission notice shall be */
  20. /* included in all copies or substantial portions of the Software. */
  21. /* */
  22. /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
  23. /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
  24. /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
  25. /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
  26. /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
  27. /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
  28. /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
  29. /*************************************************************************/
  30. #include "marshalls.h"
  31. #include "os/keyboard.h"
  32. #include "print_string.h"
  33. #include "reference.h"
  34. #include <limits.h>
  35. #include <stdio.h>
  36. #define _S(a) ((int32_t)a)
  37. #define ERR_FAIL_ADD_OF(a, b, err) ERR_FAIL_COND_V(_S(b) < 0 || _S(a) < 0 || _S(a) > INT_MAX - _S(b), err)
  38. #define ERR_FAIL_MUL_OF(a, b, err) ERR_FAIL_COND_V(_S(a) < 0 || _S(b) <= 0 || _S(a) > INT_MAX / _S(b), err)
  39. void EncodedObjectAsID::_bind_methods() {
  40. ClassDB::bind_method(D_METHOD("set_object_id", "id"), &EncodedObjectAsID::set_object_id);
  41. ClassDB::bind_method(D_METHOD("get_object_id"), &EncodedObjectAsID::get_object_id);
  42. }
  43. void EncodedObjectAsID::set_object_id(ObjectID p_id) {
  44. id = p_id;
  45. }
  46. ObjectID EncodedObjectAsID::get_object_id() const {
  47. return id;
  48. }
  49. EncodedObjectAsID::EncodedObjectAsID() {
  50. id = 0;
  51. }
  52. #define ENCODE_MASK 0xFF
  53. #define ENCODE_FLAG_64 1 << 16
  54. #define ENCODE_FLAG_OBJECT_AS_ID 1 << 16
  55. static Error _decode_string(const uint8_t *&buf, int &len, int *r_len, String &r_string) {
  56. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  57. int32_t strlen = decode_uint32(buf);
  58. int32_t pad = 0;
  59. // Handle padding
  60. if (strlen % 4) {
  61. pad = 4 - strlen % 4;
  62. }
  63. buf += 4;
  64. len -= 4;
  65. // Ensure buffer is big enough
  66. ERR_FAIL_ADD_OF(strlen, pad, ERR_FILE_EOF);
  67. ERR_FAIL_COND_V(strlen < 0 || strlen + pad > len, ERR_FILE_EOF);
  68. String str;
  69. ERR_FAIL_COND_V(str.parse_utf8((const char *)buf, strlen), ERR_INVALID_DATA);
  70. r_string = str;
  71. // Add padding
  72. strlen += pad;
  73. // Update buffer pos, left data count, and return size
  74. buf += strlen;
  75. len -= strlen;
  76. if (r_len) {
  77. (*r_len) += 4 + strlen;
  78. }
  79. return OK;
  80. }
  81. Error decode_variant(Variant &r_variant, const uint8_t *p_buffer, int p_len, int *r_len, bool p_allow_objects) {
  82. const uint8_t *buf = p_buffer;
  83. int len = p_len;
  84. if (len < 4) {
  85. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  86. }
  87. uint32_t type = decode_uint32(buf);
  88. ERR_FAIL_COND_V((type & ENCODE_MASK) >= Variant::VARIANT_MAX, ERR_INVALID_DATA);
  89. buf += 4;
  90. len -= 4;
  91. if (r_len)
  92. *r_len = 4;
  93. switch (type & ENCODE_MASK) {
  94. case Variant::NIL: {
  95. r_variant = Variant();
  96. } break;
  97. case Variant::BOOL: {
  98. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  99. bool val = decode_uint32(buf);
  100. r_variant = val;
  101. if (r_len)
  102. (*r_len) += 4;
  103. } break;
  104. case Variant::INT: {
  105. if (type & ENCODE_FLAG_64) {
  106. ERR_FAIL_COND_V(len < 8, ERR_INVALID_DATA);
  107. int64_t val = decode_uint64(buf);
  108. r_variant = val;
  109. if (r_len)
  110. (*r_len) += 8;
  111. } else {
  112. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  113. int32_t val = decode_uint32(buf);
  114. r_variant = val;
  115. if (r_len)
  116. (*r_len) += 4;
  117. }
  118. } break;
  119. case Variant::REAL: {
  120. if (type & ENCODE_FLAG_64) {
  121. ERR_FAIL_COND_V(len < 8, ERR_INVALID_DATA);
  122. double val = decode_double(buf);
  123. r_variant = val;
  124. if (r_len)
  125. (*r_len) += 8;
  126. } else {
  127. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  128. float val = decode_float(buf);
  129. r_variant = val;
  130. if (r_len)
  131. (*r_len) += 4;
  132. }
  133. } break;
  134. case Variant::STRING: {
  135. String str;
  136. Error err = _decode_string(buf, len, r_len, str);
  137. if (err)
  138. return err;
  139. r_variant = str;
  140. } break;
  141. // math types
  142. case Variant::VECTOR2: {
  143. ERR_FAIL_COND_V(len < 4 * 2, ERR_INVALID_DATA);
  144. Vector2 val;
  145. val.x = decode_float(&buf[0]);
  146. val.y = decode_float(&buf[4]);
  147. r_variant = val;
  148. if (r_len)
  149. (*r_len) += 4 * 2;
  150. } break; // 5
  151. case Variant::RECT2: {
  152. ERR_FAIL_COND_V(len < 4 * 4, ERR_INVALID_DATA);
  153. Rect2 val;
  154. val.position.x = decode_float(&buf[0]);
  155. val.position.y = decode_float(&buf[4]);
  156. val.size.x = decode_float(&buf[8]);
  157. val.size.y = decode_float(&buf[12]);
  158. r_variant = val;
  159. if (r_len)
  160. (*r_len) += 4 * 4;
  161. } break;
  162. case Variant::VECTOR3: {
  163. ERR_FAIL_COND_V(len < 4 * 3, ERR_INVALID_DATA);
  164. Vector3 val;
  165. val.x = decode_float(&buf[0]);
  166. val.y = decode_float(&buf[4]);
  167. val.z = decode_float(&buf[8]);
  168. r_variant = val;
  169. if (r_len)
  170. (*r_len) += 4 * 3;
  171. } break;
  172. case Variant::TRANSFORM2D: {
  173. ERR_FAIL_COND_V(len < 4 * 6, ERR_INVALID_DATA);
  174. Transform2D val;
  175. for (int i = 0; i < 3; i++) {
  176. for (int j = 0; j < 2; j++) {
  177. val.elements[i][j] = decode_float(&buf[(i * 2 + j) * 4]);
  178. }
  179. }
  180. r_variant = val;
  181. if (r_len)
  182. (*r_len) += 4 * 6;
  183. } break;
  184. case Variant::PLANE: {
  185. ERR_FAIL_COND_V(len < 4 * 4, ERR_INVALID_DATA);
  186. Plane val;
  187. val.normal.x = decode_float(&buf[0]);
  188. val.normal.y = decode_float(&buf[4]);
  189. val.normal.z = decode_float(&buf[8]);
  190. val.d = decode_float(&buf[12]);
  191. r_variant = val;
  192. if (r_len)
  193. (*r_len) += 4 * 4;
  194. } break;
  195. case Variant::QUAT: {
  196. ERR_FAIL_COND_V(len < 4 * 4, ERR_INVALID_DATA);
  197. Quat val;
  198. val.x = decode_float(&buf[0]);
  199. val.y = decode_float(&buf[4]);
  200. val.z = decode_float(&buf[8]);
  201. val.w = decode_float(&buf[12]);
  202. r_variant = val;
  203. if (r_len)
  204. (*r_len) += 4 * 4;
  205. } break;
  206. case Variant::AABB: {
  207. ERR_FAIL_COND_V(len < 4 * 6, ERR_INVALID_DATA);
  208. AABB val;
  209. val.position.x = decode_float(&buf[0]);
  210. val.position.y = decode_float(&buf[4]);
  211. val.position.z = decode_float(&buf[8]);
  212. val.size.x = decode_float(&buf[12]);
  213. val.size.y = decode_float(&buf[16]);
  214. val.size.z = decode_float(&buf[20]);
  215. r_variant = val;
  216. if (r_len)
  217. (*r_len) += 4 * 6;
  218. } break;
  219. case Variant::BASIS: {
  220. ERR_FAIL_COND_V(len < 4 * 9, ERR_INVALID_DATA);
  221. Basis val;
  222. for (int i = 0; i < 3; i++) {
  223. for (int j = 0; j < 3; j++) {
  224. val.elements[i][j] = decode_float(&buf[(i * 3 + j) * 4]);
  225. }
  226. }
  227. r_variant = val;
  228. if (r_len)
  229. (*r_len) += 4 * 9;
  230. } break;
  231. case Variant::TRANSFORM: {
  232. ERR_FAIL_COND_V(len < 4 * 12, ERR_INVALID_DATA);
  233. Transform val;
  234. for (int i = 0; i < 3; i++) {
  235. for (int j = 0; j < 3; j++) {
  236. val.basis.elements[i][j] = decode_float(&buf[(i * 3 + j) * 4]);
  237. }
  238. }
  239. val.origin[0] = decode_float(&buf[36]);
  240. val.origin[1] = decode_float(&buf[40]);
  241. val.origin[2] = decode_float(&buf[44]);
  242. r_variant = val;
  243. if (r_len)
  244. (*r_len) += 4 * 12;
  245. } break;
  246. // misc types
  247. case Variant::COLOR: {
  248. ERR_FAIL_COND_V(len < 4 * 4, ERR_INVALID_DATA);
  249. Color val;
  250. val.r = decode_float(&buf[0]);
  251. val.g = decode_float(&buf[4]);
  252. val.b = decode_float(&buf[8]);
  253. val.a = decode_float(&buf[12]);
  254. r_variant = val;
  255. if (r_len)
  256. (*r_len) += 4 * 4;
  257. } break;
  258. case Variant::NODE_PATH: {
  259. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  260. int32_t strlen = decode_uint32(buf);
  261. if (strlen & 0x80000000) {
  262. //new format
  263. ERR_FAIL_COND_V(len < 12, ERR_INVALID_DATA);
  264. Vector<StringName> names;
  265. Vector<StringName> subnames;
  266. uint32_t namecount = strlen &= 0x7FFFFFFF;
  267. uint32_t subnamecount = decode_uint32(buf + 4);
  268. uint32_t flags = decode_uint32(buf + 8);
  269. len -= 12;
  270. buf += 12;
  271. if (flags & 2) // Obsolete format with property separate from subpath
  272. subnamecount++;
  273. uint32_t total = namecount + subnamecount;
  274. if (r_len)
  275. (*r_len) += 12;
  276. for (uint32_t i = 0; i < total; i++) {
  277. String str;
  278. Error err = _decode_string(buf, len, r_len, str);
  279. if (err)
  280. return err;
  281. if (i < namecount)
  282. names.push_back(str);
  283. else
  284. subnames.push_back(str);
  285. }
  286. r_variant = NodePath(names, subnames, flags & 1);
  287. } else {
  288. //old format, just a string
  289. ERR_FAIL_V(ERR_INVALID_DATA);
  290. }
  291. } break;
  292. /*case Variant::RESOURCE: {
  293. ERR_EXPLAIN("Can't marshallize resources");
  294. ERR_FAIL_V(ERR_INVALID_DATA); //no, i'm sorry, no go
  295. } break;*/
  296. case Variant::_RID: {
  297. r_variant = RID();
  298. } break;
  299. case Variant::OBJECT: {
  300. if (type & ENCODE_FLAG_OBJECT_AS_ID) {
  301. //this _is_ allowed
  302. ERR_FAIL_COND_V(len < 8, ERR_INVALID_DATA);
  303. ObjectID val = decode_uint64(buf);
  304. if (r_len)
  305. (*r_len) += 8;
  306. if (val == 0) {
  307. r_variant = (Object *)NULL;
  308. } else {
  309. Ref<EncodedObjectAsID> obj_as_id;
  310. obj_as_id.instance();
  311. obj_as_id->set_object_id(val);
  312. r_variant = obj_as_id;
  313. }
  314. } else {
  315. ERR_FAIL_COND_V(!p_allow_objects, ERR_UNAUTHORIZED);
  316. String str;
  317. Error err = _decode_string(buf, len, r_len, str);
  318. if (err)
  319. return err;
  320. if (str == String()) {
  321. r_variant = (Object *)NULL;
  322. } else {
  323. Object *obj = ClassDB::instance(str);
  324. ERR_FAIL_COND_V(!obj, ERR_UNAVAILABLE);
  325. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  326. int32_t count = decode_uint32(buf);
  327. buf += 4;
  328. len -= 4;
  329. if (r_len) {
  330. (*r_len) += 4;
  331. }
  332. for (int i = 0; i < count; i++) {
  333. str = String();
  334. err = _decode_string(buf, len, r_len, str);
  335. if (err)
  336. return err;
  337. Variant value;
  338. int used;
  339. err = decode_variant(value, buf, len, &used, p_allow_objects);
  340. if (err)
  341. return err;
  342. buf += used;
  343. len -= used;
  344. if (r_len) {
  345. (*r_len) += used;
  346. }
  347. obj->set(str, value);
  348. }
  349. if (Object::cast_to<Reference>(obj)) {
  350. REF ref = REF(Object::cast_to<Reference>(obj));
  351. r_variant = ref;
  352. } else {
  353. r_variant = obj;
  354. }
  355. }
  356. }
  357. } break;
  358. case Variant::DICTIONARY: {
  359. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  360. int32_t count = decode_uint32(buf);
  361. // bool shared = count&0x80000000;
  362. count &= 0x7FFFFFFF;
  363. buf += 4;
  364. len -= 4;
  365. if (r_len) {
  366. (*r_len) += 4;
  367. }
  368. Dictionary d;
  369. for (int i = 0; i < count; i++) {
  370. Variant key, value;
  371. int used;
  372. Error err = decode_variant(key, buf, len, &used, p_allow_objects);
  373. ERR_FAIL_COND_V(err, err);
  374. buf += used;
  375. len -= used;
  376. if (r_len) {
  377. (*r_len) += used;
  378. }
  379. err = decode_variant(value, buf, len, &used, p_allow_objects);
  380. ERR_FAIL_COND_V(err, err);
  381. buf += used;
  382. len -= used;
  383. if (r_len) {
  384. (*r_len) += used;
  385. }
  386. d[key] = value;
  387. }
  388. r_variant = d;
  389. } break;
  390. case Variant::ARRAY: {
  391. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  392. int32_t count = decode_uint32(buf);
  393. // bool shared = count&0x80000000;
  394. count &= 0x7FFFFFFF;
  395. buf += 4;
  396. len -= 4;
  397. if (r_len) {
  398. (*r_len) += 4;
  399. }
  400. Array varr;
  401. for (int i = 0; i < count; i++) {
  402. int used = 0;
  403. Variant v;
  404. Error err = decode_variant(v, buf, len, &used, p_allow_objects);
  405. ERR_FAIL_COND_V(err, err);
  406. buf += used;
  407. len -= used;
  408. varr.push_back(v);
  409. if (r_len) {
  410. (*r_len) += used;
  411. }
  412. }
  413. r_variant = varr;
  414. } break;
  415. // arrays
  416. case Variant::POOL_BYTE_ARRAY: {
  417. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  418. int32_t count = decode_uint32(buf);
  419. buf += 4;
  420. len -= 4;
  421. ERR_FAIL_COND_V(count < 0 || count > len, ERR_INVALID_DATA);
  422. PoolVector<uint8_t> data;
  423. if (count) {
  424. data.resize(count);
  425. PoolVector<uint8_t>::Write w = data.write();
  426. for (int32_t i = 0; i < count; i++) {
  427. w[i] = buf[i];
  428. }
  429. w = PoolVector<uint8_t>::Write();
  430. }
  431. r_variant = data;
  432. if (r_len) {
  433. if (count % 4)
  434. (*r_len) += 4 - count % 4;
  435. (*r_len) += 4 + count;
  436. }
  437. } break;
  438. case Variant::POOL_INT_ARRAY: {
  439. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  440. int32_t count = decode_uint32(buf);
  441. buf += 4;
  442. len -= 4;
  443. ERR_FAIL_MUL_OF(count, 4, ERR_INVALID_DATA);
  444. ERR_FAIL_COND_V(count < 0 || count * 4 > len, ERR_INVALID_DATA);
  445. PoolVector<int> data;
  446. if (count) {
  447. //const int*rbuf=(const int*)buf;
  448. data.resize(count);
  449. PoolVector<int>::Write w = data.write();
  450. for (int32_t i = 0; i < count; i++) {
  451. w[i] = decode_uint32(&buf[i * 4]);
  452. }
  453. w = PoolVector<int>::Write();
  454. }
  455. r_variant = Variant(data);
  456. if (r_len) {
  457. (*r_len) += 4 + count * sizeof(int);
  458. }
  459. } break;
  460. case Variant::POOL_REAL_ARRAY: {
  461. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  462. int32_t count = decode_uint32(buf);
  463. buf += 4;
  464. len -= 4;
  465. ERR_FAIL_MUL_OF(count, 4, ERR_INVALID_DATA);
  466. ERR_FAIL_COND_V(count < 0 || count * 4 > len, ERR_INVALID_DATA);
  467. PoolVector<float> data;
  468. if (count) {
  469. //const float*rbuf=(const float*)buf;
  470. data.resize(count);
  471. PoolVector<float>::Write w = data.write();
  472. for (int32_t i = 0; i < count; i++) {
  473. w[i] = decode_float(&buf[i * 4]);
  474. }
  475. w = PoolVector<float>::Write();
  476. }
  477. r_variant = data;
  478. if (r_len) {
  479. (*r_len) += 4 + count * sizeof(float);
  480. }
  481. } break;
  482. case Variant::POOL_STRING_ARRAY: {
  483. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  484. int32_t count = decode_uint32(buf);
  485. PoolVector<String> strings;
  486. buf += 4;
  487. len -= 4;
  488. if (r_len)
  489. (*r_len) += 4;
  490. //printf("string count: %i\n",count);
  491. for (int32_t i = 0; i < count; i++) {
  492. String str;
  493. Error err = _decode_string(buf, len, r_len, str);
  494. if (err)
  495. return err;
  496. strings.push_back(str);
  497. }
  498. r_variant = strings;
  499. } break;
  500. case Variant::POOL_VECTOR2_ARRAY: {
  501. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  502. int32_t count = decode_uint32(buf);
  503. buf += 4;
  504. len -= 4;
  505. ERR_FAIL_MUL_OF(count, 4 * 2, ERR_INVALID_DATA);
  506. ERR_FAIL_COND_V(count < 0 || count * 4 * 2 > len, ERR_INVALID_DATA);
  507. PoolVector<Vector2> varray;
  508. if (r_len) {
  509. (*r_len) += 4;
  510. }
  511. if (count) {
  512. varray.resize(count);
  513. PoolVector<Vector2>::Write w = varray.write();
  514. for (int32_t i = 0; i < count; i++) {
  515. w[i].x = decode_float(buf + i * 4 * 2 + 4 * 0);
  516. w[i].y = decode_float(buf + i * 4 * 2 + 4 * 1);
  517. }
  518. int adv = 4 * 2 * count;
  519. if (r_len)
  520. (*r_len) += adv;
  521. len -= adv;
  522. buf += adv;
  523. }
  524. r_variant = varray;
  525. } break;
  526. case Variant::POOL_VECTOR3_ARRAY: {
  527. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  528. int32_t count = decode_uint32(buf);
  529. buf += 4;
  530. len -= 4;
  531. ERR_FAIL_MUL_OF(count, 4 * 3, ERR_INVALID_DATA);
  532. ERR_FAIL_COND_V(count < 0 || count * 4 * 3 > len, ERR_INVALID_DATA);
  533. PoolVector<Vector3> varray;
  534. if (r_len) {
  535. (*r_len) += 4;
  536. }
  537. if (count) {
  538. varray.resize(count);
  539. PoolVector<Vector3>::Write w = varray.write();
  540. for (int32_t i = 0; i < count; i++) {
  541. w[i].x = decode_float(buf + i * 4 * 3 + 4 * 0);
  542. w[i].y = decode_float(buf + i * 4 * 3 + 4 * 1);
  543. w[i].z = decode_float(buf + i * 4 * 3 + 4 * 2);
  544. }
  545. int adv = 4 * 3 * count;
  546. if (r_len)
  547. (*r_len) += adv;
  548. len -= adv;
  549. buf += adv;
  550. }
  551. r_variant = varray;
  552. } break;
  553. case Variant::POOL_COLOR_ARRAY: {
  554. ERR_FAIL_COND_V(len < 4, ERR_INVALID_DATA);
  555. int32_t count = decode_uint32(buf);
  556. buf += 4;
  557. len -= 4;
  558. ERR_FAIL_MUL_OF(count, 4 * 4, ERR_INVALID_DATA);
  559. ERR_FAIL_COND_V(count < 0 || count * 4 * 4 > len, ERR_INVALID_DATA);
  560. PoolVector<Color> carray;
  561. if (r_len) {
  562. (*r_len) += 4;
  563. }
  564. if (count) {
  565. carray.resize(count);
  566. PoolVector<Color>::Write w = carray.write();
  567. for (int32_t i = 0; i < count; i++) {
  568. w[i].r = decode_float(buf + i * 4 * 4 + 4 * 0);
  569. w[i].g = decode_float(buf + i * 4 * 4 + 4 * 1);
  570. w[i].b = decode_float(buf + i * 4 * 4 + 4 * 2);
  571. w[i].a = decode_float(buf + i * 4 * 4 + 4 * 3);
  572. }
  573. int adv = 4 * 4 * count;
  574. if (r_len)
  575. (*r_len) += adv;
  576. len -= adv;
  577. buf += adv;
  578. }
  579. r_variant = carray;
  580. } break;
  581. default: { ERR_FAIL_V(ERR_BUG); }
  582. }
  583. return OK;
  584. }
  585. static void _encode_string(const String &p_string, uint8_t *&buf, int &r_len) {
  586. CharString utf8 = p_string.utf8();
  587. if (buf) {
  588. encode_uint32(utf8.length(), buf);
  589. buf += 4;
  590. copymem(buf, utf8.get_data(), utf8.length());
  591. buf += utf8.length();
  592. }
  593. r_len += 4 + utf8.length();
  594. while (r_len % 4) {
  595. r_len++; //pad
  596. if (buf) {
  597. *(buf++) = 0;
  598. }
  599. }
  600. }
  601. Error encode_variant(const Variant &p_variant, uint8_t *r_buffer, int &r_len, bool p_object_as_id) {
  602. uint8_t *buf = r_buffer;
  603. r_len = 0;
  604. uint32_t flags = 0;
  605. switch (p_variant.get_type()) {
  606. case Variant::INT: {
  607. int64_t val = p_variant;
  608. if (val > 0x7FFFFFFF || val < -0x80000000) {
  609. flags |= ENCODE_FLAG_64;
  610. }
  611. } break;
  612. case Variant::REAL: {
  613. double d = p_variant;
  614. float f = d;
  615. if (double(f) != d) {
  616. flags |= ENCODE_FLAG_64; //always encode real as double
  617. }
  618. } break;
  619. case Variant::OBJECT: {
  620. if (p_object_as_id) {
  621. flags |= ENCODE_FLAG_OBJECT_AS_ID;
  622. }
  623. } break;
  624. }
  625. if (buf) {
  626. encode_uint32(p_variant.get_type() | flags, buf);
  627. buf += 4;
  628. }
  629. r_len += 4;
  630. switch (p_variant.get_type()) {
  631. case Variant::NIL: {
  632. //nothing to do
  633. } break;
  634. case Variant::BOOL: {
  635. if (buf) {
  636. encode_uint32(p_variant.operator bool(), buf);
  637. }
  638. r_len += 4;
  639. } break;
  640. case Variant::INT: {
  641. int64_t val = p_variant;
  642. if (val > 0x7FFFFFFF || val < -0x80000000) {
  643. //64 bits
  644. if (buf) {
  645. encode_uint64(val, buf);
  646. }
  647. r_len += 8;
  648. } else {
  649. if (buf) {
  650. encode_uint32(int32_t(val), buf);
  651. }
  652. r_len += 4;
  653. }
  654. } break;
  655. case Variant::REAL: {
  656. double d = p_variant;
  657. float f = d;
  658. if (double(f) != d) {
  659. if (buf) {
  660. encode_double(p_variant.operator double(), buf);
  661. }
  662. r_len += 8;
  663. } else {
  664. if (buf) {
  665. encode_float(p_variant.operator float(), buf);
  666. }
  667. r_len += 4;
  668. }
  669. } break;
  670. case Variant::NODE_PATH: {
  671. NodePath np = p_variant;
  672. if (buf) {
  673. encode_uint32(uint32_t(np.get_name_count()) | 0x80000000, buf); //for compatibility with the old format
  674. encode_uint32(np.get_subname_count(), buf + 4);
  675. uint32_t flags = 0;
  676. if (np.is_absolute())
  677. flags |= 1;
  678. encode_uint32(flags, buf + 8);
  679. buf += 12;
  680. }
  681. r_len += 12;
  682. int total = np.get_name_count() + np.get_subname_count();
  683. for (int i = 0; i < total; i++) {
  684. String str;
  685. if (i < np.get_name_count())
  686. str = np.get_name(i);
  687. else
  688. str = np.get_subname(i - np.get_name_count());
  689. CharString utf8 = str.utf8();
  690. int pad = 0;
  691. if (utf8.length() % 4)
  692. pad = 4 - utf8.length() % 4;
  693. if (buf) {
  694. encode_uint32(utf8.length(), buf);
  695. buf += 4;
  696. copymem(buf, utf8.get_data(), utf8.length());
  697. buf += pad + utf8.length();
  698. }
  699. r_len += 4 + utf8.length() + pad;
  700. }
  701. } break;
  702. case Variant::STRING: {
  703. _encode_string(p_variant, buf, r_len);
  704. } break;
  705. // math types
  706. case Variant::VECTOR2: {
  707. if (buf) {
  708. Vector2 v2 = p_variant;
  709. encode_float(v2.x, &buf[0]);
  710. encode_float(v2.y, &buf[4]);
  711. }
  712. r_len += 2 * 4;
  713. } break; // 5
  714. case Variant::RECT2: {
  715. if (buf) {
  716. Rect2 r2 = p_variant;
  717. encode_float(r2.position.x, &buf[0]);
  718. encode_float(r2.position.y, &buf[4]);
  719. encode_float(r2.size.x, &buf[8]);
  720. encode_float(r2.size.y, &buf[12]);
  721. }
  722. r_len += 4 * 4;
  723. } break;
  724. case Variant::VECTOR3: {
  725. if (buf) {
  726. Vector3 v3 = p_variant;
  727. encode_float(v3.x, &buf[0]);
  728. encode_float(v3.y, &buf[4]);
  729. encode_float(v3.z, &buf[8]);
  730. }
  731. r_len += 3 * 4;
  732. } break;
  733. case Variant::TRANSFORM2D: {
  734. if (buf) {
  735. Transform2D val = p_variant;
  736. for (int i = 0; i < 3; i++) {
  737. for (int j = 0; j < 2; j++) {
  738. copymem(&buf[(i * 2 + j) * 4], &val.elements[i][j], sizeof(float));
  739. }
  740. }
  741. }
  742. r_len += 6 * 4;
  743. } break;
  744. case Variant::PLANE: {
  745. if (buf) {
  746. Plane p = p_variant;
  747. encode_float(p.normal.x, &buf[0]);
  748. encode_float(p.normal.y, &buf[4]);
  749. encode_float(p.normal.z, &buf[8]);
  750. encode_float(p.d, &buf[12]);
  751. }
  752. r_len += 4 * 4;
  753. } break;
  754. case Variant::QUAT: {
  755. if (buf) {
  756. Quat q = p_variant;
  757. encode_float(q.x, &buf[0]);
  758. encode_float(q.y, &buf[4]);
  759. encode_float(q.z, &buf[8]);
  760. encode_float(q.w, &buf[12]);
  761. }
  762. r_len += 4 * 4;
  763. } break;
  764. case Variant::AABB: {
  765. if (buf) {
  766. AABB aabb = p_variant;
  767. encode_float(aabb.position.x, &buf[0]);
  768. encode_float(aabb.position.y, &buf[4]);
  769. encode_float(aabb.position.z, &buf[8]);
  770. encode_float(aabb.size.x, &buf[12]);
  771. encode_float(aabb.size.y, &buf[16]);
  772. encode_float(aabb.size.z, &buf[20]);
  773. }
  774. r_len += 6 * 4;
  775. } break;
  776. case Variant::BASIS: {
  777. if (buf) {
  778. Basis val = p_variant;
  779. for (int i = 0; i < 3; i++) {
  780. for (int j = 0; j < 3; j++) {
  781. copymem(&buf[(i * 3 + j) * 4], &val.elements[i][j], sizeof(float));
  782. }
  783. }
  784. }
  785. r_len += 9 * 4;
  786. } break;
  787. case Variant::TRANSFORM: {
  788. if (buf) {
  789. Transform val = p_variant;
  790. for (int i = 0; i < 3; i++) {
  791. for (int j = 0; j < 3; j++) {
  792. copymem(&buf[(i * 3 + j) * 4], &val.basis.elements[i][j], sizeof(float));
  793. }
  794. }
  795. encode_float(val.origin.x, &buf[36]);
  796. encode_float(val.origin.y, &buf[40]);
  797. encode_float(val.origin.z, &buf[44]);
  798. }
  799. r_len += 12 * 4;
  800. } break;
  801. // misc types
  802. case Variant::COLOR: {
  803. if (buf) {
  804. Color c = p_variant;
  805. encode_float(c.r, &buf[0]);
  806. encode_float(c.g, &buf[4]);
  807. encode_float(c.b, &buf[8]);
  808. encode_float(c.a, &buf[12]);
  809. }
  810. r_len += 4 * 4;
  811. } break;
  812. /*case Variant::RESOURCE: {
  813. ERR_EXPLAIN("Can't marshallize resources");
  814. ERR_FAIL_V(ERR_INVALID_DATA); //no, i'm sorry, no go
  815. } break;*/
  816. case Variant::_RID: {
  817. } break;
  818. case Variant::OBJECT: {
  819. if (p_object_as_id) {
  820. if (buf) {
  821. Object *obj = p_variant;
  822. ObjectID id = 0;
  823. if (obj && ObjectDB::instance_validate(obj)) {
  824. id = obj->get_instance_id();
  825. }
  826. encode_uint64(id, buf);
  827. }
  828. r_len += 8;
  829. } else {
  830. Object *obj = p_variant;
  831. if (!obj) {
  832. if (buf) {
  833. encode_uint32(0, buf);
  834. buf += 4;
  835. }
  836. r_len += 4;
  837. } else {
  838. _encode_string(obj->get_class(), buf, r_len);
  839. List<PropertyInfo> props;
  840. obj->get_property_list(&props);
  841. int pc = 0;
  842. for (List<PropertyInfo>::Element *E = props.front(); E; E = E->next()) {
  843. if (!(E->get().usage & PROPERTY_USAGE_STORAGE))
  844. continue;
  845. pc++;
  846. }
  847. if (buf) {
  848. encode_uint32(pc, buf);
  849. buf += 4;
  850. }
  851. r_len += 4;
  852. for (List<PropertyInfo>::Element *E = props.front(); E; E = E->next()) {
  853. if (!(E->get().usage & PROPERTY_USAGE_STORAGE))
  854. continue;
  855. _encode_string(E->get().name, buf, r_len);
  856. int len;
  857. Error err = encode_variant(obj->get(E->get().name), buf, len, p_object_as_id);
  858. if (err)
  859. return err;
  860. ERR_FAIL_COND_V(len % 4, ERR_BUG);
  861. r_len += len;
  862. if (buf)
  863. buf += len;
  864. }
  865. }
  866. }
  867. } break;
  868. case Variant::DICTIONARY: {
  869. Dictionary d = p_variant;
  870. if (buf) {
  871. encode_uint32(uint32_t(d.size()), buf);
  872. buf += 4;
  873. }
  874. r_len += 4;
  875. List<Variant> keys;
  876. d.get_key_list(&keys);
  877. for (List<Variant>::Element *E = keys.front(); E; E = E->next()) {
  878. /*
  879. CharString utf8 = E->->utf8();
  880. if (buf) {
  881. encode_uint32(utf8.length()+1,buf);
  882. buf+=4;
  883. copymem(buf,utf8.get_data(),utf8.length()+1);
  884. }
  885. r_len+=4+utf8.length()+1;
  886. while (r_len%4)
  887. r_len++; //pad
  888. */
  889. int len;
  890. encode_variant(E->get(), buf, len, p_object_as_id);
  891. ERR_FAIL_COND_V(len % 4, ERR_BUG);
  892. r_len += len;
  893. if (buf)
  894. buf += len;
  895. encode_variant(d[E->get()], buf, len, p_object_as_id);
  896. ERR_FAIL_COND_V(len % 4, ERR_BUG);
  897. r_len += len;
  898. if (buf)
  899. buf += len;
  900. }
  901. } break;
  902. case Variant::ARRAY: {
  903. Array v = p_variant;
  904. if (buf) {
  905. encode_uint32(uint32_t(v.size()), buf);
  906. buf += 4;
  907. }
  908. r_len += 4;
  909. for (int i = 0; i < v.size(); i++) {
  910. int len;
  911. encode_variant(v.get(i), buf, len, p_object_as_id);
  912. ERR_FAIL_COND_V(len % 4, ERR_BUG);
  913. r_len += len;
  914. if (buf)
  915. buf += len;
  916. }
  917. } break;
  918. // arrays
  919. case Variant::POOL_BYTE_ARRAY: {
  920. PoolVector<uint8_t> data = p_variant;
  921. int datalen = data.size();
  922. int datasize = sizeof(uint8_t);
  923. if (buf) {
  924. encode_uint32(datalen, buf);
  925. buf += 4;
  926. PoolVector<uint8_t>::Read r = data.read();
  927. copymem(buf, &r[0], datalen * datasize);
  928. }
  929. r_len += 4 + datalen * datasize;
  930. while (r_len % 4)
  931. r_len++;
  932. } break;
  933. case Variant::POOL_INT_ARRAY: {
  934. PoolVector<int> data = p_variant;
  935. int datalen = data.size();
  936. int datasize = sizeof(int32_t);
  937. if (buf) {
  938. encode_uint32(datalen, buf);
  939. buf += 4;
  940. PoolVector<int>::Read r = data.read();
  941. for (int i = 0; i < datalen; i++)
  942. encode_uint32(r[i], &buf[i * datasize]);
  943. }
  944. r_len += 4 + datalen * datasize;
  945. } break;
  946. case Variant::POOL_REAL_ARRAY: {
  947. PoolVector<real_t> data = p_variant;
  948. int datalen = data.size();
  949. int datasize = sizeof(real_t);
  950. if (buf) {
  951. encode_uint32(datalen, buf);
  952. buf += 4;
  953. PoolVector<real_t>::Read r = data.read();
  954. for (int i = 0; i < datalen; i++)
  955. encode_float(r[i], &buf[i * datasize]);
  956. }
  957. r_len += 4 + datalen * datasize;
  958. } break;
  959. case Variant::POOL_STRING_ARRAY: {
  960. PoolVector<String> data = p_variant;
  961. int len = data.size();
  962. if (buf) {
  963. encode_uint32(len, buf);
  964. buf += 4;
  965. }
  966. r_len += 4;
  967. for (int i = 0; i < len; i++) {
  968. CharString utf8 = data.get(i).utf8();
  969. if (buf) {
  970. encode_uint32(utf8.length() + 1, buf);
  971. buf += 4;
  972. copymem(buf, utf8.get_data(), utf8.length() + 1);
  973. buf += utf8.length() + 1;
  974. }
  975. r_len += 4 + utf8.length() + 1;
  976. while (r_len % 4) {
  977. r_len++; //pad
  978. if (buf)
  979. *(buf++) = 0;
  980. }
  981. }
  982. } break;
  983. case Variant::POOL_VECTOR2_ARRAY: {
  984. PoolVector<Vector2> data = p_variant;
  985. int len = data.size();
  986. if (buf) {
  987. encode_uint32(len, buf);
  988. buf += 4;
  989. }
  990. r_len += 4;
  991. if (buf) {
  992. for (int i = 0; i < len; i++) {
  993. Vector2 v = data.get(i);
  994. encode_float(v.x, &buf[0]);
  995. encode_float(v.y, &buf[4]);
  996. buf += 4 * 2;
  997. }
  998. }
  999. r_len += 4 * 2 * len;
  1000. } break;
  1001. case Variant::POOL_VECTOR3_ARRAY: {
  1002. PoolVector<Vector3> data = p_variant;
  1003. int len = data.size();
  1004. if (buf) {
  1005. encode_uint32(len, buf);
  1006. buf += 4;
  1007. }
  1008. r_len += 4;
  1009. if (buf) {
  1010. for (int i = 0; i < len; i++) {
  1011. Vector3 v = data.get(i);
  1012. encode_float(v.x, &buf[0]);
  1013. encode_float(v.y, &buf[4]);
  1014. encode_float(v.z, &buf[8]);
  1015. buf += 4 * 3;
  1016. }
  1017. }
  1018. r_len += 4 * 3 * len;
  1019. } break;
  1020. case Variant::POOL_COLOR_ARRAY: {
  1021. PoolVector<Color> data = p_variant;
  1022. int len = data.size();
  1023. if (buf) {
  1024. encode_uint32(len, buf);
  1025. buf += 4;
  1026. }
  1027. r_len += 4;
  1028. if (buf) {
  1029. for (int i = 0; i < len; i++) {
  1030. Color c = data.get(i);
  1031. encode_float(c.r, &buf[0]);
  1032. encode_float(c.g, &buf[4]);
  1033. encode_float(c.b, &buf[8]);
  1034. encode_float(c.a, &buf[12]);
  1035. buf += 4 * 4;
  1036. }
  1037. }
  1038. r_len += 4 * 4 * len;
  1039. } break;
  1040. default: { ERR_FAIL_V(ERR_BUG); }
  1041. }
  1042. return OK;
  1043. }