1 简介
针对当前翼伞空投航迹规划中未考虑复杂风场影响,文中提出一种利用风场优势求解最优航迹的算法。将航 迹规划问题转换成 Bezier 曲线的参数寻优问题,针对风场环境下可行轨迹特点提出优化策略,提出改进的粒子群优 化算法求取最优解。实验结果表明,该航迹规划算法能在复杂风场环境下求出一条满足各种要求的最优航迹,算法设计合理,工程易实现。
2 部分代码
function particle_v = particle(input)% 利用格栅数据获取,任意粒子的速度% 输入点的坐标(仅含x和y),输出含有速度量的坐标值load wind x2=x(:,:,5); y2=y(:,:,5); u2=u(:,:,5); v2=v(:,:,5); % 导入数据[m, n] = size(x2);[input_m, input_n] = size(input);Output = [];particle_v = [];U = [];for ii = 1:(input_n/2) Input = [input(:,2*ii-1), input(:,2*ii)]; index = 0; distance_min = sqrt(Input(1)^2 + Input(2)^2); for i=1:m*n Point_i = [x2(i) y2(i) u2(i) v2(i)]; distance = sqrt((Point_i(1)-Input(1))^2 + (Point_i(2)-Input(2))^2); if distance < distance_min distance_min = distance; index = i; U = [Point_i(3), Point_i(4)]; end end Output = [Input(1), Input(2), U(1), U(2)]; particle_v = [particle_v, Output];end
3 仿真结果
4 参考文献
[1]于群涛, 陈楸, 李德荣,等. 基于Bezier和改进PSO算法的风环境下翼伞航迹规划[J]. 电子设计工程, 2014, 22(19):4.
博主简介:擅长智能优化算法、神经网络预测、信号处理、元胞自动机、图像处理、路径规划、无人机等多种领域的Matlab仿真,相关matlab代码问题可私信交流。
一些理论参考了网络文学。如有侵权,请联系博主删除。
文章出处登录后可见!
已经登录?立即刷新