[發明專利]速度檢測裝置

有效

• 申請號: 200710196856.0
• 申請日: 2007-12-05
• 公開（公告）號: CN101196532A
• 公開（公告）日: 2008-06-11
• 發明（設計）人: 青野龍二
• 申請（專利權）人: 東芝機械株式會社
• 主分類號: G01P3/64
• 分類號: G01P3/64;G06F1/03
• 代理公司: 中國專利代理(香港)有限公司
• 代理人: 曾祥夌;劉宗杰

1.一種將表示進行旋轉運動或往復運動的運動體位置的座標周期地采樣，并基于所述座標檢測出所述運動體的角速度的速度檢測裝置，其特征在于：

設有：存儲預設的多個暫設角度和與該多個暫設角度中各角度對應的三角函數值的存儲器；

存放通過第1采樣得到的運動體的第1實際座標(x1、y1)的第1寄存器；

存放通過接著所述第1采樣的第2采樣得到的運動體的第2實際座標(x2、y2)的第2寄存器；

算出第1計算座標的第1運算部，該第1計算座標通過將所述x1和按照所述三角函數值移動y1的數位后的結果值相加或相減來表達；

算出第2計算座標的第2運算部，該第2計算座標通過將所述y2和按照所述三角函數值移動x2的數位后的結果值相加或相減來表達；以及

累計由所述第1或所述第2運算部的運算中使用的所述暫設角度的第3運算部，

所述第1和所述第2運算部進行運算，使所述第1和所述第2實際座標相互接近。

2.如權利要求1所述的速度檢測裝置，其特征在于：

所述第1和所述第2運算部重復運算，一邊減小所述暫設角度，一邊使所述第1和所述第2計算座標收斂，

所述第3運算部累計經所述第1或所述第2運算部的運算而收斂的所述暫設角度，并基于所述第1和所述第2計算座標收斂后的該暫設角度，生成所述運動體的角速度。

3.如權利要求1或權利要求2所述的速度檢測裝置，其特征在于：

所述存儲器存儲Φ_i(Φ₀＞Φ₁＞Φ₂＞…＞Φ_i＞…Φ_n)(n為自然數)作為所述暫設角度，并存儲tanΦ_i作為所述三角函數值，

設所述第1或所述第2計算座標為(xxc_i，yyc_i)，則有：

xxci=xxci-1-yyci-1*tanΦiyyci=yyci-1+xxci-1*tanΦi]]>式1

xxci=xxci-1-yyci-1*tanΦiyyci=yyci-1+xxci-1*tanΦi]]>式2

式中，Φ_i＝tan^-12^-i(i＝0、1、2…n)，i＝0時所述第1運算部中xxc_i-1＝x1、yyc_i-1＝y1，所述第2運算部中xxc_i-1＝x2、yyc_i-1＝y2，

所述第1和所述第2運算部按i＝0、1、2…n的順序演算式1或式2，

所述第3運算部按各個i累計所述暫設角度。