20251117

2025-11-17 11:16:02 +08:00
parent 4bd2d87fc4
commit 1b3b07a7f6
35 changed files with 454 additions and 0 deletions
@@ -0,0 +1,10 @@
+function [raf,jl]=pmzbfs(x1,y1,x2,y2)
+detx=x2-x1;dety=y2-y1;
+faw1=atan(dety/detx);
+j1=sqrt(detx*detx+dety*dety);
+if detx<0
+    raf=faw1+pi;
+end
+if (detx>0)*(det<0)
+    raf=faw1+2*pi;
+end