求Matlab bsplinepolytraj函数的Python等效实现

用SciPy实现核心功能 #

SciPy的scipy.interpolate.make_interp_spline可以完美替代bsplinepolytraj，支持生成B样条轨迹并输出位置、速度、加速度，逻辑和Matlab原生函数一致。

步骤示例 #

1. 导入依赖

import numpy as np
from scipy.interpolate import make_interp_spline

2. 准备输入数据
   假设你有机器人关节路径点和对应的时间节点（如果没指定时间，可均匀分配）：

# 示例：3自由度机械臂的5个路径点
waypoints = np.array([[0, 0, 0], [1, 2, 3], [4, 5, 6], [7, 8, 9], [10, 10, 10]])
# 均匀分配时间（总时长5秒）
t_waypoints = np.linspace(0, 5, len(waypoints))

3. 生成轨迹并计算运动数据
   默认生成三次B样条（和bsplinepolytraj默认一致），通过求导得到速度和加速度：

# 创建B样条对象，k=3对应三次样条
spl = make_interp_spline(t_waypoints, waypoints, k=3)

# 定义输出的时间序列（更密集的采样点）
t_eval = np.linspace(t_waypoints[0], t_waypoints[-1], 100)

# 计算位置、速度、加速度
pos = spl(t_eval)
vel = spl(t_eval, 1)  # 一阶导数为速度
acc = spl(t_eval, 2)  # 二阶导数为加速度

匹配Matlab默认行为的细节 #

• bsplinepolytraj默认使用自然边界条件（两端二阶导数为0），make_interp_spline默认也是该设置，无需额外调整。
• 若需自定义边界（比如指定两端速度），可通过bc_type参数设置：

# 示例：强制起始和结束速度为0
bc_type = ((1, [0, 0, 0]), (1, [0, 0, 0]))
spl = make_interp_spline(t_waypoints, waypoints, k=3, bc_type=bc_type)

封装化方案：robopy库 #

如果需要更贴近机器人轨迹生成的封装接口，可以使用robopy库，它提供了和Matlab风格更接近的BSpline轨迹生成工具：

from robopy.trajectory import BSplineTrajectory

# 创建轨迹对象
traj = BSplineTrajectory(waypoints, t_waypoints)

# 计算各时刻的运动数据
pos = traj.position(t_eval)
vel = traj.velocity(t_eval)
acc = traj.acceleration(t_eval)

安装方式：pip install robopy

内容的提问来源于stack exchange，提问作者ediblazetp