def distance_2D(p1, p2):
    """
    Get distance between two points

    Args:
        p1: first point index 0 and 1 should be x and y axis value
        p2: second point index 0 and 1 should be x and y axis value

    Returns:
        distance between two points
    """
    return (p1[0] - p2[0]) * (p1[0] - p2[0]) + (p1[1] - p2[1]) * (p1[1] - p2[1])