(debug, trans, col=carla.Color(255, 0, 0), lt=-1)
| 38 | |
| 39 | |
| 40 | def draw_transform(debug, trans, col=carla.Color(255, 0, 0), lt=-1): |
| 41 | yaw_in_rad = math.radians(trans.rotation.yaw) |
| 42 | pitch_in_rad = math.radians(trans.rotation.pitch) |
| 43 | p1 = carla.Location( |
| 44 | x=trans.location.x + math.cos(pitch_in_rad) * math.cos(yaw_in_rad), |
| 45 | y=trans.location.y + math.cos(pitch_in_rad) * math.sin(yaw_in_rad), |
| 46 | z=trans.location.z + math.sin(pitch_in_rad)) |
| 47 | debug.draw_arrow(trans.location, p1, thickness=0.05, arrow_size=0.1, color=col, life_time=lt) |
| 48 | |
| 49 | |
| 50 | def draw_waypoint_union(debug, w0, w1, color=carla.Color(255, 0, 0), lt=5): |
no test coverage detected