1 Star 0 Fork 0

gzl2012/lmx_ems_sim

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
theta.m 595 Bytes
一键复制 编辑 原始数据 按行查看 历史
LiAnn 提交于 2018-05-10 13:47 . test OK.
function theta = theta(ctn,g)
global UavHighway
Tunnelnow = UavHighway.group(g).Highway(ctn).ph2 - UavHighway.group(g).Highway(ctn).ph1;
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% 注意Tunnnel1!!
Tunnel1= [1 0]';
tempc = dot(Tunnelnow,Tunnel1); %求内积
tempd = dot(Tunnelnow,Tunnelnow);
tempe = sqrt(tempd);%求Tunnelnow的长度
tempf = dot(Tunnel1,Tunnel1);
tempg = sqrt(tempf); %求Tunnel1的长度
temph = tempc/(tempe*tempg);
theta = acos(temph); %两个向量的夹角
if Tunnelnow(2)<0
theta = -theta;
end
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化
1
https://gitee.com/gzl2012/lmx_ems_sim.git
git@gitee.com:gzl2012/lmx_ems_sim.git
gzl2012
lmx_ems_sim
lmx_ems_sim
master

搜索帮助