4*4矩阵转换成二维平面坐标

x33g5p2x  于2022-07-14 转载在 其他  
字(11.3k)|赞(0)|评价(0)|浏览(779)

一、需求:基于苹果数据4*4矩阵数据,转换成二维平面坐标系

二、解决方法与步骤:

用到的方法:

1、Matrix4的转化_Catirl的博客-CSDN博客

2、平面内直角坐标系中坐标旋转变换公式_Eric_Wangyz的博客-CSDN博客_坐标旋转变换公式

苹果数据效果:

  1. {
  2. "windows" : [
  3. {
  4. "category" : {
  5. "window" : {
  6. }
  7. },
  8. "confidence" : {
  9. "medium" : {
  10. }
  11. },
  12. "dimensions" : [
  13. 4.4304699897766113,
  14. 2.4727039337158203,
  15. 0
  16. ],
  17. "completedEdges" : [
  18. ],
  19. "parentIdentifier" : "B4002F3F-2741-405F-9A82-18FF65284C8C",
  20. "identifier" : "70ABA8D4-0AA8-4404-940E-04309F358EBC",
  21. "curve" : null,
  22. "transform" : [
  23. -0.30633658170700073,
  24. 0,
  25. -0.95192313194274902,
  26. 0,
  27. 0,
  28. 0.99999994039535522,
  29. 0,
  30. 0,
  31. 0.9519231915473938,
  32. 0,
  33. -0.30633658170700073,
  34. 0,
  35. -3.3060400485992432,
  36. -0.20823472738265991,
  37. 2.7119290828704834,
  38. 1
  39. ]
  40. }
  41. ],
  42. "doors" : [
  43. {
  44. "category" : {
  45. "door" : {
  46. "isOpen" : false
  47. }
  48. },
  49. "confidence" : {
  50. "medium" : {
  51. }
  52. },
  53. "dimensions" : [
  54. 1.0301132202148438,
  55. 2.5737776756286621,
  56. 0
  57. ],
  58. "completedEdges" : [
  59. ],
  60. "parentIdentifier" : "CC22237C-B6ED-44B5-8547-180A3A0E5994",
  61. "identifier" : "B19AD43B-3C4D-4DA5-A5C0-34A1D39F5892",
  62. "curve" : null,
  63. "transform" : [
  64. 0.3063366711139679,
  65. 0,
  66. 0.95192307233810425,
  67. 0,
  68. 0,
  69. 1,
  70. 0,
  71. 0,
  72. -0.95192307233810425,
  73. 0,
  74. 0.3063366711139679,
  75. 0,
  76. 0.90193623304367065,
  77. -0.24133116006851196,
  78. -0.033205278217792511,
  79. 1
  80. ]
  81. },
  82. {
  83. "category" : {
  84. "door" : {
  85. "isOpen" : false
  86. }
  87. },
  88. "confidence" : {
  89. "medium" : {
  90. }
  91. },
  92. "dimensions" : [
  93. 1.0522669553756714,
  94. 2.411841869354248,
  95. 0
  96. ],
  97. "completedEdges" : [
  98. ],
  99. "parentIdentifier" : "CC22237C-B6ED-44B5-8547-180A3A0E5994",
  100. "identifier" : "8095E4C9-2986-446E-9FC9-D92225777FBC",
  101. "curve" : null,
  102. "transform" : [
  103. 0.30633670091629028,
  104. 0,
  105. 0.95192313194274902,
  106. 0,
  107. 0,
  108. 0.99999994039535522,
  109. 0,
  110. 0,
  111. -0.95192307233810425,
  112. 0,
  113. 0.3063366711139679,
  114. 0,
  115. 1.2751809358596802,
  116. -0.2488710880279541,
  117. 1.1266312599182129,
  118. 1
  119. ]
  120. },
  121. {
  122. "category" : {
  123. "door" : {
  124. "isOpen" : true
  125. }
  126. },
  127. "confidence" : {
  128. "medium" : {
  129. }
  130. },
  131. "dimensions" : [
  132. 0.79290330410003662,
  133. 2.3365452289581299,
  134. 0
  135. ],
  136. "completedEdges" : [
  137. ],
  138. "parentIdentifier" : "CC22237C-B6ED-44B5-8547-180A3A0E5994",
  139. "identifier" : "717D86E1-F273-4577-85DF-E03B933D6188",
  140. "curve" : null,
  141. "transform" : [
  142. 0.30633661150932312,
  143. 0,
  144. 0.95192325115203857,
  145. 0,
  146. 0,
  147. 1,
  148. 0,
  149. 0,
  150. -0.95192325115203857,
  151. 0,
  152. 0.30633661150932312,
  153. 0,
  154. 0.5105128288269043,
  155. -0.35994744300842285,
  156. -1.249530553817749,
  157. 1
  158. ]
  159. }
  160. ],
  161. "walls" : [
  162. {
  163. "category" : {
  164. "wall" : {
  165. }
  166. },
  167. "confidence" : {
  168. "high" : {
  169. }
  170. },
  171. "dimensions" : [
  172. 5.6710019111633301,
  173. 2.9569838047027588,
  174. 0
  175. ],
  176. "completedEdges" : [
  177. ],
  178. "parentIdentifier" : "8D161454-7233-4E76-BC11-3E3186A8B6D6",
  179. "identifier" : "B4002F3F-2741-405F-9A82-18FF65284C8C",
  180. "curve" : null,
  181. "transform" : [
  182. -0.30633664131164551,
  183. 0,
  184. -0.9519231915473938,
  185. 0,
  186. 0,
  187. 0.99999994039535522,
  188. 0,
  189. 0,
  190. 0.95192313194274902,
  191. 0,
  192. -0.30633658170700073,
  193. 0,
  194. -3.4495170116424561,
  195. -0.049728155136108398,
  196. 2.2660825252532959,
  197. 1
  198. ]
  199. },
  200. {
  201. "category" : {
  202. "wall" : {
  203. }
  204. },
  205. "confidence" : {
  206. "high" : {
  207. }
  208. },
  209. "dimensions" : [
  210. 4.8466057777404785,
  211. 2.9569838047027588,
  212. 0
  213. ],
  214. "completedEdges" : [
  215. ],
  216. "parentIdentifier" : "5ADD04DA-13E7-4010-B381-D3307FFD5E46",
  217. "identifier" : "F4BCF245-4442-422E-9894-177078F54AE0",
  218. "curve" : null,
  219. "transform" : [
  220. 0.9519231915473938,
  221. 0,
  222. -0.30633658170700073,
  223. 0,
  224. 0,
  225. 0.99999994039535522,
  226. 0,
  227. 0,
  228. 0.30633652210235596,
  229. 0,
  230. 0.95192307233810425,
  231. 0,
  232. -2.0113365650177002,
  233. -0.049728155136108398,
  234. -1.1754434108734131,
  235. 1
  236. ]
  237. },
  238. {
  239. "category" : {
  240. "wall" : {
  241. }
  242. },
  243. "confidence" : {
  244. "high" : {
  245. }
  246. },
  247. "dimensions" : [
  248. 4.1486597061157227,
  249. 2.9569838047027588,
  250. 0
  251. ],
  252. "completedEdges" : [
  253. ],
  254. "parentIdentifier" : "25A96F47-C12D-4EFE-B971-472089DF4594",
  255. "identifier" : "4AD4A1DE-4257-49F2-B788-EAEE5223107C",
  256. "curve" : null,
  257. "transform" : [
  258. -0.9519231915473938,
  259. 0,
  260. 0.30633658170700073,
  261. 0,
  262. 0,
  263. 0.99999994039535522,
  264. 0,
  265. 0,
  266. -0.30633652210235596,
  267. 0,
  268. -0.95192307233810425,
  269. 0,
  270. 0.18788377940654755,
  271. -0.049728155136108398,
  272. 4.5193233489990234,
  273. 1
  274. ]
  275. },
  276. {
  277. "category" : {
  278. "wall" : {
  279. }
  280. },
  281. "confidence" : {
  282. "high" : {
  283. }
  284. },
  285. "dimensions" : [
  286. 0.69794571399688721,
  287. 2.9569838047027588,
  288. 0
  289. ],
  290. "completedEdges" : [
  291. ],
  292. "parentIdentifier" : "44C4678D-23CB-4C12-B6C4-762CB0452E60",
  293. "identifier" : "74CA573A-F192-47E2-A262-EEF9CAF44E7E",
  294. "curve" : null,
  295. "transform" : [
  296. -0.95192313194274902,
  297. 0,
  298. 0.30633693933486938,
  299. 0,
  300. 0,
  301. 0.99999994039535522,
  302. 0,
  303. 0,
  304. -0.306336909532547,
  305. 0,
  306. -0.95192307233810425,
  307. 0,
  308. -2.2487037181854248,
  309. -0.049728155136108398,
  310. 4.8583579063415527,
  311. 1
  312. ]
  313. },
  314. {
  315. "category" : {
  316. "wall" : {
  317. }
  318. },
  319. "confidence" : {
  320. "high" : {
  321. }
  322. },
  323. "dimensions" : [
  324. 0.4236811101436615,
  325. 2.9569838047027588,
  326. 0
  327. ],
  328. "completedEdges" : [
  329. ],
  330. "parentIdentifier" : "D510898F-31C8-4986-8A1C-9EE75CC68D91",
  331. "identifier" : "4912B095-361F-4914-8F1A-FB2F9A0C3C94",
  332. "curve" : null,
  333. "transform" : [
  334. -0.30633756518363953,
  335. 0,
  336. -0.95192277431488037,
  337. 0,
  338. 0,
  339. 0.99999994039535522,
  340. 0,
  341. 0,
  342. 0.95192277431488037,
  343. 0,
  344. -0.30633756518363953,
  345. 0,
  346. -1.8516137599945068,
  347. -0.049728155136108398,
  348. 4.9531106948852539,
  349. 1
  350. ]
  351. },
  352. {
  353. "category" : {
  354. "wall" : {
  355. }
  356. },
  357. "confidence" : {
  358. "high" : {
  359. }
  360. },
  361. "dimensions" : [
  362. 6.0946831703186035,
  363. 2.9569838047027588,
  364. 0
  365. ],
  366. "completedEdges" : [
  367. ],
  368. "parentIdentifier" : "34D0C39D-D4D7-48B4-9DE0-7ACD7E6EFBB9",
  369. "identifier" : "CC22237C-B6ED-44B5-8547-180A3A0E5994",
  370. "curve" : null,
  371. "transform" : [
  372. 0.30633670091629028,
  373. 0,
  374. 0.9519231915473938,
  375. 0,
  376. 0,
  377. 0.99999994039535522,
  378. 0,
  379. 0,
  380. -0.95192313194274902,
  381. 0,
  382. 0.30633664131164551,
  383. 0,
  384. 1.2289738655090332,
  385. -0.049728155136108398,
  386. 0.98304539918899536,
  387. 1
  388. ]
  389. }
  390. ],
  391. "openings" : [
  392. ],
  393. "objects" : [
  394. {
  395. "dimensions" : [
  396. 1.5987249612808228,
  397. 0.94955956935882568,
  398. 0.065000005066394806
  399. ],
  400. "confidence" : {
  401. "medium" : {
  402. }
  403. },
  404. "transform" : [
  405. 0.95192325115203857,
  406. 0,
  407. -0.30633643269538879,
  408. 0,
  409. 0,
  410. 0.99999994039535522,
  411. 0,
  412. 0,
  413. 0.30633637309074402,
  414. 0,
  415. 0.9519231915473938,
  416. 0,
  417. -1.6764084100723267,
  418. -0.001988828182220459,
  419. -0.99941855669021606,
  420. 1
  421. ],
  422. "category" : {
  423. "television" : {
  424. }
  425. },
  426. "identifier" : "C3BEB09E-7408-42CE-8954-E87B355B4299"
  427. },
  428. {
  429. "dimensions" : [
  430. 0.51159495115280151,
  431. 1.0113105773925781,
  432. 0.56274306774139404
  433. ],
  434. "confidence" : {
  435. "medium" : {
  436. }
  437. },
  438. "transform" : [
  439. -0.95192283391952515,
  440. 0,
  441. 0.30633756518363953,
  442. 0,
  443. 0,
  444. 1,
  445. 0,
  446. 0,
  447. -0.30633753538131714,
  448. 0,
  449. -0.95192289352416992,
  450. 0,
  451. -0.40752917528152466,
  452. -1.0225648880004883,
  453. 3.9929168224334717,
  454. 1
  455. ],
  456. "category" : {
  457. "chair" : {
  458. }
  459. },
  460. "identifier" : "B8105472-71D6-417E-9E2C-F1155FB1F1F2"
  461. },
  462. {
  463. "dimensions" : [
  464. 0.4749830961227417,
  465. 0.40395355224609375,
  466. 0.57471352815628052
  467. ],
  468. "confidence" : {
  469. "medium" : {
  470. }
  471. },
  472. "transform" : [
  473. -0.95192235708236694,
  474. 0,
  475. 0.30633917450904846,
  476. 0,
  477. 0,
  478. 1.0000001192092896,
  479. 0,
  480. 0,
  481. -0.30633923411369324,
  482. 0,
  483. -0.95192247629165649,
  484. 0,
  485. -0.55003666877746582,
  486. -1.3262432813644409,
  487. 3.1927976608276367,
  488. 1
  489. ],
  490. "category" : {
  491. "chair" : {
  492. }
  493. },
  494. "identifier" : "2A7F638D-DAB2-4FAB-A4EA-FA0F9793390A"
  495. },
  496. {
  497. "dimensions" : [
  498. 0.47498306632041931,
  499. 0.40395355224609375,
  500. 0.57471358776092529
  501. ],
  502. "confidence" : {
  503. "medium" : {
  504. }
  505. },
  506. "transform" : [
  507. -0.30632853507995605,
  508. 0,
  509. -0.95192575454711914,
  510. 0,
  511. 0,
  512. 1.0000001192092896,
  513. 0,
  514. 0,
  515. 0.95192593336105347,
  516. 0,
  517. -0.30632859468460083,
  518. 0,
  519. -1.6257414817810059,
  520. -1.3262432813644409,
  521. 1.6771179437637329,
  522. 1
  523. ],
  524. "category" : {
  525. "chair" : {
  526. }
  527. },
  528. "identifier" : "0ED886B4-014C-47E9-B952-F868561FC3B0"
  529. },
  530. {
  531. "dimensions" : [
  532. 0.52009981870651245,
  533. 0.94679880142211914,
  534. 0.57890421152114868
  535. ],
  536. "confidence" : {
  537. "medium" : {
  538. }
  539. },
  540. "transform" : [
  541. 0.21847167611122131,
  542. 0,
  543. 0.97584319114685059,
  544. 0,
  545. 0,
  546. 0.99999988079071045,
  547. 0,
  548. 0,
  549. -0.97584307193756104,
  550. 0,
  551. 0.21847164630889893,
  552. 0,
  553. 1.4021255970001221,
  554. -1.0548207759857178,
  555. 2.5414259433746338,
  556. 1
  557. ],
  558. "category" : {
  559. "chair" : {
  560. }
  561. },
  562. "identifier" : "5A194FF7-5D66-4FFA-9379-4B801234BA3A"
  563. },
  564. {
  565. "dimensions" : [
  566. 3.7170906066894531,
  567. 0.83971703052520752,
  568. 1.2917746305465698
  569. ],
  570. "confidence" : {
  571. "high" : {
  572. }
  573. },
  574. "transform" : [
  575. 0.30633649230003357,
  576. 0,
  577. 0.9519231915473938,
  578. 0,
  579. 0,
  580. 1.0000001192092896,
  581. 0,
  582. 0,
  583. -0.95192337036132812,
  584. 0,
  585. 0.30633652210235596,
  586. 0,
  587. -1.0929687023162842,
  588. -1.1083616018295288,
  589. 1.5056676864624023,
  590. 1
  591. ],
  592. "category" : {
  593. "table" : {
  594. }
  595. },
  596. "identifier" : "2524B480-8A47-4ED7-BD97-0A9C6ACE8A95"
  597. },
  598. {
  599. "dimensions" : [
  600. 3.3376014232635498,
  601. 2.3581094741821289,
  602. 0.49721428751945496
  603. ],
  604. "confidence" : {
  605. "medium" : {
  606. }
  607. },
  608. "transform" : [
  609. -0.95192277431488037,
  610. 0,
  611. 0.30633765459060669,
  612. 0,
  613. 0,
  614. 1,
  615. 0,
  616. 0,
  617. -0.3063376247882843,
  618. 0,
  619. -0.95192277431488037,
  620. 0,
  621. -0.2743067741394043,
  622. -0.34916538000106812,
  623. 4.4068951606750488,
  624. 1
  625. ],
  626. "category" : {
  627. "storage" : {
  628. }
  629. },
  630. "identifier" : "52E23C35-59C5-404B-A46F-DBDB2A5BECCC"
  631. }
  632. ],
  633. "version" : 1
  634. }

