[发明专利]速度检测装置

权利要求书

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累计所述暂设角度。