def rotate_points(points, rot):
    """
    Rotate 3D points given a provided rotation matrix
    """
    points_rot = points.transpose()
    points_rot = rot @ points_rot
    points_rot = points_rot.transpose()
    # print(f"Rotation Took {(time.time() - t0) * 1000:.1f} ms")
    return points_rot