1、4*4矩阵转成二维:基于四维矩阵中心点,求两端点坐标

  1. # 墙体信息
  2. for wall in json_data["walls"]:
  3. # 墙体中心坐标
  4. center_p = np.array([wall["transform"][-4], wall["transform"][-2]])
  5. length = wall["dimensions"][0]
  6. transform01 = abs(wall["transform"][10])
  7. if wall["transform"][10] < 0:
  8. transform02 = wall["transform"][8]
  9. else:
  10. transform02 = -wall["transform"][8]
  11. # 基于中心点与四维矩阵,获取起始点
  12. p1 = center_p + 0.5 * length * np.array([transform01, transform02])
  13. p2 = center_p - 0.5 * length * np.array([transform01, transform02])

2、平面坐标系转化

  1. cos = abs(json_data["walls"][0]["transform"][10])
  2. sin = -abs(json_data["walls"][0]["transform"][8])
  3. # # # 坐标翻转
  4. x1 = p1[0] * cos - p1[1] * sin
  5. y1 = p1[1] * cos + p1[0] * sin
  6. p1 = Point2D(int(round(x1 * 1000, 0)), int(round(y1 * 1000, 0)))
  7. x2 = p2[0] * cos - p2[1] * sin
  8. y2 = p2[1] * cos + p2[0] * sin
  9. p2 = Point2D(int(round(x2 * 1000, 0)), int(round(y2 * 1000, 0)))

