Patent ID: 8401817
Filing Date: 2013-03-19
Classification: G01D,G01P

Abstract:
1. A velocity detection device for periodically sampling coordinates indicating a position of a moving body making a rotational motion or a reciprocating motion, and for detecting a velocity of the moving body based on the coordinates, comprising: a memory storing a plurality of preset temporary angles and trigonometric function values corresponding to the temporary angles, respectively; a first register storing actual first coordinates of the moving body, the actual first coordinates being obtained by a first sampling; a second register storing actual second coordinates of the moving body, the actual second coordinates being obtained by a second sampling next to the first sampling; a rotational direction discriminator calculating at least either an x coordinate or a y coordinate in temporary coordinates on a line, which connects between an origin of the coordinates and a point obtained by rotating the actual second coordinates by as much as a rotational angle θ in a direction of a coordinate axis, the rotational direction discriminator discriminating a rotational direction from the actual first coordinates to the actual second coordinates based on either a sign of the x coordinate in the temporary coordinates or a sign of the y coordinate in the temporary coordinates, the origin of the coordinates being a center of rotation, and the θ being the rotational angle from the actual first coordinates to the coordinate axis; and a processor calculating calculational second coordinates represented by multiplication, addition or subtraction between the actual first coordinates and one of the trigonometric function values in order to make the calculational second coordinates closer to the actual second coordinates based on the rotational direction, the processor calculating the velocity of the moving body based on one of the temporary angles corresponding to the trigonometric function value used for the calculational second coordinates, wherein: the rotational direction discriminator calculates at least either an x coordinate or a y coordinate in temporary coordinates on a line, which connects between the origin of the coordinates and a point obtained by rotating the actual second coordinates by as much as a rotational angle β in the direction of the coordinate axis, the rotational direction discriminator discriminates a rotational direction from the calculational second coordinates to the actual second coordinates based on either a sign of the x coordinate in the temporary coordinates or a sign of the y coordinate in the temporary coordinates, the origin of the coordinates is the center of rotation, the β is the rotational angle from the calculational second coordinates to the coordinate axis, the memory stores Φ the processor repeatedly calculates Equations (3) or (4), where Φ the rotational direction discriminator: calculates the temporary coordinates (x′, y′) by calculating Equation 1 or 2 at i=0 discriminates a rotational direction from the actual first coordinates to the actual second coordinates based on whether a sign of the x′ or a sign of the y′ is plus or minus, and selects either the Equations (3) or (4) according to the rotational direction, and the rotational direction discriminator also: calculates the temporary coordinates (x′, y′) by calculating Equation 16 or 17 at i≧1: discriminates a rotational direction from the calculational second coordinates to the actual second coordinates based on whether the sign of the x′ or the sign of the y′ is plus or minus, and selects either the Equations (3) or (4) according to the rotational direction.