用腾讯云做淘宝客购物网站视频商城平台开发公司

Ruckig 是一种实时轨迹生成器，允许机器人和机器即时响应传感器输入。Ruckig 从任意初始状态开始，计算到目标路径点（包括位置、速度和加速度）的轨迹，并受限于速度、加速度和加加速度约束。除了目标状态外，Ruckig 还允许定义中间位置以进行路径点跟踪。对于状态到状态的运动，Ruckig 保证时间最优解。通过中间路径点，Ruckig 联合计算路径及其时间参数化，与传统方法相比，生成的轨迹显著更快。

• 参考 Ruckig 的 GitHub 仓库

1. 基本概念

• 自由度 (Degrees of Freedom, DOFs)：指系统中可以独立运动的维度数量。例如，一个三轴机器人臂有三个自由度。
• 位置 (Position)：系统在某一时刻的具体位置。
• 速度 (Velocity)：系统在某一时刻的运动速度。
• 加速度 (Acceleration)：系统在某一时刻的速度变化率。
• 加加速度 (Jerk)：系统在某一时刻的加速度变化率。
• 输入参数 (Input Parameters)：包括当前状态（位置、速度、加速度）、目标状态（位置、速度、加速度）以及最大速度、加速度和加加速度等约束条件。
• 输出参数 (Output Parameters)：计算得到的新的状态（位置、速度、加速度）。
• 同步模式 (Synchronization)：确保所有自由度在相同的时间内完成运动。

2. 轨迹规划类型

• 状态到状态的轨迹规划：从任意初始状态（包括位置、速度和加速度）到目标状态的轨迹规划，保证时间最优解。
• 路径点跟踪：允许定义中间位置，通过这些路径点进行轨迹规划，联合计算路径及其时间参数化。
• 实时轨迹生成：能够在运行时根据传感器输入即时生成轨迹，适用于需要快速响应的应用场景。

3. 安装

pip install ruckig

4. 使用示例

一自由度的运动规划

import ruckig
import numpy as np
import matplotlib.pyplot as plt# 维度
DOFs = 1  # 1自由度示例# 创建 Ruckig 实例
otg = ruckig.Ruckig(DOFs, 0.01)  # 时间步长为 0.01 秒# 输入和输出参数
input = ruckig.InputParameter(DOFs)
output = ruckig.OutputParameter(DOFs)# 设置初始状态
input.current_position = [0.0]
input.current_velocity = [0.0]
input.current_acceleration = [0.0]# 设置目标状态
input.target_position = [1.0]
input.target_velocity = [0.0]
input.target_acceleration = [0.0]# 设置最大速度、加速度和加加速度
input.max_velocity = [1.0]
input.max_acceleration = [1.0]
input.max_jerk = [1.0]# 用于存储轨迹数据
positions = []
velocities = []
accelerations = []
jerks = []# 计算轨迹
while True:result = otg.update(input, output)if result == ruckig.Result.Finished:break# 存储当前状态positions.append(output.new_position.copy())velocities.append(output.new_velocity.copy())accelerations.append(output.new_acceleration.copy())# 计算并存储加加速度（jerk）if len(accelerations) > 1:jerk = (accelerations[-1][0] - accelerations[-2][0]) / 0.01else:jerk = 0.0jerks.append(jerk)# 更新输入参数input.current_position = output.new_positioninput.current_velocity = output.new_velocityinput.current_acceleration = output.new_acceleration# 转换为 NumPy 数组
positions = np.array(positions)
velocities = np.array(velocities)
accelerations = np.array(accelerations)
jerks = np.array(jerks)# 绘制轨迹图
time_steps = np.arange(positions.shape[0]) * 0.01fig, axs = plt.subplots(4, 1, figsize=(10, 10))axs[0].plot(time_steps, positions, label='Position')
axs[1].plot(time_steps, velocities, label='Velocity')
axs[2].plot(time_steps, accelerations, label='Acceleration')
axs[3].plot(time_steps, jerks, label='Jerk')axs[0].set_title('Position')
axs[1].set_title('Velocity')
axs[2].set_title('Acceleration')
axs[3].set_title('Jerk')for ax in axs:ax.set_xlabel('Time [s]')ax.legend()ax.grid()plt.tight_layout()
plt.show()

七自由度的运动规划

import ruckig
import numpy as np
import matplotlib.pyplot as plt# 维度
DOFs = 7  # 7自由度机械臂# 创建 Ruckig 实例
otg = ruckig.Ruckig(DOFs, 0.01)  # 时间步长为 0.01 秒# 输入和输出参数
input = ruckig.InputParameter(DOFs)
output = ruckig.OutputParameter(DOFs)# 设置初始状态
input.current_position = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
input.current_velocity = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
input.current_acceleration = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]# 设置目标状态（假设已通过逆运动学计算得到）
input.target_position = [1.0, 0.5, 0.25, 0.0, -1.0, -0.5, -0.25]
input.target_velocity = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]
input.target_acceleration = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0]# 设置最大速度、加速度和加加速度
input.max_velocity = [1.0, 1.0, 1.0, 1.0, 1.0, 1.0, 1.0]
input.max_acceleration = [1.0, 1.0, 1.0, 1.0, 1.0, 1.0, 1.0]
input.max_jerk = [1.0, 1.0, 1.0, 1.0, 1.0, 1.0, 1.0]# 用于存储轨迹数据
positions = []
velocities = []
accelerations = []# 计算轨迹
while True:result = otg.update(input, output)if result == ruckig.Result.Finished:break# 存储当前状态positions.append(output.new_position.copy())velocities.append(output.new_velocity.copy())accelerations.append(output.new_acceleration.copy())# 更新输入参数input.current_position = output.new_positioninput.current_velocity = output.new_velocityinput.current_acceleration = output.new_acceleration# 转换为 NumPy 数组
positions = np.array(positions)
velocities = np.array(velocities)
accelerations = np.array(accelerations)# 绘制轨迹图
time_steps = np.arange(positions.shape[0]) * 0.01fig, axs = plt.subplots(3, 1, figsize=(10, 8))for i in range(DOFs):axs[0].plot(time_steps, positions[:, i], label=f'Joint {i+1}')axs[1].plot(time_steps, velocities[:, i], label=f'Joint {i+1}')axs[2].plot(time_steps, accelerations[:, i], label=f'Joint {i+1}')axs[0].set_title('Position')
axs[1].set_title('Velocity')
axs[2].set_title('Acceleration')for ax in axs:ax.set_xlabel('Time [s]')ax.legend()ax.grid()plt.tight_layout()
plt.show()