3、整合代码:

  1. import json
  2. from sympy.geometry import *
  3. PATH = r"D:\Desktop\room74.json"
  4. f = open(PATH, 'rb')
  5. j = json.load(f)
  6. f.close()
  7. def get_start_end_point(center_p, length, transform01, transform02, cos, sin):
  8. # 基于中心点与四维矩阵,获取起始点
  9. p1 = center_p + 0.5 * length * np.array([transform01, transform02])
  10. p2 = center_p - 0.5 * length * np.array([transform01, transform02])
  11. # # # 坐标翻转
  12. x1 = p1[0] * cos - p1[1] * sin
  13. y1 = p1[1] * cos + p1[0] * sin
  14. p1 = Point2D(int(round(x1 * 1000, 0)), int(round(y1 * 1000, 0)))
  15. x2 = p2[0] * cos - p2[1] * sin
  16. y2 = p2[1] * cos + p2[0] * sin
  17. p2 = Point2D(int(round(x2 * 1000, 0)), int(round(y2 * 1000, 0)))
  18. return p1, p2
  19. def get_wall_points(json_data):
  20. # 获取墙所有的坐标点
  21. wall_p_list = []
  22. # 墙体信息
  23. cos = abs(json_data["walls"][0]["transform"][10])
  24. sin = -abs(json_data["walls"][0]["transform"][8])
  25. for wall in json_data["walls"]:
  26. # 墙体中心坐标
  27. center_p = np.array([wall["transform"][-4], wall["transform"][-2]])
  28. length = wall["dimensions"][0]
  29. transform01 = abs(wall["transform"][10])
  30. if wall["transform"][10] < 0:
  31. transform02 = wall["transform"][8]
  32. else:
  33. transform02 = -wall["transform"][8]
  34. p1, p2 = get_start_end_point(center_p, length, transform01, transform02, cos, sin)
  35. wall_p_list.extend([p1, p2])
  36. return wall_p_list
  37. # 获取墙所有的坐标点:
  38. wall_points_list = get_wall_points(json_data)
  39. print(wall_points_list )

4、结果:

  1. [[Point2D(760, -869), Point2D(-270, -869)], [Point2D(1989, -869), Point2D(937, -869)], [Point2D(-637, -869), Point2D(-1430, -869)]]

相关文章