设计思路
-
先竖直方向上进行螺旋线条的绘制,初始化螺线圈位置,使得螺旋线能在竖直方向上竖直上升,同时设置螺旋线参数
-
再将竖直方向的螺旋线条倾斜所需要的的角度,需要左乘旋转矩阵,旋转算子为绕x轴和y轴
4*4矩阵只需在空位置填充0或1
-
绘制动态小坐标系,需要右乘一个绕参考坐标系z轴旋转的旋转矩阵,使得参考坐标系x轴始终指向中心轴线
源代码
clc;clear;
grid on;
n=5; %圈数
r=5; %半径
d=2; %间距
F0=eye(4);%螺线圈初始坐标位置
Tx = [1 0 0 0;%Roll=-20°
0 0.940 0.342 0;
0 -0.342 0.940 0;
0 0 0 1];
Ty = [0.866 0 -0.5 0;%Pitch=-30°
0 1 0 0;
0.5 0 0.866 0;
0 0 0 1];
% yuanzhu %绘制圆柱
for u=0:0.1:2