2008年12月2日 星期二

電腦鼠-旋轉角度校正

當電腦鼠的旋轉角度需要被校正時,移動方程式應該也是需要被校正的


假設紅色為實際電腦鼠朝向,藍色為利用紅外線來校正旋轉角度。而藍色線也是希望移動到的位置



所以我用VISIO劃製測試圖,希望計算完後可以和量測的差不多。


因為迷宮的每格的距離皆為18公分。為了方便繪圖,我縮小了10倍。


而假設需要被校正的角度為45度。



所以可以利用三角函數來計算


cos(欲被校正的角度)=X/18   。 (X為應該走的距離)


而x1=18-x。(x1 為多走的距離)。


套入剛推導的式子。大概可以得知如果需要被校正45度的話,需小心會多走5.2度左右。


用量測的和計算是有少許的誤差,但是因為裡面劃了一條垂直線,所以會有2個直角三角度,也可以畢式定理來推導是否計算正確。


再用30度的夾角來測試一下。


看起來這樣的公式是可以使用的。


最近想重改校正。但似乎是動一髮而動全身。


原因是用太多try error了。


如果想改裡面的校正的話,如果沒有一塊一塊重新再確認的話,直接寫程式的話,似乎是不可行的。


最近幾天改了好幾塊副程式都改到不知所以然來。


或許把所有的校正都搬開再一塊一塊的把確認過的校正放進去應該會比較合適吧!


不然盲目的寫程式也不知道發生什麼事。


1 則留言:

  1. 1. 如何知道欲被校正角度的大小呢?利用紅外線感測器來校正旋轉角度嗎?那如何利用外線感測器來計算正確的角度呢?
    2. 為何紅色與藍色的電腦鼠運動軌跡都是直線呢?如果不是,cos(欲被校正的角度)=X/18 。 (X為應該走的距離)這樣的公式還能用嗎?

    回覆刪除