lighthouse定位系统入门教程-心电图飞行

原创

创客智造ROS 2024-06-19 11:12:12 ©著作权

文章标签 无人机 crazyflie ros1 无人机编队 crazyswarm 文章分类 MySQL 数据库

©著作权归作者所有：来自51CTO博客作者创客智造ROS的原创作品，请联系作者获取转载授权，否则将追究法律责任

lighthouse定位系统入门教程-硬件
lighthouse定位系统入门教程-软件
lighthouse定位系统入门教程-安装系统和相关软件
lighthouse定位系统入门教程-安装客户端
lighthouse定位系统入门教程-更新固件
lighthouse定位系统入门教程-配置基站通道（2个基站）
lighthouse定位系统入门教程-配置基站通道（4个基站）
lighthouse定位系统入门教程-通过cfclient测试飞行
lighthouse定位系统入门教程-测试单台无人机起飞和降落
lighthouse定位系统入门教程-测试单台无人机8字飞行
lighthouse定位系统入门教程-测试多台无人机方形绕飞
lighthouse定位系统入门教程-测试无人机圆形飞行
lighthouse定位系统入门教程-安装生成轨迹包
lighthouse定位系统入门教程-生成航点和轨迹
lighthouse定位系统入门教程-单机螺旋上升直线下降
lighthouse定位系统入门教程-心电图飞行
lighthouse定位系统入门教程-多边形飞行
lighthouse定位系统入门教程-圆形飞行
lighthouse定位系统入门教程-拼字母ABCD
lighthouse定位系统入门教程-拼数字1234

说明

介绍如何实现单台无人机的心电图飞行
本文基于无人机多机套件主机测试
Crazyflie无人机集群套件，采购地址

仿真飞行：

生成心电图轨迹的点坐标的脚本

import numpy as np
import matplotlib.pyplot as plt
from mpl_toolkits.mplot3d import Axes3D

# Define ECG curve equation (e.g., sine wave)
t = np.linspace(0, 7*np.pi, 30)
z = 0.3 + 0.38 * np.sin(t)  # Adjust amplitude and frequency as needed
x = 0.5 * t / (2*np.pi)     # Scale y-axis to match height
y = np.zeros_like(t)        # Set z-axis to 0 (assuming flat plane)

# Create 3D plot
fig = plt.figure()
ax = fig.add_subplot(111, projection='3d')
ax.plot(x, y, z)

# Save 3D coordinates to a file
data = np.column_stack((x, y, z))
np.savetxt('ecg_coordinates.csv', data, delimiter=',')

# Show plot (optional)
plt.show()

生成轨迹，参考
进入脚本目录

roscd crazyswarm/scripts/

脚本代码

#!/usr/bin/env python

import numpy as np

from pycrazyswarm import *
import uav_trajectory

if __name__ == "__main__":
    swarm = Crazyswarm()
    timeHelper = swarm.timeHelper
    allcfs = swarm.allcfs

    traj1 = uav_trajectory.Trajectory()
    traj1.loadcsv("ecg_coordinates.csv")

    TRIALS = 1
    TIMESCALE = 1.0
    for i in range(TRIALS):
        for cf in allcfs.crazyflies:
            cf.uploadTrajectory(0, 0, traj1)

        allcfs.takeoff(targetHeight=0.5, duration=2.0)
        timeHelper.sleep(2.5)
        for cf in allcfs.crazyflies:
            pos = np.array(cf.initialPosition) + np.array([0, 0, 0.5])
            cf.goTo(pos, 0, 2.0)
        timeHelper.sleep(2.5)

        allcfs.startTrajectory(0, timescale=TIMESCALE)
        timeHelper.sleep(traj1.duration * TIMESCALE + 2.0)
        # allcfs.startTrajectory(0, timescale=TIMESCALE, reverse=True)
        # timeHelper.sleep(traj1.duration * TIMESCALE + 2.0)

        allcfs.land(targetHeight=0.06, duration=2.0)
        timeHelper.sleep(3.0)