s1-行驶-去e点 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152
  1. 车开到n2位置,车头朝向倒渣口(事先需要联系师傅,将n20的包对上,我们需要记录一下包的位置信息)
  2. 凯强 122.755687 210.019149 -1.570920
  3. n.20 122.8439634 198.54541533333332
  4. mqtt当前位置: 'position_x': 24.480705865127597, 'position_y': 202.35537350570837
  5. "navigation": [
  6. {
  7. 'type': 'forward',
  8. 'nav_coordinates': [
  9. {
  10. 'start_point_x': 24.4807, # 当前n2位置
  11. 'start_point_y': 202.35537350570837, # 当前n2位置
  12. 'end_point_x': 18.618844,
  13. 'end_point_y': 200.67567
  14. },
  15. {
  16. 'start_point_x': 18.618844,
  17. 'start_point_y': 200.67567,
  18. 'center_point_x': 18.306224428571426,
  19. 'center_point_y': 186.9142662857143,
  20. 'end_point_x': 17.993604857142852,
  21. 'end_point_y': 173.15286257142859
  22. },
  23. {
  24. 'start_point_x': 17.993604857142852,
  25. 'start_point_y': 173.15286257142859,
  26. 'end_point_x': 182.6588877142857,
  27. 'end_point_y': 169.8418064285714
  28. },
  29. {
  30. 'start_point_x': 182.6588877142857,
  31. 'start_point_y': 169.8418064285714,
  32. 'center_point_x': 182.92185485714285,
  33. 'center_point_y': 183.5769582142857,
  34. 'end_point_x': 183.184822,
  35. 'end_point_y': 197.31211
  36. },
  37. {
  38. 'start_point_x': 183.184822,
  39. 'start_point_y': 197.31211,
  40. # e点位置
  41. 'end_point_x': 122.8439634 - 50, # e点需要往前开50
  42. 'end_point_y': 198.54541533333332
  43. }
  44. ]
  45. }
  46. ]