车位角点检测代码
Ви не можете вибрати більше 25 тем Теми мають розпочинатися з літери або цифри, можуть містити дефіси (-) і не повинні перевищувати 35 символів.

85 lines
3.0KB

  1. """Collect the value range of different propertity of ps dataset."""
  2. import argparse
  3. import json
  4. import math
  5. import os
  6. import matplotlib.pyplot as plt
  7. import numpy as np
  8. from data import MarkingPoint
  9. from data.struct import calc_point_squre_dist, direction_diff
  10. from prepare_dataset import generalize_marks
  11. def get_parser():
  12. """Return argument parser for collecting thresholds."""
  13. parser = argparse.ArgumentParser()
  14. parser.add_argument('--label_directory', required=True,
  15. help="The location of label directory.")
  16. return parser
  17. def collect_thresholds(args):
  18. """Collect range of value from ground truth to determine threshold."""
  19. distances = []
  20. separator_angles = []
  21. bridge_angles = []
  22. for label_file in os.listdir(args.label_directory):
  23. print(label_file)
  24. with open(os.path.join(args.label_directory, label_file), 'r') as file:
  25. label = json.load(file)
  26. marks = np.array(label['marks'])
  27. slots = np.array(label['slots'])
  28. if slots.size == 0:
  29. continue
  30. if len(marks.shape) < 2:
  31. marks = np.expand_dims(marks, axis=0)
  32. if len(slots.shape) < 2:
  33. slots = np.expand_dims(slots, axis=0)
  34. marks[:, 0:4] -= 300.5
  35. marks = [MarkingPoint(*mark) for mark in generalize_marks(marks)]
  36. for slot in slots:
  37. mark_a = marks[slot[0] - 1]
  38. mark_b = marks[slot[1] - 1]
  39. distances.append(calc_point_squre_dist(mark_a, mark_b))
  40. vector_ab = np.array([mark_b.x - mark_a.x, mark_b.y - mark_a.y])
  41. vector_ab = vector_ab / np.linalg.norm(vector_ab)
  42. ab_bridge_direction = math.atan2(vector_ab[1], vector_ab[0])
  43. ba_bridge_direction = math.atan2(-vector_ab[1], -vector_ab[0])
  44. separator_direction = math.atan2(-vector_ab[0], vector_ab[1])
  45. sangle = direction_diff(separator_direction, mark_a.direction)
  46. if mark_a.shape > 0.5:
  47. separator_angles.append(sangle)
  48. else:
  49. bangle = direction_diff(ab_bridge_direction, mark_a.direction)
  50. if sangle < bangle:
  51. separator_angles.append(sangle)
  52. else:
  53. bridge_angles.append(bangle)
  54. bangle = direction_diff(ba_bridge_direction, mark_b.direction)
  55. if mark_b.shape > 0.5:
  56. bridge_angles.append(bangle)
  57. else:
  58. sangle = direction_diff(separator_direction, mark_b.direction)
  59. if sangle < bangle:
  60. separator_angles.append(sangle)
  61. else:
  62. bridge_angles.append(bangle)
  63. distances = sorted(distances)
  64. separator_angles = sorted(separator_angles)
  65. bridge_angles = sorted(bridge_angles)
  66. plt.figure()
  67. plt.hist(distances, len(distances) // 10)
  68. plt.figure()
  69. plt.hist(separator_angles, len(separator_angles) // 10)
  70. plt.figure()
  71. plt.hist(bridge_angles, len(bridge_angles) // 3)
  72. if __name__ == '__main__':
  73. collect_thresholds(get_parser().parse_args())