import numpy as np
MAX_SPEED = 30
v = np.array([50,50,0])
def truncate(vector, min_length=None, max_length=None):
"""
Truncate the length of a vector to be within the specified range.
Parameters:
vector (numpy.ndarray): The input vector.
min_length (float, optional): The minimum length of the vector. Defaults to None.
max_length (float, optional): The maximum length of the vector. Defaults to None.
Returns:
numpy.ndarray: The truncated vector.
"""
length = np.linalg.norm(vector) # 计算向量的长度
if min_length is not None and length < min_length:
# 如果指定了最小长度且当前长度小于最小长度,则缩放到最小长度
return vector / length * min_length
elif max_length is not None and length > max_length: