import math


def distance_vehicle(waypoint, vehicle_position):
    """
    Calculate distance between waypoint and vehicle position
    """
    dx = waypoint[0] - vehicle_position[0]
    dy = waypoint[1] - vehicle_position[1]
    dz = waypoint[2] - vehicle_position[2]

    return math.sqrt(dx * dx + dy * dy + dz * dz)