[讨论]：[0817]如何判断A角度是否B角度逆时针区间中?

xyz518mm

[讨论]：[0817]如何判断A角度是否B角度逆时针区间中?
小弟写了一个函数,
设基准角为 PR 其中 +PR 逆时针角度为 -PR ,
另设对照角为 SU,
若 SU 并非为 +PR 至 -PR 之间的角度值时, 回传 NIL , 反之传回 1 .

遇到了一个问题就是关於精度值问题,
如:
(ang-side (DTOR 270) (DTOR 269.9999999999999))
_$ 1
(ang-side (DTOR 270) (DTOR 269.99999999999999))
_$ nil

如果为这样的话,
应该回传结果要相同,
但却不同,不知道哪出错了,
另外也请各位高手可以测试一下
看看这函数是否有其他问题.

谢谢~

TEST:
(ang-side (* pi 2) 0)  
_$ nil
(ang-side (* pi 2) (/ pi 2))
_$ nil
(ang-side (* pi 2) pi)
_$ nil
(ang-side (* pi 2) (* pi 1.5))
_$ 1
(Sang-side (* pi 2) (* pi 2))
_$ nil

2. 
   
3. ;;判断A角度是否B角度逆时针区间中
   
4. (defun ang-side
   
5. (pr_ang su_ang / pr_ang_st pr_ang_ed pr_ang_st_ch pr_ang_ed_ch)
   
6. (setq pr_ang (RTOD pr_ang))
   
7. (setq su_ang (RTOD su_ang))
   
8. (if (> pr_ang 360.0)
   
9. (setq pr_ang (abs (- pr_ang (* (fix (/ pr_ang 360.0))360))))
   
10. ) ;超出360检测
    
11. (if (> su_ang 360.0)
    
12. (setq su_ang (abs (- su_ang (* (fix (/ su_ang 360.0))360))))
    
13. )
    
14. (if (<= pr_ang 180.0)
    
15. (progn
    
16. (if (= pr_ang 180.0)
    
17.     (progn
    
18. (setq pr_ang_ed_ch 0.0)
    
19. (setq pr_ang_st_ch pr_ang)
    
20. ) ;_ 结束progn
    
21.     (progn
    
22. (setq pr_ang_ed_ch (+ (- pr_ang 180.0) 360.0))
    
23. (setq pr_ang_st_ch pr_ang)
    
24. ) ;_ 结束progn
    
25.     ) ;_ 结束if
    
26. ) ;_ 结束progn
    
27. (progn
    
28. (if (= pr_ang 360.0)
    
29.     (progn
    
30. (setq pr_ang_ed_ch 180.0)
    
31. (setq pr_ang_st_ch pr_ang)
    
32. ) ;_ 结束progn
    
33.     (progn
    
34. (setq pr_ang_ed_ch (- pr_ang 180.0))
    
35. (setq pr_ang_st_ch pr_ang)
    
36. ) ;_ 结束progn
    
37.     ) ;_ 结束if
    
38. ) ;_ 结束progn
    
39. ) ;_ 结束IF
    
40. ;;设定正逆界线角度
    
41. (cond
    
42. ((< pr_ang 180.0)
    
43. (setq pr_ang_ed (- (+ (- pr_ang 180.0) 360.0) 0.1e-16))
    
44. (setq pr_ang_st (- pr_ang 0.1e-16))
    
45. )
    
46. ((> pr_ang 180.0)
    
47. (setq pr_ang_ed (- (- pr_ang 180.0) 0.1e-16))
    
48. (setq pr_ang_st (- pr_ang 0.1e-16))
    
49. )
    
50. ((= pr_ang 0.0)
    
51. (setq pr_ang_ed (- 180.0 0.1e-16))
    
52. (setq pr_ang_st (+ pr_ang 0.1e-16))
    
53. )
    
54. ((= pr_ang 180.0)
    
55. (setq pr_ang_ed (+ 0.0 0.1e-16))
    
56. (setq pr_ang_st (- pr_ang 0.1e-16))
    
57. )
    
58. ((= pr_ang 360.0)
    
59. (setq pr_ang_ed (- 180.0 0.1e-16))
    
60. (setq pr_ang_st (- pr_ang 0.1e-16))
    
61. )
    
62. ) ;_cond
    
63. ;判断角度 1 & nil
    
64. (cond
    
65. ((= su_ang pr_ang_st_ch)
    
66. (setq ang:ans nil ) );等角为nil
    
67. ((= su_ang pr_ang_ed_ch)
    
68. (setq ang:ans nil ) );对角为nil
    
69. 
    
70. ((or (and (= su_ang 0.0)(= pr_ang 360.0))
    
71.      (and (= su_ang 360.0)(= pr_ang 0.0)))
    
72. (setq ang:ans nil ) );对角为nil
    
73. 
    
74. ((and (< su_ang 180.0) (<= pr_ang 180.0))
    
75. (if (< su_ang pr_ang_st)
    
76.     (setq ang:ans 1 )
    
77.     (setq ang:ans nil )
    
78.     )
    
79. )
    
80. ((and (< su_ang 180.0) (> pr_ang 180.0))
    
81. (if (> su_ang pr_ang_ed )
    
82.     (setq ang:ans 1 )
    
83.     (setq ang:ans nil )
    
84.     )
    
85. )
    
86. ((and (> su_ang 180.0) (< pr_ang 180.0))
    
87. (if (> su_ang pr_ang_ed )
    
88.     (setq ang:ans 1 )
    
89.     (setq ang:ans nil )
    
90.     )
    
91. )
    
92. ((and (> su_ang 180.0) (> pr_ang 180.0))
    
93. (if (< su_ang pr_ang_st)
    
94.     (setq ang:ans 1 )
    
95.     (setq ang:ans nil )
    
96.     )
    
97. )
    
98. (t nil)
    
99. ) ;_cond
    
100. ang:ans
     
101. ) ;_defun
     
102. 
     
103. (defun dtor (dang)
     
104.     (* dang (/ pi 180))
     
105. )
     
106. 
     
107. (defun rtod (rang)
     
108.     (* rang (/ 180 pi))
     
109. )
     

<br /> ;;判断A角度是否B角度逆时针区间中<br /> (defun ang-side<br /> (pr_ang su_ang / pr_ang_st pr_ang_ed pr_ang_st_ch pr_ang_ed_ch)<br /> (setq pr_ang (RTOD pr_ang))<br /> (setq su_ang (RTOD su_ang))<br /> (if (> pr_ang 360.0)<br /> (setq pr_ang (abs (- pr_ang (* (fix (/ pr_ang 360.0))360))))<br /> ) ;超出360检测<br /> (if (> su_ang 360.0)<br /> (setq su_ang (abs (- su_ang (* (fix (/ su_ang 360.0))360))))<br /> )<br /> (if (<= pr_ang 180.0)<br /> (progn<br /> (if (= pr_ang 180.0)<br />     (progn<br /> (setq pr_ang_ed_ch 0.0)<br /> (setq pr_ang_st_ch pr_ang)<br /> ) ;_ 结束progn<br />     (progn<br /> (setq pr_ang_ed_ch (+ (- pr_ang 180.0) 360.0))<br /> (setq pr_ang_st_ch pr_ang)<br /> ) ;_ 结束progn<br />     ) ;_ 结束if<br /> ) ;_ 结束progn<br /> (progn<br /> (if (= pr_ang 360.0)<br />     (progn<br /> (setq pr_ang_ed_ch 180.0)<br /> (setq pr_ang_st_ch pr_ang)<br /> ) ;_ 结束progn<br />     (progn<br /> (setq pr_ang_ed_ch (- pr_ang 180.0))<br /> (setq pr_ang_st_ch pr_ang)<br /> ) ;_ 结束progn<br />     ) ;_ 结束if<br /> ) ;_ 结束progn<br /> ) ;_ 结束IF<br /> ;;设定正逆界线角度<br /> (cond <br /> ((< pr_ang 180.0)<br /> (setq pr_ang_ed (- (+ (- pr_ang 180.0) 360.0) 0.1e-16))<br /> (setq pr_ang_st (- pr_ang 0.1e-16))<br /> )<br /> ((> pr_ang 180.0)<br /> (setq pr_ang_ed (- (- pr_ang 180.0) 0.1e-16))<br /> (setq pr_ang_st (- pr_ang 0.1e-16))<br /> )<br /> ((= pr_ang 0.0)<br /> (setq pr_ang_ed (- 180.0 0.1e-16))<br /> (setq pr_ang_st (+ pr_ang 0.1e-16))<br /> )<br /> ((= pr_ang 180.0)<br /> (setq pr_ang_ed (+ 0.0 0.1e-16))<br /> (setq pr_ang_st (- pr_ang 0.1e-16))<br /> )<br /> ((= pr_ang 360.0)<br /> (setq pr_ang_ed (- 180.0 0.1e-16))<br /> (setq pr_ang_st (- pr_ang 0.1e-16))<br /> )<br /> ) ;_cond<br /> ;判断角度 1 & nil<br /> (cond<br /> ((= su_ang pr_ang_st_ch)<br /> (setq ang:ans nil ) );等角为nil<br /> ((= su_ang pr_ang_ed_ch)<br /> (setq ang:ans nil ) );对角为nil<br /> <br /> ((or (and (= su_ang 0.0)(= pr_ang 360.0))<br />      (and (= su_ang 360.0)(= pr_ang 0.0)))<br /> (setq ang:ans nil ) );对角为nil<br /> <br /> ((and (< su_ang 180.0) (<= pr_ang 180.0))<br /> (if (< su_ang pr_ang_st)<br />     (setq ang:ans 1 )<br />     (setq ang:ans nil )<br />     )<br /> )<br /> ((and (< su_ang 180.0) (> pr_ang 180.0))<br /> (if (> su_ang pr_ang_ed )<br />     (setq ang:ans 1 )<br />     (setq ang:ans nil )<br />     )<br /> )<br /> ((and (> su_ang 180.0) (< pr_ang 180.0))<br /> (if (> su_ang pr_ang_ed )<br />     (setq ang:ans 1 )<br />     (setq ang:ans nil )<br />     )<br /> )<br /> ((and (> su_ang 180.0) (> pr_ang 180.0))<br /> (if (< su_ang pr_ang_st)<br />     (setq ang:ans 1 )<br />     (setq ang:ans nil )<br />     )<br /> )<br /> (t nil)<br /> ) ;_cond<br /> ang:ans<br /> ) ;_defun<br /> <br /> (defun dtor (dang)<br />     (* dang (/ pi 180))<br /> )<br /> <br /> (defun rtod (rang)<br />     (* rang (/ 180 pi))<br /> )<br />